2 files changed, 43 insertions, 0 deletions
diff --git a/src/soc/mediatek/mt8183/include/soc/mt6358.h b/src/soc/mediatek/mt8183/include/soc/mt6358.h
index 02937bac9a..277ee9aa35 100644
--- a/src/soc/mediatek/mt8183/include/soc/mt6358.h
+++ b/src/soc/mediatek/mt8183/include/soc/mt6358.h
@@ -27,6 +27,7 @@ enum {
 	PMIC_CPSDSA4                  = 0x0a2e,
 	PMIC_VDRAM1_VOSEL_SLEEP       = 0x160a,
 	PMIC_SMPS_ANA_CON0            = 0x1808,
+	PMIC_VSIM2_ANA_CON0           = 0x1e30,
 };
 
 struct pmic_setting {
@@ -38,5 +39,6 @@ struct pmic_setting {
 
 void mt6358_init(void);
 void pmic_set_power_hold(bool enable);
+void pmic_set_vsim2_cali(unsigned int vsim2_mv);
 
 #endif /* __SOC_MEDIATEK_MT6358_H__ */
diff --git a/src/soc/mediatek/mt8183/mt6358.c b/src/soc/mediatek/mt8183/mt6358.c
index 705424337f..ea4274f14b 100644
--- a/src/soc/mediatek/mt8183/mt6358.c
+++ b/src/soc/mediatek/mt8183/mt6358.c
@@ -13,6 +13,7 @@
  * GNU General Public License for more details.
  */
 
+#include <assert.h>
 #include <console/console.h>
 #include <soc/pmic_wrap.h>
 #include <soc/mt6358.h>
@@ -733,6 +734,46 @@ void pmic_set_power_hold(bool enable)
 	pwrap_write_field(PMIC_PWRHOLD, (enable) ? 1 : 0, 0x1, 0);
 }
 
+void pmic_set_vsim2_cali(unsigned int 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:
+		assert(0);
+		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);
+}
+
 static void pmic_wdt_set(void)
 {
 	/* [5]=1, RG_WDTRSTB_DEB */