diff options
Diffstat (limited to 'firmware/microblaze/apps/txrx.c')
| -rw-r--r-- | firmware/microblaze/apps/txrx.c | 24 |
1 files changed, 23 insertions, 1 deletions
diff --git a/firmware/microblaze/apps/txrx.c b/firmware/microblaze/apps/txrx.c index 23a88c246..1c43a2ca1 100644 --- a/firmware/microblaze/apps/txrx.c +++ b/firmware/microblaze/apps/txrx.c @@ -160,7 +160,29 @@ void handle_udp_ctrl_packet( unsigned char *payload, int payload_len ){ printf("Got ctrl packet #words: %d\n", (int)payload_len); - send_udp_pkt(USRP2_UDP_CTRL_PORT, src, payload, payload_len); + if (payload_len < sizeof(usrp2_ctrl_data_t)){ + //TODO send err packet + return; + } + //setup the input and output data + usrp2_ctrl_data_t *ctrl_data_in = (usrp2_ctrl_data_t *)payload; + usrp2_ctrl_data_t ctrl_data_out = { + .id=USRP2_CTRL_ID_NONE, + .seq=ctrl_data_in->seq + }; + //handle the data based on the id + switch(ctrl_data_in->id){ + case USRP2_CTRL_ID_HELLO: + ctrl_data_out.id = ctrl_data_in->id; + //grab the addrs + struct ip_addr ip_addr = get_my_ip_addr(); + eth_mac_addr_t mac_addr = get_my_eth_mac_addr(); + //copy them into the out data + memcpy(&ctrl_data_out.data.discovery_addrs.ip_addr, &ip_addr, sizeof(ip_addr)); + memcpy(&ctrl_data_out.data.discovery_addrs.mac_addr, &mac_addr, sizeof(mac_addr)); + break; + } + send_udp_pkt(USRP2_UDP_CTRL_PORT, src, &ctrl_data_out, sizeof(ctrl_data_out)); } /* |