mei: me: add power gating isolation register write wrappers

[firefly-linux-kernel-4.4.55.git] / drivers / misc / mei / hw-me.c

diff --git a/drivers/misc/mei/hw-me.c b/drivers/misc/mei/hw-me.c
index 8dbdaaef1af57dcbd63f60bd1088ea39d8d80596..fc5d001983b32aac87227e8649819097941ab6e1 100644 (file)
--- a/drivers/misc/mei/hw-me.c
+++ b/drivers/misc/mei/hw-me.c
@@ -430,6 +430,35 @@ static int mei_me_read_slots(struct mei_device *dev, unsigned char *buffer,
        return 0;
 }
 
+/**
+ * mei_me_pg_enter - write pg enter register to mei device.
+ *
+ * @dev: the device structure
+ */
+static void mei_me_pg_enter(struct mei_device *dev)
+{
+       struct mei_me_hw *hw = to_me_hw(dev);
+       u32 reg = mei_me_reg_read(hw, H_HPG_CSR);
+       reg |= H_HPG_CSR_PGI;
+       mei_me_reg_write(hw, H_HPG_CSR, reg);
+}
+
+/**
+ * mei_me_pg_enter - write pg enter register to mei device.
+ *
+ * @dev: the device structure
+ */
+static void mei_me_pg_exit(struct mei_device *dev)
+{
+       struct mei_me_hw *hw = to_me_hw(dev);
+       u32 reg = mei_me_reg_read(hw, H_HPG_CSR);
+
+       WARN(!(reg & H_HPG_CSR_PGI), "PGI is not set\n");
+
+       reg |= H_HPG_CSR_PGIHEXR;
+       mei_me_reg_write(hw, H_HPG_CSR, reg);
+}
+
 /**
  * mei_me_irq_quick_handler - The ISR of the MEI device
  *