struct wtpman * wtplist_get(const struct sockaddr * addr) { struct conn * conn = connlist_get(connlist,addr); if (!conn) return 0; return conn->data; }
void event_reconnect(struct eventhub * hub){ struct list_head * head = connlist_get(); if(!connlist_check(CONNSOCKETSERVER)){ struct connection * serverconn = connectserver(); if(serverconn){ eventhub_register(hub,connection_getfd(serverconn)); } } if(!connlist_check(CONNSERIALPORT)){ struct connection * serialconn = connserialport(); if(serialconn){ eventhub_register(hub,connection_getfd(serialconn)); } } }
static int do_discover_conn(struct conn * conn,struct discovery_info * di) { rand_sleep(conf_max_discovery_interval); struct wtpinfo * wtpinfo; wtpinfo = get_wtpinfo(); // wtpinfo_print(wtpinfo); // struct timespec tstart,tcur; struct radioinfo ri; memset(&ri,0,sizeof(ri)); ri.rmac[0]=6; ri.rmac[2]=14; ri.rmac[3]=14; ri.rmac[4]=14; ri.rmac[5]=14; ri.rmac[6]=14; ri.rmac[7]=14; #ifdef WITH_CW_LOG_DEBUG char str[100]; sock_addrtostr((struct sockaddr*)&conn->addr,str,100); cw_log_debug0("Sending discovery request to %s",str); #endif int rc; do { rc = cwsend_discovery_request(conn,&ri,wtpinfo); if (rc<0){ if (errno == EINTR) continue; if (errno == EMSGSIZE){ conn->mtu-=4; cw_log_debug2("Setting mtu to %i",conn->mtu); continue; } } break; }while (rc<0); if (rc < 0 ) { char str[100]; sock_addrtostr((struct sockaddr*)&conn->addr,str,100); cw_log(LOG_ERR,"Error sending discovery request to %s: %s",str,strerror(errno)); return 0; } struct connlist * connlist; connlist = connlist_create(30); // clock_gettime(CLOCK_REALTIME,&tstart); // int tstart = time(0); int treset = 0; do { char buf[2048]; int buflen=2048; struct sockaddr_storage sa; socklen_t fromlen=sizeof(struct sockaddr_storage); rc = recvfrom(conn->sock,buf,buflen,0,(struct sockaddr*)&sa,&fromlen); if (rc<0){ if (errno==EINTR) rc=0; if (errno==EAGAIN) rc=0; if (errno==EWOULDBLOCK) rc=0; } if (rc>0) { #ifdef WITH_CW_LOG_DEBUG char str[100]; sock_addrtostr((struct sockaddr*)&sa,str,100); cw_log_debug0("Received packet from %s",str); #endif struct conn * rconn; rconn = connlist_get(connlist,(struct sockaddr*)&sa); if (!rconn){ rconn = conn_create_noq(conn->sock,(struct sockaddr*)&sa); //msg_cb,NULL,0); // rconn->pmsgarg=conn->pmsgarg; rconn->mtu = conn->mtu; rconn->seqnum=conn->seqnum; connlist_add(connlist,rconn); } conn_process_packet(rconn,(uint8_t*)buf,rc,msg_cb,di); } /* reset discovery timer after we have received the first response */ if ( di->response_count == 1 && !treset ){ tstart=time(0); treset=1; } //clock_gettime(CLOCK_REALTIME,&tcur); // printf("TTSub: %i %i\n",time(0)-tstart, conf_discovery_interval); }while(time(0)-tstart < conf_discovery_interval && rc>=0 ); if (rc <0){ char str[100]; sock_addrtostr((struct sockaddr*)&conn->addr,str,100); cw_log(LOG_ERR,"Error sendings discovery request to %s: %s",str,strerror(errno)); } connlist_destroy(connlist); return 1; }