mediatek: Refactor PMIC wrapper code among similar SoCs
Refactor PMIC wrapper code which will be reused among similar SoCs. Move reusable code into the common folder. BUG=b:80501386 BRANCH=none TEST=emerge-elm coreboot Change-Id: I25acb6da49e72748d856804ef4f97e9ec3bef72d Signed-off-by: Tristan Shieh <tristan.shieh@mediatek.com> Reviewed-on: https://review.coreboot.org/29420 Tested-by: build bot (Jenkins) <no-reply@coreboot.org> Reviewed-by: Julius Werner <jwerner@chromium.org>
This commit is contained in:
committed by
Patrick Georgi
parent
d3d0f07fd5
commit
ab1b83d5a4
186
src/soc/mediatek/common/include/soc/pmic_wrap_common.h
Normal file
186
src/soc/mediatek/common/include/soc/pmic_wrap_common.h
Normal file
@@ -0,0 +1,186 @@
|
||||
/*
|
||||
* This file is part of the coreboot project.
|
||||
*
|
||||
* Copyright 2018 MediaTek Inc.
|
||||
*
|
||||
* 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; version 2 of the License.
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
#ifndef SOC_MEDIATEK_PMIC_WRAP_COMMON_H
|
||||
#define SOC_MEDIATEK_PMIC_WRAP_COMMON_H
|
||||
|
||||
#include <arch/io.h>
|
||||
#include <console/console.h>
|
||||
#include <timer.h>
|
||||
|
||||
#define PWRAPTAG "[PWRAP] "
|
||||
#define pwrap_err(fmt, arg ...) printk(BIOS_ERR, PWRAPTAG "ERROR,line=%d" fmt, \
|
||||
__LINE__, ## arg)
|
||||
|
||||
/* external API */
|
||||
s32 pwrap_wacs2(u32 write, u16 adr, u16 wdata, u16 *rdata, u32 init_check);
|
||||
s32 pwrap_init(void);
|
||||
static inline s32 pwrap_read(u16 addr, u16 *rdata)
|
||||
{
|
||||
return pwrap_wacs2(0, addr, 0, rdata, 1);
|
||||
}
|
||||
|
||||
static inline s32 pwrap_write(u16 addr, u16 wdata)
|
||||
{
|
||||
return pwrap_wacs2(1, addr, wdata, 0, 1);
|
||||
}
|
||||
|
||||
static inline u16 pwrap_read_field(u16 reg, u16 mask, u16 shift)
|
||||
{
|
||||
u16 rdata;
|
||||
|
||||
pwrap_read(reg, &rdata);
|
||||
rdata &= (mask << shift);
|
||||
rdata = (rdata >> shift);
|
||||
|
||||
return rdata;
|
||||
}
|
||||
|
||||
static inline void pwrap_write_field(u16 reg, u16 val, u16 mask, u16 shift)
|
||||
{
|
||||
u16 old, new;
|
||||
|
||||
pwrap_read(reg, &old);
|
||||
new = old & ~(mask << shift);
|
||||
new |= (val << shift);
|
||||
pwrap_write(reg, new);
|
||||
}
|
||||
|
||||
/* internal API */
|
||||
s32 pwrap_reset_spislv(void);
|
||||
|
||||
static inline s32 pwrap_read_nochk(u16 addr, u16 *rdata)
|
||||
{
|
||||
return pwrap_wacs2(0, addr, 0, rdata, 0);
|
||||
}
|
||||
|
||||
static inline s32 pwrap_write_nochk(u16 addr, u16 wdata)
|
||||
{
|
||||
return pwrap_wacs2(1, addr, wdata, 0, 0);
|
||||
}
|
||||
|
||||
/* dewrapper defaule value */
|
||||
enum {
|
||||
DEFAULT_VALUE_READ_TEST = 0x5aa5,
|
||||
WRITE_TEST_VALUE = 0xa55a
|
||||
};
|
||||
|
||||
/* timeout setting */
|
||||
enum {
|
||||
TIMEOUT_READ_US = 255,
|
||||
TIMEOUT_WAIT_IDLE_US = 255
|
||||
};
|
||||
|
||||
/* manual commnd */
|
||||
enum {
|
||||
OP_WR = 0x1,
|
||||
OP_CSH = 0x0,
|
||||
OP_CSL = 0x1,
|
||||
OP_OUTS = 0x8,
|
||||
};
|
||||
|
||||
enum {
|
||||
RDATA_WACS_RDATA_SHIFT = 0,
|
||||
RDATA_WACS_FSM_SHIFT = 16,
|
||||
RDATA_WACS_REQ_SHIFT = 19,
|
||||
RDATA_SYNC_IDLE_SHIFT,
|
||||
RDATA_INIT_DONE_SHIFT,
|
||||
RDATA_SYS_IDLE_SHIFT,
|
||||
};
|
||||
|
||||
enum {
|
||||
RDATA_WACS_RDATA_MASK = 0xffff,
|
||||
RDATA_WACS_FSM_MASK = 0x7,
|
||||
RDATA_WACS_REQ_MASK = 0x1,
|
||||
RDATA_SYNC_IDLE_MASK = 0x1,
|
||||
RDATA_INIT_DONE_MASK = 0x1,
|
||||
RDATA_SYS_IDLE_MASK = 0x1,
|
||||
};
|
||||
|
||||
/* WACS_FSM */
|
||||
enum {
|
||||
WACS_FSM_IDLE = 0x00,
|
||||
WACS_FSM_REQ = 0x02,
|
||||
WACS_FSM_WFDLE = 0x04, /* wait for dle, wait for read data done */
|
||||
WACS_FSM_WFVLDCLR = 0x06, /* finish read data, wait for valid flag
|
||||
* clearing */
|
||||
WACS_INIT_DONE = 0x01,
|
||||
WACS_SYNC_IDLE = 0x01,
|
||||
WACS_SYNC_BUSY = 0x00
|
||||
};
|
||||
|
||||
/* error information flag */
|
||||
enum {
|
||||
E_PWR_INVALID_ARG = 1,
|
||||
E_PWR_INVALID_RW = 2,
|
||||
E_PWR_INVALID_ADDR = 3,
|
||||
E_PWR_INVALID_WDAT = 4,
|
||||
E_PWR_INVALID_OP_MANUAL = 5,
|
||||
E_PWR_NOT_IDLE_STATE = 6,
|
||||
E_PWR_NOT_INIT_DONE = 7,
|
||||
E_PWR_NOT_INIT_DONE_READ = 8,
|
||||
E_PWR_WAIT_IDLE_TIMEOUT = 9,
|
||||
E_PWR_WAIT_IDLE_TIMEOUT_READ = 10,
|
||||
E_PWR_INIT_SIDLY_FAIL = 11,
|
||||
E_PWR_RESET_TIMEOUT = 12,
|
||||
E_PWR_TIMEOUT = 13,
|
||||
E_PWR_INIT_RESET_SPI = 20,
|
||||
E_PWR_INIT_SIDLY = 21,
|
||||
E_PWR_INIT_REG_CLOCK = 22,
|
||||
E_PWR_INIT_ENABLE_PMIC = 23,
|
||||
E_PWR_INIT_DIO = 24,
|
||||
E_PWR_INIT_CIPHER = 25,
|
||||
E_PWR_INIT_WRITE_TEST = 26,
|
||||
E_PWR_INIT_ENABLE_CRC = 27,
|
||||
E_PWR_INIT_ENABLE_DEWRAP = 28,
|
||||
E_PWR_INIT_ENABLE_EVENT = 29,
|
||||
E_PWR_READ_TEST_FAIL = 30,
|
||||
E_PWR_WRITE_TEST_FAIL = 31,
|
||||
E_PWR_SWITCH_DIO = 32
|
||||
};
|
||||
|
||||
typedef u32 (*loop_condition_fp)(u32);
|
||||
|
||||
static inline u32 wait_for_fsm_vldclr(u32 x)
|
||||
{
|
||||
return ((x >> RDATA_WACS_FSM_SHIFT) & RDATA_WACS_FSM_MASK) !=
|
||||
WACS_FSM_WFVLDCLR;
|
||||
}
|
||||
|
||||
static inline u32 wait_for_sync(u32 x)
|
||||
{
|
||||
return ((x >> RDATA_SYNC_IDLE_SHIFT) & RDATA_SYNC_IDLE_MASK) !=
|
||||
WACS_SYNC_IDLE;
|
||||
}
|
||||
|
||||
static inline u32 wait_for_idle_and_sync(u32 x)
|
||||
{
|
||||
return ((((x >> RDATA_WACS_FSM_SHIFT) & RDATA_WACS_FSM_MASK) !=
|
||||
WACS_FSM_IDLE) || (((x >> RDATA_SYNC_IDLE_SHIFT) &
|
||||
RDATA_SYNC_IDLE_MASK) != WACS_SYNC_IDLE));
|
||||
}
|
||||
|
||||
static inline u32 wait_for_cipher_ready(u32 x)
|
||||
{
|
||||
return x != 3;
|
||||
}
|
||||
|
||||
u32 wait_for_state_idle(u32 timeout_us, void *wacs_register,
|
||||
void *wacs_vldclr_register, u32 *read_reg);
|
||||
|
||||
u32 wait_for_state_ready(loop_condition_fp fp, u32 timeout_us,
|
||||
void *wacs_register, u32 *read_reg);
|
||||
|
||||
#endif /* SOC_MEDIATEK_PMIC_WRAP_COMMON_H */
|
165
src/soc/mediatek/common/pmic_wrap.c
Normal file
165
src/soc/mediatek/common/pmic_wrap.c
Normal file
@@ -0,0 +1,165 @@
|
||||
/*
|
||||
* This file is part of the coreboot project.
|
||||
*
|
||||
* Copyright 2018 MediaTek Inc.
|
||||
*
|
||||
* 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; version 2 of the License.
|
||||
*
|
||||
* 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.
|
||||
*/
|
||||
|
||||
#include <arch/io.h>
|
||||
#include <assert.h>
|
||||
#include <soc/pmic_wrap.h>
|
||||
|
||||
u32 wait_for_state_idle(u32 timeout_us, void *wacs_register,
|
||||
void *wacs_vldclr_register, u32 *read_reg)
|
||||
{
|
||||
u32 reg_rdata;
|
||||
|
||||
struct stopwatch sw;
|
||||
|
||||
stopwatch_init_usecs_expire(&sw, timeout_us);
|
||||
do {
|
||||
reg_rdata = read32((wacs_register));
|
||||
/* if last read command timeout,clear vldclr bit
|
||||
read command state machine:FSM_REQ-->wfdle-->WFVLDCLR;
|
||||
write:FSM_REQ-->idle */
|
||||
switch (((reg_rdata >> RDATA_WACS_FSM_SHIFT) &
|
||||
RDATA_WACS_FSM_MASK)) {
|
||||
case WACS_FSM_WFVLDCLR:
|
||||
write32(wacs_vldclr_register, 1);
|
||||
pwrap_err("WACS_FSM = PMIC_WRAP_WACS_VLDCLR\n");
|
||||
break;
|
||||
case WACS_FSM_WFDLE:
|
||||
pwrap_err("WACS_FSM = WACS_FSM_WFDLE\n");
|
||||
break;
|
||||
case WACS_FSM_REQ:
|
||||
pwrap_err("WACS_FSM = WACS_FSM_REQ\n");
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
}
|
||||
|
||||
if (stopwatch_expired(&sw))
|
||||
return E_PWR_WAIT_IDLE_TIMEOUT;
|
||||
|
||||
} while (((reg_rdata >> RDATA_WACS_FSM_SHIFT) & RDATA_WACS_FSM_MASK) !=
|
||||
WACS_FSM_IDLE); /* IDLE State */
|
||||
if (read_reg)
|
||||
*read_reg = reg_rdata;
|
||||
return 0;
|
||||
}
|
||||
|
||||
u32 wait_for_state_ready(loop_condition_fp fp, u32 timeout_us,
|
||||
void *wacs_register, u32 *read_reg)
|
||||
{
|
||||
u32 reg_rdata;
|
||||
struct stopwatch sw;
|
||||
|
||||
stopwatch_init_usecs_expire(&sw, timeout_us);
|
||||
do {
|
||||
reg_rdata = read32((wacs_register));
|
||||
|
||||
if (stopwatch_expired(&sw)) {
|
||||
pwrap_err("timeout when waiting for idle\n");
|
||||
return E_PWR_WAIT_IDLE_TIMEOUT;
|
||||
}
|
||||
} while (fp(reg_rdata)); /* IDLE State */
|
||||
if (read_reg)
|
||||
*read_reg = reg_rdata;
|
||||
return 0;
|
||||
}
|
||||
|
||||
s32 pwrap_reset_spislv(void)
|
||||
{
|
||||
u32 ret = 0;
|
||||
|
||||
write32(&mtk_pwrap->hiprio_arb_en, 0);
|
||||
write32(&mtk_pwrap->wrap_en, 0);
|
||||
write32(&mtk_pwrap->mux_sel, 1);
|
||||
write32(&mtk_pwrap->man_en, 1);
|
||||
write32(&mtk_pwrap->dio_en, 0);
|
||||
|
||||
write32(&mtk_pwrap->man_cmd, (OP_WR << 13) | (OP_CSL << 8));
|
||||
/* Reset counter */
|
||||
write32(&mtk_pwrap->man_cmd, (OP_WR << 13) | (OP_OUTS << 8));
|
||||
write32(&mtk_pwrap->man_cmd, (OP_WR << 13) | (OP_CSH << 8));
|
||||
/*
|
||||
* In order to pull CSN signal to PMIC,
|
||||
* PMIC will count it then reset spi slave
|
||||
*/
|
||||
write32(&mtk_pwrap->man_cmd, (OP_WR << 13) | (OP_OUTS << 8));
|
||||
write32(&mtk_pwrap->man_cmd, (OP_WR << 13) | (OP_OUTS << 8));
|
||||
write32(&mtk_pwrap->man_cmd, (OP_WR << 13) | (OP_OUTS << 8));
|
||||
write32(&mtk_pwrap->man_cmd, (OP_WR << 13) | (OP_OUTS << 8));
|
||||
|
||||
if (wait_for_state_ready(wait_for_sync, TIMEOUT_WAIT_IDLE_US,
|
||||
&mtk_pwrap->wacs2_rdata, 0))
|
||||
ret = E_PWR_TIMEOUT;
|
||||
|
||||
write32(&mtk_pwrap->man_en, 0);
|
||||
write32(&mtk_pwrap->mux_sel, 0);
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
s32 pwrap_wacs2(u32 write, u16 addr, u16 wdata, u16 *rdata, u32 init_check)
|
||||
{
|
||||
u32 reg_rdata = 0;
|
||||
u32 wacs_write = 0;
|
||||
u32 wacs_addr = 0;
|
||||
u32 wacs_cmd = 0;
|
||||
u32 wait_result = 0;
|
||||
|
||||
if (init_check) {
|
||||
reg_rdata = read32(&mtk_pwrap->wacs2_rdata);
|
||||
/* Prevent someone to use pwrap before pwrap init */
|
||||
if (((reg_rdata >> RDATA_INIT_DONE_SHIFT) &
|
||||
RDATA_INIT_DONE_MASK) != WACS_INIT_DONE) {
|
||||
pwrap_err("Pwrap initialization isn't finished\n");
|
||||
return E_PWR_NOT_INIT_DONE;
|
||||
}
|
||||
}
|
||||
reg_rdata = 0;
|
||||
/* Check IDLE in advance */
|
||||
wait_result = wait_for_state_idle(TIMEOUT_WAIT_IDLE_US,
|
||||
&mtk_pwrap->wacs2_rdata,
|
||||
&mtk_pwrap->wacs2_vldclr,
|
||||
0);
|
||||
if (wait_result != 0) {
|
||||
pwrap_err("wait_for_fsm_idle fail,wait_result=%d\n",
|
||||
wait_result);
|
||||
return E_PWR_WAIT_IDLE_TIMEOUT;
|
||||
}
|
||||
wacs_write = write << 31;
|
||||
wacs_addr = (addr >> 1) << 16;
|
||||
wacs_cmd = wacs_write | wacs_addr | wdata;
|
||||
|
||||
write32(&mtk_pwrap->wacs2_cmd, wacs_cmd);
|
||||
if (write == 0) {
|
||||
if (rdata == NULL) {
|
||||
pwrap_err("rdata is a NULL pointer\n");
|
||||
return E_PWR_INVALID_ARG;
|
||||
}
|
||||
wait_result = wait_for_state_ready(wait_for_fsm_vldclr,
|
||||
TIMEOUT_READ_US,
|
||||
&mtk_pwrap->wacs2_rdata,
|
||||
®_rdata);
|
||||
if (wait_result != 0) {
|
||||
pwrap_err("wait_for_fsm_vldclr fail,wait_result=%d\n",
|
||||
wait_result);
|
||||
return E_PWR_WAIT_IDLE_TIMEOUT_READ;
|
||||
}
|
||||
*rdata = ((reg_rdata >> RDATA_WACS_RDATA_SHIFT)
|
||||
& RDATA_WACS_RDATA_MASK);
|
||||
write32(&mtk_pwrap->wacs2_vldclr, 1);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
Reference in New Issue
Block a user