summaryrefslogtreecommitdiff
path: root/drivers/chibios/usbpd_stm32g4.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/chibios/usbpd_stm32g4.c')
-rw-r--r--drivers/chibios/usbpd_stm32g4.c76
1 files changed, 0 insertions, 76 deletions
diff --git a/drivers/chibios/usbpd_stm32g4.c b/drivers/chibios/usbpd_stm32g4.c
deleted file mode 100644
index f16ca8aeae..0000000000
--- a/drivers/chibios/usbpd_stm32g4.c
+++ /dev/null
@@ -1,76 +0,0 @@
-/* Copyright 2021 Nick Brassel (@tzarc)
- *
- * This program is free software: you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation, either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program. If not, see <http://www.gnu.org/licenses/>.
- */
-
-#include <quantum.h>
-
-#ifndef USBPD_UCPD1_CFG1
-# define USBPD_UCPD1_CFG1 (UCPD_CFG1_PSC_UCPDCLK_0 | UCPD_CFG1_TRANSWIN_3 | UCPD_CFG1_IFRGAP_4 | UCPD_CFG1_HBITCLKDIV_4)
-#endif // USBPD_UCPD1_CFG1
-
-// Initialises the USBPD subsystem
-__attribute__((weak)) void usbpd_init(void) {
- // Disable dead-battery signals
- PWR->CR3 |= PWR_CR3_UCPD_DBDIS;
- // Enable the clock for the UCPD1 peripheral
- RCC->APB1ENR2 |= RCC_APB1ENR2_UCPD1EN;
-
- // Copy the existing value
- uint32_t CFG1 = UCPD1->CFG1;
- // Force-disable UCPD1 before configuring
- CFG1 &= ~UCPD_CFG1_UCPDEN;
- // Configure UCPD1
- CFG1 = USBPD_UCPD1_CFG1;
- // Apply the changes
- UCPD1->CFG1 = CFG1;
- // Enable UCPD1
- UCPD1->CFG1 |= UCPD_CFG1_UCPDEN;
-
- // Copy the existing value
- uint32_t CR = UCPD1->CR;
- // Clear out ANASUBMODE (irrelevant as a sink device)
- CR &= ~UCPD_CR_ANASUBMODE_Msk;
- // Advertise our capabilities as a sink, with both CC lines enabled
- CR |= UCPD_CR_ANAMODE | UCPD_CR_CCENABLE_Msk;
- // Apply the changes
- UCPD1->CR = CR;
-}
-
-// Gets the current state of the USBPD allowance
-__attribute__((weak)) usbpd_allowance_t usbpd_get_allowance(void) {
- uint32_t CR = UCPD1->CR;
-
- int ucpd_enabled = (UCPD1->CFG1 & UCPD_CFG1_UCPDEN_Msk) >> UCPD_CFG1_UCPDEN_Pos;
- int anamode = (CR & UCPD_CR_ANAMODE_Msk) >> UCPD_CR_ANAMODE_Pos;
- int cc_enabled = (CR & UCPD_CR_CCENABLE_Msk) >> UCPD_CR_CCENABLE_Pos;
-
- if (ucpd_enabled && anamode && cc_enabled) {
- uint32_t SR = UCPD1->SR;
- int vstate_cc1 = (SR & UCPD_SR_TYPEC_VSTATE_CC1_Msk) >> UCPD_SR_TYPEC_VSTATE_CC1_Pos;
- int vstate_cc2 = (SR & UCPD_SR_TYPEC_VSTATE_CC2_Msk) >> UCPD_SR_TYPEC_VSTATE_CC2_Pos;
- int vstate_max = vstate_cc1 > vstate_cc2 ? vstate_cc1 : vstate_cc2;
- switch (vstate_max) {
- case 0:
- case 1:
- return USBPD_500MA; // Note that this is 500mA (i.e. max USB 2.0), not 900mA, as we're not using USB 3.1 as a sink device.
- case 2:
- return USBPD_1500MA;
- case 3:
- return USBPD_3000MA;
- }
- }
-
- return USBPD_500MA;
-} \ No newline at end of file