0081-RP2040-USBPhy-implement-stall-and-unstall.patch

From 72a88cc2dd0c18745b84f5ae76e841e321742904 Mon Sep 17 00:00:00 2001
From: Martino Facchin <m.facchin@arduino.cc>
Date: Fri, 7 May 2021 16:08:53 +0200
Subject: [PATCH 81/87] RP2040: USBPhy: implement stall() and unstall()

---
 .../TARGET_RP2040/USBPhy_RP2040.cpp                  | 12 +++++++++---
 1 file changed, 9 insertions(+), 3 deletions(-)

diff --git a/targets/TARGET_RASPBERRYPI/TARGET_RP2040/USBPhy_RP2040.cpp b/targets/TARGET_RASPBERRYPI/TARGET_RP2040/USBPhy_RP2040.cpp
index fbece56a1d..9beb225a30 100644
--- a/targets/TARGET_RASPBERRYPI/TARGET_RP2040/USBPhy_RP2040.cpp
+++ b/targets/TARGET_RASPBERRYPI/TARGET_RP2040/USBPhy_RP2040.cpp
@@ -111,7 +111,11 @@ void USBPhyHw::connect()
     // and when a setup packet is received
     usb_hw->inte = USB_INTS_BUFF_STATUS_BITS   |
                    USB_INTS_BUS_RESET_BITS     |
-                   USB_INTS_SETUP_REQ_BITS;
+                   USB_INTS_SETUP_REQ_BITS     |
+                   USB_INTS_HOST_CONN_DIS_BITS |
+                   USB_INTS_HOST_RESUME_BITS   |
+                   USB_INTS_ERROR_RX_OVERFLOW_BITS |
+                   USB_INTS_STALL_BITS;
 
     // Present full speed device by enabling pull up on DP
     usb_hw_set->sie_ctrl = USB_SIE_CTRL_PULLUP_EN_BITS;
@@ -301,12 +305,14 @@ void USBPhyHw::endpoint_remove(usb_ep_t endpoint)
 
 void USBPhyHw::endpoint_stall(usb_ep_t endpoint)
 {
-
+    int ep_num = endpoint & 0x7f;
+    usb_dpram->ep_buf_ctrl[ep_num].out |= USB_BUF_CTRL_STALL;
 }
 
 void USBPhyHw::endpoint_unstall(usb_ep_t endpoint)
 {
-
+    int ep_num = endpoint & 0x7f;
+    usb_dpram->ep_buf_ctrl[ep_num].out &= ~USB_BUF_CTRL_STALL;
 }
 
 bool USBPhyHw::endpoint_read(usb_ep_t endpoint, uint8_t *data, uint32_t size)
-- 
2.30.2