99 lines
1.9 KiB
C
99 lines
1.9 KiB
C
|
#include <time.h>
|
||
|
#include <errno.h>
|
||
|
|
||
|
#include "capwap/capwap.h"
|
||
|
#include "capwap/conn.h"
|
||
|
#include "capwap/radioinfo.h"
|
||
|
#include "capwap/cw_log.h"
|
||
|
#include "capwap/dtls.h"
|
||
|
|
||
|
|
||
|
#include "wtp_conf.h"
|
||
|
|
||
|
static int echo_interval_timer;
|
||
|
|
||
|
struct cwrmsg * get_response(struct conn * conn, int type,int seqnum)
|
||
|
{
|
||
|
struct cwrmsg * cwrmsg;
|
||
|
int i;
|
||
|
for(i=0; i<conf_retransmit_interval; i++){
|
||
|
cwrmsg = conn_get_message(conn);
|
||
|
if ( cwrmsg==0){
|
||
|
//printf("null message \n");
|
||
|
continue;
|
||
|
}
|
||
|
|
||
|
if (cwrmsg->type==type && cwrmsg->seqnum==seqnum)
|
||
|
return cwrmsg;
|
||
|
printf("another message was detected %i %i\n",cwrmsg->type,cwrmsg->seqnum);
|
||
|
}
|
||
|
return 0;
|
||
|
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
struct cwrmsg * send_request(struct conn * conn,struct cwmsg *cwmsg)
|
||
|
{
|
||
|
int i;
|
||
|
for (i=0; i<conf_max_retransmit; i++){
|
||
|
|
||
|
#ifdef WITH_CW_LOG_DEBUG
|
||
|
if (i>0){
|
||
|
cw_log_debug1("Retransmitting request, type=%i,seqnum=%i",cwmsg->type,cwmsg->seqnum);
|
||
|
}
|
||
|
#endif
|
||
|
|
||
|
int rc = conn_send_cwmsg(conn,cwmsg);
|
||
|
if (rc<0){
|
||
|
cw_log_debug1("Error sending request, type=%i, seqnum %i, %s",cwmsg->type,cwmsg->seqnum,strerror(errno));
|
||
|
return 0;
|
||
|
}
|
||
|
struct cwrmsg * r = get_response(conn,cwmsg->type+1,cwmsg->seqnum);
|
||
|
if (r)
|
||
|
return r;
|
||
|
|
||
|
}
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
|
||
|
|
||
|
|
||
|
int run(struct conn * conn)
|
||
|
{
|
||
|
struct radioinfo radioinfo;
|
||
|
memset(&radioinfo,0,sizeof(radioinfo));
|
||
|
|
||
|
echo_interval_timer=time(NULL);
|
||
|
while (1){
|
||
|
if (time(NULL)-echo_interval_timer >= conf_echo_interval)
|
||
|
{
|
||
|
struct cwmsg cwmsg;
|
||
|
uint8_t buffer[CWMSG_MAX_SIZE];
|
||
|
|
||
|
// cwsend_echo_request(conn,&radioinfo);
|
||
|
|
||
|
cw_log_debug1("Sending echo request");
|
||
|
cwmsg_init_echo_request(&cwmsg,buffer,conn,&radioinfo);
|
||
|
struct cwrmsg * rc = send_request(conn,&cwmsg);
|
||
|
|
||
|
// printf("conn->seqnum %i\n",conn->seqnum);
|
||
|
// struct cwrmsg * rc = get_response(conn,CWMSG_ECHO_RESPONSE,conn->seqnum);
|
||
|
if (rc==0){
|
||
|
|
||
|
dtls_shutdown(conn);
|
||
|
cw_log_debug1("Connection lost, no echo response");
|
||
|
return 0;
|
||
|
}
|
||
|
echo_interval_timer=time(NULL);
|
||
|
}
|
||
|
sleep(1);
|
||
|
|
||
|
}
|
||
|
exit(0);
|
||
|
}
|
||
|
|
||
|
|
||
|
|