generic-poky/meta-moblin/packages/linux/linux-moblin-2.6.33.2/linux-2.6.34-moorestown-gra...

1860 lines
53 KiB
Diff

From a060e4d4a34b0fe17384e2d02e65c74fe73ee4c9 Mon Sep 17 00:00:00 2001
From: Prajwal Mohan <prajwal.karur.mohan@intel.com>
Date: Thu, 6 May 2010 14:29:26 -0700
Subject: [PATCH] Graphics changes for Aava Koski DV1 hardware
Signed-Off-By: Prajwal Mohan <prajwal.karur.mohan@intel.com>
Patch-mainline: 2.6.35?
---
drivers/gpu/drm/mrst/drv/psb_drv.h | 7 +
drivers/gpu/drm/mrst/drv/psb_intel_display.c | 75 +-
drivers/gpu/drm/mrst/drv/psb_intel_dsi.c | 9 +
drivers/gpu/drm/mrst/drv/psb_intel_dsi_aava.c | 1356 ++++++++++----------
.../linux_framebuffer_mrst/mrstlfb_displayclass.c | 21 +-
5 files changed, 735 insertions(+), 733 deletions(-)
diff --git a/drivers/gpu/drm/mrst/drv/psb_drv.h b/drivers/gpu/drm/mrst/drv/psb_drv.h
index 2ac7934..56c1e90 100644
--- a/drivers/gpu/drm/mrst/drv/psb_drv.h
+++ b/drivers/gpu/drm/mrst/drv/psb_drv.h
@@ -413,6 +413,8 @@ struct drm_psb_private {
uint32_t dspcntr;
/* MRST_DSI private date start */
+ struct work_struct dsi_work;
+
/*
*MRST DSI info
*/
@@ -430,6 +432,9 @@ struct drm_psb_private {
enum mipi_panel_type panel_make;
+ /* Set if MIPI encoder wants to control plane/pipe */
+ bool dsi_plane_pipe_control;
+
/* status */
uint32_t videoModeFormat:2;
uint32_t laneCount:3;
@@ -610,6 +615,8 @@ struct drm_psb_private {
uint32_t saveMIPI_CONTROL_REG;
uint32_t saveMIPI;
void (*init_drvIC)(struct drm_device *dev);
+ void (*dsi_prePowerState)(struct drm_device *dev);
+ void (*dsi_postPowerState)(struct drm_device *dev);
/* DPST Register Save */
uint32_t saveHISTOGRAM_INT_CONTROL_REG;
diff --git a/drivers/gpu/drm/mrst/drv/psb_intel_display.c b/drivers/gpu/drm/mrst/drv/psb_intel_display.c
index 10c6dec..72d42eb 100644
--- a/drivers/gpu/drm/mrst/drv/psb_intel_display.c
+++ b/drivers/gpu/drm/mrst/drv/psb_intel_display.c
@@ -2089,6 +2089,7 @@ static void mrst_crtc_dpms(struct drm_crtc *crtc, int mode)
{
struct drm_device *dev = crtc->dev;
struct psb_intel_crtc *psb_intel_crtc = to_psb_intel_crtc(crtc);
+ struct drm_psb_private *dev_priv = dev->dev_private;
int pipe = psb_intel_crtc->pipe;
int dpll_reg = (pipe == 0) ? MRST_DPLL_A : DPLL_B;
int dspcntr_reg = (pipe == 0) ? DSPACNTR : DSPBCNTR;
@@ -2130,18 +2131,22 @@ static void mrst_crtc_dpms(struct drm_crtc *crtc, int mode)
udelay(150);
}
- /* Enable the pipe */
- temp = REG_READ(pipeconf_reg);
- if ((temp & PIPEACONF_ENABLE) == 0)
- REG_WRITE(pipeconf_reg, temp | PIPEACONF_ENABLE);
-
- /* Enable the plane */
- temp = REG_READ(dspcntr_reg);
- if ((temp & DISPLAY_PLANE_ENABLE) == 0) {
- REG_WRITE(dspcntr_reg,
- temp | DISPLAY_PLANE_ENABLE);
- /* Flush the plane changes */
- REG_WRITE(dspbase_reg, REG_READ(dspbase_reg));
+ if (dev_priv->iLVDS_enable ||
+ !dev_priv->dsi_plane_pipe_control) {
+ /* Enable the pipe */
+ temp = REG_READ(pipeconf_reg);
+ if ((temp & PIPEACONF_ENABLE) == 0)
+ REG_WRITE(pipeconf_reg,
+ temp | PIPEACONF_ENABLE);
+
+ /* Enable the plane */
+ temp = REG_READ(dspcntr_reg);
+ if ((temp & DISPLAY_PLANE_ENABLE) == 0) {
+ REG_WRITE(dspcntr_reg,
+ temp | DISPLAY_PLANE_ENABLE);
+ /* Flush the plane changes */
+ REG_WRITE(dspbase_reg, REG_READ(dspbase_reg));
+ }
}
psb_intel_crtc_load_lut(crtc);
@@ -2158,30 +2163,34 @@ static void mrst_crtc_dpms(struct drm_crtc *crtc, int mode)
/* Disable the VGA plane that we never use */
REG_WRITE(VGACNTRL, VGA_DISP_DISABLE);
- /* Disable display plane */
- temp = REG_READ(dspcntr_reg);
- if ((temp & DISPLAY_PLANE_ENABLE) != 0) {
- REG_WRITE(dspcntr_reg,
- temp & ~DISPLAY_PLANE_ENABLE);
- /* Flush the plane changes */
- REG_WRITE(dspbase_reg, REG_READ(dspbase_reg));
- REG_READ(dspbase_reg);
- }
+ if (dev_priv->iLVDS_enable ||
+ !dev_priv->dsi_plane_pipe_control) {
+ /* Disable display plane */
+ temp = REG_READ(dspcntr_reg);
+ if ((temp & DISPLAY_PLANE_ENABLE) != 0) {
+ REG_WRITE(dspcntr_reg,
+ temp & ~DISPLAY_PLANE_ENABLE);
+ /* Flush the plane changes */
+ REG_WRITE(dspbase_reg, REG_READ(dspbase_reg));
+ REG_READ(dspbase_reg);
+ }
- if (!IS_I9XX(dev)) {
- /* Wait for vblank for the disable to take effect */
- psb_intel_wait_for_vblank(dev);
- }
+ if (!IS_I9XX(dev)) {
+ /* Wait for vblank for the disable to take effect */
+ psb_intel_wait_for_vblank(dev);
+ }
- /* Next, disable display pipes */
- temp = REG_READ(pipeconf_reg);
- if ((temp & PIPEACONF_ENABLE) != 0) {
- REG_WRITE(pipeconf_reg, temp & ~PIPEACONF_ENABLE);
- REG_READ(pipeconf_reg);
- }
+ /* Next, disable display pipes */
+ temp = REG_READ(pipeconf_reg);
+ if ((temp & PIPEACONF_ENABLE) != 0) {
+ REG_WRITE(pipeconf_reg,
+ temp & ~PIPEACONF_ENABLE);
+ REG_READ(pipeconf_reg);
+ }
- /* Wait for for the pipe disable to take effect. */
- mrstWaitForPipeDisable(dev);
+ /* Wait for for the pipe disable to take effect. */
+ mrstWaitForPipeDisable(dev);
+ }
temp = REG_READ(dpll_reg);
if ((temp & DPLL_VCO_ENABLE) != 0) {
diff --git a/drivers/gpu/drm/mrst/drv/psb_intel_dsi.c b/drivers/gpu/drm/mrst/drv/psb_intel_dsi.c
index 3d45df8..eb6cb2a 100644
--- a/drivers/gpu/drm/mrst/drv/psb_intel_dsi.c
+++ b/drivers/gpu/drm/mrst/drv/psb_intel_dsi.c
@@ -18,6 +18,11 @@
* jim liu <jim.liu@intel.com>
*/
+#define USE_AAVA_VERSION
+#ifdef USE_AAVA_VERSION
+#include "psb_intel_dsi_aava.c"
+#else
+
#include <linux/backlight.h>
#include <drm/drmP.h>
#include <drm/drm.h>
@@ -2448,3 +2453,7 @@ failed_find:
drm_connector_cleanup(connector);
kfree(connector);
}
+
+#endif /* USE_AAVA_VERSION */
+
+
diff --git a/drivers/gpu/drm/mrst/drv/psb_intel_dsi_aava.c b/drivers/gpu/drm/mrst/drv/psb_intel_dsi_aava.c
index 6c21480..9e761c6 100644
--- a/drivers/gpu/drm/mrst/drv/psb_intel_dsi_aava.c
+++ b/drivers/gpu/drm/mrst/drv/psb_intel_dsi_aava.c
@@ -1,32 +1,4 @@
-/*
- * Copyright © 2006-2007 Intel Corporation
- *
- * Permission is hereby granted, free of charge, to any person obtaining a
- * copy of this software and associated documentation files (the "Software"),
- * to deal in the Software without restriction, including without limitation
- * the rights to use, copy, modify, merge, publish, distribute, sublicense,
- * and/or sell copies of the Software, and to permit persons to whom the
- * Software is furnished to do so, subject to the following conditions:
- *
- * The above copyright notice and this permission notice (including the next
- * paragraph) shall be included in all copies or substantial portions of the
- * Software.
- *
- * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
- * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
- * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
- * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
- * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
- * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
- * DEALINGS IN THE SOFTWARE.
- *
- * Authors:
- * jim liu <jim.liu@intel.com>
- */
-
-/* This enables setting backlights on with a delay at startup,
- should be removed after resolving issue with backlights going off
- after setting them on in initial mrst_dsi_set_power call */
+
#define AAVA_BACKLIGHT_HACK
#include <linux/backlight.h>
@@ -34,26 +6,33 @@
#include <drm/drm.h>
#include <drm/drm_crtc.h>
#include <drm/drm_edid.h>
-
#include <asm/ipc_defs.h>
-#ifdef AAVA_BACKLIGHT_HACK
-#include <linux/workqueue.h>
-#endif /* AAVA_BACKLIGHT_HACK */
-
#include "psb_drv.h"
#include "psb_intel_drv.h"
#include "psb_intel_reg.h"
#include "ospm_power.h"
-#define DRM_MODE_ENCODER_MIPI 5
+#ifdef AAVA_BACKLIGHT_HACK
+#include <linux/workqueue.h>
+#endif /* AAVA_BACKLIGHT_HACK */
-//#define DBG_PRINTS 1
-#define DBG_PRINTS 0
+/* Debug trace definitions */
+#define DBG_LEVEL 1
-#define NEW_CRAP_SAMPLE_SETTINGS
+#if (DBG_LEVEL > 0)
+#define DBG_TRACE(format,args...) printk(KERN_ERR "%s: " format "\n", \
+ __FUNCTION__ , ## args)
+#else
+#define DBG_TRACE(format,args...)
+#endif
+
+#define DBG_ERR(format,args...) printk(KERN_ERR "%s: " format "\n", \
+ __FUNCTION__ , ## args)
-#define AAVA_EV_0_5
+#define BRIGHTNESS_MAX_LEVEL 100
+
+#define DRM_MODE_ENCODER_MIPI 5
#define VSIZE 480
#define HSIZE 864
@@ -84,686 +63,633 @@
#define DISP_VSYNC_START (DISP_VBLANK_START + VFP_LINES - 1)
#define DISP_VSYNC_END (DISP_VSYNC_START + VSYNC_LINES - 1)
-#define BRIGHTNESS_MAX_LEVEL 100
+#define MAX_FIFO_WAIT_MS 100
static unsigned int dphy_reg = 0x0d0a7f06;
static unsigned int mipi_clock = 0x2;
#ifdef AAVA_BACKLIGHT_HACK
-static void bl_work_handler(struct work_struct *work);
-DECLARE_DELAYED_WORK(bl_work, bl_work_handler);
+static void dsi_bl_work_handler(struct work_struct *work);
+DECLARE_DELAYED_WORK(bl_work, dsi_bl_work_handler);
#endif /* AAVA_BACKLIGHT_HACK */
// Temporary access from sysfs begin
-static struct drm_encoder *orig_encoder;
-static void mrst_dsi_prepare(struct drm_encoder *encoder);
-static void mrst_dsi_commit(struct drm_encoder *encoder);
-static void mrst_dsi_mode_set(struct drm_encoder *encoder,
- struct drm_display_mode *mode,
- struct drm_display_mode *adjusted_mode);
-static void panel_reset(void);
-
-static ssize_t dphy_store(struct class *class, const char *buf, size_t len)
+static struct drm_device *test_dev;
+// Temporary access from sysfs end
+
+
+static int dsi_wait_hs_data_fifo(struct drm_device *dev)
{
- ssize_t status;
- unsigned long value;
+ int fifo_wait_time = 0;
- status = strict_strtoul(buf, 16, &value);
- dphy_reg = value;
- printk("!!! dphy_reg = %x, clock = %x\n", dphy_reg, mipi_clock);
+ while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
+ HS_DATA_FIFO_FULL) {
+ if (fifo_wait_time == MAX_FIFO_WAIT_MS) {
+ DBG_ERR("timeout");
+ return -1;
+ }
+ udelay(1000);
+ fifo_wait_time++;
+ }
+ return 0;
+}
- return len;
+static int dsi_wait_hs_ctrl_fifo(struct drm_device *dev)
+{
+ int fifo_wait_time = 0;
+
+ while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
+ HS_CTRL_FIFO_FULL) {
+ if (fifo_wait_time == MAX_FIFO_WAIT_MS) {
+ DBG_ERR("timeout");
+ return -1;
+ }
+ udelay(1000);
+ fifo_wait_time++;
+ }
+ return 0;
}
-static ssize_t clock_store(struct class *class, const char *buf, size_t len)
+static void dsi_set_backlight_state(int state)
{
- ssize_t status;
- unsigned long value;
+ struct ipc_pmic_reg_data tmp_reg;
- status = strict_strtoul(buf, 0, &value);
- mipi_clock = value;
- printk("!!! dphy_reg = %x, clock = %x\n", dphy_reg, mipi_clock);
+ DBG_TRACE("%d", state);
- return len;
+ tmp_reg.ioc = 1;
+ tmp_reg.num_entries = 2;
+ tmp_reg.pmic_reg_data[0].register_address = 0x2a;
+ tmp_reg.pmic_reg_data[1].register_address = 0x28;
+
+ if (state) {
+ tmp_reg.pmic_reg_data[0].value = 0xaa;
+ tmp_reg.pmic_reg_data[1].value = 0x30;
+ } else {
+ tmp_reg.pmic_reg_data[0].value = 0x00;
+ tmp_reg.pmic_reg_data[1].value = 0x00;
+ }
+
+ if (ipc_pmic_register_write(&tmp_reg, TRUE))
+ DBG_ERR("pmic reg write failed");
}
-static ssize_t apply_settings(struct class *class, const char *buf, size_t len)
+
+#ifdef AAVA_BACKLIGHT_HACK
+static void dsi_bl_work_handler(struct work_struct *work)
{
- ssize_t status;
- long value;
+ DBG_TRACE("");
+ dsi_set_backlight_state(1);
+}
+#endif /* AAVA_BACKLIGHT_HACK */
- printk("!!! dphy_reg = %x, clock = %x\n", dphy_reg, mipi_clock);
- status = strict_strtoul(buf, 0, &value);
- if (value > 0) {
- mrst_dsi_prepare(orig_encoder);
- msleep(500);
- if (value > 1) {
- panel_reset();
- msleep(500);
- }
- mrst_dsi_mode_set(orig_encoder, NULL, NULL);
- msleep(500);
- mrst_dsi_commit(orig_encoder);
+static void dsi_set_panel_reset_state(int state)
+{
+ struct ipc_pmic_reg_data tmp_reg = {0};
+
+ DBG_TRACE("%d", state);
+
+ tmp_reg.ioc = 1;
+ tmp_reg.num_entries = 1;
+ tmp_reg.pmic_reg_data[0].register_address = 0xe6;
+
+ if (state)
+ tmp_reg.pmic_reg_data[0].value = 0x01;
+ else
+ tmp_reg.pmic_reg_data[0].value = 0x09;
+
+ if (ipc_pmic_register_write(&tmp_reg, TRUE)) {
+ DBG_ERR("pmic reg write failed");
+ return;
}
- return len;
+ if (state) {
+ /* Minimum active time to trigger reset is 10us */
+ udelay(10);
+ } else {
+ /* Maximum startup time from reset is 120ms */
+ msleep(120);
+ }
}
-// Temporary access from sysfs end
-static void panel_init(struct drm_device *dev)
+
+static void dsi_init_panel(struct drm_device *dev)
{
-#if DBG_PRINTS
- printk("panel_init\n");
-#endif /* DBG_PRINTS */
+ DBG_TRACE("");
- /* Flip page order */
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
+ /* Flip page order to have correct image orientation */
+ if (dsi_wait_hs_data_fifo(dev) < 0)
+ return;
REG_WRITE(0xb068, 0x00008036);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
+ if (dsi_wait_hs_ctrl_fifo(dev) < 0)
+ return;
REG_WRITE(0xb070, 0x00000229);
-#ifdef NEW_CRAP_SAMPLE_SETTINGS
- // 0xF0, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x005a5af0);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
+ /* Write protection key to allow DM bit setting */
+ if (dsi_wait_hs_data_fifo(dev) < 0)
+ return;
+ REG_WRITE(0xb068, 0x005a5af1);
+ if (dsi_wait_hs_ctrl_fifo(dev) < 0)
+ return;
REG_WRITE(0xb070, 0x00000329);
-#endif
- /* Write protection key */
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x005a5af1);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
+ /* Set DM bit to enable video mode */
+ if (dsi_wait_hs_data_fifo(dev) < 0)
+ return;
+ REG_WRITE(0xb068, 0x000100f7);
+ if (dsi_wait_hs_ctrl_fifo(dev) < 0)
+ return;
REG_WRITE(0xb070, 0x00000329);
-#ifdef NEW_CRAP_SAMPLE_SETTINGS
- // 0xFC, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
+ /* Write protection keys to allow TCON setting */
+ if (dsi_wait_hs_data_fifo(dev) < 0)
+ return;
+ REG_WRITE(0xb068, 0x005a5af0);
+ if (dsi_wait_hs_ctrl_fifo(dev) < 0)
+ return;
+ REG_WRITE(0xb070, 0x00000329);
+
+ if (dsi_wait_hs_data_fifo(dev) < 0)
+ return;
REG_WRITE(0xb068, 0x005a5afc);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
+ if (dsi_wait_hs_ctrl_fifo(dev) < 0)
+ return;
REG_WRITE(0xb070, 0x00000329);
- // 0xB7, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
-#ifdef DOES_NOT_WORK
- /* Suggested by TPO, doesn't work as usual */
+ /* Write TCON setting */
+ if (dsi_wait_hs_data_fifo(dev) < 0)
+ return;
+#if 0
+ /* Suggested by TPO, doesn't work */
REG_WRITE(0xb068, 0x110000b7);
REG_WRITE(0xb068, 0x00000044);
#else
REG_WRITE(0xb068, 0x770000b7);
REG_WRITE(0xb068, 0x00000044);
#endif
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
+ if (dsi_wait_hs_ctrl_fifo(dev) < 0)
+ return;
REG_WRITE(0xb070, 0x00000529);
+}
- // 0xB6, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x000a0ab6);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00000329);
- // 0xF2, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x081010f2);
- REG_WRITE(0xb068, 0x4a070708);
- REG_WRITE(0xb068, 0x000000c5);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00000929);
+static void dsi_set_ptarget_state(struct drm_device *dev, int state)
+{
+ u32 pp_sts_reg;
- // 0xF8, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x024003f8);
- REG_WRITE(0xb068, 0x01030a04);
- REG_WRITE(0xb068, 0x0e020220);
- REG_WRITE(0xb068, 0x00000004);
+ DBG_TRACE("%d", state);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00000d29);
+ if (state) {
+ REG_WRITE(PP_CONTROL, (REG_READ(PP_CONTROL) | POWER_TARGET_ON));
+ do {
+ pp_sts_reg = REG_READ(PP_STATUS);
+ } while ((pp_sts_reg & (PP_ON | PP_READY)) == PP_READY);
+ } else {
+ REG_WRITE(PP_CONTROL,
+ (REG_READ(PP_CONTROL) & ~POWER_TARGET_ON));
+ do {
+ pp_sts_reg = REG_READ(PP_STATUS);
+ } while (pp_sts_reg & PP_ON);
+ }
+}
- // 0xE2, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x398fc3e2);
- REG_WRITE(0xb068, 0x0000916f);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00000629);
-#ifdef DOES_NOT_WORK
- /* Suggested by TPO, doesn't work as usual */
- // 0xE3, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x20f684e3);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00000429);
+static void dsi_send_turn_on_packet(struct drm_device *dev)
+{
+ DBG_TRACE("");
- msleep(50);
-#endif
+ REG_WRITE(DPI_CONTROL_REG, DPI_TURN_ON);
- // 0xB0, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x000000b0);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00000229);
+ /* Short delay to wait that display turns on */
+ msleep(10);
+}
- // 0xF4, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x240242f4);
- REG_WRITE(0xb068, 0x78ee2002);
- REG_WRITE(0xb068, 0x2a071050);
- REG_WRITE(0xb068, 0x507fee10);
- REG_WRITE(0xb068, 0x10300710);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00001429);
- // 0xBA, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x19fe07ba);
- REG_WRITE(0xb068, 0x101c0a31);
- REG_WRITE(0xb068, 0x00000010);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00000929);
+static void dsi_send_shutdown_packet(struct drm_device *dev)
+{
+ DBG_TRACE("");
- // 0xBB, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x28ff07bb);
- REG_WRITE(0xb068, 0x24280a31);
- REG_WRITE(0xb068, 0x00000034);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00000929);
+ REG_WRITE(DPI_CONTROL_REG, DPI_SHUT_DOWN);
+}
- // 0xFB, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x535d05fb);
- REG_WRITE(0xb068, 0x1b1a2130);
- REG_WRITE(0xb068, 0x221e180e);
- REG_WRITE(0xb068, 0x131d2120);
- REG_WRITE(0xb068, 0x535d0508);
- REG_WRITE(0xb068, 0x1c1a2131);
- REG_WRITE(0xb068, 0x231f160d);
- REG_WRITE(0xb068, 0x111b2220);
- REG_WRITE(0xb068, 0x535c2008);
- REG_WRITE(0xb068, 0x1f1d2433);
- REG_WRITE(0xb068, 0x2c251a10);
- REG_WRITE(0xb068, 0x2c34372d);
- REG_WRITE(0xb068, 0x00000023);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00003129);
- // 0xFA, for new crap displays
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x525c0bfa);
- REG_WRITE(0xb068, 0x1c1c232f);
- REG_WRITE(0xb068, 0x2623190e);
- REG_WRITE(0xb068, 0x18212625);
- REG_WRITE(0xb068, 0x545d0d0e);
- REG_WRITE(0xb068, 0x1e1d2333);
- REG_WRITE(0xb068, 0x26231a10);
- REG_WRITE(0xb068, 0x1a222725);
- REG_WRITE(0xb068, 0x545d280f);
- REG_WRITE(0xb068, 0x21202635);
- REG_WRITE(0xb068, 0x31292013);
- REG_WRITE(0xb068, 0x31393d33);
- REG_WRITE(0xb068, 0x00000029);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00003129);
-#endif
+static void dsi_set_pipe_plane_enable_state(struct drm_device *dev, int state)
+{
+ u32 temp_reg;
- /* Set DM */
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_DATA_FIFO_FULL) ==
- HS_DATA_FIFO_FULL);
- REG_WRITE(0xb068, 0x000100f7);
- while ((REG_READ(GEN_FIFO_STAT_REG) & HS_CTRL_FIFO_FULL) ==
- HS_CTRL_FIFO_FULL);
- REG_WRITE(0xb070, 0x00000329);
-}
+ DBG_TRACE("%d", state);
+ if (state) {
+ /* Enable pipe */
+ temp_reg = REG_READ(PIPEACONF);
+ temp_reg |= (PIPEACONF_ENABLE);
+ REG_WRITE(PIPEACONF, temp_reg);
+ temp_reg = REG_READ(PIPEACONF);
-static void panel_reset_on(void)
-{
- struct ipc_pmic_reg_data tmp_reg = {0};
-#if DBG_PRINTS
- printk("panel_reset_on\n");
-#endif /* DBG_PRINTS */
- tmp_reg.ioc = 1;
- tmp_reg.num_entries = 1;
-#ifdef AAVA_EV_0_5
- tmp_reg.pmic_reg_data[0].register_address = 0xe6;
- tmp_reg.pmic_reg_data[0].value = 0x01;
-#else /* CDK */
- tmp_reg.pmic_reg_data[0].register_address = 0xf4;
- if (ipc_pmic_register_read(&tmp_reg)) {
- printk("panel_reset_on: failed to read pmic reg 0xf4!\n");
- return;
- }
- tmp_reg.pmic_reg_data[0].value &= 0xbf;
-#endif /* AAVA_EV_0_5 */
- if (ipc_pmic_register_write(&tmp_reg, TRUE)) {
- printk("panel_reset_on: failed to write pmic reg 0xe6!\n");
- }
-}
+ /* Wait for 20ms for the pipe enable to take effect. */
+ msleep(20);
+ /* Enable plane */
+ temp_reg = REG_READ(DSPACNTR);
+ temp_reg |= (DISPLAY_PLANE_ENABLE);
+ REG_WRITE(DSPACNTR, temp_reg);
+ temp_reg = REG_READ(DSPACNTR);
-static void panel_reset_off(void)
-{
- struct ipc_pmic_reg_data tmp_reg = {0};
-#if DBG_PRINTS
- printk("panel_reset_off\n");
-#endif /* DBG_PRINTS */
- tmp_reg.ioc = 1;
- tmp_reg.num_entries = 1;
-#ifdef AAVA_EV_0_5
- tmp_reg.pmic_reg_data[0].register_address = 0xe6;
- tmp_reg.pmic_reg_data[0].value = 0x09;
-#else /* CDK */
- tmp_reg.pmic_reg_data[0].register_address = 0xf4;
- if (ipc_pmic_register_read(&tmp_reg)) {
- printk("panel_reset_off: failed to read pmic reg 0xf4!\n");
- return;
- }
- tmp_reg.pmic_reg_data[0].value |= 0x40;
-#endif /* AAVA_EV_0_5 */
- if (ipc_pmic_register_write(&tmp_reg, TRUE)) {
- printk("panel_reset_off: failed to write pmic reg 0xe6!\n");
+ /* Flush plane change by read/write/read of BASE reg */
+ temp_reg = REG_READ(MRST_DSPABASE);
+ REG_WRITE(MRST_DSPABASE, temp_reg);
+ temp_reg = REG_READ(MRST_DSPABASE);
+
+ /* Wait for 20ms for the plane enable to take effect. */
+ msleep(20);
+ } else {
+ /* Disable plane */
+ temp_reg = REG_READ(DSPACNTR);
+ temp_reg &= ~(DISPLAY_PLANE_ENABLE);
+ REG_WRITE(DSPACNTR, temp_reg);
+ temp_reg = REG_READ(DSPACNTR);
+
+ /* Flush plane change by read/write/read of BASE reg */
+ temp_reg = REG_READ(MRST_DSPABASE);
+ REG_WRITE(MRST_DSPABASE, temp_reg);
+ temp_reg = REG_READ(MRST_DSPABASE);
+
+ /* Wait for 20ms for the plane disable to take effect. */
+ msleep(20);
+
+ /* Disable pipe */
+ temp_reg = REG_READ(PIPEACONF);
+ temp_reg &= ~(PIPEACONF_ENABLE);
+ REG_WRITE(PIPEACONF, temp_reg);
+ temp_reg = REG_READ(PIPEACONF);
+
+ /* Wait for 20ms for the pipe disable to take effect. */
+ msleep(20);
}
}
-static void panel_reset(void)
+static void dsi_set_device_ready_state(struct drm_device *dev, int state)
{
-#if DBG_PRINTS
- printk("panel_reset\n");
-#endif /* DBG_PRINTS */
-
- panel_reset_on();
- msleep(20);
- panel_reset_off();
- msleep(20);
+ DBG_TRACE("%d", state);
+
+ if (state)
+ REG_WRITE(DEVICE_READY_REG, 0x00000001);
+ else
+ REG_WRITE(DEVICE_READY_REG, 0x00000000);
}
-static void backlight_state(bool on)
+static void dsi_configure_mipi_block(struct drm_device *dev)
{
- struct ipc_pmic_reg_data tmp_reg;
+ DRM_DRIVER_PRIVATE_T *dev_priv = dev->dev_private;
+ u32 color_format = (RGB_888_FMT << FMT_DPI_POS);
+ u32 res = 0;
-#if DBG_PRINTS
- printk("backlight_state\n");
-#endif /* DBG_PRINTS */
+ DBG_TRACE("");
- tmp_reg.ioc = 1;
- tmp_reg.num_entries = 2;
- tmp_reg.pmic_reg_data[0].register_address = 0x2a;
- tmp_reg.pmic_reg_data[1].register_address = 0x28;
+ /* MIPI clock ratio 1:1 */
+ //REG_WRITE(MIPI_CONTROL_REG, 0x00000018);
+ //REG_WRITE(0xb080, 0x0b061a02);
- if( on ) {
-#if DBG_PRINTS
- printk("backlight_state: ON\n");
-#endif /* DBG_PRINTS */
- tmp_reg.pmic_reg_data[0].value = 0xaa;
-#ifdef AAVA_EV_0_5
- tmp_reg.pmic_reg_data[1].value = 0x30;
-#else /* CDK */
- tmp_reg.pmic_reg_data[1].value = 0x60;
-#endif /* AAVA_EV_0_5 */
- } else {
-#if DBG_PRINTS
- printk("backlight_state: OFF\n");
-#endif /* DBG_PRINTS */
- tmp_reg.pmic_reg_data[0].value = 0x00;
- tmp_reg.pmic_reg_data[1].value = 0x00;
- }
+ /* MIPI clock ratio 2:1 */
+ //REG_WRITE(MIPI_CONTROL_REG, 0x00000019);
+ //REG_WRITE(0xb080, 0x3f1f1c04);
- if (ipc_pmic_register_write(&tmp_reg, TRUE)) {
- printk("backlight_state: failed to write pmic regs 0x2a and 0x28!\n");
- }
-}
+ /* MIPI clock ratio 3:1 */
+ //REG_WRITE(MIPI_CONTROL_REG, 0x0000001a);
+ //REG_WRITE(0xb080, 0x091f7f08);
-#ifdef AAVA_BACKLIGHT_HACK
-static void bl_work_handler(struct work_struct *work)
-{
- backlight_state(true);
+ /* MIPI clock ratio 4:1 */
+ REG_WRITE(MIPI_CONTROL_REG, (0x00000018 | mipi_clock));
+ REG_WRITE(0xb080, dphy_reg);
+
+ /* Enable all interrupts */
+ REG_WRITE(INTR_EN_REG, 0xffffffff);
+
+ REG_WRITE(TURN_AROUND_TIMEOUT_REG, 0x0000000A);
+ REG_WRITE(DEVICE_RESET_REG, 0x000000ff);
+ REG_WRITE(INIT_COUNT_REG, 0x00000fff);
+ REG_WRITE(HS_TX_TIMEOUT_REG, 0x90000);
+ REG_WRITE(LP_RX_TIMEOUT_REG, 0xffff);
+ REG_WRITE(HIGH_LOW_SWITCH_COUNT_REG, 0x46);
+ REG_WRITE(EOT_DISABLE_REG, 0x00000000);
+ REG_WRITE(LP_BYTECLK_REG, 0x00000004);
+
+ REG_WRITE(VIDEO_FMT_REG, dev_priv->videoModeFormat);
+
+ REG_WRITE(DSI_FUNC_PRG_REG, (dev_priv->laneCount | color_format));
+
+ res = dev_priv->HactiveArea | (dev_priv->VactiveArea << RES_V_POS);
+ REG_WRITE(DPI_RESOLUTION_REG, res);
+
+ REG_WRITE(VERT_SYNC_PAD_COUNT_REG, dev_priv->VsyncWidth);
+ REG_WRITE(VERT_BACK_PORCH_COUNT_REG, dev_priv->VbackPorch);
+ REG_WRITE(VERT_FRONT_PORCH_COUNT_REG, dev_priv->VfrontPorch);
+
+ REG_WRITE(HORIZ_SYNC_PAD_COUNT_REG, dev_priv->HsyncWidth);
+ REG_WRITE(HORIZ_BACK_PORCH_COUNT_REG, dev_priv->HbackPorch);
+ REG_WRITE(HORIZ_FRONT_PORCH_COUNT_REG, dev_priv->HfrontPorch);
+ REG_WRITE(HORIZ_ACTIVE_AREA_COUNT_REG, MIPI_HACT);
+
+ /* Enable MIPI Port */
+ REG_WRITE(MIPI, MIPI_PORT_EN);
}
-#endif /* AAVA_BACKLIGHT_HACK */
-/**
- * Sets the power state for the panel.
- */
-static void mrst_dsi_set_power(struct drm_device *dev,
- struct psb_intel_output *output, bool on)
+static void dsi_configure_down(struct drm_device *dev)
{
DRM_DRIVER_PRIVATE_T *dev_priv = dev->dev_private;
- u32 pp_status;
-#if DBG_PRINTS
- printk("mrst_dsi_set_power\n");
-#endif /* DBG_PRINTS */
+ DBG_TRACE("");
- /*
- * The DIS device must be ready before we can change power state.
- */
- if (!dev_priv->dsi_device_ready)
- {
-#if DBG_PRINTS
- printk("mrst_dsi_set_power: !dev_priv->dsi_device_ready!\n");
-#endif /* DBG_PRINTS */
+ if (!dev_priv->dpi_panel_on) {
+ DBG_TRACE("already off");
return;
}
- /*
- * We don't support dual DSI yet. May be in POR in the future.
+ /* Disable backlight */
+ dsi_set_backlight_state(0);
+
+ /* Disable pipe and plane */
+ dsi_set_pipe_plane_enable_state(dev, 0);
+
+ /* Disable PTARGET */
+ dsi_set_ptarget_state(dev, 0);
+
+ /* Send shutdown command, can only be sent if
+ * interface is configured
*/
- if (dev_priv->dual_display)
- {
-#if DBG_PRINTS
- printk("mrst_dsi_set_power: dev_priv->dual_display!\n");
-#endif /* DBG_PRINTS */
- return;
- }
+ if (dev_priv->dsi_device_ready)
+ dsi_send_shutdown_packet(dev);
- if (!ospm_power_using_hw_begin(OSPM_DISPLAY_ISLAND,
- OSPM_UHB_FORCE_POWER_ON))
- return;
+ /* Clear device ready state */
+ dsi_set_device_ready_state(dev, 0);
- if (on) {
-#if DBG_PRINTS
- printk("mrst_dsi_set_power: on\n");
-#endif /* DBG_PRINTS */
- if (dev_priv->dpi && !dev_priv->dpi_panel_on) {
-#if DBG_PRINTS
- printk("mrst_dsi_set_power: dpi\n");
-#endif /* DBG_PRINTS */
- REG_WRITE(DPI_CONTROL_REG, DPI_TURN_ON);
- REG_WRITE(PP_CONTROL,
- (REG_READ(PP_CONTROL) | POWER_TARGET_ON));
- do {
- pp_status = REG_READ(PP_STATUS);
- } while ((pp_status & (PP_ON | PP_READY)) == PP_READY);
-
- /* Run TPO display specific initialisations */
-// MiKo TBD, this delay may need to be tuned
- msleep(50);
- panel_init(dev);
-
- /* Set backlights on */
- backlight_state( true );
- dev_priv->dpi_panel_on = true;
- }
- } else {
-#if DBG_PRINTS
- printk("mrst_dsi_set_power: off\n");
-#endif /* DBG_PRINTS */
- if (dev_priv->dpi && dev_priv->dpi_panel_on) {
-#if DBG_PRINTS
- printk("mrst_dsi_set_power: dpi\n");
-#endif /* DBG_PRINTS */
- /* Set backlights off */
- backlight_state( false );
-
-// MiKo TBD, something clever could be done here to save power, for example:
-// -Set display to sleep mode, or
-// -Set display to HW reset, or
-// -Shutdown the voltages to display
-
- REG_WRITE(PP_CONTROL,
- (REG_READ(PP_CONTROL) & ~POWER_TARGET_ON));
- do {
- pp_status = REG_READ(PP_STATUS);
- } while (pp_status & PP_ON);
-
- REG_WRITE(DPI_CONTROL_REG, DPI_SHUT_DOWN);
-
- dev_priv->dpi_panel_on = false;
- }
- }
+ /* Set panel to reset */
+ dsi_set_panel_reset_state(1);
- ospm_power_using_hw_end(OSPM_DISPLAY_ISLAND);
+ dev_priv->dpi_panel_on = false;
}
-static void mrst_dsi_dpms(struct drm_encoder *encoder, int mode)
+static void dsi_configure_up(struct drm_device *dev)
{
- struct drm_device *dev = encoder->dev;
- struct psb_intel_output *output = enc_to_psb_intel_output(encoder);
+ DRM_DRIVER_PRIVATE_T *dev_priv = dev->dev_private;
-#if DBG_PRINTS
- printk("mrst_dsi_dpms\n");
-#endif /* DBG_PRINTS */
+ DBG_TRACE("");
- if (mode == DRM_MODE_DPMS_ON)
- mrst_dsi_set_power(dev, output, true);
- else
- mrst_dsi_set_power(dev, output, false);
+ if (dev_priv->dpi_panel_on) {
+ DBG_TRACE("already on");
+ return;
+ }
+
+ /* Get panel from reset */
+ dsi_set_panel_reset_state(0);
+
+ /* Set device ready state */
+ dsi_set_device_ready_state(dev, 1);
+
+ /* Send turn on command */
+ dsi_send_turn_on_packet(dev);
+
+ /* Enable PTARGET */
+ dsi_set_ptarget_state(dev, 1);
+
+ /* Initialize panel */
+ dsi_init_panel(dev);
+
+ /* Enable plane and pipe */
+ dsi_set_pipe_plane_enable_state(dev, 1);
+
+ /* Enable backlight */
+ dsi_set_backlight_state(1);
+
+ dev_priv->dpi_panel_on = true;
}
-static void mrst_dsi_save(struct drm_connector *connector)
+static void dsi_init_drv_ic(struct drm_device *dev)
{
-#if DBG_PRINTS
- printk("mrst_dsi_save\n");
-#endif /* DBG_PRINTS */
- // MiKo TBD
+ DBG_TRACE("");
}
-static void mrst_dsi_restore(struct drm_connector *connector)
+static void dsi_schedule_work(struct drm_device *dev)
{
-#if DBG_PRINTS
- printk("mrst_dsi_restore\n");
-#endif /* DBG_PRINTS */
- // MiKo TBD
+ DRM_DRIVER_PRIVATE_T *dev_priv = dev->dev_private;
+
+ DBG_TRACE("");
+
+ schedule_work(&dev_priv->dsi_work);
}
-static void mrst_dsi_prepare(struct drm_encoder *encoder)
+static void dsi_work_handler(struct work_struct *work)
{
- struct drm_device *dev = encoder->dev;
- struct psb_intel_output *output = enc_to_psb_intel_output(encoder);
+ struct drm_psb_private *dev_priv = container_of(work,
+ struct drm_psb_private, dsi_work);
-#if DBG_PRINTS
- printk("mrst_dsi_prepare\n");
-#endif /* DBG_PRINTS */
+ DBG_TRACE("");
- if (!ospm_power_using_hw_begin(OSPM_DISPLAY_ISLAND,
- OSPM_UHB_FORCE_POWER_ON))
- return;
+ dsi_configure_up(dev_priv->dev);
+}
- mrst_dsi_set_power(dev, output, false);
- ospm_power_using_hw_end(OSPM_DISPLAY_ISLAND);
+static void dsi_init_mipi_config(DRM_DRIVER_PRIVATE_T *dev_priv)
+{
+ DBG_TRACE("");
+
+ /* Fixed values for TPO display */
+ dev_priv->pixelClock = 33264;
+ dev_priv->HsyncWidth = MIPI_HSPAD;
+ dev_priv->HbackPorch = MIPI_HBP;
+ dev_priv->HfrontPorch = MIPI_HFP;
+ dev_priv->HactiveArea = HSIZE;
+ dev_priv->VsyncWidth = MIPI_VSPAD;
+ dev_priv->VbackPorch = MIPI_VBP;
+ dev_priv->VfrontPorch = MIPI_VFP;
+ dev_priv->VactiveArea = VSIZE;
+ dev_priv->bpp = 24;
+
+ /* video mode */
+ dev_priv->dpi = true;
+
+ /* Set this true since firmware or kboot has enabled display */
+ dev_priv->dpi_panel_on = true;
+
+ /* Set this false to ensure proper initial configuration */
+ dev_priv->dsi_device_ready = false;
+
+ /* 2 lanes */
+ dev_priv->laneCount = MIPI_LANES;
+
+ /* Burst mode */
+ dev_priv->videoModeFormat = BURST_MODE;
+
+ dev_priv->init_drvIC = dsi_init_drv_ic;
+ dev_priv->dsi_prePowerState = dsi_configure_down;
+ dev_priv->dsi_postPowerState = dsi_schedule_work;
}
-static void mrst_dsi_commit(struct drm_encoder *encoder)
+static struct drm_display_mode *dsi_get_fixed_display_mode(void)
{
- struct drm_device *dev = encoder->dev;
- struct psb_intel_output *output = enc_to_psb_intel_output(encoder);
+ struct drm_display_mode *mode;
+
+ DBG_TRACE("");
+
+ mode = kzalloc(sizeof(*mode), GFP_KERNEL);
+ if (!mode) {
+ DBG_ERR("kzalloc failed\n");
+ return NULL;
+ }
+
+ /* Fixed mode for TPO display
+ Note: Using defined values for easier match with ITP scripts
+ and adding 1 since psb_intel_display.c decreases by 1
+ */
+ mode->hdisplay = (DISP_HPIX + 1);
+ mode->vdisplay = (DISP_VPIX + 1);
+ mode->hsync_start = (DISP_HSYNC_START + 1);
+ mode->hsync_end = (DISP_HSYNC_END + 1);
+ mode->htotal = (DISP_HBLANK_END + 1);
+ mode->vsync_start = (DISP_VSYNC_START + 1);
+ mode->vsync_end = (DISP_VSYNC_END + 1);
+ mode->vtotal = (DISP_VBLANK_END + 1);
+ mode->clock = 33264;
-#if DBG_PRINTS
- printk("mrst_dsi_commit\n");
-#endif /* DBG_PRINTS */
+ drm_mode_set_name(mode);
+ drm_mode_set_crtcinfo(mode, 0);
- mrst_dsi_set_power(dev, output, true);
+ return mode;
}
-static void mrst_dsi_mode_set(struct drm_encoder *encoder,
- struct drm_display_mode *mode,
- struct drm_display_mode *adjusted_mode)
+/* Encoder funcs */
+static void dsi_encoder_mode_set(struct drm_encoder *encoder,
+ struct drm_display_mode *mode,
+ struct drm_display_mode *adjusted_mode)
{
struct drm_device *dev = encoder->dev;
DRM_DRIVER_PRIVATE_T *dev_priv = dev->dev_private;
- u32 SupportedFormat = 0;
- u32 resolution = 0;
- uint64_t curValue = DRM_MODE_SCALE_FULLSCREEN;
+ uint64_t scale_mode = DRM_MODE_SCALE_FULLSCREEN;
-#if DBG_PRINTS
- printk("mrst_dsi_mode_set\n");
-#endif /* DBG_PRINTS */
+ DBG_TRACE("");
if (!ospm_power_using_hw_begin(OSPM_DISPLAY_ISLAND,
- OSPM_UHB_FORCE_POWER_ON))
+ OSPM_UHB_FORCE_POWER_ON)) {
+ DBG_ERR("OSPM_DISPLAY_ISLAND OSPM_UHB_FORCE_POWER_ON failed");
return;
+ }
/* Sleep to ensure that the graphics engine is ready
* since its mode_set is called before ours
*/
msleep(100);
- switch (dev_priv->bpp)
- {
- case 24:
- SupportedFormat = RGB_888_FMT;
- break;
- default:
- printk("mrst_dsi_mode_set, invalid bpp!\n");
- break;
- }
-
- if (dev_priv->dpi) {
+ /* Only one mode is supported,
+ * so configure only if not yet configured
+ */
+ if (!dev_priv->dsi_device_ready) {
drm_connector_property_get_value(
&enc_to_psb_intel_output(encoder)->base,
dev->mode_config.scaling_mode_property,
- &curValue);
- if (curValue == DRM_MODE_SCALE_CENTER) {
+ &scale_mode);
+ if (scale_mode == DRM_MODE_SCALE_CENTER)
REG_WRITE(PFIT_CONTROL, 0);
- } else if (curValue == DRM_MODE_SCALE_FULLSCREEN) {
+ else if (scale_mode == DRM_MODE_SCALE_FULLSCREEN)
REG_WRITE(PFIT_CONTROL, PFIT_ENABLE);
- } else {
- printk("mrst_dsi_mode_set, scaling not supported!\n");
+ else {
+ DBG_ERR("unsupported scaling");
REG_WRITE(PFIT_CONTROL, 0);
}
+ dsi_configure_mipi_block(dev);
+ dev_priv->dsi_device_ready = true;
+ }
+ ospm_power_using_hw_end(OSPM_DISPLAY_ISLAND);
+}
- /* MIPI clock ratio 1:1 */
- //REG_WRITE(MIPI_CONTROL_REG, 0x00000018);
- //REG_WRITE(0xb080, 0x0b061a02);
-
- /* MIPI clock ratio 2:1 */
- //REG_WRITE(MIPI_CONTROL_REG, 0x00000019);
- //REG_WRITE(0xb080, 0x3f1f1c04);
- /* MIPI clock ratio 3:1 */
- //REG_WRITE(MIPI_CONTROL_REG, 0x0000001a);
- //REG_WRITE(0xb080, 0x091f7f08);
+static void dsi_encoder_prepare(struct drm_encoder *encoder)
+{
+ struct drm_device *dev = encoder->dev;
- /* MIPI clock ratio 4:1 */
- REG_WRITE(MIPI_CONTROL_REG, (0x00000018 | mipi_clock));
- REG_WRITE(0xb080, dphy_reg);
+ DBG_TRACE("");
- /* Enable all interrupts */
- REG_WRITE(INTR_EN_REG, 0xffffffff);
+ if (!ospm_power_using_hw_begin(OSPM_DISPLAY_ISLAND,
+ OSPM_UHB_FORCE_POWER_ON)) {
+ DBG_ERR("OSPM_DISPLAY_ISLAND OSPM_UHB_FORCE_POWER_ON failed");
+ return;
+ }
- REG_WRITE(TURN_AROUND_TIMEOUT_REG, 0x0000000A);
- REG_WRITE(DEVICE_RESET_REG, 0x000000ff);
- REG_WRITE(INIT_COUNT_REG, 0x00000fff);
- REG_WRITE(HS_TX_TIMEOUT_REG, 0x90000);
- REG_WRITE(LP_RX_TIMEOUT_REG, 0xffff);
- REG_WRITE(HIGH_LOW_SWITCH_COUNT_REG, 0x46);
- REG_WRITE(EOT_DISABLE_REG, 0x00000000);
- REG_WRITE(LP_BYTECLK_REG, 0x00000004);
+ dsi_configure_down(dev);
- REG_WRITE(VIDEO_FMT_REG, dev_priv->videoModeFormat);
+ ospm_power_using_hw_end(OSPM_DISPLAY_ISLAND);
+}
- SupportedFormat <<= FMT_DPI_POS;
- REG_WRITE(DSI_FUNC_PRG_REG,
- (dev_priv->laneCount | SupportedFormat));
- resolution = dev_priv->HactiveArea |
- (dev_priv->VactiveArea << RES_V_POS);
- REG_WRITE(DPI_RESOLUTION_REG, resolution);
+static void dsi_encoder_commit(struct drm_encoder *encoder)
+{
+ struct drm_device *dev = encoder->dev;
+ DRM_DRIVER_PRIVATE_T *dev_priv = dev->dev_private;
- REG_WRITE(VERT_SYNC_PAD_COUNT_REG, dev_priv->VsyncWidth);
- REG_WRITE(VERT_BACK_PORCH_COUNT_REG, dev_priv->VbackPorch);
- REG_WRITE(VERT_FRONT_PORCH_COUNT_REG, dev_priv->VfrontPorch);
+ DBG_TRACE("");
- REG_WRITE(HORIZ_SYNC_PAD_COUNT_REG, dev_priv->HsyncWidth);
- REG_WRITE(HORIZ_BACK_PORCH_COUNT_REG, dev_priv->HbackPorch);
- REG_WRITE(HORIZ_FRONT_PORCH_COUNT_REG, dev_priv->HfrontPorch);
- REG_WRITE(HORIZ_ACTIVE_AREA_COUNT_REG, MIPI_HACT);
+ if (!ospm_power_using_hw_begin(OSPM_DISPLAY_ISLAND,
+ OSPM_UHB_FORCE_POWER_ON)) {
+ DBG_ERR("OSPM_DISPLAY_ISLAND OSPM_UHB_FORCE_POWER_ON failed");
+ return;
}
- /* Enable MIPI Port */
- REG_WRITE(MIPI, MIPI_PORT_EN);
+ if (!work_pending(&dev_priv->dsi_work))
+ dsi_configure_up(dev);
- REG_WRITE(DEVICE_READY_REG, 0x00000001);
- REG_WRITE(DPI_CONTROL_REG, 0x00000002); /* Turn On */
+ ospm_power_using_hw_end(OSPM_DISPLAY_ISLAND);
+}
- dev_priv->dsi_device_ready = true;
- /* Enable pipe */
- REG_WRITE(PIPEACONF, dev_priv->pipeconf);
- REG_READ(PIPEACONF);
+static void dsi_encoder_dpms(struct drm_encoder *encoder, int mode)
+{
+ struct drm_device *dev = encoder->dev;
+ DRM_DRIVER_PRIVATE_T *dev_priv = dev->dev_private;
- /* Wait for 20ms for the pipe enable to take effect. */
- udelay(20000);
+ DBG_TRACE("%s", ((mode == DRM_MODE_DPMS_ON) ? "ON" : "OFF"));
- /* Enable plane */
- REG_WRITE(DSPACNTR, dev_priv->dspcntr);
+ if (!ospm_power_using_hw_begin(OSPM_DISPLAY_ISLAND,
+ OSPM_UHB_FORCE_POWER_ON)) {
+ DBG_ERR("OSPM_DISPLAY_ISLAND OSPM_UHB_FORCE_POWER_ON failed");
+ return;
+ }
- /* Wait for 20ms for the plane enable to take effect. */
- udelay(20000);
+ if (mode == DRM_MODE_DPMS_ON) {
+ if (!work_pending(&dev_priv->dsi_work))
+ dsi_configure_up(dev);
+ } else
+ dsi_configure_down(dev);
ospm_power_using_hw_end(OSPM_DISPLAY_ISLAND);
}
-/**
- * Detect the MIPI connection.
- *
- * This always returns CONNECTOR_STATUS_CONNECTED.
- * This connector should only have
- * been set up if the MIPI was actually connected anyway.
- */
-static enum drm_connector_status mrst_dsi_detect(struct drm_connector
- *connector)
+/* Connector funcs */
+static enum drm_connector_status dsi_connector_detect(struct drm_connector
+ *connector)
{
-#if DBG_PRINTS
- printk("mrst_dsi_detect\n");
-#endif /* DBG_PRINTS */
+ DBG_TRACE("");
return connector_status_connected;
}
-/**
- * Return the list of MIPI DDB modes if available.
- */
-static int mrst_dsi_get_modes(struct drm_connector *connector)
+static int dsi_connector_get_modes(struct drm_connector *connector)
{
struct drm_device *dev = connector->dev;
- struct psb_intel_output *psb_intel_output = to_psb_intel_output(connector);
- struct psb_intel_mode_device *mode_dev = psb_intel_output->mode_dev;
+ struct psb_intel_output *psb_output = to_psb_intel_output(connector);
+ struct psb_intel_mode_device *mode_dev = psb_output->mode_dev;
+ struct drm_display_mode *mode;
+
+ DBG_TRACE("");
/* Didn't get an DDB, so
* Set wide sync ranges so we get all modes
@@ -775,8 +701,7 @@ static int mrst_dsi_get_modes(struct drm_connector *connector)
connector->display_info.max_hfreq = 200;
if (mode_dev->panel_fixed_mode != NULL) {
- struct drm_display_mode *mode =
- drm_mode_duplicate(dev, mode_dev->panel_fixed_mode);
+ mode = drm_mode_duplicate(dev, mode_dev->panel_fixed_mode);
drm_mode_probed_add(connector, mode);
return 1;
}
@@ -784,180 +709,116 @@ static int mrst_dsi_get_modes(struct drm_connector *connector)
}
-static const struct drm_encoder_helper_funcs mrst_dsi_helper_funcs = {
- .dpms = mrst_dsi_dpms,
+static void dsi_connector_save(struct drm_connector *connector)
+{
+ DBG_TRACE("");
+}
+
+
+static void dsi_connector_restore(struct drm_connector *connector)
+{
+ DBG_TRACE("");
+}
+
+
+static const struct drm_encoder_helper_funcs encoder_helper_funcs = {
+ .dpms = dsi_encoder_dpms,
.mode_fixup = psb_intel_lvds_mode_fixup,
- .prepare = mrst_dsi_prepare,
- .mode_set = mrst_dsi_mode_set,
- .commit = mrst_dsi_commit,
+ .prepare = dsi_encoder_prepare,
+ .mode_set = dsi_encoder_mode_set,
+ .commit = dsi_encoder_commit,
};
-
-static const struct drm_connector_helper_funcs
- mrst_dsi_connector_helper_funcs = {
- .get_modes = mrst_dsi_get_modes,
- .mode_valid = psb_intel_lvds_mode_valid,
- .best_encoder = psb_intel_best_encoder,
+static const struct drm_connector_helper_funcs connector_helper_funcs = {
+ .get_modes = dsi_connector_get_modes,
+ .mode_valid = psb_intel_lvds_mode_valid,
+ .best_encoder = psb_intel_best_encoder,
};
-static const struct drm_connector_funcs mrst_dsi_connector_funcs = {
+static const struct drm_connector_funcs connector_funcs = {
.dpms = drm_helper_connector_dpms,
- .save = mrst_dsi_save,
- .restore = mrst_dsi_restore,
- .detect = mrst_dsi_detect,
+ .save = dsi_connector_save,
+ .restore = dsi_connector_restore,
+ .detect = dsi_connector_detect,
.fill_modes = drm_helper_probe_single_connector_modes,
.set_property = psb_intel_lvds_set_property,
.destroy = psb_intel_lvds_destroy,
};
-/** Returns the panel fixed mode from configuration. */
-struct drm_display_mode *mrst_dsi_get_configuration_mode(struct drm_device *dev)
-{
- struct drm_display_mode *mode;
-
- mode = kzalloc(sizeof(*mode), GFP_KERNEL);
- if (!mode)
- return NULL;
-
- /* MiKo, fixed mode for TPO display
- Note: Using defined values for easier match with ITP scripts
- and adding 1 since psb_intel_display.c decreases by 1
- */
- mode->hdisplay = (DISP_HPIX + 1);
- mode->vdisplay = (DISP_VPIX + 1);
- mode->hsync_start = (DISP_HSYNC_START + 1);
- mode->hsync_end = (DISP_HSYNC_END + 1);
- mode->htotal = (DISP_HBLANK_END + 1);
- mode->vsync_start = (DISP_VSYNC_START + 1);
- mode->vsync_end = (DISP_VSYNC_END + 1);
- mode->vtotal = (DISP_VBLANK_END + 1);
- mode->clock = 33264;
-
- drm_mode_set_name(mode);
- drm_mode_set_crtcinfo(mode, 0);
-
- return mode;
-}
-
-
-/* ************************************************************************* *\
-FUNCTION: mrst_mipi_settings_init
- `
-DESCRIPTION:
-
-\* ************************************************************************* */
-static bool mrst_mipi_settings_init(DRM_DRIVER_PRIVATE_T *dev_priv)
-{
- /* MiKo, fixed values for TPO display */
- dev_priv->pixelClock = 33264;
- dev_priv->HsyncWidth = MIPI_HSPAD;
- dev_priv->HbackPorch = MIPI_HBP;
- dev_priv->HfrontPorch = MIPI_HFP;
- dev_priv->HactiveArea = HSIZE;
- dev_priv->VsyncWidth = MIPI_VSPAD;
- dev_priv->VbackPorch = MIPI_VBP;
- dev_priv->VfrontPorch = MIPI_VFP;
- dev_priv->VactiveArea = VSIZE;
- dev_priv->bpp = 24;
-
- /* video mode */
- dev_priv->dpi = true;
-
- /* MiKo, set these true by default to ensure that first mode set is done
- cleanly
- */
- dev_priv->dpi_panel_on = true;
- dev_priv->dsi_device_ready = true;
-
- /* 2 lanes */
- dev_priv->laneCount = MIPI_LANES;
-
- /* Burst mode */
- dev_priv->videoModeFormat = BURST_MODE;
-
- return true;
-}
-
-
-/**
- * mrst_dsi_init - setup MIPI connectors on this device
- * @dev: drm device
- *
- * Create the connector, try to figure out what
- * modes we can display on the MIPI panel (if present).
- */
void mrst_dsi_init(struct drm_device *dev,
- struct psb_intel_mode_device *mode_dev)
+ struct psb_intel_mode_device *mode_dev)
{
DRM_DRIVER_PRIVATE_T *dev_priv = dev->dev_private;
- struct psb_intel_output *psb_intel_output;
+ struct psb_intel_output *psb_output;
struct drm_connector *connector;
struct drm_encoder *encoder;
-#if DBG_PRINTS
- printk("mrst_dsi_init\n");
-#endif /* DBG_PRINTS */
+ DBG_TRACE("");
- psb_intel_output = kzalloc(sizeof(struct psb_intel_output), GFP_KERNEL);
- if (!psb_intel_output)
+ psb_output = kzalloc(sizeof(struct psb_intel_output), GFP_KERNEL);
+ if (!psb_output) {
+ DBG_ERR("kzalloc failed\n");
return;
-
- panel_reset();
+ }
#ifdef AAVA_BACKLIGHT_HACK
schedule_delayed_work(&bl_work, 2*HZ);
#endif /* AAVA_BACKLIGHT_HACK */
- psb_intel_output->mode_dev = mode_dev;
- connector = &psb_intel_output->base;
- encoder = &psb_intel_output->enc;
- drm_connector_init(dev,
- &psb_intel_output->base,
- &mrst_dsi_connector_funcs,
- DRM_MODE_CONNECTOR_MIPI);
-
- drm_encoder_init(dev,
- &psb_intel_output->enc,
- &psb_intel_lvds_enc_funcs,
- DRM_MODE_ENCODER_MIPI);
-
- drm_mode_connector_attach_encoder(&psb_intel_output->base,
- &psb_intel_output->enc);
- psb_intel_output->type = INTEL_OUTPUT_MIPI;
-
- drm_encoder_helper_add(encoder, &mrst_dsi_helper_funcs);
- drm_connector_helper_add(connector, &mrst_dsi_connector_helper_funcs);
+ psb_output->mode_dev = mode_dev;
+ connector = &psb_output->base;
+ encoder = &psb_output->enc;
+ drm_connector_init(dev, &psb_output->base, &connector_funcs,
+ DRM_MODE_CONNECTOR_MIPI);
+
+ drm_encoder_init(dev, &psb_output->enc, &psb_intel_lvds_enc_funcs,
+ DRM_MODE_ENCODER_MIPI);
+
+ drm_mode_connector_attach_encoder(&psb_output->base, &psb_output->enc);
+ psb_output->type = INTEL_OUTPUT_MIPI;
+
+ drm_encoder_helper_add(encoder, &encoder_helper_funcs);
+ drm_connector_helper_add(connector, &connector_helper_funcs);
connector->display_info.subpixel_order = SubPixelHorizontalRGB;
connector->interlace_allowed = false;
connector->doublescan_allowed = false;
drm_connector_attach_property(connector,
- dev->mode_config.scaling_mode_property,
- DRM_MODE_SCALE_FULLSCREEN);
- drm_connector_attach_property(connector,
- dev_priv->backlight_property,
- BRIGHTNESS_MAX_LEVEL);
+ dev->mode_config.scaling_mode_property,
+ DRM_MODE_SCALE_FULLSCREEN);
+ drm_connector_attach_property(connector, dev_priv->backlight_property,
+ BRIGHTNESS_MAX_LEVEL);
- if (!mrst_mipi_settings_init(dev_priv))
- printk("Can't initialize MIPI settings\n");
+ mode_dev->panel_wants_dither = false;
+
+ dsi_init_mipi_config(dev_priv);
/* No config phase */
dev_priv->config_phase = false;
/* Get the fixed mode */
- mode_dev->panel_fixed_mode = mrst_dsi_get_configuration_mode(dev);
- if (mode_dev->panel_fixed_mode) {
+ mode_dev->panel_fixed_mode = dsi_get_fixed_display_mode();
+ if (mode_dev->panel_fixed_mode)
mode_dev->panel_fixed_mode->type |= DRM_MODE_TYPE_PREFERRED;
- } else {
- printk("Found no modes for MIPI!\n");
+ else {
+ DBG_ERR("Fixed mode not available!\n");
goto failed_find;
}
+
+ /* Set this true since we enable/disable plane and pipe */
+ dev_priv->dsi_plane_pipe_control = true;
+
+ drm_sysfs_connector_add(connector);
+
+ /* Initialize work queue */
+ INIT_WORK(&dev_priv->dsi_work, dsi_work_handler);
+
// Temporary access from sysfs begin
- orig_encoder = encoder;
+ test_dev = dev;
// Temporary access from sysfs end
- drm_sysfs_connector_add(connector);
+
return;
failed_find:
@@ -966,31 +827,140 @@ failed_find:
kfree(connector);
}
+
// Temporary access from sysfs begin
-static struct class_attribute miko_class_attrs[] = {
- __ATTR(dphy, 0644, NULL, dphy_store),
- __ATTR(clock, 0644, NULL, clock_store),
- __ATTR(apply, 0200, NULL, apply_settings),
+static ssize_t dsi_run_test(struct class *class, const char *buf, size_t len)
+{
+ struct drm_device *dev = test_dev;
+ ssize_t status;
+ long test_id;
+ int i;
+
+ status = strict_strtoul(buf, 0, &test_id);
+
+ DBG_TRACE("test_id %li", test_id);
+
+ switch(test_id) {
+ case 1:
+ /* BL on */
+ dsi_set_backlight_state(1);
+ break;
+ case 2:
+ /* BL off */
+ dsi_set_backlight_state(0);
+ break;
+ case 3:
+ /* Reset off */
+ dsi_set_panel_reset_state(0);
+ break;
+ case 4:
+ /* Reset on */
+ dsi_set_panel_reset_state(1);
+ break;
+ case 5:
+ /* Set device ready state */
+ dsi_set_device_ready_state(dev, 1);
+ break;
+ case 6:
+ /* Clear device ready state */
+ dsi_set_device_ready_state(dev, 0);
+ break;
+ case 7:
+ /* Send turn on command */
+ dsi_send_turn_on_packet(dev);
+ break;
+ case 8:
+ /* Send shutdown command */
+ dsi_send_shutdown_packet(dev);
+ break;
+ case 9:
+ /* Enable PTARGET */
+ dsi_set_ptarget_state(dev, 1);
+ break;
+ case 10:
+ /* Disable PTARGET */
+ dsi_set_ptarget_state(dev, 0);
+ break;
+ case 11:
+ /* Initialize panel */
+ dsi_init_panel(dev);
+ break;
+ case 12:
+ /* Enable plane and pipe */
+ dsi_set_pipe_plane_enable_state(dev, 1);
+ break;
+ case 13:
+ /* Disable plane and pipe */
+ dsi_set_pipe_plane_enable_state(dev, 0);
+ break;
+ case 14:
+ /* configure up */
+ dsi_configure_up(dev);
+ break;
+ case 15:
+ /* configure down */
+ dsi_configure_down(dev);
+ break;
+ case 16:
+ /* Draw pixels */
+ for (i = 0 ; i < (864*40) ; i++) {
+ if (dsi_wait_hs_data_fifo(dev) < 0)
+ break;
+ if (i == 0)
+ REG_WRITE(0xb068, 0x0f0f0f2c);
+ else
+ REG_WRITE(0xb068, 0x0f0f0f3c);
+ if (dsi_wait_hs_ctrl_fifo(dev) < 0)
+ break;
+ REG_WRITE(0xb070, 0x00000429);
+ }
+ case 17:
+ /* Sleep out command */
+ if (dsi_wait_hs_data_fifo(dev) < 0)
+ break;
+ REG_WRITE(0xb068, 0x00000011);
+ if (dsi_wait_hs_ctrl_fifo(dev) < 0)
+ break;
+ REG_WRITE(0xb070, 0x00000129);
+ break;
+ case 18:
+ /* Display on command */
+ if (dsi_wait_hs_data_fifo(dev) < 0)
+ break;
+ REG_WRITE(0xb068, 0x00000029);
+ if (dsi_wait_hs_ctrl_fifo(dev) < 0)
+ break;
+ REG_WRITE(0xb070, 0x00000129);
+ break;
+ default:
+ break;
+ }
+ return len;
+}
+
+
+
+static struct class_attribute tpo_class_attrs[] = {
+ __ATTR(test, 0200, NULL, dsi_run_test),
__ATTR_NULL,
};
-static struct class miko_class = {
- .name = "miko",
+static struct class tpo_class = {
+ .name = "tpo",
.owner = THIS_MODULE,
- .class_attrs = miko_class_attrs,
+ .class_attrs = tpo_class_attrs,
};
-static int __init miko_sysfs_init(void)
+static int __init tpo_sysfs_init(void)
{
- int status;
+ int status;
- status = class_register(&miko_class);
+ status = class_register(&tpo_class);
if (status < 0)
return status;
return status;
}
-postcore_initcall(miko_sysfs_init);
+postcore_initcall(tpo_sysfs_init);
// Temporary access from sysfs end
-
diff --git a/drivers/gpu/drm/mrst/pvr/services4/3rdparty/linux_framebuffer_mrst/mrstlfb_displayclass.c b/drivers/gpu/drm/mrst/pvr/services4/3rdparty/linux_framebuffer_mrst/mrstlfb_displayclass.c
index adca7e2..7831183 100644
--- a/drivers/gpu/drm/mrst/pvr/services4/3rdparty/linux_framebuffer_mrst/mrstlfb_displayclass.c
+++ b/drivers/gpu/drm/mrst/pvr/services4/3rdparty/linux_framebuffer_mrst/mrstlfb_displayclass.c
@@ -1977,6 +1977,9 @@ PVRSRV_ERROR MRSTLFBPrePowerState(IMG_HANDLE hDevHandle,
(eNewPowerState == PVRSRV_DEV_POWER_STATE_ON))
return PVRSRV_OK;
+ if (!dev_priv->iLVDS_enable && dev_priv->dsi_prePowerState != NULL)
+ dev_priv->dsi_prePowerState(dev);
+
save_display_registers(dev);
if (dev_priv->iLVDS_enable) {
@@ -1999,14 +2002,15 @@ PVRSRV_ERROR MRSTLFBPrePowerState(IMG_HANDLE hDevHandle,
/*turn off PLLs*/
PSB_WVDC32(0, MRST_DPLL_A);
} else {
- PSB_WVDC32(DPI_SHUT_DOWN, DPI_CONTROL_REG);
- PSB_WVDC32(0x0, PIPEACONF);
- PSB_WVDC32(0x2faf0000, BLC_PWM_CTL);
- while (REG_READ(0x70008) & 0x40000000);
- while ((PSB_RVDC32(GEN_FIFO_STAT_REG) & DPI_FIFO_EMPTY)
+ if (dev_priv->dsi_prePowerState == NULL) {
+ PSB_WVDC32(DPI_SHUT_DOWN, DPI_CONTROL_REG);
+ PSB_WVDC32(0x0, PIPEACONF);
+ PSB_WVDC32(0x2faf0000, BLC_PWM_CTL);
+ while (REG_READ(0x70008) & 0x40000000);
+ while ((PSB_RVDC32(GEN_FIFO_STAT_REG) & DPI_FIFO_EMPTY)
!= DPI_FIFO_EMPTY);
- PSB_WVDC32(0, DEVICE_READY_REG);
-
+ PSB_WVDC32(0, DEVICE_READY_REG);
+ }
/* turn off mipi panel power */
ret = lnw_ipc_single_cmd(IPC_MSG_PANEL_ON_OFF, IPC_CMD_PANEL_OFF, 0, 0);
if (ret)
@@ -2052,5 +2056,8 @@ PVRSRV_ERROR MRSTLFBPostPowerState(IMG_HANDLE hDevHandle,
restore_display_registers(dev);
+ if (!dev_priv->iLVDS_enable && dev_priv->dsi_postPowerState != NULL)
+ dev_priv->dsi_postPowerState(dev);
+
return PVRSRV_OK;
}
--
1.6.2.5