|
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