FIX: fix usb_send tx_space_available check, closes #52

r2axz · Feb 11, 2022 · e7cb9ec · e7cb9ec
1 parent 7cea59a
commit e7cb9ec
Showing 1 changed file with 3 additions and 1 deletion.
diff --git a/usb_io.c b/usb_io.c
@@ -115,11 +115,12 @@ size_t usb_send(uint8_t ep_num, const void *buf, size_t count) {
     ep_reg_t *ep_reg = ep_regs(ep_num);
     usb_pbuffer_data_t *ep_buf = (usb_pbuffer_data_t *)(USB_PMAADDR + (usb_btable[ep_num].tx_offset<<1));
     pb_word_t *buf_p = (pb_word_t*)buf;
-    pb_word_t words_left  = count >> 1;
+    pb_word_t words_left;
     size_t tx_space_available = usb_endpoints[ep_num].tx_size;
     if (count > tx_space_available) {
         count = tx_space_available;
     }
+    words_left = count >> 1;
     while (words_left--) {
         (ep_buf++)->data = *buf_p++;
     }
@@ -131,6 +132,7 @@ size_t usb_send(uint8_t ep_num, const void *buf, size_t count) {
     return count;
 }
 
+
 /* Circular Buffer Read/Write Operations */
 
 /* NOTE: usb_circ_buf_read assumes enough buffer space is available */