int main (int argc, char *argv[]) { FILE *fp; uint8_t tx_buf[128]; uint8_t rx_buf[128]; TRANSDUCER_PKT_T tran_pkt; TRANSDUCER_MSG_T tran_msg; int32_t v,cnt,i,len,j; uint8_t nav_time_secs, reply_time_secs; int32_t tmp; time_t reply_timeout,nav_timeout,t; uint8_t cmd,error; char buf[1024]; char mbuf[128]; uint8_t num_msgs,p2p_mode,echo; FF_POWER_ACTUATE_PKT ff_pwr_actuate[10]; uint8_t ff_pwr_actuate_mac[10]; uint8_t ff_pwr_actuate_ack[10]; debug_txt_flag=0; p2p_mode=0; if (argc < 6 ) { printf ("Usage: server port num-msgs [mac-addr socket state] [-m or p]\n"); printf (" ex: %s localhost 5000 1 0x000000f0 1 on\n",argv[0]); printf (" mac-addr MAC address of node to actuate\n"); printf (" socket 0 or 1\n"); printf (" state on or off\n"); printf (" -d debug mode\n"); printf (" -m multi-cast\n"); printf (" -p P2P packet mode\n"); exit (1); } for(i=0; i<argc; i++ ) { // Grab dash command line options if(strstr(argv[i],"-d")!=NULL ) debug_txt_flag=1; if(strcmp(argv[i],"-p")==0) p2p_mode=1; if(strcmp(argv[i],"-m")==0) p2p_mode=0; } sscanf( argv[3],"%d",&tmp); num_msgs=tmp; if(p2p_mode==1 && num_msgs!=1 ) { printf( "Error: Can't send multi-cast p2p message\n" ); return -1; } if(num_msgs>9 ) { printf( "Sorry, too many messages...\n" ); return 0; } if(debug_txt_flag==1) printf( "Composing %d actuation msgs\n", num_msgs ); for(i=0; i<num_msgs; i++ ) { sscanf( argv[(i*3)+4],"%x",&tmp ); subnet_3=(tmp&0xff000000) >> 24; subnet_2=(tmp&0xff0000) >> 16; subnet_1=(tmp&0xff00) >> 8; ff_pwr_actuate_mac[i]=(tmp & 0xff); ff_pwr_actuate_ack[i]=0; if(debug_txt_flag==1) printf( "MAC_ADDR: 0x%x ",ff_pwr_actuate_mac[i]); sscanf( argv[(i*3)+5],"%d",&tmp ); if(debug_txt_flag==1) printf( " socket 0 " ); ff_pwr_actuate[i].socket0_state=SOCKET_HOLD; ff_pwr_actuate[i].socket1_state=SOCKET_HOLD; if( strstr(argv[(i*3)+6],"on")!=NULL ) { if(tmp==0) ff_pwr_actuate[i].socket0_state=SOCKET_ON; else ff_pwr_actuate[i].socket1_state=SOCKET_ON; } else { if(tmp==0) ff_pwr_actuate[i].socket0_state=SOCKET_OFF; else ff_pwr_actuate[i].socket1_state=SOCKET_OFF; } if(debug_txt_flag==1) { printf( "Socket MAC %d\n",ff_pwr_actuate_mac[i] ); printf( " Socket 0: %d\n",ff_pwr_actuate[i].socket0_state ); printf( " Socket 1: %d\n",ff_pwr_actuate[i].socket1_state ); } } v=slipstream_open(argv[1],atoi(argv[2]),NONBLOCKING); nav_time_secs=25; cnt = 0; while (1) { error=0; cmd=0; retry: // Setup the packet to send out to the network if(!p2p_mode) { // These values setup the internal data structure and probably don't // need to be changed ds_pkt.payload_len=0; ds_pkt.buf=tx_buf; ds_pkt.buf_len=DS_PAYLOAD_START; ds_pkt.payload_start=DS_PAYLOAD_START; ds_pkt.payload=&(tx_buf[DS_PAYLOAD_START]); // These are parameters that can be adjusted for different packets //ds_pkt.pkt_type=PING_PKT; ds_pkt.pkt_type=TRANSDUCER_PKT; ds_pkt.ctrl_flags= DS_MASK | DEBUG_FLAG | ENCRYPT; //srand(time(NULL)); //ds_pkt.seq_num=rand()%255; // Use the gateway's spiffy auto-cnt when set to 0 ds_pkt.seq_num=0; // Use the gateway's spiffy auto-cnt when set to 0 if(debug_txt_flag==1) printf( "rand seq-num=%d\n",ds_pkt.seq_num ); ds_pkt.priority=0; ds_pkt.ack_retry=10; ds_pkt.subnet_mac[0]=subnet_1; ds_pkt.subnet_mac[1]=subnet_2; ds_pkt.subnet_mac[2]=subnet_3; ds_pkt.hop_cnt=0; // Starting depth, always keep at 0 ds_pkt.hop_max=5; // Max tree depth ds_pkt.delay_per_level=0; // Reply delay per level in seconds ds_pkt.nav=0; // Time in seconds until next message to be sent ds_pkt.mac_check_rate=100; // B-mac check rate in ms ds_pkt.rssi_threshold=-45; // Reply RSSI threshold ds_pkt.last_hop_mac=0; ds_pkt.mac_filter_num=0; // Increase if MAC_FILTER is active ds_pkt.aes_ctr[0]=0; // Encryption AES counter ds_pkt.aes_ctr[1]=0; ds_pkt.aes_ctr[2]=0; ds_pkt.aes_ctr[3]=0; } else { // These values setup the internal data structure and probably don't // need to be changed p2p_pkt.payload_len=0; p2p_pkt.buf=tx_buf; p2p_pkt.buf_len=P2P_PAYLOAD_START; p2p_pkt.payload_start=P2P_PAYLOAD_START; p2p_pkt.payload=&(tx_buf[P2P_PAYLOAD_START]); // These are parameters that can be adjusted for different packets //p2p_pkt.pkt_type=PING_PKT; p2p_pkt.pkt_type=TRANSDUCER_PKT; p2p_pkt.ctrl_flags= MOBILE_MASK | LINK_ACK | DEBUG_FLAG | ENCRYPT; p2p_pkt.seq_num=0; // Use the gateway's spiffy auto-cnt when set to 0 //p2p_pkt.seq_num=rand()%255; // Use the gateway's spiffy auto-cnt when set to 0 if(debug_txt_flag==1) printf( "rand seq-num=%d\n",p2p_pkt.seq_num ); p2p_pkt.priority=0; p2p_pkt.hop_cnt=0; p2p_pkt.ttl=5; p2p_pkt.ack_retry=10; p2p_pkt.src_subnet_mac[0]=0; p2p_pkt.src_subnet_mac[1]=0; p2p_pkt.src_subnet_mac[2]=0; p2p_pkt.src_mac=0; p2p_pkt.last_hop_mac=0; p2p_pkt.next_hop_mac=BROADCAST; p2p_pkt.dst_subnet_mac[0] = subnet_1; p2p_pkt.dst_subnet_mac[1] = subnet_2; p2p_pkt.dst_subnet_mac[2] = subnet_3; p2p_pkt.dst_mac = ff_pwr_actuate_mac[0]; p2p_pkt.check_rate=100; // B-mac check rate in ms } // At the top level you have a SAMPL packet (ds_pkt) // For transducers, this holds a single transducer pkt (tran_pkt) // Each transducer packet contains multiple transducer messages (tran_msg) // Transducers typically have helper functions used to pack the transducer messages. // Setup Transducer Packet tran_pkt.num_msgs=0; tran_pkt.checksum=0; tran_pkt.msgs_payload=buf; for(i=0; i<num_msgs; i++ ) { // Setup Transducer Message tran_msg.mac_addr = ff_pwr_actuate_mac[i]; tran_msg.type = TRAN_POWER_PKT; tran_msg.len = 0; tran_msg.payload = mbuf; // Pack application specifc message into transducer message tran_msg.len=ff_power_actuate_pack(mbuf, &(ff_pwr_actuate[i])); // Add the transducer message to the transducer packet len=transducer_msg_add( &tran_pkt, &tran_msg); // printf( "payload = " ); // for(j=0; j<len; j++ ) // printf( "%d ",ds_pkt.payload[j] ); // printf( "\n" ); } if(!p2p_mode) { // Add the packet to the payload ds_pkt.payload_len = transducer_pkt_pack(&tran_pkt, ds_pkt.payload); // This takes the structure and packs it into the raw // array that is sent using SLIP pack_downstream_packet( &ds_pkt); // Add MAC filter entries below // downstream_packet_add_mac_filter( &ds_pkt, 0x07 ); // downstream_packet_add_mac_filter( &ds_pkt, 3 ); // downstream_packet_add_mac_filter( &ds_pkt, 4 ); // downstream_packet_add_mac_filter( &ds_pkt, 5 ); // Print your packet on the screen if(debug_txt_flag==1) print_ds_packet(&ds_pkt ); if(error==0) v=slipstream_send(ds_pkt.buf,ds_pkt.buf_len); //nav_time_secs=ds_pkt.nav; nav_time_secs=5; reply_time_secs=ds_pkt.delay_per_level * ds_pkt.hop_max; } else { p2p_pkt.payload_len = transducer_pkt_pack(&tran_pkt,p2p_pkt.payload); // This takes the structure and packs it into the raw // array that is sent using SLIP pack_peer_2_peer_packet( &p2p_pkt); if(error==0) v=slipstream_send(p2p_pkt.buf,p2p_pkt.buf_len); if(debug_txt_flag==1) { if (v == 0) printf( "Error sending\n" ); else printf( "Sent request %d\n",p2p_pkt.seq_num); } nav_time_secs=10; reply_time_secs=10; } if(debug_txt_flag==1) { if (v == 0) printf( "Error sending\n" ); else printf( "Sent request %d\n",cnt); } t=time(NULL); reply_timeout=t+reply_time_secs+1; nav_timeout=t+nav_time_secs; echo=0; while (nav_timeout > time (NULL)) { v = slipstream_receive (rx_buf); if (v > 0) { if (check_for_ack(rx_buf,v, ff_pwr_actuate_mac[0], p2p_pkt.seq_num)==1 ) { printf( "ACK\n" ); return 1; } } usleep (1000); } cnt++; if(cnt>2) break; } printf( "NCK\n" ); return 0; }
//XMLParser func called whenever an end of element is encountered static void XMLCALL endElement (void *data, const char *element_name) { int i; FF_POWER_RQST_PKT ff_pwr_rqst; FF_POWER_ACTUATE_PKT ff_pwr_actuate; //printf( "end=%s\n",element_name ); if (strcmp (element_name, "FireFlyDSPacket") == 0) { pb_state = WAIT_STATE; if (pb_tran_pkt.num_msgs > 0) { // Pack tran_pkt pb_ds_pkt.payload_len = transducer_pkt_pack(&pb_tran_pkt,pb_ds_pkt.payload); } pack_downstream_packet (&pb_ds_pkt); pb_gw_pkt[pb_cnt].size = pb_ds_pkt.buf_len; for (i = 0; i < pb_ds_pkt.buf_len; i++) pb_gw_pkt[pb_cnt].pkt[i] = pb_ds_pkt.buf[i]; pb_cnt++; } else if (strcmp (element_name, "Transducer") == 0) { // Add msg to tran_pkt switch(pb_tran_msg.type) { case TRAN_FF_BASIC_SHORT: // don't need to do anything really... pb_tran_msg.len=0; //transducer_msg_add( &pb_tran_pkt, &pb_tran_msg ); break; case TRAN_LED_BLINK: // don't need to do anything really... if(strstr(params,"RED")!=0) pb_tran_msg.payload[0]|=TRAN_RED_LED_MASK; if(strstr(params,"GREEN")!=0) pb_tran_msg.payload[0]|=TRAN_GREEN_LED_MASK; if(strstr(params,"BLUE")!=0) pb_tran_msg.payload[0]|=TRAN_BLUE_LED_MASK; if(strstr(params,"ORANGE")!=0) pb_tran_msg.payload[0]|=TRAN_ORANGE_LED_MASK; pb_tran_msg.len=1; break; case TRAN_POWER_PKT: if(strcmp(action,"sense")==0 ) { if(strstr(params,"1")!=0) ff_pwr_rqst.socket=1; else ff_pwr_rqst.socket=0; ff_pwr_rqst.pkt_type=SENSE_PKT; pb_tran_msg.len=ff_power_rqst_pack(pb_tran_msg.payload, &ff_pwr_rqst); printf( "Transducer sense packet!\n" ); } if(strcmp(action,"actuate")==0 ) { ff_pwr_actuate.socket0_state=SOCKET_HOLD; ff_pwr_actuate.socket1_state=SOCKET_HOLD; if(strstr(params,"0")!=0) { if(strstr(params,"on")!=0) ff_pwr_actuate.socket0_state=SOCKET_ON; if(strstr(params,"off")!=0) ff_pwr_actuate.socket0_state=SOCKET_OFF; } else if(strstr(params,"1")!=0) { if(strstr(params,"on")!=0) ff_pwr_actuate.socket1_state=SOCKET_ON; if(strstr(params,"off")!=0) ff_pwr_actuate.socket1_state=SOCKET_OFF; } ff_pwr_actuate.type=ACTUATE_PKT; pb_tran_msg.len=ff_power_actuate_pack(pb_tran_msg.payload, &ff_pwr_actuate); } break; } transducer_msg_add( &pb_tran_pkt, &pb_tran_msg ); } else if (strcmp (element_name, "Sleep") == 0) { pb_state = WAIT_STATE; pb_cnt++; } }