293 lines
7.3 KiB
C
293 lines
7.3 KiB
C
#include "asm/power_interface.h"
|
||
#include "asm/adc_api.h"
|
||
#include "app_config.h"
|
||
#include "includes.h"
|
||
#include "stdlib.h"
|
||
|
||
__attribute__((noinline))
|
||
AT(.volatile_ram_code)
|
||
static u8 wiovdd_trim(u8 trim, s16 *adc_wiovdd_voltage)
|
||
{
|
||
u32 wiovdd_lev = 7;
|
||
u32 miovdd_lev = 0;
|
||
P33_CON_SET(P3_ANA_CON5, 3, 3, wiovdd_lev);
|
||
delay(215);//延时50us
|
||
P33_CON_SET(P3_ANA_CON5, 0, 3, miovdd_lev);
|
||
delay(430);
|
||
|
||
if (trim) {
|
||
for (; wiovdd_lev > 3; wiovdd_lev--) {
|
||
P33_CON_SET(P3_ANA_CON5, 3, 3, wiovdd_lev);
|
||
delay(700);//延时50us
|
||
adc_wiovdd_voltage[wiovdd_lev] = get_vddio_voltage();;
|
||
}
|
||
|
||
for (int i = 3; i >= 0; i--) {
|
||
adc_wiovdd_voltage[i] = adc_wiovdd_voltage[i + 1] - 200;
|
||
}
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
__attribute__((noinline))
|
||
AT(.volatile_ram_code)
|
||
u8 miovdd_trim(u8 trim, s16 *adc_miovdd_voltage)
|
||
{
|
||
u32 wiovdd_lev = 0;
|
||
u32 miovdd_lev = 7;
|
||
P33_CON_SET(P3_ANA_CON5, 0, 3, miovdd_lev);
|
||
delay(430);
|
||
P33_CON_SET(P3_ANA_CON5, 3, 3, wiovdd_lev);
|
||
delay(215);//延时50us
|
||
|
||
if (trim) {
|
||
for (; miovdd_lev > 3; miovdd_lev--) {
|
||
P33_CON_SET(P3_ANA_CON5, 0, 3, miovdd_lev);
|
||
delay(700);//延时50us
|
||
adc_miovdd_voltage[miovdd_lev] = get_vddio_voltage();;
|
||
}
|
||
|
||
for (int i = 3; i >= 0; i--) {
|
||
adc_miovdd_voltage[i] = adc_miovdd_voltage[i + 1] - 200;
|
||
}
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
|
||
__attribute__((noinline))
|
||
AT(.volatile_ram_code)
|
||
u32 iovdd_trim(u8 trim, u8 *miovdd_lev, u8 *wiovdd_lev)
|
||
{
|
||
|
||
const u32 m_iovdd_lev = P3_ANA_CON5 & 0xf;
|
||
if (trim == 0) {
|
||
return 1;
|
||
}
|
||
|
||
u32 check_vbat = get_vdd_voltage(AD_CH_VBAT) * 4;
|
||
printf("check_vbat = %d\n", check_vbat);
|
||
if (check_vbat < 3700) {
|
||
printf("%s %d\n", __func__, __LINE__);
|
||
*miovdd_lev = m_iovdd_lev | BIT(7);
|
||
*wiovdd_lev = m_iovdd_lev | BIT(7);
|
||
return 0;
|
||
}
|
||
local_irq_disable();
|
||
|
||
const u32 lvd_con = P3_VLVD_CON;
|
||
P3_VLVD_CON &= ~BIT(2);
|
||
delay(100);
|
||
P3_VLVD_CON &= ~BIT(0); //关闭lvd
|
||
|
||
s16 adc_wiovdd_voltage[8];
|
||
s16 adc_miovdd_voltage[8];
|
||
|
||
miovdd_trim(trim, adc_miovdd_voltage);
|
||
wiovdd_trim(trim, adc_wiovdd_voltage);
|
||
|
||
if (lvd_con & BIT(0)) {
|
||
P3_VLVD_CON |= BIT(0);//en
|
||
delay(3);
|
||
P3_VLVD_CON |= BIT(2);//oe
|
||
}
|
||
|
||
local_irq_enable();
|
||
|
||
int miovdd_voltage = m_iovdd_lev * 200 + 2000;
|
||
u32 min_diff = -1;
|
||
int mlev = 0;
|
||
|
||
for (int i = 7; i >= 0; i--) {
|
||
u32 diff = abs(miovdd_voltage - adc_miovdd_voltage[i]);
|
||
if (diff < min_diff) {
|
||
mlev = i;
|
||
min_diff = diff;
|
||
}
|
||
}
|
||
*miovdd_lev = mlev;
|
||
|
||
u32 wlev = 0;
|
||
min_diff = -1;
|
||
for (int i = 7; i >= 0; i--) {
|
||
u32 diff = abs(adc_miovdd_voltage[mlev] - adc_wiovdd_voltage[i]);
|
||
if (diff < min_diff) {
|
||
wlev = i;
|
||
min_diff = diff;
|
||
}
|
||
}
|
||
|
||
*wiovdd_lev = wlev;
|
||
|
||
|
||
for (u8 i = 0; i < 8; i++) {
|
||
printf("adc_wiovdd_voltage[%d] = %d\n", i, adc_wiovdd_voltage[i]);
|
||
printf("adc_miovdd_voltage[%d] = %d\n", i, adc_miovdd_voltage[i]);
|
||
}
|
||
return 0;
|
||
}
|
||
|
||
static u8 wvdd_trim(u8 trim)
|
||
{
|
||
u8 wvdd_lev = 0;
|
||
wvdd_lev = 0;
|
||
int v = 0;
|
||
u8 err = 0;
|
||
|
||
if (trim) {
|
||
|
||
v = get_wvdd_level_trim();
|
||
if (v == 0) {
|
||
//0.65v
|
||
wvdd_lev = 0b0011;
|
||
} else if (v == 1) {
|
||
//0.7v
|
||
wvdd_lev = 0b0100;
|
||
} else if (v == 2) {
|
||
//0.75v
|
||
wvdd_lev = 0b0101;
|
||
} else {
|
||
//0.8v
|
||
//wvdd_lev = 0b0110;
|
||
WVDD_VOL_SEL(wvdd_lev);
|
||
WVDD_LOAD_EN(1);
|
||
WLDO06_EN(1);
|
||
delay(2000);//1ms
|
||
do {
|
||
WVDD_VOL_SEL(wvdd_lev);
|
||
delay(2000);//1ms * n
|
||
v = get_vdd_voltage(AD_CH_WVDD);
|
||
if (v > WVDD_VOL_TRIM) {
|
||
break;
|
||
}
|
||
wvdd_lev ++;
|
||
} while (wvdd_lev < WVDD_LEVEL_MAX);
|
||
WVDD_LOAD_EN(0);
|
||
WLDO06_EN(0);
|
||
|
||
u8 min = (WVDD_VOL_TRIM - WVDD_VOL_MIN) / WVDD_VOL_STEP - 2;
|
||
u8 max = (WVDD_VOL_TRIM - WVDD_VOL_MIN) / WVDD_VOL_STEP + 2;
|
||
if (!(wvdd_lev >= min && wvdd_lev <= max)) {
|
||
wvdd_lev = WVDD_LEVEL_DEFAULT;
|
||
err = 1;
|
||
}
|
||
}
|
||
|
||
//update_wvdd_trim_level(wvdd_lev);
|
||
} else {
|
||
wvdd_lev = get_wvdd_trim_level();
|
||
}
|
||
|
||
printf("trim: %d, wvdd_lev: %d, v: %d, err: %d\n", trim, wvdd_lev, v, err);
|
||
|
||
M2P_WDVDD = wvdd_lev;
|
||
|
||
if (err) {
|
||
return WVDD_LEVEL_ERR;
|
||
}
|
||
|
||
return wvdd_lev;
|
||
}
|
||
|
||
static u8 pvdd_trim(u8 trim)
|
||
{
|
||
/* return 0; */
|
||
u32 v = 0;
|
||
u8 lev_high_now = PVDD_LEVEL_DEFAULT;
|
||
u8 err = 0;
|
||
|
||
if (trim) {
|
||
PVDD_LEVEL_HIGH_NOW(PVDD_LEVEL_REF);
|
||
delay(2000);//1ms
|
||
v = get_vdd_voltage(AD_CH_PVDD);//adc_get_voltage_preemption(AD_CH_PVDD);
|
||
|
||
if ((v < (PVDD_VOL_REF - 2 * PVDD_VOL_STEP)) || (v > (PVDD_VOL_REF + 2 * PVDD_VOL_STEP))) {
|
||
lev_high_now = PVDD_LEVEL_DEFAULT;
|
||
M2P_PVDD_LEVEL_SLEEP_TRIM = PVDD_LEVEL_SLEEP;
|
||
err = 1;
|
||
|
||
} else {
|
||
M2P_PVDD_LEVEL_SLEEP_TRIM = (PVDD_LEVEL_REF - (v - PVDD_VOL_SLEEP) / PVDD_VOL_STEP);
|
||
lev_high_now = M2P_PVDD_LEVEL_SLEEP_TRIM + (PVDD_VOL_HIGH_NOW - PVDD_VOL_SLEEP) / PVDD_VOL_STEP;
|
||
|
||
}
|
||
} else {
|
||
lev_high_now = get_pvdd_trim_level();
|
||
M2P_PVDD_LEVEL_SLEEP_TRIM = get_pvdd_level() - (PVDD_VOL_HIGH_NOW - PVDD_VOL_SLEEP) / PVDD_VOL_STEP;
|
||
}
|
||
|
||
#if (!PMU_NEW_FLOW)
|
||
if (get_pvdd_dcdc_cfg()) {
|
||
//外接dcdc，pvdd配置为3档
|
||
lev_high_now = 3;
|
||
|
||
}
|
||
#endif
|
||
|
||
PVDD_LEVEL_HIGH_NOW(lev_high_now);
|
||
delay(2000);
|
||
PVDD_AUTO_PRD(0x3);
|
||
PVDD_LEVEL_AUTO(0x1);
|
||
PVDD_LEVEL_LOW(M2P_WDVDD);
|
||
|
||
#if PMU_NEW_FLOW
|
||
if (get_pvdd_dcdc_cfg()) {
|
||
power_set_pvdd_mode(PWR_PVDD_DCDC);
|
||
}
|
||
#endif
|
||
|
||
printf("trim: %d, pvdd_vol_ref: %d, pvdd_level_high_now_trim: %d, pvdd_level_sleep_trim: %d, pvdd_level_lev_l_trim: %d, err: %d\n", \
|
||
trim, v, lev_high_now, M2P_PVDD_LEVEL_SLEEP_TRIM, M2P_WDVDD, err);
|
||
cap_rch_enable();
|
||
|
||
if (err) {
|
||
return PVDD_LEVEL_ERR;
|
||
}
|
||
|
||
return lev_high_now;
|
||
}
|
||
|
||
void volatage_trim_init()
|
||
{
|
||
/* trim wvdd */
|
||
printf("lvd_con = 0x%x\n", P3_VLVD_CON);
|
||
u8 trim = load_pmu_trim_value_from_vm();
|
||
u8 wvdd_lev = 0;
|
||
u8 pvdd_lev = 0;
|
||
|
||
extern bool vm_need_recover(void);
|
||
if (vm_need_recover()) { // 升级完后重新trim
|
||
trim = 0xff;
|
||
}
|
||
|
||
printf("trim = 0x%x\n", trim);
|
||
|
||
wvdd_lev = wvdd_trim((trim & TRIM_WVDD) ? 1 : 0);
|
||
pvdd_lev = pvdd_trim((trim & TRIM_PVDD) ? 1 : 0);
|
||
|
||
u8 miovdd_lev = 0;
|
||
u8 wiovdd_lev = 0;
|
||
if (trim & TRIM_IOVDD) {
|
||
u8 trim_succ = iovdd_trim(trim, &miovdd_lev, &wiovdd_lev);
|
||
} else {
|
||
miovdd_lev = get_miovdd_trim_level();
|
||
wiovdd_lev = get_wiovdd_trim_level();
|
||
}
|
||
|
||
if (trim) {
|
||
if ((wvdd_lev != WVDD_LEVEL_ERR) && (pvdd_lev != PVDD_LEVEL_ERR)) {
|
||
store_pmu_trim_value_to_vm(wvdd_lev, pvdd_lev, miovdd_lev, wiovdd_lev);
|
||
}
|
||
}
|
||
|
||
printf("miovdd_lev = %x\n", miovdd_lev);
|
||
printf("wiovdd_lev = %x\n", wiovdd_lev);
|
||
|
||
P33_CON_SET(P3_ANA_CON5, 0, 3, miovdd_lev);
|
||
P33_CON_SET(P3_ANA_CON5, 3, 3, 0);
|
||
}
|
||
|
||
|