Просмотр исходного кода

update(port/chipidea): add dcache support for device

Signed-off-by: sakumisu <1203593632@qq.com>
sakumisu 2 месяцев назад
Родитель
Сommit
84b1d3feeb
1 измененных файлов с 11 добавлено и 0 удалено
  1. 11 0
      port/chipidea/usb_dc_chipidea.c

+ 11 - 0
port/chipidea/usb_dc_chipidea.c

@@ -594,10 +594,15 @@ int usbd_ep_start_write(uint8_t busid, const uint8_t ep, const uint8_t *data, ui
         return -2;
     }
 
+#ifdef CONFIG_USB_DCACHE_ENABLE
+    USB_ASSERT_MSG(!((uintptr_t)data % CONFIG_USB_ALIGN_SIZE), "data is not aligned %d", CONFIG_USB_ALIGN_SIZE);
+#endif
+
     g_chipidea_udc[busid].in_ep[ep_idx].xfer_buf = (uint8_t *)data;
     g_chipidea_udc[busid].in_ep[ep_idx].xfer_len = data_len;
     g_chipidea_udc[busid].in_ep[ep_idx].actual_xfer_len = 0;
 
+    usb_dcache_clean((uintptr_t)data, USB_ALIGN_UP(data_len, CONFIG_USB_ALIGN_SIZE));
     chipidea_start_xfer(busid, ep, (uint8_t *)data, data_len);
 
     return 0;
@@ -614,10 +619,15 @@ int usbd_ep_start_read(uint8_t busid, const uint8_t ep, uint8_t *data, uint32_t
         return -2;
     }
 
+#ifdef CONFIG_USB_DCACHE_ENABLE
+    USB_ASSERT_MSG(!((uintptr_t)data % CONFIG_USB_ALIGN_SIZE), "data is not aligned %d", CONFIG_USB_ALIGN_SIZE);
+#endif
+
     g_chipidea_udc[busid].out_ep[ep_idx].xfer_buf = (uint8_t *)data;
     g_chipidea_udc[busid].out_ep[ep_idx].xfer_len = data_len;
     g_chipidea_udc[busid].out_ep[ep_idx].actual_xfer_len = 0;
 
+    usb_dcache_invalidate((uintptr_t)data, USB_ALIGN_UP(data_len, CONFIG_USB_ALIGN_SIZE));
     chipidea_start_xfer(busid, ep, data, data_len);
 
     return 0;
@@ -712,6 +722,7 @@ void USBD_IRQHandler(uint8_t busid)
                         if (ep_addr & 0x80) {
                             usbd_event_ep_in_complete_handler(busid, ep_addr, transfer_len);
                         } else {
+                            usb_dcache_invalidate((uintptr_t)g_chipidea_udc[busid].out_ep[ep_idx].xfer_buf, USB_ALIGN_UP(transfer_len, CONFIG_USB_ALIGN_SIZE));
                             usbd_event_ep_out_complete_handler(busid, ep_addr, transfer_len);
                         }
                     }