/* * Copyright (c) 2014 MediaTek Inc. * Author: Flora Fu, MediaTek * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * 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 #include #include #include #include #include #include #include #include #define PWRAP_MT8135_BRIDGE_IORD_ARB_EN 0x4 #define PWRAP_MT8135_BRIDGE_WACS3_EN 0x10 #define PWRAP_MT8135_BRIDGE_INIT_DONE3 0x14 #define PWRAP_MT8135_BRIDGE_WACS4_EN 0x24 #define PWRAP_MT8135_BRIDGE_INIT_DONE4 0x28 #define PWRAP_MT8135_BRIDGE_INT_EN 0x38 #define PWRAP_MT8135_BRIDGE_TIMER_EN 0x48 #define PWRAP_MT8135_BRIDGE_WDT_UNIT 0x50 #define PWRAP_MT8135_BRIDGE_WDT_SRC_EN 0x54 /* macro for wrapper status */ #define PWRAP_GET_WACS_RDATA(x) (((x) >> 0) & 0x0000ffff) #define PWRAP_GET_WACS_FSM(x) (((x) >> 16) & 0x00000007) #define PWRAP_GET_WACS_REQ(x) (((x) >> 19) & 0x00000001) #define PWRAP_STATE_SYNC_IDLE0 (1 << 20) #define PWRAP_STATE_INIT_DONE0 (1 << 21) /* macro for WACS FSM */ #define PWRAP_WACS_FSM_IDLE 0x00 #define PWRAP_WACS_FSM_REQ 0x02 #define PWRAP_WACS_FSM_WFDLE 0x04 #define PWRAP_WACS_FSM_WFVLDCLR 0x06 #define PWRAP_WACS_INIT_DONE 0x01 #define PWRAP_WACS_WACS_SYNC_IDLE 0x01 #define PWRAP_WACS_SYNC_BUSY 0x00 /* macro for device wrapper default value */ #define PWRAP_DEW_READ_TEST_VAL 0x5aa5 #define PWRAP_DEW_WRITE_TEST_VAL 0xa55a /* macro for manual command */ #define PWRAP_MAN_CMD_SPI_WRITE (1 << 13) #define PWRAP_MAN_CMD_OP_CSH (0x0 << 8) #define PWRAP_MAN_CMD_OP_CSL (0x1 << 8) #define PWRAP_MAN_CMD_OP_CK (0x2 << 8) #define PWRAP_MAN_CMD_OP_OUTS (0x8 << 8) #define PWRAP_MAN_CMD_OP_OUTD (0x9 << 8) #define PWRAP_MAN_CMD_OP_OUTQ (0xa << 8) /* macro for Watch Dog Timer Source */ #define PWRAP_WDT_SRC_EN_STAUPD_TRIG (1 << 25) #define PWRAP_WDT_SRC_EN_HARB_STAUPD_DLE (1 << 20) #define PWRAP_WDT_SRC_EN_HARB_STAUPD_ALE (1 << 6) #define PWRAP_WDT_SRC_MASK_ALL 0xffffffff #define PWRAP_WDT_SRC_MASK_NO_STAUPD ~(PWRAP_WDT_SRC_EN_STAUPD_TRIG | \ PWRAP_WDT_SRC_EN_HARB_STAUPD_DLE | \ PWRAP_WDT_SRC_EN_HARB_STAUPD_ALE) /* macro for slave device wrapper registers */ #define PWRAP_DEW_BASE 0xbc00 #define PWRAP_DEW_EVENT_OUT_EN (PWRAP_DEW_BASE + 0x0) #define PWRAP_DEW_DIO_EN (PWRAP_DEW_BASE + 0x2) #define PWRAP_DEW_EVENT_SRC_EN (PWRAP_DEW_BASE + 0x4) #define PWRAP_DEW_EVENT_SRC (PWRAP_DEW_BASE + 0x6) #define PWRAP_DEW_EVENT_FLAG (PWRAP_DEW_BASE + 0x8) #define PWRAP_DEW_READ_TEST (PWRAP_DEW_BASE + 0xa) #define PWRAP_DEW_WRITE_TEST (PWRAP_DEW_BASE + 0xc) #define PWRAP_DEW_CRC_EN (PWRAP_DEW_BASE + 0xe) #define PWRAP_DEW_CRC_VAL (PWRAP_DEW_BASE + 0x10) #define PWRAP_DEW_MON_GRP_SEL (PWRAP_DEW_BASE + 0x12) #define PWRAP_DEW_MON_FLAG_SEL (PWRAP_DEW_BASE + 0x14) #define PWRAP_DEW_EVENT_TEST (PWRAP_DEW_BASE + 0x16) #define PWRAP_DEW_CIPHER_KEY_SEL (PWRAP_DEW_BASE + 0x18) #define PWRAP_DEW_CIPHER_IV_SEL (PWRAP_DEW_BASE + 0x1a) #define PWRAP_DEW_CIPHER_LOAD (PWRAP_DEW_BASE + 0x1c) #define PWRAP_DEW_CIPHER_START (PWRAP_DEW_BASE + 0x1e) #define PWRAP_DEW_CIPHER_RDY (PWRAP_DEW_BASE + 0x20) #define PWRAP_DEW_CIPHER_MODE (PWRAP_DEW_BASE + 0x22) #define PWRAP_DEW_CIPHER_SWRST (PWRAP_DEW_BASE + 0x24) #define PWRAP_MT8173_DEW_CIPHER_IV0 (PWRAP_DEW_BASE + 0x26) #define PWRAP_MT8173_DEW_CIPHER_IV1 (PWRAP_DEW_BASE + 0x28) #define PWRAP_MT8173_DEW_CIPHER_IV2 (PWRAP_DEW_BASE + 0x2a) #define PWRAP_MT8173_DEW_CIPHER_IV3 (PWRAP_DEW_BASE + 0x2c) #define PWRAP_MT8173_DEW_CIPHER_IV4 (PWRAP_DEW_BASE + 0x2e) #define PWRAP_MT8173_DEW_CIPHER_IV5 (PWRAP_DEW_BASE + 0x30) enum pwrap_regs { PWRAP_MUX_SEL, PWRAP_WRAP_EN, PWRAP_DIO_EN, PWRAP_SIDLY, PWRAP_CSHEXT_WRITE, PWRAP_CSHEXT_READ, PWRAP_CSLEXT_START, PWRAP_CSLEXT_END, PWRAP_STAUPD_PRD, PWRAP_STAUPD_GRPEN, PWRAP_STAUPD_MAN_TRIG, PWRAP_STAUPD_STA, PWRAP_WRAP_STA, PWRAP_HARB_INIT, PWRAP_HARB_HPRIO, PWRAP_HIPRIO_ARB_EN, PWRAP_HARB_STA0, PWRAP_HARB_STA1, PWRAP_MAN_EN, PWRAP_MAN_CMD, PWRAP_MAN_RDATA, PWRAP_MAN_VLDCLR, PWRAP_WACS0_EN, PWRAP_INIT_DONE0, PWRAP_WACS0_CMD, PWRAP_WACS0_RDATA, PWRAP_WACS0_VLDCLR, PWRAP_WACS1_EN, PWRAP_INIT_DONE1, PWRAP_WACS1_CMD, PWRAP_WACS1_RDATA, PWRAP_WACS1_VLDCLR, PWRAP_WACS2_EN, PWRAP_INIT_DONE2, PWRAP_WACS2_CMD, PWRAP_WACS2_RDATA, PWRAP_WACS2_VLDCLR, PWRAP_INT_EN, PWRAP_INT_FLG_RAW, PWRAP_INT_FLG, PWRAP_INT_CLR, PWRAP_SIG_ADR, PWRAP_SIG_MODE, PWRAP_SIG_VALUE, PWRAP_SIG_ERRVAL, PWRAP_CRC_EN, PWRAP_TIMER_EN, PWRAP_TIMER_STA, PWRAP_WDT_UNIT, PWRAP_WDT_SRC_EN, PWRAP_WDT_FLG, PWRAP_DEBUG_INT_SEL, PWRAP_CIPHER_KEY_SEL, PWRAP_CIPHER_IV_SEL, PWRAP_CIPHER_RDY, PWRAP_CIPHER_MODE, PWRAP_CIPHER_SWRST, PWRAP_DCM_EN, PWRAP_DCM_DBC_PRD, /* MT8135 only regs */ PWRAP_CSHEXT, PWRAP_EVENT_IN_EN, PWRAP_EVENT_DST_EN, PWRAP_RRARB_INIT, PWRAP_RRARB_EN, PWRAP_RRARB_STA0, PWRAP_RRARB_STA1, PWRAP_EVENT_STA, PWRAP_EVENT_STACLR, PWRAP_CIPHER_LOAD, PWRAP_CIPHER_START, /* MT8173 only regs */ PWRAP_RDDMY, PWRAP_SI_CK_CON, PWRAP_DVFS_ADR0, PWRAP_DVFS_WDATA0, PWRAP_DVFS_ADR1, PWRAP_DVFS_WDATA1, PWRAP_DVFS_ADR2, PWRAP_DVFS_WDATA2, PWRAP_DVFS_ADR3, PWRAP_DVFS_WDATA3, PWRAP_DVFS_ADR4, PWRAP_DVFS_WDATA4, PWRAP_DVFS_ADR5, PWRAP_DVFS_WDATA5, PWRAP_DVFS_ADR6, PWRAP_DVFS_WDATA6, PWRAP_DVFS_ADR7, PWRAP_DVFS_WDATA7, PWRAP_SPMINF_STA, PWRAP_CIPHER_EN, }; static int mt8173_regs[] = { [PWRAP_MUX_SEL] = 0x0, [PWRAP_WRAP_EN] = 0x4, [PWRAP_DIO_EN] = 0x8, [PWRAP_SIDLY] = 0xc, [PWRAP_RDDMY] = 0x10, [PWRAP_SI_CK_CON] = 0x14, [PWRAP_CSHEXT_WRITE] = 0x18, [PWRAP_CSHEXT_READ] = 0x1c, [PWRAP_CSLEXT_START] = 0x20, [PWRAP_CSLEXT_END] = 0x24, [PWRAP_STAUPD_PRD] = 0x28, [PWRAP_STAUPD_GRPEN] = 0x2c, [PWRAP_STAUPD_MAN_TRIG] = 0x40, [PWRAP_STAUPD_STA] = 0x44, [PWRAP_WRAP_STA] = 0x48, [PWRAP_HARB_INIT] = 0x4c, [PWRAP_HARB_HPRIO] = 0x50, [PWRAP_HIPRIO_ARB_EN] = 0x54, [PWRAP_HARB_STA0] = 0x58, [PWRAP_HARB_STA1] = 0x5c, [PWRAP_MAN_EN] = 0x60, [PWRAP_MAN_CMD] = 0x64, [PWRAP_MAN_RDATA] = 0x68, [PWRAP_MAN_VLDCLR] = 0x6c, [PWRAP_WACS0_EN] = 0x70, [PWRAP_INIT_DONE0] = 0x74, [PWRAP_WACS0_CMD] = 0x78, [PWRAP_WACS0_RDATA] = 0x7c, [PWRAP_WACS0_VLDCLR] = 0x80, [PWRAP_WACS1_EN] = 0x84, [PWRAP_INIT_DONE1] = 0x88, [PWRAP_WACS1_CMD] = 0x8c, [PWRAP_WACS1_RDATA] = 0x90, [PWRAP_WACS1_VLDCLR] = 0x94, [PWRAP_WACS2_EN] = 0x98, [PWRAP_INIT_DONE2] = 0x9c, [PWRAP_WACS2_CMD] = 0xa0, [PWRAP_WACS2_RDATA] = 0xa4, [PWRAP_WACS2_VLDCLR] = 0xa8, [PWRAP_INT_EN] = 0xac, [PWRAP_INT_FLG_RAW] = 0xb0, [PWRAP_INT_FLG] = 0xb4, [PWRAP_INT_CLR] = 0xb8, [PWRAP_SIG_ADR] = 0xbc, [PWRAP_SIG_MODE] = 0xc0, [PWRAP_SIG_VALUE] = 0xc4, [PWRAP_SIG_ERRVAL] = 0xc8, [PWRAP_CRC_EN] = 0xcc, [PWRAP_TIMER_EN] = 0xd0, [PWRAP_TIMER_STA] = 0xd4, [PWRAP_WDT_UNIT] = 0xd8, [PWRAP_WDT_SRC_EN] = 0xdc, [PWRAP_WDT_FLG] = 0xe0, [PWRAP_DEBUG_INT_SEL] = 0xe4, [PWRAP_DVFS_ADR0] = 0xe8, [PWRAP_DVFS_WDATA0] = 0xec, [PWRAP_DVFS_ADR1] = 0xf0, [PWRAP_DVFS_WDATA1] = 0xf4, [PWRAP_DVFS_ADR2] = 0xf8, [PWRAP_DVFS_WDATA2] = 0xfc, [PWRAP_DVFS_ADR3] = 0x100, [PWRAP_DVFS_WDATA3] = 0x104, [PWRAP_DVFS_ADR4] = 0x108, [PWRAP_DVFS_WDATA4] = 0x10c, [PWRAP_DVFS_ADR5] = 0x110, [PWRAP_DVFS_WDATA5] = 0x114, [PWRAP_DVFS_ADR6] = 0x118, [PWRAP_DVFS_WDATA6] = 0x11c, [PWRAP_DVFS_ADR7] = 0x120, [PWRAP_DVFS_WDATA7] = 0x124, [PWRAP_SPMINF_STA] = 0x128, [PWRAP_CIPHER_KEY_SEL] = 0x12c, [PWRAP_CIPHER_IV_SEL] = 0x130, [PWRAP_CIPHER_EN] = 0x134, [PWRAP_CIPHER_RDY] = 0x138, [PWRAP_CIPHER_MODE] = 0x13c, [PWRAP_CIPHER_SWRST] = 0x140, [PWRAP_DCM_EN] = 0x144, [PWRAP_DCM_DBC_PRD] = 0x148, }; static int mt8135_regs[] = { [PWRAP_MUX_SEL] = 0x0, [PWRAP_WRAP_EN] = 0x4, [PWRAP_DIO_EN] = 0x8, [PWRAP_SIDLY] = 0xc, [PWRAP_CSHEXT] = 0x10, [PWRAP_CSHEXT_WRITE] = 0x14, [PWRAP_CSHEXT_READ] = 0x18, [PWRAP_CSLEXT_START] = 0x1c, [PWRAP_CSLEXT_END] = 0x20, [PWRAP_STAUPD_PRD] = 0x24, [PWRAP_STAUPD_GRPEN] = 0x28, [PWRAP_STAUPD_MAN_TRIG] = 0x2c, [PWRAP_STAUPD_STA] = 0x30, [PWRAP_EVENT_IN_EN] = 0x34, [PWRAP_EVENT_DST_EN] = 0x38, [PWRAP_WRAP_STA] = 0x3c, [PWRAP_RRARB_INIT] = 0x40, [PWRAP_RRARB_EN] = 0x44, [PWRAP_RRARB_STA0] = 0x48, [PWRAP_RRARB_STA1] = 0x4c, [PWRAP_HARB_INIT] = 0x50, [PWRAP_HARB_HPRIO] = 0x54, [PWRAP_HIPRIO_ARB_EN] = 0x58, [PWRAP_HARB_STA0] = 0x5c, [PWRAP_HARB_STA1] = 0x60, [PWRAP_MAN_EN] = 0x64, [PWRAP_MAN_CMD] = 0x68, [PWRAP_MAN_RDATA] = 0x6c, [PWRAP_MAN_VLDCLR] = 0x70, [PWRAP_WACS0_EN] = 0x74, [PWRAP_INIT_DONE0] = 0x78, [PWRAP_WACS0_CMD] = 0x7c, [PWRAP_WACS0_RDATA] = 0x80, [PWRAP_WACS0_VLDCLR] = 0x84, [PWRAP_WACS1_EN] = 0x88, [PWRAP_INIT_DONE1] = 0x8c, [PWRAP_WACS1_CMD] = 0x90, [PWRAP_WACS1_RDATA] = 0x94, [PWRAP_WACS1_VLDCLR] = 0x98, [PWRAP_WACS2_EN] = 0x9c, [PWRAP_INIT_DONE2] = 0xa0, [PWRAP_WACS2_CMD] = 0xa4, [PWRAP_WACS2_RDATA] = 0xa8, [PWRAP_WACS2_VLDCLR] = 0xac, [PWRAP_INT_EN] = 0xb0, [PWRAP_INT_FLG_RAW] = 0xb4, [PWRAP_INT_FLG] = 0xb8, [PWRAP_INT_CLR] = 0xbc, [PWRAP_SIG_ADR] = 0xc0, [PWRAP_SIG_MODE] = 0xc4, [PWRAP_SIG_VALUE] = 0xc8, [PWRAP_SIG_ERRVAL] = 0xcc, [PWRAP_CRC_EN] = 0xd0, [PWRAP_EVENT_STA] = 0xd4, [PWRAP_EVENT_STACLR] = 0xd8, [PWRAP_TIMER_EN] = 0xdc, [PWRAP_TIMER_STA] = 0xe0, [PWRAP_WDT_UNIT] = 0xe4, [PWRAP_WDT_SRC_EN] = 0xe8, [PWRAP_WDT_FLG] = 0xec, [PWRAP_DEBUG_INT_SEL] = 0xf0, [PWRAP_CIPHER_KEY_SEL] = 0x134, [PWRAP_CIPHER_IV_SEL] = 0x138, [PWRAP_CIPHER_LOAD] = 0x13c, [PWRAP_CIPHER_START] = 0x140, [PWRAP_CIPHER_RDY] = 0x144, [PWRAP_CIPHER_MODE] = 0x148, [PWRAP_CIPHER_SWRST] = 0x14c, [PWRAP_DCM_EN] = 0x15c, [PWRAP_DCM_DBC_PRD] = 0x160, }; enum pwrap_type { PWRAP_MT8135, PWRAP_MT8173, }; struct pmic_wrapper { struct device *dev; void __iomem *base; struct regmap *regmap; const struct pmic_wrapper_type *master; struct clk *clk_spi; struct clk *clk_wrap; struct reset_control *rstc; struct reset_control *rstc_bridge; void __iomem *bridge_base; }; struct pmic_wrapper_type { int *regs; enum pwrap_type type; u32 arb_en_all; int (*init_reg_clock)(struct pmic_wrapper *wrp); int (*init_soc_specific)(struct pmic_wrapper *wrp); }; static inline int pwrap_is_mt8135(struct pmic_wrapper *wrp) { return wrp->master->type == PWRAP_MT8135; } static inline int pwrap_is_mt8173(struct pmic_wrapper *wrp) { return wrp->master->type == PWRAP_MT8173; } static u32 pwrap_readl(struct pmic_wrapper *wrp, enum pwrap_regs reg) { return readl(wrp->base + wrp->master->regs[reg]); } static void pwrap_writel(struct pmic_wrapper *wrp, u32 val, enum pwrap_regs reg) { writel(val, wrp->base + wrp->master->regs[reg]); } static bool pwrap_is_fsm_idle(struct pmic_wrapper *wrp) { u32 val = pwrap_readl(wrp, PWRAP_WACS2_RDATA); return PWRAP_GET_WACS_FSM(val) == PWRAP_WACS_FSM_IDLE; } static bool pwrap_is_fsm_vldclr(struct pmic_wrapper *wrp) { u32 val = pwrap_readl(wrp, PWRAP_WACS2_RDATA); return PWRAP_GET_WACS_FSM(val) == PWRAP_WACS_FSM_WFVLDCLR; } /* * Timeout issue sometimes caused by the last read command * failed because pmic wrap could not got the FSM_VLDCLR * in time after finishing WACS2_CMD. It made state machine * still on FSM_VLDCLR and timeout next time. * Check the status of FSM and clear the vldclr to recovery the * error. */ static inline void pwrap_leave_fsm_vldclr(struct pmic_wrapper *wrp) { if (pwrap_is_fsm_vldclr(wrp)) pwrap_writel(wrp, 1, PWRAP_WACS2_VLDCLR); } static bool pwrap_is_sync_idle(struct pmic_wrapper *wrp) { return pwrap_readl(wrp, PWRAP_WACS2_RDATA) & PWRAP_STATE_SYNC_IDLE0; } static bool pwrap_is_fsm_idle_and_sync_idle(struct pmic_wrapper *wrp) { u32 val = pwrap_readl(wrp, PWRAP_WACS2_RDATA); return (PWRAP_GET_WACS_FSM(val) == PWRAP_WACS_FSM_IDLE) && (val & PWRAP_STATE_SYNC_IDLE0); } static int pwrap_wait_for_state(struct pmic_wrapper *wrp, bool (*fp)(struct pmic_wrapper *)) { unsigned long timeout; timeout = jiffies + usecs_to_jiffies(255); do { if (time_after(jiffies, timeout)) return fp(wrp) ? 0 : -ETIMEDOUT; if (fp(wrp)) return 0; } while (1); } static int pwrap_write(struct pmic_wrapper *wrp, u32 adr, u32 wdata) { int ret; ret = pwrap_wait_for_state(wrp, pwrap_is_fsm_idle); if (ret) { pwrap_leave_fsm_vldclr(wrp); return ret; } pwrap_writel(wrp, (1 << 31) | ((adr >> 1) << 16) | wdata, PWRAP_WACS2_CMD); return 0; } static int pwrap_read(struct pmic_wrapper *wrp, u32 adr, u32 *rdata) { int ret; ret = pwrap_wait_for_state(wrp, pwrap_is_fsm_idle); if (ret) { pwrap_leave_fsm_vldclr(wrp); return ret; } pwrap_writel(wrp, (adr >> 1) << 16, PWRAP_WACS2_CMD); ret = pwrap_wait_for_state(wrp, pwrap_is_fsm_vldclr); if (ret) return ret; *rdata = PWRAP_GET_WACS_RDATA(pwrap_readl(wrp, PWRAP_WACS2_RDATA)); pwrap_writel(wrp, 1, PWRAP_WACS2_VLDCLR); return 0; } static int pwrap_regmap_read(void *context, u32 adr, u32 *rdata) { return pwrap_read(context, adr, rdata); } static int pwrap_regmap_write(void *context, u32 adr, u32 wdata) { return pwrap_write(context, adr, wdata); } static int pwrap_reset_spislave(struct pmic_wrapper *wrp) { int ret, i; pwrap_writel(wrp, 0, PWRAP_HIPRIO_ARB_EN); pwrap_writel(wrp, 0, PWRAP_WRAP_EN); pwrap_writel(wrp, 1, PWRAP_MUX_SEL); pwrap_writel(wrp, 1, PWRAP_MAN_EN); pwrap_writel(wrp, 0, PWRAP_DIO_EN); pwrap_writel(wrp, PWRAP_MAN_CMD_SPI_WRITE | PWRAP_MAN_CMD_OP_CSL, PWRAP_MAN_CMD); pwrap_writel(wrp, PWRAP_MAN_CMD_SPI_WRITE | PWRAP_MAN_CMD_OP_OUTS, PWRAP_MAN_CMD); pwrap_writel(wrp, PWRAP_MAN_CMD_SPI_WRITE | PWRAP_MAN_CMD_OP_CSH, PWRAP_MAN_CMD); for (i = 0; i < 4; i++) pwrap_writel(wrp, PWRAP_MAN_CMD_SPI_WRITE | PWRAP_MAN_CMD_OP_OUTS, PWRAP_MAN_CMD); ret = pwrap_wait_for_state(wrp, pwrap_is_sync_idle); if (ret) { dev_err(wrp->dev, "%s fail, ret=%d\n", __func__, ret); return ret; } pwrap_writel(wrp, 0, PWRAP_MAN_EN); pwrap_writel(wrp, 0, PWRAP_MUX_SEL); return 0; } /* * pwrap_init_sidly - configure serial input delay * * This configures the serial input delay. We can configure 0, 2, 4 or 6ns * delay. Do a read test with all possible values and chose the best delay. */ static int pwrap_init_sidly(struct pmic_wrapper *wrp) { u32 rdata; u32 i; u32 pass = 0; signed char dly[16] = { -1, 0, 1, 0, 2, -1, 1, 1, 3, -1, -1, -1, 3, -1, 2, 1 }; for (i = 0; i < 4; i++) { pwrap_writel(wrp, i, PWRAP_SIDLY); pwrap_read(wrp, PWRAP_DEW_READ_TEST, &rdata); if (rdata == PWRAP_DEW_READ_TEST_VAL) { dev_dbg(wrp->dev, "[Read Test] pass, SIDLY=%x\n", i); pass |= 1 << i; } } if (dly[pass] < 0) { dev_err(wrp->dev, "sidly pass range 0x%x not continuous\n", pass); return -EIO; } pwrap_writel(wrp, dly[pass], PWRAP_SIDLY); return 0; } static int pwrap_mt8135_init_reg_clock(struct pmic_wrapper *wrp) { pwrap_writel(wrp, 0x4, PWRAP_CSHEXT); pwrap_writel(wrp, 0x0, PWRAP_CSHEXT_WRITE); pwrap_writel(wrp, 0x4, PWRAP_CSHEXT_READ); pwrap_writel(wrp, 0x0, PWRAP_CSLEXT_START); pwrap_writel(wrp, 0x0, PWRAP_CSLEXT_END); return 0; } static int pwrap_mt8173_init_reg_clock(struct pmic_wrapper *wrp) { pwrap_writel(wrp, 0x0, PWRAP_CSHEXT_WRITE); pwrap_writel(wrp, 0x4, PWRAP_CSHEXT_READ); pwrap_writel(wrp, 0x2, PWRAP_CSLEXT_START); pwrap_writel(wrp, 0x2, PWRAP_CSLEXT_END); return 0; } static bool pwrap_is_cipher_ready(struct pmic_wrapper *wrp) { return pwrap_readl(wrp, PWRAP_CIPHER_RDY) & 1; } static bool pwrap_is_pmic_cipher_ready(struct pmic_wrapper *wrp) { u32 rdata; int ret; ret = pwrap_read(wrp, PWRAP_DEW_CIPHER_RDY, &rdata); if (ret) return 0; return rdata == 1; } static int pwrap_init_cipher(struct pmic_wrapper *wrp) { int ret; u32 rdata; pwrap_writel(wrp, 0x1, PWRAP_CIPHER_SWRST); pwrap_writel(wrp, 0x0, PWRAP_CIPHER_SWRST); pwrap_writel(wrp, 0x1, PWRAP_CIPHER_KEY_SEL); pwrap_writel(wrp, 0x2, PWRAP_CIPHER_IV_SEL); if (pwrap_is_mt8135(wrp)) { pwrap_writel(wrp, 1, PWRAP_CIPHER_LOAD); pwrap_writel(wrp, 1, PWRAP_CIPHER_START); } else { pwrap_writel(wrp, 1, PWRAP_CIPHER_EN); } /* Config cipher mode @PMIC */ pwrap_write(wrp, PWRAP_DEW_CIPHER_SWRST, 0x1); pwrap_write(wrp, PWRAP_DEW_CIPHER_SWRST, 0x0); pwrap_write(wrp, PWRAP_DEW_CIPHER_KEY_SEL, 0x1); pwrap_write(wrp, PWRAP_DEW_CIPHER_IV_SEL, 0x2); pwrap_write(wrp, PWRAP_DEW_CIPHER_LOAD, 0x1); pwrap_write(wrp, PWRAP_DEW_CIPHER_START, 0x1); /* wait for cipher data ready@AP */ ret = pwrap_wait_for_state(wrp, pwrap_is_cipher_ready); if (ret) { dev_err(wrp->dev, "cipher data ready@AP fail, ret=%d\n", ret); return ret; } /* wait for cipher data ready@PMIC */ ret = pwrap_wait_for_state(wrp, pwrap_is_pmic_cipher_ready); if (ret) { dev_err(wrp->dev, "timeout waiting for cipher data ready@PMIC\n"); return ret; } /* wait for cipher mode idle */ pwrap_write(wrp, PWRAP_DEW_CIPHER_MODE, 0x1); ret = pwrap_wait_for_state(wrp, pwrap_is_fsm_idle_and_sync_idle); if (ret) { dev_err(wrp->dev, "cipher mode idle fail, ret=%d\n", ret); return ret; } pwrap_writel(wrp, 1, PWRAP_CIPHER_MODE); /* Write Test */ if (pwrap_write(wrp, PWRAP_DEW_WRITE_TEST, PWRAP_DEW_WRITE_TEST_VAL) || pwrap_read(wrp, PWRAP_DEW_WRITE_TEST, &rdata) || (rdata != PWRAP_DEW_WRITE_TEST_VAL)) { dev_err(wrp->dev, "rdata=0x%04X\n", rdata); return -EFAULT; } return 0; } static int pwrap_mt8135_init_soc_specific(struct pmic_wrapper *wrp) { /* enable pwrap events and pwrap bridge in AP side */ pwrap_writel(wrp, 0x1, PWRAP_EVENT_IN_EN); pwrap_writel(wrp, 0xffff, PWRAP_EVENT_DST_EN); writel(0x7f, wrp->bridge_base + PWRAP_MT8135_BRIDGE_IORD_ARB_EN); writel(0x1, wrp->bridge_base + PWRAP_MT8135_BRIDGE_WACS3_EN); writel(0x1, wrp->bridge_base + PWRAP_MT8135_BRIDGE_WACS4_EN); writel(0x1, wrp->bridge_base + PWRAP_MT8135_BRIDGE_WDT_UNIT); writel(0xffff, wrp->bridge_base + PWRAP_MT8135_BRIDGE_WDT_SRC_EN); writel(0x1, wrp->bridge_base + PWRAP_MT8135_BRIDGE_TIMER_EN); writel(0x7ff, wrp->bridge_base + PWRAP_MT8135_BRIDGE_INT_EN); /* enable PMIC event out and sources */ if (pwrap_write(wrp, PWRAP_DEW_EVENT_OUT_EN, 0x1) || pwrap_write(wrp, PWRAP_DEW_EVENT_SRC_EN, 0xffff)) { dev_err(wrp->dev, "enable dewrap fail\n"); return -EFAULT; } return 0; } static int pwrap_mt8173_init_soc_specific(struct pmic_wrapper *wrp) { /* PMIC_DEWRAP enables */ if (pwrap_write(wrp, PWRAP_DEW_EVENT_OUT_EN, 0x1) || pwrap_write(wrp, PWRAP_DEW_EVENT_SRC_EN, 0xffff)) { dev_err(wrp->dev, "enable dewrap fail\n"); return -EFAULT; } return 0; } static int pwrap_init(struct pmic_wrapper *wrp) { int ret; u32 rdata; reset_control_reset(wrp->rstc); if (wrp->rstc_bridge) reset_control_reset(wrp->rstc_bridge); if (pwrap_is_mt8173(wrp)) { /* Enable DCM */ pwrap_writel(wrp, 3, PWRAP_DCM_EN); pwrap_writel(wrp, 0, PWRAP_DCM_DBC_PRD); } /* Reset SPI slave */ ret = pwrap_reset_spislave(wrp); if (ret) return ret; pwrap_writel(wrp, 1, PWRAP_WRAP_EN); pwrap_writel(wrp, wrp->master->arb_en_all, PWRAP_HIPRIO_ARB_EN); pwrap_writel(wrp, 1, PWRAP_WACS2_EN); ret = wrp->master->init_reg_clock(wrp); if (ret) return ret; /* Setup serial input delay */ ret = pwrap_init_sidly(wrp); if (ret) return ret; /* Enable dual IO mode */ pwrap_write(wrp, PWRAP_DEW_DIO_EN, 1); /* Check IDLE & INIT_DONE in advance */ ret = pwrap_wait_for_state(wrp, pwrap_is_fsm_idle_and_sync_idle); if (ret) { dev_err(wrp->dev, "%s fail, ret=%d\n", __func__, ret); return ret; } pwrap_writel(wrp, 1, PWRAP_DIO_EN); /* Read Test */ pwrap_read(wrp, PWRAP_DEW_READ_TEST, &rdata); if (rdata != PWRAP_DEW_READ_TEST_VAL) { dev_err(wrp->dev, "Read test failed after switch to DIO mode: 0x%04x != 0x%04x\n", PWRAP_DEW_READ_TEST_VAL, rdata); return -EFAULT; } /* Enable encryption */ ret = pwrap_init_cipher(wrp); if (ret) return ret; /* Signature checking - using CRC */ if (pwrap_write(wrp, PWRAP_DEW_CRC_EN, 0x1)) return -EFAULT; pwrap_writel(wrp, 0x1, PWRAP_CRC_EN); pwrap_writel(wrp, 0x0, PWRAP_SIG_MODE); pwrap_writel(wrp, PWRAP_DEW_CRC_VAL, PWRAP_SIG_ADR); pwrap_writel(wrp, wrp->master->arb_en_all, PWRAP_HIPRIO_ARB_EN); if (pwrap_is_mt8135(wrp)) pwrap_writel(wrp, 0x7, PWRAP_RRARB_EN); pwrap_writel(wrp, 0x1, PWRAP_WACS0_EN); pwrap_writel(wrp, 0x1, PWRAP_WACS1_EN); pwrap_writel(wrp, 0x1, PWRAP_WACS2_EN); pwrap_writel(wrp, 0x5, PWRAP_STAUPD_PRD); pwrap_writel(wrp, 0xff, PWRAP_STAUPD_GRPEN); if (wrp->master->init_soc_specific) { ret = wrp->master->init_soc_specific(wrp); if (ret) return ret; } /* Setup the init done registers */ pwrap_writel(wrp, 1, PWRAP_INIT_DONE2); pwrap_writel(wrp, 1, PWRAP_INIT_DONE0); pwrap_writel(wrp, 1, PWRAP_INIT_DONE1); if (pwrap_is_mt8135(wrp)) { writel(1, wrp->bridge_base + PWRAP_MT8135_BRIDGE_INIT_DONE3); writel(1, wrp->bridge_base + PWRAP_MT8135_BRIDGE_INIT_DONE4); } return 0; } static irqreturn_t pwrap_interrupt(int irqno, void *dev_id) { u32 rdata; struct pmic_wrapper *wrp = dev_id; rdata = pwrap_readl(wrp, PWRAP_INT_FLG); dev_err(wrp->dev, "unexpected interrupt int=0x%x\n", rdata); pwrap_writel(wrp, 0xffffffff, PWRAP_INT_CLR); return IRQ_HANDLED; } static const struct regmap_config pwrap_regmap_config = { .reg_bits = 16, .val_bits = 16, .reg_stride = 2, .reg_read = pwrap_regmap_read, .reg_write = pwrap_regmap_write, .max_register = 0xffff, }; static struct pmic_wrapper_type pwrap_mt8135 = { .regs = mt8135_regs, .type = PWRAP_MT8135, .arb_en_all = 0x1ff, .init_reg_clock = pwrap_mt8135_init_reg_clock, .init_soc_specific = pwrap_mt8135_init_soc_specific, }; static struct pmic_wrapper_type pwrap_mt8173 = { .regs = mt8173_regs, .type = PWRAP_MT8173, .arb_en_all = 0x3f, .init_reg_clock = pwrap_mt8173_init_reg_clock, .init_soc_specific = pwrap_mt8173_init_soc_specific, }; static struct of_device_id of_pwrap_match_tbl[] = { { .compatible = "mediatek,mt8135-pwrap", .data = &pwrap_mt8135, }, { .compatible = "mediatek,mt8173-pwrap", .data = &pwrap_mt8173, }, { /* sentinel */ } }; MODULE_DEVICE_TABLE(of, of_pwrap_match_tbl); static int pwrap_probe(struct platform_device *pdev) { int ret, irq, wdt_src; struct pmic_wrapper *wrp; struct device_node *np = pdev->dev.of_node; const struct of_device_id *of_id = of_match_device(of_pwrap_match_tbl, &pdev->dev); struct resource *res; wrp = devm_kzalloc(&pdev->dev, sizeof(*wrp), GFP_KERNEL); if (!wrp) return -ENOMEM; platform_set_drvdata(pdev, wrp); wrp->master = of_id->data; wrp->dev = &pdev->dev; res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pwrap"); wrp->base = devm_ioremap_resource(wrp->dev, res); if (IS_ERR(wrp->base)) return PTR_ERR(wrp->base); wrp->rstc = devm_reset_control_get(wrp->dev, "pwrap"); if (IS_ERR(wrp->rstc)) { ret = PTR_ERR(wrp->rstc); dev_dbg(wrp->dev, "cannot get pwrap reset: %d\n", ret); return ret; } if (pwrap_is_mt8135(wrp)) { res = platform_get_resource_byname(pdev, IORESOURCE_MEM, "pwrap-bridge"); wrp->bridge_base = devm_ioremap_resource(wrp->dev, res); if (IS_ERR(wrp->bridge_base)) return PTR_ERR(wrp->bridge_base); wrp->rstc_bridge = devm_reset_control_get(wrp->dev, "pwrap-bridge"); if (IS_ERR(wrp->rstc_bridge)) { ret = PTR_ERR(wrp->rstc_bridge); dev_dbg(wrp->dev, "cannot get pwrap-bridge reset: %d\n", ret); return ret; } } wrp->clk_spi = devm_clk_get(wrp->dev, "spi"); if (IS_ERR(wrp->clk_spi)) { dev_dbg(wrp->dev, "failed to get clock: %ld\n", PTR_ERR(wrp->clk_spi)); return PTR_ERR(wrp->clk_spi); } wrp->clk_wrap = devm_clk_get(wrp->dev, "wrap"); if (IS_ERR(wrp->clk_wrap)) { dev_dbg(wrp->dev, "failed to get clock: %ld\n", PTR_ERR(wrp->clk_wrap)); return PTR_ERR(wrp->clk_wrap); } ret = clk_prepare_enable(wrp->clk_spi); if (ret) return ret; ret = clk_prepare_enable(wrp->clk_wrap); if (ret) goto err_out1; /* Enable internal dynamic clock */ pwrap_writel(wrp, 1, PWRAP_DCM_EN); pwrap_writel(wrp, 0, PWRAP_DCM_DBC_PRD); /* * The PMIC could already be initialized by the bootloader. * Skip initialization here in this case. */ if (!pwrap_readl(wrp, PWRAP_INIT_DONE2)) { ret = pwrap_init(wrp); if (ret) { dev_dbg(wrp->dev, "init failed with %d\n", ret); goto err_out2; } } if (!(pwrap_readl(wrp, PWRAP_WACS2_RDATA) & PWRAP_STATE_INIT_DONE0)) { dev_dbg(wrp->dev, "initialization isn't finished\n"); return -ENODEV; } /* Initialize watchdog, may not be done by the bootloader */ pwrap_writel(wrp, 0xf, PWRAP_WDT_UNIT); /* * Since STAUPD was not used on mt8173 platform, * so STAUPD of WDT_SRC which should be turned off */ wdt_src = pwrap_is_mt8173(wrp) ? PWRAP_WDT_SRC_MASK_NO_STAUPD : PWRAP_WDT_SRC_MASK_ALL; pwrap_writel(wrp, wdt_src, PWRAP_WDT_SRC_EN); pwrap_writel(wrp, 0x1, PWRAP_TIMER_EN); pwrap_writel(wrp, ~((1 << 31) | (1 << 1)), PWRAP_INT_EN); irq = platform_get_irq(pdev, 0); ret = devm_request_irq(wrp->dev, irq, pwrap_interrupt, IRQF_TRIGGER_HIGH, "mt-pmic-pwrap", wrp); if (ret) goto err_out2; wrp->regmap = devm_regmap_init(wrp->dev, NULL, wrp, &pwrap_regmap_config); if (IS_ERR(wrp->regmap)) return PTR_ERR(wrp->regmap); ret = of_platform_populate(np, NULL, NULL, wrp->dev); if (ret) { dev_dbg(wrp->dev, "failed to create child devices at %s\n", np->full_name); goto err_out2; } return 0; err_out2: clk_disable_unprepare(wrp->clk_wrap); err_out1: clk_disable_unprepare(wrp->clk_spi); return ret; } static struct platform_driver pwrap_drv = { .driver = { .name = "mt-pmic-pwrap", .of_match_table = of_match_ptr(of_pwrap_match_tbl), }, .probe = pwrap_probe, }; module_platform_driver(pwrap_drv); MODULE_AUTHOR("Flora Fu, MediaTek"); MODULE_DESCRIPTION("MediaTek MT8135 PMIC Wrapper Driver"); MODULE_LICENSE("GPL v2");