56 lines
1.4 KiB
C
56 lines
1.4 KiB
C
|
/* Copyright 2016 The Chromium OS Authors. All rights reserved.
|
||
|
|
* Use of this source code is governed by a BSD-style license that can be
|
||
|
|
* found in the LICENSE file.
|
||
|
|
*/
|
||
|
|
/* Detect what adapter is connected */
|
||
|
|
|
||
|
|
#include "charge_manager.h"
|
||
|
|
#include "hooks.h"
|
||
|
|
#include "registers.h"
|
||
|
|
#include "timer.h"
|
||
|
|
|
||
|
|
static void enable_usb(void)
|
||
|
|
{
|
||
|
|
/* Enable USB device clock. */
|
||
|
|
STM32_RCC_APB1ENR |= STM32_RCC_PB1_USB;
|
||
|
|
}
|
||
|
|
DECLARE_HOOK(HOOK_INIT, enable_usb, HOOK_PRIO_DEFAULT);
|
||
|
|
|
||
|
|
static void disable_usb(void)
|
||
|
|
{
|
||
|
|
/* Disable USB device clock. */
|
||
|
|
STM32_RCC_APB1ENR &= ~STM32_RCC_PB1_USB;
|
||
|
|
}
|
||
|
|
DECLARE_HOOK(HOOK_SYSJUMP, disable_usb, HOOK_PRIO_DEFAULT);
|
||
|
|
|
||
|
|
static uint16_t detect_type(uint16_t det_type)
|
||
|
|
{
|
||
|
|
STM32_USB_BCDR &= 0;
|
||
|
|
usleep(1);
|
||
|
|
STM32_USB_BCDR |= (STM32_USB_BCDR_BCDEN | det_type);
|
||
|
|
usleep(1);
|
||
|
|
STM32_USB_BCDR &= ~(STM32_USB_BCDR_BCDEN | det_type);
|
||
|
|
return STM32_USB_BCDR;
|
||
|
|
}
|
||
|
|
|
||
|
|
|
||
|
|
int charger_detect_get_device_type(void)
|
||
|
|
{
|
||
|
|
uint16_t pdet_result;
|
||
|
|
|
||
|
|
if (!(detect_type(STM32_USB_BCDR_DCDEN) & STM32_USB_BCDR_DCDET))
|
||
|
|
return CHARGE_SUPPLIER_PD;
|
||
|
|
|
||
|
|
pdet_result = detect_type(STM32_USB_BCDR_PDEN);
|
||
|
|
/* TODO: add support for detecting proprietary chargers. */
|
||
|
|
if (pdet_result & STM32_USB_BCDR_PDET) {
|
||
|
|
if (detect_type(STM32_USB_BCDR_SDEN) & STM32_USB_BCDR_SDET)
|
||
|
|
return CHARGE_SUPPLIER_BC12_DCP;
|
||
|
|
else
|
||
|
|
return CHARGE_SUPPLIER_BC12_CDP;
|
||
|
|
} else if (pdet_result & STM32_USB_BCDR_PS2DET)
|
||
|
|
return CHARGE_SUPPLIER_PROPRIETARY;
|
||
|
|
else
|
||
|
|
return CHARGE_SUPPLIER_BC12_SDP;
|
||
|
|
}
|