video: decon: mic: support hibernation display mode

@ DISP Block power off sequence (cont.d)
1. MIC core disable
2. MIC s/w reset for stabilization
3. SYSREG_DISP : MIC disable

@ DISP Block power on sequence
1. SYSREG_DISP : MIC enable
2. MIC : initialization & start

Change-Id: I4a571824174058832e3581130bd62d266742ad54
Signed-off-by: SeWoon Park <[email protected]>

Author: SeWoon Park

drivers/video/decon_display/decon_mic.c

@@ -49,6 +49,11 @@ struct decon_mic {
 struct decon_mic *mic_for_decon;
 EXPORT_SYMBOL(mic_for_decon);
 
+#ifdef CONFIG_FB_I80_COMMAND_MODE
+int decon_mic_hibernation_power_on(struct display_driver *dispdrv);
+int decon_mic_hibernation_power_off(struct display_driver *dispdrv);
+#endif
+
 static int decon_mic_set_sys_reg(struct decon_mic *mic, bool enable)
 {
 	u32 data;
@@ -175,6 +180,12 @@ int create_decon_mic(struct platform_device *pdev)
 
 	mic->decon_mic_on = true;
 
+	dispdrv->mic_driver.mic = mic;
+#ifdef CONFIG_FB_I80_COMMAND_MODE
+	dispdrv->mic_driver.ops->pwr_on = decon_mic_hibernation_power_on;
+	dispdrv->mic_driver.ops->pwr_off = decon_mic_hibernation_power_off;
+#endif
+
 	dev_info(dev, "MIC driver has been probed\n");
 	return 0;
 }
@@ -214,6 +225,47 @@ int decon_mic_disable(struct decon_mic *mic)
 	return 0;
 }
 
+int decon_mic_sw_reset(struct decon_mic *mic)
+{
+	void __iomem *regs = mic->reg_base + DECON_MIC_OP;
+
+	u32 data = readl(regs);
+
+	data |= DECON_MIC_SW_RST;
+	writel(data, regs);
+
+	return 0;
+}
+
+#ifdef CONFIG_FB_I80_COMMAND_MODE
+int decon_mic_hibernation_power_on(struct display_driver *dispdrv)
+{
+	struct decon_mic *mic = dispdrv->mic_driver.mic;
+
+	decon_mic_set_sys_reg(mic, DECON_MIC_ON);
+	decon_mic_set_image_size(mic);
+	decon_mic_set_2d_bit_stream_size(mic);
+	decon_mic_set_mic_base_operation(mic, DECON_MIC_ON);
+
+	mic->decon_mic_on = true;
+
+	return 0;
+}
+
+int decon_mic_hibernation_power_off(struct display_driver *dispdrv)
+{
+	struct decon_mic *mic = dispdrv->mic_driver.mic;
+
+	decon_mic_set_mic_base_operation(mic, DECON_MIC_OFF);
+	decon_mic_sw_reset(mic);
+	decon_mic_set_sys_reg(mic, DECON_MIC_OFF);
+
+	mic->decon_mic_on = false;
+
+	return 0;
+}
+#endif
+
 MODULE_AUTHOR("Haowei Li <[email protected]>");
 MODULE_DESCRIPTION("Samsung MIC driver");
 MODULE_LICENSE("GPL");

drivers/video/decon_display/decon_mic.h

@@ -10,6 +10,7 @@ struct mic_config {
 #define DECON_MIC_OP		0x00
 #define DECON_MIC_UPDATE_REG	(1 << 31)
 #define DECON_MIC_ON_REG	(1 << 30)
+#define DECON_MIC_SW_RST	(1 << 4)
 #define DECON_MIC_NEW_CORE	(0 << 2)
 #define DECON_MIC_OLD_CORE	(1 << 2)
 #define DECON_MIC_VIDEO_MODE	(0 << 1)