3afcb53fb9
The current code was spreaded over power and powermgmt which made it behave strangely, especially since there are relationships between power management and frequency scaling. The new code makes sure power management is initialised before frequency scaling starts. It also makes sure to start from a known state, thus fixing potential issue when the bootloader stops in a trickle state where DCDC is improperly configured. Change-Id: Ibded2e590e108f6c98daa52d2cf1bd28763c8923
188 lines
7 KiB
C
188 lines
7 KiB
C
/***************************************************************************
|
|
* __________ __ ___.
|
|
* Open \______ \ ____ ____ | | _\_ |__ _______ ___
|
|
* Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
|
|
* Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
|
|
* Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
|
|
* \/ \/ \/ \/ \/
|
|
* $Id$
|
|
*
|
|
* Copyright (C) 2011 by Amaury Pouly
|
|
*
|
|
* 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 software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
|
|
* KIND, either express or implied.
|
|
*
|
|
****************************************************************************/
|
|
|
|
#include "powermgmt.h"
|
|
#include "power-imx233.h"
|
|
#include "usb.h"
|
|
#include "string.h"
|
|
//#define LOGF_ENABLE
|
|
#include "logf.h"
|
|
|
|
#if !defined(IMX233_CHARGE_CURRENT) || !defined(IMX233_STOP_CURRENT) \
|
|
|| !defined(IMX233_CHARGING_TIMEOUT) || !defined(IMX233_TOPOFF_TIMEOUT)
|
|
#error You must define IMX233_CHARGE_CURRENT, IMX233_STOP_CURRENT, \
|
|
IMX233_CHARGING_TIMEOUT and IMX233_TOPOFF_TIMEOUT !
|
|
#endif
|
|
|
|
/* charger state is maintained in charge_state (see powermgmt.h) */
|
|
static int timeout_charging; /* timeout before charging will be declared broken */
|
|
static int timeout_topping_off; /* timeout before stopping charging after topping off */
|
|
static int timeout_4p2_ilimit_increase; /* timeout before increasing 4p2 ilimit */
|
|
|
|
/* Returns battery voltage from ADC [millivolts] */
|
|
int _battery_voltage(void)
|
|
{
|
|
/* battery value is in 8mV LSB */
|
|
return BF_RD(POWER_BATTMONITOR, BATT_VAL) * 8;
|
|
}
|
|
|
|
void imx233_powermgmt_init(void)
|
|
{
|
|
imx233_power_set_charge_current(IMX233_CHARGE_CURRENT);
|
|
imx233_power_set_stop_current(IMX233_STOP_CURRENT);
|
|
/* assume that adc_init was called and battery monitoring via LRADC setup */
|
|
BF_WR(POWER_BATTMONITOR, EN_BATADJ, 1);
|
|
#if IMX233_SUBTARGET >= 3700
|
|
/* setup linear regulator offsets to 25 mV below to prevent contention between
|
|
* linear regulators and DCDC */
|
|
BF_WR(POWER_VDDDCTRL, LINREG_OFFSET, 2);
|
|
BF_WR(POWER_VDDACTRL, LINREG_OFFSET, 2);
|
|
BF_WR(POWER_VDDIOCTRL, LINREG_OFFSET, 2);
|
|
/* enable DCDC (more efficient) */
|
|
BF_SET(POWER_5VCTRL, ENABLE_DCDC);
|
|
BF_CLR(POWER_5VCTRL, DCDC_XFER);
|
|
#else
|
|
BF_SET(POWER_5VCTRL, LINREG_OFFSET);
|
|
BF_SET(POWER_5VCTRL, EN_DCDC1);
|
|
BF_SET(POWER_5VCTRL, EN_DCDC2);
|
|
#endif
|
|
|
|
#if IMX233_SUBTARGET >= 3780
|
|
/* enable a few bits controlling the DC-DC as recommended by Freescale */
|
|
BF_SET(POWER_LOOPCTRL, TOGGLE_DIF);
|
|
BF_SET(POWER_LOOPCTRL, EN_CM_HYST);
|
|
BF_CLR(POWER_LOOPCTRL, EN_RCSCALE);
|
|
BF_SETV(POWER_LOOPCTRL, EN_RCSCALE, 1);
|
|
/* adjust arbitration between 4.2 and battery */
|
|
BF_WR(POWER_DCDC4P2, CMPTRIP, 0); /* 85% */
|
|
BF_WR(POWER_DCDC4P2, DROPOUT_CTRL, 0xe); /* select greater, 200 mV drop */
|
|
/* make sure we are in a known state: disable charger and 4p2 */
|
|
BF_SET(POWER_CHARGE, PWD_BATTCHRG);
|
|
BF_WR(POWER_DCDC4P2, ENABLE_DCDC, 0);
|
|
BF_WR(POWER_DCDC4P2, ENABLE_4P2, 0);
|
|
BF_SET(POWER_5VCTRL, PWD_CHARGE_4P2);
|
|
#endif
|
|
}
|
|
|
|
void powermgmt_init_target(void)
|
|
{
|
|
charge_state = DISCHARGING;
|
|
}
|
|
|
|
void charging_algorithm_step(void)
|
|
{
|
|
#if IMX233_SUBTARGET >= 3780
|
|
bool is_5v_present = usb_detect() == USB_INSERTED;
|
|
|
|
/* initial state & 5v -> battery transition */
|
|
if(!is_5v_present && charge_state != DISCHARGING)
|
|
{
|
|
logf("pwrmgmt: * -> discharging");
|
|
logf("pwrmgmt: disable charger and 4p2");
|
|
/* 5V has been lost: disable 4p2 power rail */
|
|
BF_SET(POWER_CHARGE, PWD_BATTCHRG);
|
|
BF_WR(POWER_DCDC4P2, ENABLE_DCDC, 0);
|
|
BF_WR(POWER_DCDC4P2, ENABLE_4P2, 0);
|
|
BF_SET(POWER_5VCTRL, PWD_CHARGE_4P2);
|
|
charge_state = DISCHARGING;
|
|
}
|
|
/* battery -> 5v transition */
|
|
else if(is_5v_present && charge_state == DISCHARGING)
|
|
{
|
|
logf("pwrmgmt: discharging -> trickle");
|
|
logf("pwrmgmt: begin charging 4p2");
|
|
/* 5V has been detected: prepare 4.2V power rail for activation */
|
|
BF_WR(POWER_DCDC4P2, ENABLE_4P2, 1);
|
|
BF_SET(POWER_CHARGE, ENABLE_LOAD);
|
|
BF_WR(POWER_5VCTRL, CHARGE_4P2_ILIMIT, 1);
|
|
BF_CLR(POWER_5VCTRL, PWD_CHARGE_4P2);// FIXME: manual error ?
|
|
BF_WR(POWER_DCDC4P2, ENABLE_DCDC, 1);
|
|
timeout_4p2_ilimit_increase = current_tick + HZ / 100;
|
|
charge_state = TRICKLE;
|
|
}
|
|
else if(charge_state == TRICKLE && TIME_AFTER(current_tick, timeout_4p2_ilimit_increase))
|
|
{
|
|
/* if 4.2V current limit has not reached 780mA, increase it slowly to
|
|
* charge the 4.2V capacitance */
|
|
if(BF_RD(POWER_5VCTRL, CHARGE_4P2_ILIMIT) != 0x3f)
|
|
{
|
|
//logf("pwrmgmt: incr 4.2 ilimit");
|
|
HW_POWER_5VCTRL += BF_POWER_5VCTRL_CHARGE_4P2_ILIMIT(1);
|
|
timeout_4p2_ilimit_increase = current_tick + HZ / 100;
|
|
}
|
|
/* we've reached the maximum, take action */
|
|
else
|
|
{
|
|
logf("pwrmgmt: enable dcdc and charger");
|
|
logf("pwrmgmt: trickle -> charging");
|
|
BF_CLR(POWER_5VCTRL, DCDC_XFER);
|
|
BF_SET(POWER_5VCTRL, ENABLE_DCDC);
|
|
/* enable battery charging */
|
|
BF_CLR(POWER_CHARGE, PWD_BATTCHRG);
|
|
charge_state = CHARGING;
|
|
timeout_charging = current_tick + IMX233_CHARGING_TIMEOUT;
|
|
}
|
|
}
|
|
else if(charge_state == CHARGING && TIME_AFTER(current_tick, timeout_charging))
|
|
{
|
|
/* we have charged for a too long time, declare charger broken */
|
|
logf("pwrmgmt: charging timeout exceeded!");
|
|
logf("pwrmgmt: charging -> error");
|
|
/* stop charging */
|
|
BF_SET(POWER_5VCTRL, PWD_CHARGE_4P2);
|
|
/* goto error state */
|
|
charge_state = CHARGE_STATE_ERROR;
|
|
}
|
|
else if(charge_state == CHARGING && !BF_RD(POWER_STS, CHRGSTS))
|
|
{
|
|
logf("pwrmgmt: topping off");
|
|
logf("pwrmgmt: charging -> topoff");
|
|
charge_state = TOPOFF;
|
|
timeout_topping_off = current_tick + IMX233_TOPOFF_TIMEOUT;
|
|
}
|
|
else if(charge_state == TOPOFF && TIME_AFTER(current_tick, timeout_topping_off))
|
|
{
|
|
logf("pwrmgmt: charging finished");
|
|
logf("pwrmgmt: topoff -> disabled");
|
|
/* stop charging */
|
|
BF_SET(POWER_CHARGE, PWD_BATTCHRG);
|
|
charge_state = CHARGE_STATE_DISABLED;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
void charging_algorithm_close(void)
|
|
{
|
|
}
|
|
|
|
struct imx233_powermgmt_info_t imx233_powermgmt_get_info(void)
|
|
{
|
|
struct imx233_powermgmt_info_t info;
|
|
memset(&info, 0, sizeof(info));
|
|
info.state = charge_state;
|
|
info.charging_timeout =
|
|
charge_state == CHARGING ? timeout_charging - current_tick : 0;
|
|
info.topoff_timeout =
|
|
charge_state == TOPOFF ? timeout_topping_off - current_tick : 0;
|
|
info.incr_4p2_ilimit_timeout =
|
|
charge_state == TRICKLE ? timeout_4p2_ilimit_increase - current_tick : 0;
|
|
return info;
|
|
}
|