From 9a5797088bc1fee01d97db9c02c9cee3eced8470 Mon Sep 17 00:00:00 2001
From: josesimoes <jose.simoes@eclo.solutions>
Date: Mon, 29 Jan 2024 12:47:03 +0000
Subject: [PATCH] Updating OTG code from upstream

- Porting back changes from official ChibiOS code.
---
 os/hal/ports/STM32/LLD/USBHv1/hal_usbh_lld.c | 19 ++++++++++++-------
 1 file changed, 12 insertions(+), 7 deletions(-)

diff --git a/os/hal/ports/STM32/LLD/USBHv1/hal_usbh_lld.c b/os/hal/ports/STM32/LLD/USBHv1/hal_usbh_lld.c
index 1f6ef131f3..94f3ad3386 100644
--- a/os/hal/ports/STM32/LLD/USBHv1/hal_usbh_lld.c
+++ b/os/hal/ports/STM32/LLD/USBHv1/hal_usbh_lld.c
@@ -1448,35 +1448,40 @@ OSAL_IRQ_HANDLER(STM32_OTG2_HANDLER) {
 static void otg_core_reset(stm32_otg_t *const otgp) {
 
   /* Wait AHB idle condition.*/
-  while ((otgp->GRSTCTL & GRSTCTL_AHBIDL) == 0) osalSysPolledDelayX(1);
+  while ((otgp->GRSTCTL & GRSTCTL_AHBIDL) == 0)
+    ;
 
   /* Core reset and delay of at least 3 PHY cycles.*/
   otgp->GRSTCTL = GRSTCTL_CSRST;
   osalSysPolledDelayX(12);
-  while ((otgp->GRSTCTL & GRSTCTL_CSRST) != 0) osalSysPolledDelayX(1);
+  while ((otgp->GRSTCTL & GRSTCTL_CSRST) != 0)
+    ;
 
   osalSysPolledDelayX(18);
 
   /* Wait AHB idle condition again.*/
-  while ((otgp->GRSTCTL & GRSTCTL_AHBIDL) == 0) osalSysPolledDelayX(1);
+  while ((otgp->GRSTCTL & GRSTCTL_AHBIDL) == 0)
+    ;
 }
 
 static void otg_rxfifo_flush(USBHDriver *usbp) {
   stm32_otg_t *const otgp = usbp->otg;
 
   otgp->GRSTCTL = GRSTCTL_RXFFLSH;
-  while ((otgp->GRSTCTL & GRSTCTL_RXFFLSH) != 0) osalSysPolledDelayX(1);
+  while ((otgp->GRSTCTL & GRSTCTL_RXFFLSH) != 0)
+    ;
   /* Wait for 3 PHY Clocks.*/
-  osalSysPolledDelayX(24);
+  osalSysPolledDelayX(18);
 }
 
 static void otg_txfifo_flush(USBHDriver *usbp, uint32_t fifo) {
   stm32_otg_t *const otgp = usbp->otg;
 
   otgp->GRSTCTL = GRSTCTL_TXFNUM(fifo) | GRSTCTL_TXFFLSH;
-  while ((otgp->GRSTCTL & GRSTCTL_TXFFLSH) != 0) osalSysPolledDelayX(1);
+  while ((otgp->GRSTCTL & GRSTCTL_TXFFLSH) != 0)
+    ;
   /* Wait for 3 PHY Clocks.*/
-  osalSysPolledDelayX(24);
+  osalSysPolledDelayX(18);
 }
 
 static void _init(USBHDriver *host) {