|
36 | 36 |
|
37 | 37 | #include "common-hal/microcontroller/Pin.h"
|
38 | 38 |
|
| 39 | +STATIC void init_usb_vbus_sense(void) { |
| 40 | + |
| 41 | +#ifdef BOARD_NO_VBUS |
| 42 | + // Disable VBUS sensing |
| 43 | + #ifdef USB_OTG_GCCFG_VBDEN |
| 44 | + USB_OTG_FS->GCCFG &= ~USB_OTG_GCCFG_VBDEN; |
| 45 | + #else |
| 46 | + USB_OTG_FS->GCCFG |= USB_OTG_GCCFG_NOVBUSSENS; |
| 47 | + USB_OTG_FS->GCCFG &= ~USB_OTG_GCCFG_VBUSBSEN; |
| 48 | + USB_OTG_FS->GCCFG &= ~USB_OTG_GCCFG_VBUSASEN; |
| 49 | + #endif |
| 50 | +#else |
| 51 | + // Enable VBUS hardware sensing |
| 52 | + #ifdef USB_OTG_GCCFG_VBDEN |
| 53 | + USB_OTG_FS->GCCFG |= USB_OTG_GCCFG_VBDEN; |
| 54 | + #else |
| 55 | + USB_OTG_FS->GCCFG &= ~USB_OTG_GCCFG_NOVBUSSENS; |
| 56 | + USB_OTG_FS->GCCFG |= USB_OTG_GCCFG_VBUSBSEN; // B Device sense |
| 57 | + #endif |
| 58 | +#endif |
| 59 | +} |
| 60 | + |
| 61 | + |
39 | 62 | void init_usb_hardware(void) {
|
40 | 63 | //TODO: if future chips overload this with options, move to peripherals management.
|
41 | 64 |
|
@@ -82,20 +105,8 @@ void init_usb_hardware(void) {
|
82 | 105 | never_reset_pin_number(0, 8);
|
83 | 106 | #endif
|
84 | 107 |
|
85 |
| -#ifdef BOARD_NO_VBUS |
86 |
| - disable_usb_vbus(); |
87 |
| -#endif |
88 |
| - |
89 | 108 | /* Peripheral clock enable */
|
90 | 109 | __HAL_RCC_USB_OTG_FS_CLK_ENABLE();
|
91 |
| -} |
92 | 110 |
|
93 |
| -STATIC void disable_usb_vbus(void) { |
94 |
| -#ifdef USB_OTG_GCCFG_VBDEN |
95 |
| - USB_OTG_FS->GCCFG &= ~USB_OTG_GCCFG_VBDEN; |
96 |
| -#else |
97 |
| - USB_OTG_FS->GCCFG |= USB_OTG_GCCFG_NOVBUSSENS; |
98 |
| - USB_OTG_FS->GCCFG &= ~USB_OTG_GCCFG_VBUSBSEN; |
99 |
| - USB_OTG_FS->GCCFG &= ~USB_OTG_GCCFG_VBUSASEN; |
100 |
| -#endif |
| 111 | + init_usb_vbus_sense(); |
101 | 112 | }
|
0 commit comments