Getting hello packets from the usrp2 with ip and mac addrs.

Cleaned up the mb build system a bit.

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));
 }
 
 /*