2015-04-10 17:16:33 +02:00
|
|
|
#include <errno.h>
|
|
|
|
|
2018-03-17 17:29:09 +01:00
|
|
|
|
2015-04-10 17:16:33 +02:00
|
|
|
#include "conn.h"
|
2016-03-11 22:23:00 +01:00
|
|
|
#include "cw.h"
|
2015-04-10 17:52:01 +02:00
|
|
|
#include "log.h"
|
2015-04-14 07:42:23 +02:00
|
|
|
#include "dbg.h"
|
2015-04-10 17:16:33 +02:00
|
|
|
#include "sock.h"
|
2015-04-11 19:00:51 +02:00
|
|
|
#include "timer.h"
|
2015-04-10 17:16:33 +02:00
|
|
|
|
2015-04-14 07:42:23 +02:00
|
|
|
|
|
|
|
|
|
|
|
|
2016-03-27 04:53:12 +02:00
|
|
|
int conn_send_data_msg(struct conn * conn, uint8_t *rawmsg,int len)
|
|
|
|
{
|
|
|
|
int packetlen = len;
|
2018-03-25 10:07:39 +02:00
|
|
|
int fragoffset;
|
|
|
|
int hlen;
|
|
|
|
|
|
|
|
uint8_t * ptr;
|
|
|
|
int mtu;
|
|
|
|
|
2016-03-27 04:53:12 +02:00
|
|
|
cw_dbg_msg(DBG_MSG_OUT, conn,rawmsg, packetlen,(struct sockaddr*)&conn->addr);
|
|
|
|
|
|
|
|
|
2018-03-25 10:07:39 +02:00
|
|
|
ptr = rawmsg;
|
2016-03-27 04:53:12 +02:00
|
|
|
|
2018-03-25 10:07:39 +02:00
|
|
|
fragoffset = 0;
|
2016-03-27 04:53:12 +02:00
|
|
|
|
2018-03-25 10:07:39 +02:00
|
|
|
hlen = cw_get_hdr_hlen(rawmsg)*4;
|
2016-03-27 04:53:12 +02:00
|
|
|
|
2018-03-25 10:07:39 +02:00
|
|
|
mtu = conn->mtu;
|
2016-03-27 04:53:12 +02:00
|
|
|
|
|
|
|
while (packetlen>mtu){
|
2018-02-23 09:30:10 +01:00
|
|
|
cw_set_hdr_flags(rawmsg,CAPWAP_FLAG_HDR_F,1);
|
2018-03-25 10:35:53 +02:00
|
|
|
cw_set_dword(ptr+4, conn->fragid<<16 | fragoffset<<3 );
|
2016-03-27 04:53:12 +02:00
|
|
|
|
|
|
|
cw_dbg_pkt(DBG_PKT_OUT,conn,ptr,mtu,(struct sockaddr*)&conn->addr);
|
|
|
|
|
2018-03-25 10:07:39 +02:00
|
|
|
/* if (conn->write_data(conn,ptr,mtu)<0)*/
|
2016-03-27 04:53:12 +02:00
|
|
|
return -1;
|
|
|
|
|
2018-03-25 10:07:39 +02:00
|
|
|
/* // XXX Fragmentation stuff..*/
|
2016-03-27 04:53:12 +02:00
|
|
|
ptr +=mtu-hlen;
|
|
|
|
fragoffset+=(mtu-hlen)/8;
|
2015-04-14 07:42:23 +02:00
|
|
|
|
2016-03-27 04:53:12 +02:00
|
|
|
packetlen-=mtu-hlen;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
if (fragoffset)
|
2018-02-23 09:30:10 +01:00
|
|
|
cw_set_hdr_flags(rawmsg,CAPWAP_FLAG_HDR_F | CAPWAP_FLAG_HDR_L,1);
|
2016-03-27 04:53:12 +02:00
|
|
|
else
|
2018-02-23 09:30:10 +01:00
|
|
|
cw_set_hdr_flags(rawmsg,CAPWAP_FLAG_HDR_F,0);
|
2016-03-27 04:53:12 +02:00
|
|
|
|
2018-03-25 10:35:53 +02:00
|
|
|
cw_set_dword(ptr+4, conn->fragid<<16 | fragoffset<<3 );
|
2016-03-27 04:53:12 +02:00
|
|
|
|
|
|
|
|
|
|
|
cw_dbg_pkt(DBG_PKT_OUT,conn,ptr,packetlen,(struct sockaddr*)&conn->addr);
|
|
|
|
|
2018-03-25 10:07:39 +02:00
|
|
|
/*// return conn->write_data(conn,ptr,packetlen-0);*/
|
2016-03-27 04:53:12 +02:00
|
|
|
|
2018-03-25 10:07:39 +02:00
|
|
|
return 0;
|
2016-03-27 04:53:12 +02:00
|
|
|
}
|
2015-04-14 07:42:23 +02:00
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2015-04-10 17:16:33 +02:00
|
|
|
int cw_send_request(struct conn *conn,int msg_id)
|
|
|
|
{
|
2018-03-25 10:07:39 +02:00
|
|
|
time_t timer;
|
|
|
|
int i;
|
|
|
|
int rc;
|
2018-03-05 12:23:16 +01:00
|
|
|
char sock_buf[SOCK_ADDR_BUFSIZE];
|
2015-04-10 17:16:33 +02:00
|
|
|
cw_init_request(conn, msg_id);
|
2016-03-05 09:03:52 +01:00
|
|
|
if ( cw_put_msg(conn, conn->req_buffer) == -1 ){
|
|
|
|
errno=ENOMSG;
|
|
|
|
return -1;
|
|
|
|
}
|
2015-04-10 17:16:33 +02:00
|
|
|
conn_send_msg(conn, conn->req_buffer);
|
|
|
|
|
|
|
|
|
2018-03-25 10:07:39 +02:00
|
|
|
|
|
|
|
rc=-1;
|
2015-04-10 17:16:33 +02:00
|
|
|
for (i=0; i<conn->max_retransmit && rc<0; i++){
|
2015-04-11 19:00:51 +02:00
|
|
|
if ( i>0 ){
|
|
|
|
cw_log(LOG_WARNING,"Retransmitting request ... %d",i);
|
|
|
|
}
|
2018-03-25 10:07:39 +02:00
|
|
|
timer = cw_timer_start(conn->retransmit_interval);
|
2015-04-10 17:16:33 +02:00
|
|
|
while (!cw_timer_timeout(timer) && rc<0){
|
|
|
|
|
|
|
|
rc =cw_read_messages(conn);
|
|
|
|
if(rc<0){
|
|
|
|
if (errno!=EAGAIN)
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
if (rc<0){
|
|
|
|
if(errno!=EAGAIN)
|
|
|
|
break;
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
}
|
|
|
|
|
2015-04-11 19:00:51 +02:00
|
|
|
if ( rc <0 && errno != EAGAIN) {
|
2018-03-05 12:23:16 +01:00
|
|
|
cw_log(LOG_ERR,"Can't read from %s: %s",sock_addr2str(&conn->addr,sock_buf),strerror(errno));
|
2015-04-10 17:16:33 +02:00
|
|
|
}
|
2015-04-11 19:00:51 +02:00
|
|
|
if ( rc <0 && errno == EAGAIN) {
|
|
|
|
errno=ETIMEDOUT;
|
|
|
|
rc=-1;
|
|
|
|
}
|
2015-04-10 17:16:33 +02:00
|
|
|
|
|
|
|
return rc;
|
|
|
|
}
|
2015-04-30 14:10:59 +02:00
|
|
|
|
|
|
|
|
2018-03-25 10:07:39 +02:00
|
|
|
/*// XXX find a better name for this function */
|
2015-05-01 20:34:50 +02:00
|
|
|
int cw_send_custom_request_2(struct conn *conn,int msg_id)
|
2015-04-30 14:10:59 +02:00
|
|
|
{
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|