frame sending

Src/gex_gateway.c

@@ -108,7 +108,7 @@ void gw_handle_usb_out(uint8_t *buffer)
         txmsg_collected += wanted;
 
         if (wanted < MQ_SLOT_LEN) {
-            // this was the end
+            // this was the end - simple checksum to verify it's a valid frame
             uint8_t ck = 0;
             for (int i = 0; i < txmsg_len; i++) {
                 ck ^= txmsg_payload[i];
@@ -120,7 +120,23 @@ void gw_handle_usb_out(uint8_t *buffer)
             }
             else {
                 dbg("Verified, sending a %d B frame to slave.", (int) txmsg_len);
-                // TODO send to slave
+
+                uint8_t pipe = NRF_Addr2PipeNum(txmsg_addr);
+                if (pipe == 0xFF) {
+                    dbg("Bad slave num!");
+                } else {
+                    uint32_t remain = txmsg_len;
+                    for (int i = 0; i <= txmsg_len/32; i++) {
+                        uint8_t chunk = (uint8_t) MIN(remain, 32);
+                        bool suc = NRF_SendPacket(pipe, &txmsg_payload[i*32], chunk);
+                        remain -= chunk;
+
+                        if (!suc) {
+                            dbg("Sending failed."); // (even with retransmission)
+                            break; // skip rest of the frame
+                        }
+                    }
+                }
             }
 
             cmd_state = CMD_STATE_IDLE;