diff --git a/src/soc/mediatek/common/include/soc/pmif_common.h b/src/soc/mediatek/common/include/soc/pmif_common.h index ee0a2664b4..949b34f1bc 100644 --- a/src/soc/mediatek/common/include/soc/pmif_common.h +++ b/src/soc/mediatek/common/include/soc/pmif_common.h @@ -30,6 +30,8 @@ struct pmif { u32 pmifid; void (*read)(struct pmif *arb, u32 slvid, u32 reg, u32 *data); void (*write)(struct pmif *arb, u32 slvid, u32 reg, u32 data); + void (*read16)(struct pmif *arb, u32 slvid, u32 reg, u16 *data); + void (*write16)(struct pmif *arb, u32 slvid, u32 reg, u16 data); u32 (*read_field)(struct pmif *arb, u32 slvid, u32 reg, u32 mask, u32 shift); void (*write_field)(struct pmif *arb, u32 slvid, u32 reg, u32 val, u32 mask, u32 shift); int (*is_pmif_init_done)(struct pmif *arb); @@ -86,6 +88,8 @@ void pmwrap_interface_init(void); int mtk_pmif_init(void); void pmif_spmi_read(struct pmif *arb, u32 slvid, u32 reg, u32 *data); void pmif_spmi_write(struct pmif *arb, u32 slvid, u32 reg, u32 data); +void pmif_spmi_read16(struct pmif *arb, u32 slvid, u32 reg, u16 *data); +void pmif_spmi_write16(struct pmif *arb, u32 slvid, u32 reg, u16 data); u32 pmif_spmi_read_field(struct pmif *arb, u32 slvid, u32 reg, u32 mask, u32 shift); void pmif_spmi_write_field(struct pmif *arb, u32 slvid, u32 reg, u32 val, u32 mask, u32 shift); diff --git a/src/soc/mediatek/common/pmif.c b/src/soc/mediatek/common/pmif.c index 50fddc810b..97da4157f1 100644 --- a/src/soc/mediatek/common/pmif.c +++ b/src/soc/mediatek/common/pmif.c @@ -74,6 +74,18 @@ void pmif_spmi_write(struct pmif *arb, u32 slvid, u32 reg, u32 data) pmif_send_cmd(arb, 1, PMIF_CMD_EXT_REG_LONG, slvid, reg, NULL, data, 1); } +void pmif_spmi_read16(struct pmif *arb, u32 slvid, u32 reg, u16 *data) +{ + u32 rdata = 0; + pmif_send_cmd(arb, 0, PMIF_CMD_EXT_REG_LONG, slvid, reg, &rdata, 0, 2); + *data = (u16)rdata; +} + +void pmif_spmi_write16(struct pmif *arb, u32 slvid, u32 reg, u16 data) +{ + pmif_send_cmd(arb, 1, PMIF_CMD_EXT_REG_LONG, slvid, reg, NULL, data, 2); +} + u32 pmif_spmi_read_field(struct pmif *arb, u32 slvid, u32 reg, u32 mask, u32 shift) { u32 data;