soc/mediatek/mt8186: Add support for PMIC MT6366

Add basic support for VCORE/VDRAM1/VDDQ of MT6366.

TEST=build pass
BUG=b:202871018

Signed-off-by: James Lo <james.lo@mediatek.corp-partner.google.com>
Change-Id: I22e30421560a32f4a9e15899e8150376b1414494
Reviewed-on: https://review.coreboot.org/c/coreboot/+/59245
Tested-by: build bot (Jenkins) <no-reply@coreboot.org>
Reviewed-by: Yu-Ping Wu <yupingso@google.com>

6 files changed, 1539 insertions, 0 deletions

diff --git a/src/soc/mediatek/mt8186/Makefile.inc b/src/soc/mediatek/mt8186/Makefile.inc
index cb07ac0555..7a61bbf793 100644
--- a/src/soc/mediatek/mt8186/Makefile.inc
+++ b/src/soc/mediatek/mt8186/Makefile.inc
@@ -26,6 +26,7 @@ romstage-$(CONFIG_SPI_FLASH) += ../common/spi.c spi.c
 romstage-y += ../common/timer.c timer.c
 romstage-y += ../common/uart.c
 romstage-y += ../common/wdt.c wdt.c
+romstage-y += ../common/pmic_wrap.c pmic_wrap.c mt6366.c
 
 ramstage-y += emi.c
 ramstage-y += ../common/flash_controller.c
@@ -35,6 +36,7 @@ ramstage-y += soc.c
 ramstage-y += ../common/timer.c timer.c
 ramstage-y += ../common/uart.c
 ramstage-y += ../common/wdt.c wdt.c
+ramstage-y += ../common/pmic_wrap.c pmic_wrap.c mt6366.c
 
 CPPFLAGS_common += -Isrc/soc/mediatek/mt8186/include
 CPPFLAGS_common += -Isrc/soc/mediatek/common/include
diff --git a/src/soc/mediatek/mt8186/include/soc/addressmap.h b/src/soc/mediatek/mt8186/include/soc/addressmap.h
index 20a48addfd..28ba369474 100644
--- a/src/soc/mediatek/mt8186/include/soc/addressmap.h
+++ b/src/soc/mediatek/mt8186/include/soc/addressmap.h
@@ -27,6 +27,7 @@ enum {
 	GPT_BASE			= IO_PHYS + 0x00008000,
 	EINT_BASE			= IO_PHYS + 0x0000B000,
 	APMIXED_BASE			= IO_PHYS + 0x0000C000,
+	PWRAP_BASE			= IO_PHYS + 0x0000D000,
 	DEVAPC_AO_INFRA_PERI_BASE	= IO_PHYS + 0x0000E000,
 	DEVAPC_AO_MM_BASE		= IO_PHYS + 0x0000F000,
 	SYSTIMER_BASE			= IO_PHYS + 0x00017000,
diff --git a/src/soc/mediatek/mt8186/include/soc/mt6366.h b/src/soc/mediatek/mt8186/include/soc/mt6366.h
new file mode 100644
index 0000000000..fc6e09f419
--- /dev/null
+++ b/src/soc/mediatek/mt8186/include/soc/mt6366.h
@@ -0,0 +1,65 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+/*
+ * This file is created based on MT8186 Functional Specification
+ * Chapter number: 3.7
+ */
+
+#ifndef __SOC_MEDIATEK_MT6366_H__
+#define __SOC_MEDIATEK_MT6366_H__
+
+#include <types.h>
+
+enum {
+	PMIC_SWCID			= 0x000a,
+	PMIC_VM_MODE			= 0x004e,
+	PMIC_TOP_CKPDN_CON0_SET		= 0x010e,
+	PMIC_TOP_CKPDN_CON0_CLR		= 0x0110,
+	PMIC_TOP_CKHWEN_CON0_SET	= 0x012c,
+	PMIC_TOP_CKHWEN_CON0_CLR	= 0x012e,
+	PMIC_TOP_RST_MISC		= 0x014c,
+	PMIC_TOP_RST_MISC_SET		= 0x014e,
+	PMIC_TOP_RST_MISC_CLR		= 0x0150,
+	PMIC_OTP_CON0			= 0x038a,
+	PMIC_OTP_CON8			= 0x039a,
+	PMIC_OTP_CON11			= 0x03a0,
+	PMIC_OTP_CON12			= 0x03a2,
+	PMIC_OTP_CON13			= 0x03a4,
+	PMIC_TOP_TMA_KEY		= 0x03a8,
+	PMIC_PWRHOLD			= 0x0a08,
+	PMIC_CPSDSA4			= 0x0a2e,
+	PMIC_VCORE_OP_EN		= 0x1490,
+	PMIC_VCORE_DBG0			= 0x149e,
+	PMIC_VCORE_VOSEL		= 0x14aa,
+	PMIC_VDRAM1_VOSEL_SLEEP		= 0x160a,
+	PMIC_VDRAM1_OP_EN		= 0x1610,
+	PMIC_VDRAM1_DBG0		= 0x161e,
+	PMIC_VDRAM1_VOSEL		= 0x1626,
+	PMIC_SMPS_ANA_CON0		= 0x1808,
+	PMIC_VDDQ_OP_EN			= 0x1b16,
+	PMIC_VSIM2_ANA_CON0		= 0x1e30,
+	PMIC_VDDQ_ELR_0			= 0x1ec4,
+};
+
+enum mt6366_regulator_id {
+	MT6366_VCORE = 0,
+	MT6366_VDRAM1,
+	MT6366_VDDQ,
+	MT6366_REGULATOR_NUM,
+};
+
+struct pmic_setting {
+	unsigned short addr;
+	unsigned short val;
+	unsigned short mask;
+	unsigned char shift;
+};
+
+void mt6366_init(void);
+void mt6366_set_power_hold(bool enable);
+void mt6366_set_vsim2_cali_mv(u32 vsim2_mv);
+void mt6366_init_scp_voltage(void);
+void mt6366_set_voltage(enum mt6366_regulator_id id, u32 vcore_uv);
+u32 mt6366_get_voltage(enum mt6366_regulator_id id);
+
+#endif /* __SOC_MEDIATEK_MT6366_H__ */
diff --git a/src/soc/mediatek/mt8186/include/soc/pmic_wrap.h b/src/soc/mediatek/mt8186/include/soc/pmic_wrap.h
new file mode 100644
index 0000000000..4091485155
--- /dev/null
+++ b/src/soc/mediatek/mt8186/include/soc/pmic_wrap.h
@@ -0,0 +1,431 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+/*
+ * This file is created based on MT8186 Functional Specification
+ * Chapter number: 3.7
+ */
+
+#ifndef __SOC_MEDIATEK_MT8186_PMIC_WRAP_H__
+#define __SOC_MEDIATEK_MT8186_PMIC_WRAP_H__
+
+#include <soc/addressmap.h>
+#include <soc/pmic_wrap_common.h>
+#include <types.h>
+
+struct mt8186_pwrap_regs {
+	u32 mux_sel;
+	u32 wrap_en;
+	u32 dio_en;
+	u32 si_sample_ctrl;
+	u32 si_sample_ctrl_1;
+	u32 si_sample_ctrl_2;
+	u32 si_sample_ctrl_3;
+	u32 si_sample_ctrl_ulposc;
+	u32 rddmy;
+	u32 cshext_write;
+	u32 cshext_read;
+	u32 cslext_write;
+	u32 cslext_read;
+	u32 ext_ck_write;
+	u32 ext_ck_read;
+	u32 staupd_ctrl;
+	u32 staupd_grpen;
+	u32 eint_sta0_adr;
+	u32 eint_sta1_adr;
+	u32 eint_sta;
+	u32 eint_clr;
+	u32 eint_ctrl;
+	u32 staupd_man_trig;
+	u32 staupd_sta;
+	u32 wrap_sta;
+	u32 harb_init;
+	u32 harb_hprio;
+	u32 hiprio_arb_en;
+	u32 harb_sta0;
+	u32 harb_sta1;
+	u32 harb_sta2;
+	u32 man_en;
+	u32 man_cmd;
+	u32 man_rdata;
+	u32 man_vldclr;
+	u32 wacs0_en;
+	u32 init_done0;
+	u32 wacs1_en;
+	u32 init_done1;
+	u32 wacs2_en;
+	u32 init_done2;
+	u32 wacs3_en;
+	u32 init_done3;
+	u32 wacs_p2p_en;
+	u32 init_done_p2p;
+	u32 wacs_md32_en;
+	u32 init_done_md32;
+	u32 int0_en;
+	u32 int0_flg_raw;
+	u32 int0_flg;
+	u32 int0_clr;
+	u32 int1_en;
+	u32 int1_flg_raw;
+	u32 int1_flg;
+	u32 int1_clr;
+	u32 sig_adr;
+	u32 sig_mode;
+	u32 sig_value;
+	u32 sig_errval;
+	u32 crc_en;
+	u32 timer_ctrl;
+	u32 timer_sta;
+	u32 wdt_ctrl;
+	u32 wdt_src_en_0;
+	u32 wdt_src_en_1;
+	u32 wdt_flg_0;
+	u32 wdt_flg_1;
+	u32 debug_int_sel;
+	u32 dvfs_adr0;
+	u32 dvfs_wdata0;
+	u32 dvfs_adr1;
+	u32 dvfs_wdata1;
+	u32 dvfs_adr2;
+	u32 dvfs_wdata2;
+	u32 dvfs_adr3;
+	u32 dvfs_wdata3;
+	u32 dvfs_adr4;
+	u32 dvfs_wdata4;
+	u32 dvfs_adr5;
+	u32 dvfs_wdata5;
+	u32 dvfs_adr6;
+	u32 dvfs_wdata6;
+	u32 dvfs_adr7;
+	u32 dvfs_wdata7;
+	u32 dvfs_adr8;
+	u32 dvfs_wdata8;
+	u32 dvfs_adr9;
+	u32 dvfs_wdata9;
+	u32 dvfs_adr10;
+	u32 dvfs_wdata10;
+	u32 dvfs_adr11;
+	u32 dvfs_wdata11;
+	u32 dvfs_adr12;
+	u32 dvfs_wdata12;
+	u32 dvfs_adr13;
+	u32 dvfs_wdata13;
+	u32 dvfs_adr14;
+	u32 dvfs_wdata14;
+	u32 dvfs_adr15;
+	u32 dvfs_wdata15;
+	u32 dcxo_enable;
+	u32 dcxo_conn_adr0;
+	u32 dcxo_conn_wdata0;
+	u32 dcxo_conn_adr1;
+	u32 dcxo_conn_wdata1;
+	u32 dcxo_nfc_adr0;
+	u32 dcxo_nfc_wdata0;
+	u32 dcxo_nfc_adr1;
+	u32 dcxo_nfc_wdata1;
+	u32 spminf_sta_0;
+	u32 spminf_sta_1;
+	u32 spminf_backup_sta;
+	u32 scpinf_sta;
+	u32 srclken_rcinf_sta_0;
+	u32 srclken_rcinf_sta_1;
+	u32 mcu_pminf_sta_0;
+	u32 mcu_pminf_sta_1;
+	u32 cipher_key_sel;
+	u32 cipher_iv_sel;
+	u32 cipher_en;
+	u32 cipher_rdy;
+	u32 cipher_mode;
+	u32 cipher_swrst;
+	u32 dcm_en;
+	u32 dcm_dbc_prd;
+	u32 int_gps_auxadc_cmd_addr;
+	u32 int_gps_auxadc_cmd;
+	u32 int_gps_auxadc_rdata_addr;
+	u32 ext_gps_auxadc_rdata_addr;
+	u32 gpsinf_0_sta;
+	u32 gpsinf_1_sta;
+	u32 md_adcinf_ctrl;
+	u32 md_auxadc_rdata_latest_addr;
+	u32 md_auxadc_rdata_wp_addr;
+	u32 md_auxadc_rdata[32];
+	u32 md_adcinf_0_sta_0;
+	u32 md_adcinf_0_sta_1;
+	u32 md_adcinf_1_sta_0;
+	u32 md_adcinf_1_sta_1;
+	u32 swrst;
+	u32 sleep_protection_ctrl;
+	u32 spm_sleep_gating_ctrl;
+	u32 scp_sleep_gating_ctrl;
+	u32 busy_sta;
+	u32 busy_sta_latched_wdt;
+	u32 priority_user_sel_0;
+	u32 priority_user_sel_1;
+	u32 priority_user_sel_2;
+	u32 priority_user_sel_3;
+	u32 priority_user_sel_4;
+	u32 arbiter_out_sel_0;
+	u32 arbiter_out_sel_1;
+	u32 arbiter_out_sel_2;
+	u32 arbiter_out_sel_3;
+	u32 arbiter_out_sel_4;
+	u32 starv_counter_0;
+	u32 starv_counter_1;
+	u32 starv_counter_2;
+	u32 starv_counter_3;
+	u32 starv_counter_4;
+	u32 starv_counter_5;
+	u32 starv_counter_6;
+	u32 starv_counter_7;
+	u32 starv_counter_8;
+	u32 starv_counter_9;
+	u32 starv_counter_10;
+	u32 starv_counter_11;
+	u32 starv_counter_12;
+	u32 starv_counter_13;
+	u32 starv_counter_14;
+	u32 starv_counter_15;
+	u32 starv_counter_16;
+	u32 starv_int_en;
+	u32 starv_counter_0_status;
+	u32 starv_counter_1_status;
+	u32 starv_counter_2_status;
+	u32 starv_counter_3_status;
+	u32 starv_counter_4_status;
+	u32 starv_counter_5_status;
+	u32 starv_counter_6_status;
+	u32 starv_counter_7_status;
+	u32 starv_counter_8_status;
+	u32 starv_counter_9_status;
+	u32 starv_counter_10_status;
+	u32 starv_counter_11_status;
+	u32 starv_counter_12_status;
+	u32 starv_counter_13_status;
+	u32 starv_counter_14_status;
+	u32 starv_counter_15_status;
+	u32 starv_counter_16_status;
+	u32 starv_counter_clr;
+	u32 starv_prio_status;
+	u32 monitor_ctrl;
+	u32 monitor_target_channel_0;
+	u32 monitor_target_channel_1;
+	u32 monitor_target_channel_2;
+	u32 monitor_target_channel_3;
+	u32 monitor_target_channel_4;
+	u32 monitor_target_channel_5;
+	u32 monitor_target_channel_6;
+	u32 monitor_target_channel_7;
+	u32 monitor_target_write;
+	u32 monitor_target_adr_0;
+	u32 monitor_target_adr_1;
+	u32 monitor_target_adr_2;
+	u32 monitor_target_adr_3;
+	u32 monitor_target_adr_4;
+	u32 monitor_target_adr_5;
+	u32 monitor_target_adr_6;
+	u32 monitor_target_adr_7;
+	u32 monitor_target_wdata_0;
+	u32 monitor_target_wdata_1;
+	u32 monitor_target_wdata_2;
+	u32 monitor_target_wdata_3;
+	u32 monitor_target_wdata_4;
+	u32 monitor_target_wdata_5;
+	u32 monitor_target_wdata_6;
+	u32 monitor_target_wdata_7;
+	u32 channel_sequence_0;
+	u32 channel_sequence_1;
+	u32 channel_sequence_2;
+	u32 channel_sequence_3;
+	u32 channel_sequence_4;
+	u32 channel_sequence_5;
+	u32 channel_sequence_6;
+	u32 channel_sequence_7;
+	u32 write_sequence;
+	u32 adr_sequence_0;
+	u32 adr_sequence_1;
+	u32 adr_sequence_2;
+	u32 adr_sequence_3;
+	u32 adr_sequence_4;
+	u32 adr_sequence_5;
+	u32 adr_sequence_6;
+	u32 adr_sequence_7;
+	u32 adr_sequence_8;
+	u32 adr_sequence_9;
+	u32 adr_sequence_10;
+	u32 adr_sequence_11;
+	u32 adr_sequence_12;
+	u32 adr_sequence_13;
+	u32 adr_sequence_14;
+	u32 adr_sequence_15;
+	u32 wdata_sequence_0;
+	u32 wdata_sequence_1;
+	u32 wdata_sequence_2;
+	u32 wdata_sequence_3;
+	u32 wdata_sequence_4;
+	u32 wdata_sequence_5;
+	u32 wdata_sequence_6;
+	u32 wdata_sequence_7;
+	u32 wdata_sequence_8;
+	u32 wdata_sequence_9;
+	u32 wdata_sequence_10;
+	u32 wdata_sequence_11;
+	u32 wdata_sequence_12;
+	u32 wdata_sequence_13;
+	u32 wdata_sequence_14;
+	u32 wdata_sequence_15;
+	u32 bwc_options;
+	u32 reserved1[477];
+	u32 wacs0_cmd;
+	u32 wacs0_rdata;
+	u32 wacs0_vldclr;
+	u32 reserved2;
+	u32 wacs1_cmd;
+	u32 wacs1_rdata;
+	u32 wacs1_vldclr;
+	u32 reserved3;
+	u32 wacs2_cmd;
+	u32 wacs2_rdata;
+	u32 wacs2_vldclr;
+	u32 reserved4;
+	u32 wacs3_cmd;
+	u32 wacs3_rdata;
+	u32 wacs3_vldclr;
+};
+
+check_member(mt8186_pwrap_regs, bwc_options, 0x488);
+check_member(mt8186_pwrap_regs, wacs3_vldclr, 0xC38);
+
+static struct mt8186_pwrap_regs * const mtk_pwrap = (void *)PWRAP_BASE;
+
+enum {
+	WACS2 = 1 << 2
+};
+
+/* PMIC registers */
+enum {
+	PMIC_BASE		= 0x0000,
+	PMIC_SMT_CON1		= PMIC_BASE + 0x0030,
+	PMIC_DRV_CON1		= PMIC_BASE + 0x0038,
+	PMIC_FILTER_CON0	= PMIC_BASE + 0x0040,
+	PMIC_GPIO_PULLEN0_CLR	= PMIC_BASE + 0x0098,
+	PMIC_RG_SPI_CON0	= PMIC_BASE + 0x0408,
+	PMIC_RG_SPI_RECORD0	= PMIC_BASE + 0x040A,
+	PMIC_DEW_DIO_EN		= PMIC_BASE + 0x040C,
+	PMIC_DEW_READ_TEST	= PMIC_BASE + 0x040E,
+	PMIC_DEW_WRITE_TEST	= PMIC_BASE + 0x0410,
+	PMIC_DEW_CRC_EN		= PMIC_BASE + 0x0414,
+	PMIC_DEW_CRC_VAL	= PMIC_BASE + 0x0416,
+	PMIC_DEW_RDDMY_NO	= PMIC_BASE + 0x0426,
+	PMIC_CPU_INT_STA	= PMIC_BASE + 0x042E,
+	PMIC_RG_SPI_CON2	= PMIC_BASE + 0x0432,
+	PMIC_RG_SPI_CON3	= PMIC_BASE + 0x0434,
+	PMIC_RG_SPI_CON4	= PMIC_BASE + 0x0436,
+	PMIC_RG_SPI_CON5	= PMIC_BASE + 0x0438,
+	PMIC_RG_SPI_CON6	= PMIC_BASE + 0x043A,
+	PMIC_RG_SPI_CON7	= PMIC_BASE + 0x043C,
+	PMIC_RG_SPI_CON8	= PMIC_BASE + 0x043E,
+	PMIC_RG_SPI_CON13	= PMIC_BASE + 0x0448,
+	PMIC_SPISLV_KEY		= PMIC_BASE + 0x044A,
+	PMIC_PPCCTL0		= PMIC_BASE + 0x0A08,
+	PMIC_AUXADC_ADC17	= PMIC_BASE + 0x10AA,
+	PMIC_AUXADC_ADC31	= PMIC_BASE + 0x10C6,
+	PMIC_AUXADC_ADC32	= PMIC_BASE + 0x10C8,
+	PMIC_AUXADC_ADC35	= PMIC_BASE + 0x10CE,
+	PMIC_AUXADC_RQST0	= PMIC_BASE + 0x1108,
+	PMIC_AUXADC_RQST1	= PMIC_BASE + 0x110A,
+};
+
+enum {
+	E_CLK_EDGE = 1,
+	E_CLK_LAST_SETTING,
+};
+
+enum {
+	GPS_MAIN = 0x40,
+	GPS_SUBSYS = 0x80,
+};
+
+enum {
+	SIG_PMIC_0 = 0x1 << 0,
+	INT_STA_PMIC_0 = 0x1 << 2,
+	MD_ADC_DATA0 = 0x1 << 4,
+	MD_ADC_DATA1 = 0x1 << 5,
+	GPS_ADC_DATA0 = 0x1 << 6,
+	GPS_ADC_DATA1 = 0x1 << 7,
+};
+
+enum {
+	MD = 1,
+	MD_DVFS = 2,
+	POWER_HW = 4,
+	POWER_HW_BACKUP = 8,
+	ARB_PRIORITY = MD | MD_DVFS | POWER_HW | POWER_HW_BACKUP,
+};
+
+enum {
+	ARB_WACS0 = 0x1,
+	ARB_WACS2 = 0x1 << 2,
+	ARB_WACS_P2P = 0x1 << 4,
+	ARB_WACS_MD32 = 0x1 << 5,
+	ARB_MD = 0x1 << 6,
+	ARB_WACS_POWER_HW = 0x1 << 9,
+	ARB_DCXO_CONN = 0x1 << 11,
+	ARB_DCXO_NFC = 0x1 << 12,
+	ARB_MD_ADC0 = 0x1 << 13,
+	ARB_MD_ADC1 = 0x1 << 14,
+	ARB_GPS_0 = 0x1 << 15,
+	ARB_GPS_1 = 0x1 << 16,
+	STAUPD_HARB = 0x1 << 17,
+	ARB_USER_EN = ARB_WACS0 | ARB_WACS2 | ARB_WACS_P2P | ARB_WACS_MD32 |
+		ARB_MD | ARB_WACS_POWER_HW | ARB_DCXO_CONN | ARB_DCXO_NFC |
+		ARB_MD_ADC0 | ARB_MD_ADC1 | ARB_GPS_0 | ARB_GPS_1 | STAUPD_HARB,
+};
+
+enum {
+	STA_PD_98_5_US = 0x5,
+};
+
+enum {
+	WATCHDOG_TIMER_7_5_MS = 0xF,
+};
+
+enum {
+	WDT_MONITOR_ALL = 0xFFFF,
+};
+
+enum {
+	MONITOR_LATCH_MATCHED_TRANS = 0x1 << 28,
+	STARV_15 = 0x1 << 24,
+	DCXO = 0x1 << 19,
+	MONITOR_ALL_INT = 0xFFFFFFFF,
+	INT0_MONITOR = MONITOR_ALL_INT,
+	INT1_MONITOR = MONITOR_ALL_INT &
+		~MONITOR_LATCH_MATCHED_TRANS & ~STARV_15 & ~DCXO,
+};
+
+enum {
+	SPI_CLK = 0x1,
+	SPI_CSN = 0x1 << 1,
+	SPI_MOSI = 0x1 << 2,
+	SPI_MISO = 0x1 << 3,
+	SPI_FILTER = (SPI_CLK | SPI_CSN | SPI_MOSI | SPI_MISO) << 4,
+	SPI_SMT = (SPI_CLK | SPI_CSN | SPI_MOSI | SPI_MISO),
+	SPI_PULL_DISABLE = (SPI_CLK | SPI_CSN | SPI_MOSI | SPI_MISO) << 4,
+};
+
+enum {
+	IO_4_MA = 0x8,
+};
+
+enum {
+	SPI_CLK_SHIFT = 0,
+	SPI_CSN_SHIFT = 4,
+	SPI_MOSI_SHIFT = 8,
+	SPI_MISO_SHIFT = 12,
+	SPI_DRIVING = (IO_4_MA << SPI_CLK_SHIFT | IO_4_MA << SPI_CSN_SHIFT |
+		       IO_4_MA << SPI_MOSI_SHIFT | IO_4_MA << SPI_MISO_SHIFT),
+};
+
+enum {
+	DUMMY_READ_CYCLES = 0x8,
+};
+#endif /* __SOC_MEDIATEK_MT8186_PMIC_WRAP_H__ */
diff --git a/src/soc/mediatek/mt8186/mt6366.c b/src/soc/mediatek/mt8186/mt6366.c
new file mode 100644
index 0000000000..f9488bd4a9
--- /dev/null
+++ b/src/soc/mediatek/mt8186/mt6366.c
@@ -0,0 +1,710 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+/*
+ * This file is created based on MT8186 Functional Specification
+ * Chapter number: 3.7
+ */
+
+#include <assert.h>
+#include <console/console.h>
+#include <delay.h>
+#include <soc/mt6366.h>
+#include <soc/pmic_wrap.h>
+#include <soc/regulator.h>
+#include <timer.h>
+
+static struct pmic_setting init_setting[] = {
+	{0x1E, 0xA, 0xA, 0},
+	{0x22, 0x1F00, 0x1F00, 0},
+	{0x2E, 0x1, 0x1, 0},
+	{0x30, 0x1, 0x1, 0},
+	{0x36, 0x8888, 0xFFFF, 0},
+	{0x3A, 0x8888, 0xFFFF, 0},
+	{0x3C, 0x8888, 0xFFFF, 0},
+	{0x3E, 0x888, 0xFFF, 0},
+	{0x94, 0x0, 0xFFFF, 0},
+	{0x10C, 0x18, 0x18, 0},
+	{0x112, 0x4, 0x4, 0},
+	{0x118, 0x8, 0x8, 0},
+	{0x12A, 0x100, 0x180, 0},
+	{0x134, 0x80, 0x2890, 0},
+	{0x14C, 0x20, 0x20, 0},
+	{0x198, 0x0, 0x1FF, 0},
+	{0x790, 0x280, 0x780, 0},
+	{0x7AC, 0x0, 0x2000, 0},
+	{0x98A, 0x1840, 0x1E40, 0},
+	{0xA08, 0x1, 0x1, 0},
+	{0xA24, 0x1E00, 0x1F00, 0},
+	{0xA38, 0x0, 0x100, 0},
+	{0xA3C, 0x81E0, 0x81E0, 0},
+	{0xA44, 0xFFFF, 0xFFFF, 0},
+	{0xA46, 0xFC00, 0xFC00, 0},
+	{0xC8A, 0x4, 0xC, 0},
+	{0xF8C, 0xAAA, 0xAAA, 0},
+	{0x1188, 0x0, 0x8000, 0},
+	{0x119E, 0x6000, 0x7000, 0},
+	{0x11A2, 0x0, 0x3000, 0},
+	{0x11B0, 0x4000, 0x4000, 0},
+	{0x11B4, 0x0, 0x100, 0},
+	{0x123A, 0x8040, 0x83FF, 0},
+	{0x123E, 0x4, 0x4, 0},
+	{0x1242, 0x1, 0x1, 0},
+	{0x1260, 0x0, 0x154, 0},
+	{0x1312, 0x8, 0x8, 0},
+	{0x1334, 0x0, 0x100, 0},
+	{0x138A, 0x10, 0x7F, 0},
+	{0x138C, 0x15, 0x7F, 0},
+	{0x138E, 0x1030, 0x3030, 0},
+	{0x140A, 0x10, 0x7F, 0},
+	{0x140C, 0x15, 0x7F, 0},
+	{0x140E, 0x1030, 0x3030, 0},
+	{0x148A, 0x10, 0x7F, 0},
+	{0x148E, 0x1030, 0x3030, 0},
+	{0x14A2, 0x20, 0x20, 0},
+	{0x150A, 0x10, 0x7F, 0},
+	{0x150E, 0x1030, 0x3030, 0},
+	{0x158A, 0x8, 0x7F, 0},
+	{0x158C, 0x90C, 0x7F7F, 0},
+	{0x158E, 0x1030, 0x3030, 0},
+	{0x159C, 0x8, 0xC, 0},
+	{0x15A2, 0x20, 0x20, 0},
+	{0x168A, 0x50, 0x7F, 0},
+	{0x168C, 0x1964, 0x7F7F, 0},
+	{0x168E, 0x2020, 0x3030, 0},
+	{0x16A2, 0x20, 0x20, 0},
+	{0x16AA, 0x50, 0x7F, 0},
+	{0x170C, 0x1964, 0x7F7F, 0},
+	{0x170E, 0x2020, 0x3030, 0},
+	{0x172A, 0x44, 0x7F, 0},
+	{0x178C, 0x202, 0x7F7F, 0},
+	{0x178E, 0x70, 0x73, 0},
+	{0x1790, 0xC, 0xC, 0},
+	{0x1798, 0x2810, 0x3F3F, 0},
+	{0x179A, 0x800, 0x3F00, 0},
+	{0x179E, 0x1, 0x1, 0},
+	{0x1808, 0x2000, 0x3000, 0},
+	{0x180C, 0x60, 0x60, 0},
+	{0x1814, 0x3FF0, 0x7FFF, 0},
+	{0x1816, 0x3, 0x7, 0},
+	{0x181A, 0x6081, 0xFFBF, 0},
+	{0x181C, 0x503, 0x787, 0},
+	{0x181E, 0xA462, 0xFFFF, 0},
+	{0x1820, 0xA662, 0xFFFF, 0},
+	{0x1824, 0xDB6, 0xFFF, 0},
+	{0x1828, 0x160, 0x160, 0},
+	{0x1830, 0x3FF0, 0x7FFF, 0},
+	{0x1832, 0x3, 0x7, 0},
+	{0x1836, 0x6081, 0xFFBF, 0},
+	{0x1838, 0x503, 0x787, 0},
+	{0x183A, 0xA262, 0xFFFF, 0},
+	{0x183C, 0xA262, 0xFFFF, 0},
+	{0x1840, 0xDB6, 0xFFF, 0},
+	{0x1888, 0x420, 0xE7C, 0},
+	{0x188A, 0x801, 0x3C07, 0},
+	{0x188C, 0x1F, 0x3F, 0},
+	{0x188E, 0x129A, 0xFFFF, 0},
+	{0x1894, 0x58, 0x1F8, 0},
+	{0x1896, 0x1C, 0x7C, 0},
+	{0x1898, 0x1805, 0x3C07, 0},
+	{0x189A, 0xF, 0xF, 0},
+	{0x189C, 0x221A, 0xFFFF, 0},
+	{0x18A0, 0x2E, 0x3F, 0},
+	{0x18A2, 0x0, 0x40, 0},
+	{0x18A4, 0x2C06, 0x3C07, 0},
+	{0x18A6, 0xF, 0xF, 0},
+	{0x18A8, 0x221A, 0xFFFF, 0},
+	{0x18AC, 0x2E, 0x3F, 0},
+	{0x18AE, 0x0, 0x40, 0},
+	{0x18B0, 0x1805, 0x3C07, 0},
+	{0x18B2, 0xF, 0xF, 0},
+	{0x18B4, 0x221A, 0xFFFF, 0},
+	{0x18B8, 0x2E, 0x3F, 0},
+	{0x18BC, 0x50, 0x4F0, 0},
+	{0x18BE, 0x3C, 0xFC, 0},
+	{0x18C0, 0x0, 0x300, 0},
+	{0x18C2, 0x8886, 0xFFFF, 0},
+	{0x1A0E, 0x3, 0x3, 0},
+	{0x1A10, 0x1, 0x1, 0},
+	{0x1A12, 0x0, 0x1, 0},
+	{0x1A14, 0x0, 0x1, 0},
+	{0x1A16, 0x0, 0x1, 0},
+	{0x1A18, 0x0, 0x1, 0},
+	{0x1A1A, 0x0, 0x1, 0},
+	{0x1A1C, 0x0, 0x1, 0},
+	{0x1A1E, 0x0, 0x1, 0},
+	{0x1A20, 0x0, 0x1, 0},
+	{0x1A22, 0x0, 0x1, 0},
+	{0x1A24, 0x0, 0x1, 0},
+	{0x1A26, 0x0, 0x1, 0},
+	{0x1A2C, 0x0, 0x1, 0},
+	{0x1A2E, 0x0, 0x1, 0},
+	{0x1A30, 0x0, 0x1, 0},
+	{0x1A32, 0x0, 0x1, 0},
+	{0x1A34, 0x0, 0x1, 0},
+	{0x1A36, 0x0, 0x1, 0},
+	{0x1A38, 0x0, 0x1, 0},
+	{0x1A3A, 0x0, 0x1, 0},
+	{0x1A3C, 0x0, 0x1, 0},
+	{0x1A3E, 0x0, 0x1, 0},
+	{0x1A40, 0x0, 0x1, 0},
+	{0x1A42, 0x0, 0x1, 0},
+	{0x1A44, 0x0, 0x1, 0},
+	{0x1A46, 0x0, 0x1, 0},
+	{0x1A48, 0x0, 0x1, 0},
+	{0x1A4A, 0x0, 0x1, 0},
+	{0x1A4C, 0x0, 0x1, 0},
+	{0x1A4E, 0x0, 0x1, 0},
+	{0x1A50, 0xE7FF, 0xE7FF, 0},
+	{0x1A56, 0x7FFF, 0x7FFF, 0},
+	{0x1B48, 0x10, 0x7F, 0},
+	{0x1B4A, 0xF15, 0x7F7F, 0},
+	{0x1B8A, 0x10, 0x7F, 0},
+	{0x1B8C, 0xF15, 0x7F7F, 0},
+	{0x1BA8, 0x10, 0x7F, 0},
+	{0x1BAA, 0xF15, 0x7F7F, 0},
+	{0x1BAC, 0x0, 0x3, 0},
+	{0x1BCA, 0x10, 0x7F, 0},
+	{0x1BCC, 0x70F, 0x7F7F, 0},
+	{0x1C9E, 0x38, 0x7F, 0},
+	{0x1CA0, 0x70F, 0x7F7F, 0},
+	{0x1EA2, 0x1B, 0x1F, 0},
+	{0x1EA4, 0xC00, 0x1C00, 0},
+	{0x1EA6, 0xC00, 0x1C00, 0},
+	{0x1EA8, 0xC00, 0x1C00, 0},
+};
+
+static struct pmic_setting lp_setting[] = {
+	/* Suspend */
+	/* [0:0]: RG_BUCK_VPROC11_SW_OP_EN */
+	{0x1390, 0x1, 0x1, 0},
+	/* [0:0]: RG_BUCK_VCORE_SW_OP_EN */
+	{0x1490, 0x1, 0x1, 0},
+	/* [0:0]: RG_BUCK_VGPU_SW_OP_EN */
+	{0x1510, 0x1, 0x1, 0},
+	/* [0:0]: RG_BUCK_VMODEM_SW_OP_EN */
+	{0x1590, 0x1, 0x1, 0},
+	/* [0:0]: RG_BUCK_VS1_SW_OP_EN */
+	{0x1690, 0x1, 0x1, 0},
+	/* [1:1]: RG_BUCK_VS2_HW0_OP_EN */
+	{0x1710, 0x1, 0x1, 1},
+	/* [1:1]: RG_BUCK_VS2_HW0_OP_CFG */
+	{0x1716, 0x1, 0x1, 1},
+	/* [1:1]: RG_BUCK_VDRAM1_HW0_OP_EN */
+	{0x1610, 0x1, 0x1, 1},
+	/* [1:1]: RG_BUCK_VDRAM1_HW0_OP_CFG */
+	{0x1616, 0x1, 0x1, 1},
+	/* [0:0]: RG_BUCK_VPROC12_SW_OP_EN */
+	{0x1410, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VSRAM_GPU_SW_OP_EN */
+	{0x1BD0, 0x1, 0x1, 0},
+	/* [1:1]: RG_LDO_VSRAM_OTHERS_HW0_OP_EN */
+	{0x1BAE, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VSRAM_OTHERS_HW0_OP_CFG */
+	{0x1BB4, 0x1, 0x1, 1},
+	/* [0:0]: RG_LDO_VSRAM_PROC11_SW_OP_EN */
+	{0x1B4E, 0x1, 0x1, 0},
+	/* [1:1]: RG_LDO_VXO22_HW0_OP_EN */
+	{0x1A8A, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VXO22_HW0_OP_CFG */
+	{0x1A90, 0x1, 0x1, 1},
+	/* [2:2]: RG_LDO_VRF18_HW1_OP_EN */
+	{0x1C1E, 0x1, 0x1, 2},
+	/* [2:2]: RG_LDO_VRF18_HW1_OP_CFG */
+	{0x1C24, 0x0, 0x1, 2},
+	/* [2:2]: RG_LDO_VRF12_HW1_OP_EN */
+	{0x1C32, 0x1, 0x1, 2},
+	/* [2:2]: RG_LDO_VRF12_HW1_OP_CFG */
+	{0x1C38, 0x0, 0x1, 2},
+	/* [0:0]: RG_LDO_VEFUSE_SW_OP_EN */
+	{0x1C46, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCN33_SW_OP_EN */
+	{0x1D1E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCN33_SW_OP_EN */
+	{0x1D1E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCN28_SW_OP_EN */
+	{0x1D8A, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCN18_SW_OP_EN */
+	{0x1C5A, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCAMA1_SW_OP_EN */
+	{0x1C6E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCAMD_SW_OP_EN */
+	{0x1C9E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCAMA2_SW_OP_EN */
+	{0x1C8A, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VSRAM_PROC12_SW_OP_EN */
+	{0x1B90, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCAMIO_SW_OP_EN */
+	{0x1CB2, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VLDO28_SW_OP_EN */
+	{0x1D34, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VLDO28_SW_OP_EN */
+	{0x1D34, 0x1, 0x1, 0},
+	/* [1:1]: RG_LDO_VA12_HW0_OP_EN */
+	{0x1A9E, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VA12_HW0_OP_CFG */
+	{0x1AA4, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VAUX18_HW0_OP_EN */
+	{0x1AB2, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VAUX18_HW0_OP_CFG */
+	{0x1AB8, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VAUD28_HW0_OP_EN */
+	{0x1AC6, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VAUD28_HW0_OP_CFG */
+	{0x1ACC, 0x1, 0x1, 1},
+	/* [0:0]: RG_LDO_VIO28_SW_OP_EN */
+	{0x1ADA, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VIO18_SW_OP_EN */
+	{0x1AEE, 0x1, 0x1, 0},
+	/* [2:2]: RG_LDO_VFE28_HW1_OP_EN */
+	{0x1C0A, 0x1, 0x1, 2},
+	/* [2:2]: RG_LDO_VFE28_HW1_OP_CFG */
+	{0x1C10, 0x0, 0x1, 2},
+	/* [1:1]: RG_LDO_VDRAM2_HW0_OP_EN */
+	{0x1B0A, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VDRAM2_HW0_OP_CFG */
+	{0x1B10, 0x1, 0x1, 1},
+	/* [0:0]: RG_LDO_VMC_SW_OP_EN */
+	{0x1CC6, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VMCH_SW_OP_EN */
+	{0x1CDA, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VEMC_SW_OP_EN */
+	{0x1B1E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VSIM1_SW_OP_EN */
+	{0x1D4A, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VSIM2_SW_OP_EN */
+	{0x1D5E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VIBR_SW_OP_EN */
+	{0x1D0A, 0x1, 0x1, 0},
+	/* [1:1]: RG_LDO_VUSB_HW0_OP_EN */
+	{0x1B32, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VUSB_HW0_OP_CFG */
+	{0x1B38, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VUSB_HW0_OP_EN */
+	{0x1B32, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VUSB_HW0_OP_CFG */
+	{0x1B38, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VBIF28_HW0_OP_EN */
+	{0x1DA0, 0x1, 0x1, 1},
+	/* [1:1]: RG_LDO_VBIF28_HW0_OP_CFG */
+	{0x1DA6, 0x0, 0x1, 1},
+
+	/* Deep idle setting */
+	/* [0:0]: RG_BUCK_VPROC11_SW_OP_EN */
+	{0x1390, 0x1, 0x1, 0},
+	/* [0:0]: RG_BUCK_VCORE_SW_OP_EN */
+	{0x1490, 0x1, 0x1, 0},
+	/* [0:0]: RG_BUCK_VGPU_SW_OP_EN */
+	{0x1510, 0x1, 0x1, 0},
+	/* [0:0]: RG_BUCK_VMODEM_SW_OP_EN */
+	{0x1590, 0x1, 0x1, 0},
+	/* [0:0]: RG_BUCK_VS1_SW_OP_EN */
+	{0x1690, 0x1, 0x1, 0},
+	/* [3:3]: RG_BUCK_VS2_HW2_OP_EN */
+	{0x1710, 0x1, 0x1, 3},
+	/* [3:3]: RG_BUCK_VS2_HW2_OP_CFG */
+	{0x1716, 0x1, 0x1, 3},
+	/* [3:3]: RG_BUCK_VDRAM1_HW2_OP_EN */
+	{0x1610, 0x1, 0x1, 3},
+	/* [3:3]: RG_BUCK_VDRAM1_HW2_OP_CFG */
+	{0x1616, 0x1, 0x1, 3},
+	/* [0:0]: RG_BUCK_VPROC12_SW_OP_EN */
+	{0x1410, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VSRAM_GPU_SW_OP_EN */
+	{0x1BD0, 0x1, 0x1, 0},
+	/* [3:3]: RG_LDO_VSRAM_OTHERS_HW2_OP_EN */
+	{0x1BAE, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VSRAM_OTHERS_HW2_OP_CFG */
+	{0x1BB4, 0x1, 0x1, 3},
+	/* [0:0]: RG_LDO_VSRAM_PROC11_SW_OP_EN */
+	{0x1B4E, 0x1, 0x1, 0},
+	/* [3:3]: RG_LDO_VXO22_HW2_OP_EN */
+	{0x1A8A, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VXO22_HW2_OP_CFG */
+	{0x1A90, 0x1, 0x1, 3},
+	/* [2:2]: RG_LDO_VRF18_HW1_OP_EN */
+	{0x1C1E, 0x1, 0x1, 2},
+	/* [2:2]: RG_LDO_VRF18_HW1_OP_CFG */
+	{0x1C24, 0x0, 0x1, 2},
+	/* [2:2]: RG_LDO_VRF12_HW1_OP_EN */
+	{0x1C32, 0x1, 0x1, 2},
+	/* [2:2]: RG_LDO_VRF12_HW1_OP_CFG */
+	{0x1C38, 0x0, 0x1, 2},
+	/* [0:0]: RG_LDO_VEFUSE_SW_OP_EN */
+	{0x1C46, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCN33_SW_OP_EN */
+	{0x1D1E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCN33_SW_OP_EN */
+	{0x1D1E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCN28_SW_OP_EN */
+	{0x1D8A, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCN18_SW_OP_EN */
+	{0x1C5A, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCAMA1_SW_OP_EN */
+	{0x1C6E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCAMD_SW_OP_EN */
+	{0x1C9E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCAMA2_SW_OP_EN */
+	{0x1C8A, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VSRAM_PROC12_SW_OP_EN */
+	{0x1B90, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VCAMIO_SW_OP_EN */
+	{0x1CB2, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VLDO28_SW_OP_EN */
+	{0x1D34, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VLDO28_SW_OP_EN */
+	{0x1D34, 0x1, 0x1, 0},
+	/* [3:3]: RG_LDO_VA12_HW2_OP_EN */
+	{0x1A9E, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VA12_HW2_OP_CFG */
+	{0x1AA4, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VAUX18_HW2_OP_EN */
+	{0x1AB2, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VAUX18_HW2_OP_CFG */
+	{0x1AB8, 0x1, 0x1, 3},
+	/* [0:0]: RG_LDO_VAUD28_SW_OP_EN */
+	{0x1AC6, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VIO28_SW_OP_EN */
+	{0x1ADA, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VIO18_SW_OP_EN */
+	{0x1AEE, 0x1, 0x1, 0},
+	/* [2:2]: RG_LDO_VFE28_HW1_OP_EN */
+	{0x1C0A, 0x1, 0x1, 2},
+	/* [2:2]: RG_LDO_VFE28_HW1_OP_CFG */
+	{0x1C10, 0x0, 0x1, 2},
+	/* [3:3]: RG_LDO_VDRAM2_HW2_OP_EN */
+	{0x1B0A, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VDRAM2_HW2_OP_CFG */
+	{0x1B10, 0x1, 0x1, 3},
+	/* [0:0]: RG_LDO_VMC_SW_OP_EN */
+	{0x1CC6, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VMCH_SW_OP_EN */
+	{0x1CDA, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VEMC_SW_OP_EN */
+	{0x1B1E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VSIM1_SW_OP_EN */
+	{0x1D4A, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VSIM2_SW_OP_EN */
+	{0x1D5E, 0x1, 0x1, 0},
+	/* [0:0]: RG_LDO_VIBR_SW_OP_EN */
+	{0x1D0A, 0x1, 0x1, 0},
+	/* [3:3]: RG_LDO_VUSB_HW2_OP_EN */
+	{0x1B32, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VUSB_HW2_OP_CFG */
+	{0x1B38, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VUSB_HW2_OP_EN */
+	{0x1B32, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VUSB_HW2_OP_CFG */
+	{0x1B38, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VBIF28_HW2_OP_EN */
+	{0x1DA0, 0x1, 0x1, 3},
+	/* [3:3]: RG_LDO_VBIF28_HW2_OP_CFG */
+	{0x1DA6, 0x0, 0x1, 3},
+};
+
+static struct pmic_setting scp_setting[] = {
+	/* scp voltage initialization */
+	/* [6:0]: RG_BUCK_VCORE_SSHUB_VOSEL */
+	{0x14A6, 0x20, 0x7F, 0},
+	/* [14:8]: RG_BUCK_VCORE_SSHUB_VOSEL_SLEEP */
+	{0x14A6, 0x20, 0x7F, 8},
+	/* [0:0]: RG_BUCK_VCORE_SSHUB_EN */
+	{0x14A4, 0x1, 0x1, 0},
+	/* [1:1]: RG_BUCK_VCORE_SSHUB_SLEEP_VOSEL_EN */
+	{0x14A4, 0x0, 0x1, 1},
+	/* [6:0]: RG_LDO_VSRAM_OTHERS_SSHUB_VOSEL */
+	{0x1BC6, 0x40, 0x7F, 0},
+	/* [14:8]: RG_LDO_VSRAM_OTHERS_SSHUB_VOSEL_SLEEP */
+	{0x1BC6, 0x40, 0x7F, 8},
+	/* [0:0]: RG_LDO_VSRAM_OTHERS_SSHUB_EN */
+	{0x1BC4, 0x1, 0x1, 0},
+	/* [1:1]: RG_LDO_VSRAM_OTHERS_SSHUB_SLEEP_VOSEL_EN */
+	{0x1BC4, 0x0, 0x1, 1},
+	/* [4:4]: RG_SRCVOLTEN_LP_EN */
+	{0x134, 0x1, 0x1, 4},
+};
+
+static const int vddq_votrim[] = {
+	0, -10000, -20000, -30000, -40000, -50000, -60000, -70000,
+	80000, 70000, 60000, 50000, 40000, 30000, 20000, 10000,
+};
+
+static u32 pmic_read_efuse(int i)
+{
+	u32 efuse_data = 0;
+
+	/* 1. Enable efuse ctrl engine clock */
+	pwrap_write_field(PMIC_TOP_CKHWEN_CON0_CLR, 0x1, 0x1, 2);
+	pwrap_write_field(PMIC_TOP_CKPDN_CON0_CLR, 0x1, 0x1, 4);
+
+	/* 2. */
+	pwrap_write_field(PMIC_OTP_CON11, 0x1, 0x1, 0);
+
+	/* 3. Set row to read */
+	pwrap_write_field(PMIC_OTP_CON0, i * 2, 0xFF, 0);
+
+	/* 4. Toggle RG_OTP_RD_TRIG */
+	if (pwrap_read_field(PMIC_OTP_CON8, 0x1, 0) == 0)
+		pwrap_write_field(PMIC_OTP_CON8, 0x1, 0x1, 0);
+	else
+		pwrap_write_field(PMIC_OTP_CON8, 0, 0x1, 0);
+
+	/* 5. Polling RG_OTP_RD_BUSY = 0 */
+	udelay(300);
+	while (pwrap_read_field(PMIC_OTP_CON13, 0x1, 0) == 1)
+		;
+
+	/* 6. Read RG_OTP_DOUT_SW */
+	udelay(100);
+	efuse_data = pwrap_read_field(PMIC_OTP_CON12, 0xFFFF, 0);
+
+	/* 7. Disable efuse ctrl engine clock */
+	pwrap_write_field(PMIC_TOP_CKHWEN_CON0_SET, 0x1, 0x1, 2);
+	pwrap_write_field(PMIC_TOP_CKPDN_CON0_SET, 0x1, 0x1, 4);
+
+	return efuse_data;
+}
+
+static int pmic_get_efuse_votrim(void)
+{
+	const u32 cali_efuse = pmic_read_efuse(106) & 0xF;
+	assert(cali_efuse < ARRAY_SIZE(vddq_votrim));
+	return vddq_votrim[cali_efuse];
+}
+
+static u32 pmic_get_vcore_vol(void)
+{
+	u32 vol_reg;
+
+	vol_reg = pwrap_read_field(PMIC_VCORE_DBG0, 0x7F, 0);
+	return 500000 + vol_reg * 6250;
+}
+
+static void pmic_set_vcore_vol(u32 vcore_uv)
+{
+	u32 vol_reg;
+
+	assert(vcore_uv >= 500000);
+	assert(vcore_uv <= 1100000);
+
+	vol_reg = (vcore_uv - 500000) / 6250;
+
+	pwrap_write_field(PMIC_VCORE_OP_EN, 1, 0x7F, 0);
+	pwrap_write_field(PMIC_VCORE_VOSEL, vol_reg, 0x7F, 0);
+	udelay(1);
+}
+
+static u32 pmic_get_vdram1_vol(void)
+{
+	u32 vol_reg;
+
+	vol_reg = pwrap_read_field(PMIC_VDRAM1_DBG0, 0x7F, 0);
+	return 500000 + vol_reg * 12500;
+}
+
+static void pmic_set_vdram1_vol(u32 vdram_uv)
+{
+	u32 vol_reg;
+
+	assert(vdram_uv >= 500000);
+	assert(vdram_uv <= 1300000);
+
+	vol_reg = (vdram_uv - 500000) / 12500;
+
+	pwrap_write_field(PMIC_VDRAM1_OP_EN, 1, 0x7F, 0);
+	pwrap_write_field(PMIC_VDRAM1_VOSEL, vol_reg, 0x7F, 0);
+	udelay(1);
+}
+
+static u32 pmic_get_vddq_vol(void)
+{
+	int efuse_votrim;
+	u32 cali_trim;
+
+	if (!pwrap_read_field(PMIC_VDDQ_OP_EN, 0x1, 15))
+		return 0;
+
+	efuse_votrim = pmic_get_efuse_votrim();
+	cali_trim = pwrap_read_field(PMIC_VDDQ_ELR_0, 0xF, 0);
+	assert(cali_trim < ARRAY_SIZE(vddq_votrim));
+	return 600 * 1000 - efuse_votrim + vddq_votrim[cali_trim];
+}
+
+static void pmic_set_vddq_vol(u32 vddq_uv)
+{
+	int target_mv, dram2_ori_mv, cali_offset_uv, cali_trim;
+
+	assert(vddq_uv >= 530000);
+	assert(vddq_uv <= 680000);
+
+	/* Round down to multiple of 10 */
+	target_mv = (vddq_uv / 1000) / 10 * 10;
+
+	dram2_ori_mv = 600 - pmic_get_efuse_votrim() / 1000;
+	cali_offset_uv = 1000 * (target_mv - dram2_ori_mv);
+
+	if (cali_offset_uv >= 80000)
+		cali_trim = 8;
+	else if (cali_offset_uv <= -70000)
+		cali_trim = 7;
+	else {
+		cali_trim = 0;
+		while (cali_trim < ARRAY_SIZE(vddq_votrim) &&
+		       vddq_votrim[cali_trim] != cali_offset_uv)
+			++cali_trim;
+		assert(cali_trim < ARRAY_SIZE(vddq_votrim));
+	}
+
+	pwrap_write_field(PMIC_TOP_TMA_KEY, 0x9CA7, 0xFFFF, 0);
+	pwrap_write_field(PMIC_VDDQ_ELR_0, cali_trim, 0xF, 0);
+	pwrap_write_field(PMIC_TOP_TMA_KEY, 0, 0xFFFF, 0);
+	udelay(1);
+}
+
+static void pmic_wdt_set(void)
+{
+	/* [5]=1, RG_WDTRSTB_DEB */
+	pwrap_write_field(PMIC_TOP_RST_MISC_SET, 0x0020, 0xFFFF, 0);
+	/* [1]=0, RG_WDTRSTB_MODE */
+	pwrap_write_field(PMIC_TOP_RST_MISC_CLR, 0x0002, 0xFFFF, 0);
+	/* [0]=1, RG_WDTRSTB_EN */
+	pwrap_write_field(PMIC_TOP_RST_MISC_SET, 0x0001, 0xFFFF, 0);
+}
+
+static void mt6366_init_setting(void)
+{
+	for (size_t i = 0; i < ARRAY_SIZE(init_setting); i++)
+		pwrap_write_field(
+			init_setting[i].addr, init_setting[i].val,
+			init_setting[i].mask, init_setting[i].shift);
+}
+
+static void wk_sleep_voltage_by_ddr(void)
+{
+	if (pwrap_read_field(PMIC_VM_MODE, 0x3, 0) == 0x2)
+		pwrap_write_field(PMIC_VDRAM1_VOSEL_SLEEP, 0x3A, 0x7F, 0);
+}
+
+static void wk_power_down_seq(void)
+{
+	/* Write TMA KEY with magic number */
+	pwrap_write_field(PMIC_TOP_TMA_KEY, 0x9CA7, 0xFFFF, 0);
+	/* Set VPROC12 sequence to VA12 */
+	pwrap_write_field(PMIC_CPSDSA4, 0xA, 0x1F, 0);
+	pwrap_write_field(PMIC_TOP_TMA_KEY, 0x0, 0xFFFF, 0);
+}
+
+static void mt6366_lp_setting(void)
+{
+	for (size_t i = 0; i < ARRAY_SIZE(lp_setting); i++)
+		pwrap_write_field(
+			lp_setting[i].addr, lp_setting[i].val,
+			lp_setting[i].mask, lp_setting[i].shift);
+}
+
+static void pmic_check_hwcid(void)
+{
+	printk(BIOS_WARNING, "%s: ID = %#x\n", __func__,
+	       pwrap_read_field(0x8, 0xFFFF, 0));
+}
+
+void mt6366_set_power_hold(bool enable)
+{
+	pwrap_write_field(PMIC_PWRHOLD, (enable) ? 1 : 0, 0x1, 0);
+}
+
+void mt6366_init_scp_voltage(void)
+{
+	for (size_t i = 0; i < ARRAY_SIZE(scp_setting); i++)
+		pwrap_write_field(
+			scp_setting[i].addr, scp_setting[i].val,
+			scp_setting[i].mask, scp_setting[i].shift);
+}
+
+void mt6366_set_vsim2_cali_mv(u32 vsim2_mv)
+{
+	u16 vsim2_reg, cali_mv;
+
+	cali_mv = vsim2_mv % 100;
+	assert(cali_mv % 10 == 0);
+
+	switch (vsim2_mv - cali_mv) {
+	case 1700:
+		vsim2_reg = 0x3;
+		break;
+	case 1800:
+		vsim2_reg = 0x4;
+		break;
+	case 2700:
+		vsim2_reg = 0x8;
+		break;
+	case 3000:
+		vsim2_reg = 0xb;
+		break;
+	case 3100:
+		vsim2_reg = 0xc;
+		break;
+	default:
+		printk(BIOS_ERR, "%s: voltage %d is not supported\n", __func__, vsim2_mv);
+		return;
+	};
+
+	/* [11:8]=0x8, RG_VSIM2_VOSEL */
+	pwrap_write_field(PMIC_VSIM2_ANA_CON0, vsim2_reg, 0xF, 8);
+
+	/* [3:0], RG_VSIM2_VOCAL */
+	pwrap_write_field(PMIC_VSIM2_ANA_CON0, cali_mv / 10, 0xF, 0);
+}
+
+void mt6366_set_voltage(enum mt6366_regulator_id id, u32 voltage_uv)
+{
+	switch (id) {
+	case MT6366_VCORE:
+		pmic_set_vcore_vol(voltage_uv);
+		break;
+	case MT6366_VDRAM1:
+		pmic_set_vdram1_vol(voltage_uv);
+		break;
+	case MT6366_VDDQ:
+		pmic_set_vddq_vol(voltage_uv);
+		break;
+	default:
+		printk(BIOS_ERR, "%s: PMIC %d is not supported\n", __func__, id);
+		break;
+	}
+}
+
+u32 mt6366_get_voltage(enum mt6366_regulator_id id)
+{
+	switch (id) {
+	case MT6366_VCORE:
+		return pmic_get_vcore_vol();
+	case MT6366_VDRAM1:
+		return pmic_get_vdram1_vol();
+	case MT6366_VDDQ:
+		return pmic_get_vddq_vol();
+	default:
+		printk(BIOS_ERR, "%s: PMIC %d is not supported\n", __func__, id);
+		break;
+	}
+	return 0;
+}
+
+void mt6366_init(void)
+{
+	struct stopwatch voltage_settled;
+
+	if (pwrap_init())
+		die("ERROR - Failed to initialize pmic wrap!");
+
+	pmic_check_hwcid();
+	mt6366_set_power_hold(true);
+	pmic_wdt_set();
+	mt6366_init_setting();
+	stopwatch_init_usecs_expire(&voltage_settled, 200);
+	wk_sleep_voltage_by_ddr();
+	wk_power_down_seq();
+	mt6366_lp_setting();
+
+	while (!stopwatch_expired(&voltage_settled))
+		/* wait for voltages to settle */;
+}
diff --git a/src/soc/mediatek/mt8186/pmic_wrap.c b/src/soc/mediatek/mt8186/pmic_wrap.c
new file mode 100644
index 0000000000..62cb72dc94
--- /dev/null
+++ b/src/soc/mediatek/mt8186/pmic_wrap.c
@@ -0,0 +1,330 @@
+/* SPDX-License-Identifier: GPL-2.0-only */
+
+/*
+ * This file is created based on MT8186 Functional Specification
+ * Chapter number: 3.7
+ */
+
+#include <device/mmio.h>
+#include <soc/infracfg.h>
+#include <soc/pll.h>
+#include <soc/pmic_wrap.h>
+#include <timer.h>
+
+#define PRIORITY_FIELD(x)		((x % 4) * 8)
+#define PRIORITY_IN(id, priority)	(id << PRIORITY_FIELD(priority))
+#define PRIORITY_OUT(id, priority)	(priority << PRIORITY_FIELD(id))
+
+enum {
+	MD_ADCINF0 =  8,
+	MD_ADCINF1 =  9,
+	STAUPD     = 10,
+	GPSINF0    = 11,
+
+	PRIORITY_IN_SEL_2 = PRIORITY_IN(MD_ADCINF0,  9) |
+			    PRIORITY_IN(MD_ADCINF1, 10) |
+			    PRIORITY_IN(STAUPD,      8) |
+			    PRIORITY_IN(GPSINF0,    11),
+
+	PRIORITY_OUT_SEL_2 = PRIORITY_OUT(MD_ADCINF0,  9) |
+			     PRIORITY_OUT(MD_ADCINF1, 10) |
+			     PRIORITY_OUT(STAUPD,      8) |
+			     PRIORITY_OUT(GPSINF0,    11),
+};
+
+#define PENDING_US(x) x
+enum {
+	STARVE_ENABLE = 0x1 << 10,
+	COUNTER0_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x2),
+	COUNTER1_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x3),
+	COUNTER2_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x3),
+	COUNTER3_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x3),
+	COUNTER4_PENDING_THRES = STARVE_ENABLE | PENDING_US(0xf),
+	COUNTER5_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x20),
+	COUNTER6_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x28),
+	COUNTER7_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x28),
+	COUNTER8_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x13),
+	COUNTER9_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x17),
+	COUNTER10_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x17),
+	COUNTER11_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x7c),
+	COUNTER12_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x7c),
+	COUNTER13_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x340),
+	COUNTER16_PENDING_THRES = STARVE_ENABLE | PENDING_US(0x340),
+};
+
+static void pwrap_soft_reset(void)
+{
+	write32(&mt8186_infracfg_ao->infra_globalcon_rst2_set, 0x1);
+	write32(&mt8186_infracfg_ao->infra_globalcon_rst2_clr, 0x1);
+}
+
+static void pwrap_spi_clk_set(void)
+{
+	write32(&mt8186_infracfg_ao->module_sw_cg_0_set, 0x0000000f);
+	write32(&mt8186_infracfg_ao->module_sw_cg_2_set, 0x00000100);
+
+	write32(&mtk_topckgen->clk_cfg_8_clr, 0x00970000);
+	write32(&mtk_topckgen->clk_cfg_8_set, 0x00040000);
+	write32(&mtk_topckgen->clk_cfg_update1, (0x1 << 3));
+
+	write32(&mt8186_infracfg_ao->pmicw_clock_ctrl,
+		read32(&mt8186_infracfg_ao->pmicw_clock_ctrl) & ~(0x1 << 2));
+
+	pwrap_soft_reset();
+
+	write32(&mt8186_infracfg_ao->module_sw_cg_0_clr, 0x0000000f);
+	write32(&mt8186_infracfg_ao->module_sw_cg_2_clr, 0x00000100);
+}
+
+static s32 pwrap_init_dio(u16 dio_en)
+{
+	pwrap_write_nochk(PMIC_DEW_DIO_EN, dio_en);
+
+	if (!wait_us(100,
+		     !wait_for_idle_and_sync(read32(&mtk_pwrap->wacs2_rdata))))
+		return -1;
+
+	write32(&mtk_pwrap->dio_en, dio_en);
+	return 0;
+}
+
+static void pwrap_lock_spislvreg(void)
+{
+	pwrap_write_nochk(PMIC_SPISLV_KEY, 0x0);
+}
+
+static void pwrap_initstaupd(void)
+{
+	write32(&mtk_pwrap->staupd_grpen,
+		SIG_PMIC_0 | INT_STA_PMIC_0 | MD_ADC_DATA0 |
+		MD_ADC_DATA1 | GPS_ADC_DATA0 | GPS_ADC_DATA1);
+
+	/* CRC */
+	pwrap_write_nochk(PMIC_DEW_CRC_EN, 0x1);
+	write32(&mtk_pwrap->crc_en, 0x1);
+	write32(&mtk_pwrap->sig_adr, PMIC_DEW_CRC_VAL);
+
+	write32(&mtk_pwrap->eint_sta0_adr, PMIC_CPU_INT_STA);
+
+	/* MD ADC Interface */
+	write32(&mtk_pwrap->md_auxadc_rdata_latest_addr,
+		(PMIC_AUXADC_ADC35 << 16) + PMIC_AUXADC_ADC31);
+	write32(&mtk_pwrap->md_auxadc_rdata_wp_addr,
+		(PMIC_AUXADC_ADC35 << 16) + PMIC_AUXADC_ADC31);
+	for (size_t i = 0; i < 32; i++)
+		write32(&mtk_pwrap->md_auxadc_rdata[i],
+			(PMIC_AUXADC_ADC35 << 16) + PMIC_AUXADC_ADC31);
+
+	write32(&mtk_pwrap->int_gps_auxadc_cmd_addr,
+		(PMIC_AUXADC_RQST1 << 16) + PMIC_AUXADC_RQST0);
+	write32(&mtk_pwrap->int_gps_auxadc_cmd, (GPS_MAIN << 16) + GPS_SUBSYS);
+	write32(&mtk_pwrap->int_gps_auxadc_rdata_addr,
+		(PMIC_AUXADC_ADC32 << 16) + PMIC_AUXADC_ADC17);
+
+	write32(&mtk_pwrap->ext_gps_auxadc_rdata_addr, PMIC_AUXADC_ADC31);
+}
+
+static void pwrap_starve_set(void)
+{
+	write32(&mtk_pwrap->harb_hprio, ARB_PRIORITY);
+	write32(&mtk_pwrap->starv_counter_0, COUNTER0_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_1, COUNTER1_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_2, COUNTER2_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_3, COUNTER3_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_4, COUNTER4_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_5, COUNTER5_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_6, COUNTER6_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_7, COUNTER7_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_8, COUNTER8_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_9, COUNTER9_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_10, COUNTER10_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_11, COUNTER11_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_12, COUNTER12_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_13, COUNTER13_PENDING_THRES);
+	write32(&mtk_pwrap->starv_counter_16, COUNTER16_PENDING_THRES);
+}
+
+static void pwrap_enable(void)
+{
+	write32(&mtk_pwrap->hiprio_arb_en, ARB_USER_EN);
+	write32(&mtk_pwrap->wacs0_en, 0x1);
+	write32(&mtk_pwrap->wacs2_en, 0x1);
+	write32(&mtk_pwrap->wacs_p2p_en, 0x1);
+	write32(&mtk_pwrap->wacs_md32_en, 0x1);
+	write32(&mtk_pwrap->staupd_ctrl, STA_PD_98_5_US);
+	write32(&mtk_pwrap->wdt_ctrl, WATCHDOG_TIMER_7_5_MS);
+	write32(&mtk_pwrap->wdt_src_en_0, WDT_MONITOR_ALL);
+	write32(&mtk_pwrap->wdt_src_en_1, WDT_MONITOR_ALL);
+	write32(&mtk_pwrap->timer_ctrl, 0x1);
+	write32(&mtk_pwrap->int0_en, INT0_MONITOR);
+	write32(&mtk_pwrap->int1_en, INT1_MONITOR);
+}
+
+static s32 pwrap_init_sistrobe(void)
+{
+	u16 rdata;
+	int si_sample_ctrl;
+	int test_data[30] = {
+		0x6996, 0x9669, 0x6996, 0x9669, 0x6996, 0x9669, 0x6996,
+		0x9669, 0x6996, 0x9669, 0x5AA5, 0xA55A, 0x5AA5, 0xA55A,
+		0x5AA5, 0xA55A, 0x5AA5, 0xA55A, 0x5AA5, 0xA55A, 0x1B27,
+		0x1B27, 0x1B27, 0x1B27, 0x1B27, 0x1B27, 0x1B27, 0x1B27,
+		0x1B27, 0x1B27};
+
+	for (si_sample_ctrl = 0; si_sample_ctrl < 16; si_sample_ctrl++) {
+		write32(&mtk_pwrap->si_sample_ctrl, si_sample_ctrl << 5);
+
+		pwrap_read_nochk(PMIC_DEW_READ_TEST, &rdata);
+		if (rdata == DEFAULT_VALUE_READ_TEST)
+			break;
+	}
+
+	if (si_sample_ctrl == 16)
+		return E_CLK_EDGE;
+
+	if (si_sample_ctrl == 15)
+		return E_CLK_LAST_SETTING;
+
+	/*
+	 * Add the delay time of SPI data from PMIC to align the start boundary
+	 * to current sampling clock edge.
+	 */
+	for (int si_dly = 0; si_dly < 10; si_dly++) {
+		pwrap_write_nochk(PMIC_RG_SPI_CON2, si_dly);
+
+		int start_boundary_found = 0;
+		for (size_t i = 0; i < 30; i++) {
+			pwrap_write_nochk(PMIC_DEW_WRITE_TEST, test_data[i]);
+			pwrap_read_nochk(PMIC_DEW_WRITE_TEST, &rdata);
+			if ((rdata & 0x7fff) != (test_data[i] & 0x7fff)) {
+				start_boundary_found = 1;
+				break;
+			}
+		}
+		if (start_boundary_found == 1)
+			break;
+	}
+
+	/*
+	 * Change the sampling clock edge to the next one which is the middle
+	 * of SPI data window.
+	 */
+	write32(&mtk_pwrap->si_sample_ctrl, ++si_sample_ctrl << 5);
+
+	/* Read Test */
+	pwrap_read_nochk(PMIC_DEW_READ_TEST, &rdata);
+	if (rdata != DEFAULT_VALUE_READ_TEST) {
+		pwrap_err("rdata = %#x, exp = %#x\n", rdata,
+			  DEFAULT_VALUE_READ_TEST);
+		return E_PWR_READ_TEST_FAIL;
+	}
+
+	return 0;
+}
+
+static void pwrap_init_spislv(void)
+{
+	/* Turn on IO filter function */
+	pwrap_write_nochk(PMIC_FILTER_CON0, SPI_FILTER);
+	/* Turn on IO SMT function to improve noise immunity */
+	pwrap_write_nochk(PMIC_SMT_CON1, SPI_SMT);
+	/* Turn off IO pull function for power saving */
+	pwrap_write_nochk(PMIC_GPIO_PULLEN0_CLR, SPI_PULL_DISABLE);
+	/* Enable SPI R/W in suspend mode */
+	pwrap_write_nochk(PMIC_RG_SPI_CON0, 0x1);
+	/* Set PMIC GPIO driving current to 4mA */
+	pwrap_write_nochk(PMIC_DRV_CON1, SPI_DRIVING);
+}
+
+static void pwrap_init_reg_clock(void)
+{
+	write32(&mtk_pwrap->ext_ck_write, 0x1);
+
+	pwrap_write_nochk(PMIC_DEW_RDDMY_NO, DUMMY_READ_CYCLES);
+	write32(&mtk_pwrap->rddmy, DUMMY_READ_CYCLES);
+
+	write32(&mtk_pwrap->cshext_write, 0);
+	write32(&mtk_pwrap->cshext_read, 0);
+	write32(&mtk_pwrap->cslext_write, 0);
+	write32(&mtk_pwrap->cslext_read, 0);
+}
+
+s32 pwrap_init(void)
+{
+	s32 sub_return = 0, sub_return1 = 0;
+	u16 rdata;
+
+	pwrap_spi_clk_set();
+
+	/* Reset spislv */
+	sub_return = pwrap_reset_spislv();
+	if (sub_return != 0) {
+		pwrap_err("reset_spislv fail, ret=%d\n", sub_return);
+		return E_PWR_INIT_RESET_SPI;
+	}
+
+	/* Enable WRAP */
+	write32(&mtk_pwrap->wrap_en, 0x1);
+
+	/* Enable WACS2 */
+	write32(&mtk_pwrap->wacs2_en, 0x1);
+	write32(&mtk_pwrap->hiprio_arb_en, WACS2); /* ONLY WACS2 */
+
+	/* SPI Waveform Configuration */
+	pwrap_init_reg_clock();
+
+	/* SPI Slave Configuration */
+	pwrap_init_spislv();
+
+	/* Enable DIO mode */
+	sub_return = pwrap_init_dio(1);
+	if (sub_return != 0) {
+		pwrap_err("dio test error, ret=%d\n", sub_return);
+		return E_PWR_INIT_DIO;
+	}
+
+	/* Input data calibration flow; */
+	sub_return = pwrap_init_sistrobe();
+	if (sub_return != 0) {
+		pwrap_err("InitSiStrobe fail,ret=%d\n", sub_return);
+		return E_PWR_INIT_SIDLY;
+	}
+
+	/*
+	 * Write test using WACS2,
+	 * make sure the read/write function ready.
+	 */
+	sub_return = pwrap_write_nochk(PMIC_DEW_WRITE_TEST, WRITE_TEST_VALUE);
+	sub_return1 = pwrap_read_nochk(PMIC_DEW_WRITE_TEST, &rdata);
+	if (rdata != WRITE_TEST_VALUE || sub_return || sub_return1) {
+		pwrap_err("write error, rdata=%#x, return=%d, return1=%d\n",
+			  rdata, sub_return, sub_return1);
+		return E_PWR_INIT_WRITE_TEST;
+	}
+
+	/*
+	 * Status update function initialization
+	 * 1. Signature Checking using CRC (CRC 0 only)
+	 * 2. EINT update
+	 * 3. Read back Auxadc thermal data for GPS
+	 */
+	pwrap_initstaupd();
+
+	write32(&mtk_pwrap->priority_user_sel_2, PRIORITY_IN_SEL_2);
+	write32(&mtk_pwrap->arbiter_out_sel_2, PRIORITY_OUT_SEL_2);
+
+	pwrap_starve_set();
+
+	pwrap_enable();
+
+	/* Initialization Done */
+	write32(&mtk_pwrap->init_done0, 0x1);
+	write32(&mtk_pwrap->init_done2, 0x1);
+	write32(&mtk_pwrap->init_done_p2p, 0x1);
+	write32(&mtk_pwrap->init_done_md32, 0x1);
+
+	/* Lock SPISLV Registers */
+	pwrap_lock_spislvreg();
+
+	return 0;
+}