| /* |
| * Copyright (c) 2010 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, sublicensen |
| * 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: |
| * Thomas Eaton <thomas.g.eaton@intel.com> |
| * Scott Rowe <scott.m.rowe@intel.com> |
| */ |
| |
| #include "mdfld_dsi_dbi.h" |
| #include "mdfld_dsi_dpi.h" |
| #include "mdfld_dsi_output.h" |
| #include "mdfld_output.h" |
| |
| #include "mdfld_dsi_pkg_sender.h" |
| |
| #include "displays/tpo_cmd.h" |
| |
| static struct drm_display_mode *tpo_cmd_get_config_mode(struct drm_device *dev) |
| { |
| struct drm_display_mode *mode; |
| struct drm_psb_private *dev_priv = dev->dev_private; |
| struct mrst_timing_info *ti = &dev_priv->gct_data.DTD; |
| bool use_gct = false; |
| |
| mode = kzalloc(sizeof(*mode), GFP_KERNEL); |
| if (!mode) |
| return NULL; |
| |
| if (use_gct) { |
| dev_dbg(dev->dev, "gct find MIPI panel.\n"); |
| |
| mode->hdisplay = (ti->hactive_hi << 8) | ti->hactive_lo; |
| mode->vdisplay = (ti->vactive_hi << 8) | ti->vactive_lo; |
| mode->hsync_start = mode->hdisplay + \ |
| ((ti->hsync_offset_hi << 8) | \ |
| ti->hsync_offset_lo); |
| mode->hsync_end = mode->hsync_start + \ |
| ((ti->hsync_pulse_width_hi << 8) | \ |
| ti->hsync_pulse_width_lo); |
| mode->htotal = mode->hdisplay + ((ti->hblank_hi << 8) | \ |
| ti->hblank_lo); |
| mode->vsync_start = \ |
| mode->vdisplay + ((ti->vsync_offset_hi << 8) | \ |
| ti->vsync_offset_lo); |
| mode->vsync_end = \ |
| mode->vsync_start + ((ti->vsync_pulse_width_hi << 8) | \ |
| ti->vsync_pulse_width_lo); |
| mode->vtotal = mode->vdisplay + \ |
| ((ti->vblank_hi << 8) | ti->vblank_lo); |
| mode->clock = ti->pixel_clock * 10; |
| |
| dev_dbg(dev->dev, "hdisplay is %d\n", mode->hdisplay); |
| dev_dbg(dev->dev, "vdisplay is %d\n", mode->vdisplay); |
| dev_dbg(dev->dev, "HSS is %d\n", mode->hsync_start); |
| dev_dbg(dev->dev, "HSE is %d\n", mode->hsync_end); |
| dev_dbg(dev->dev, "htotal is %d\n", mode->htotal); |
| dev_dbg(dev->dev, "VSS is %d\n", mode->vsync_start); |
| dev_dbg(dev->dev, "VSE is %d\n", mode->vsync_end); |
| dev_dbg(dev->dev, "vtotal is %d\n", mode->vtotal); |
| dev_dbg(dev->dev, "clock is %d\n", mode->clock); |
| } else { |
| mode->hdisplay = 864; |
| mode->vdisplay = 480; |
| mode->hsync_start = 872; |
| mode->hsync_end = 876; |
| mode->htotal = 884; |
| mode->vsync_start = 482; |
| mode->vsync_end = 494; |
| mode->vtotal = 486; |
| mode->clock = 25777; |
| } |
| |
| drm_mode_set_name(mode); |
| drm_mode_set_crtcinfo(mode, 0); |
| |
| mode->type |= DRM_MODE_TYPE_PREFERRED; |
| |
| return mode; |
| } |
| |
| static bool mdfld_dsi_dbi_mode_fixup(struct drm_encoder *encoder, |
| struct drm_display_mode *mode, |
| struct drm_display_mode *adjusted_mode) |
| { |
| struct drm_device *dev = encoder->dev; |
| struct drm_display_mode *fixed_mode = tpo_cmd_get_config_mode(dev); |
| |
| if (fixed_mode) { |
| adjusted_mode->hdisplay = fixed_mode->hdisplay; |
| adjusted_mode->hsync_start = fixed_mode->hsync_start; |
| adjusted_mode->hsync_end = fixed_mode->hsync_end; |
| adjusted_mode->htotal = fixed_mode->htotal; |
| adjusted_mode->vdisplay = fixed_mode->vdisplay; |
| adjusted_mode->vsync_start = fixed_mode->vsync_start; |
| adjusted_mode->vsync_end = fixed_mode->vsync_end; |
| adjusted_mode->vtotal = fixed_mode->vtotal; |
| adjusted_mode->clock = fixed_mode->clock; |
| drm_mode_set_crtcinfo(adjusted_mode, CRTC_INTERLACE_HALVE_V); |
| kfree(fixed_mode); |
| } |
| return true; |
| } |
| |
| static void mdfld_dsi_dbi_set_power(struct drm_encoder *encoder, bool on) |
| { |
| int ret = 0; |
| struct mdfld_dsi_encoder *dsi_encoder = MDFLD_DSI_ENCODER(encoder); |
| struct mdfld_dsi_dbi_output *dbi_output = |
| MDFLD_DSI_DBI_OUTPUT(dsi_encoder); |
| /*struct drm_device *dev = dbi_output->dev;*/ |
| struct drm_device *dev = encoder->dev; |
| struct drm_psb_private *dev_priv = dev->dev_private; |
| u32 reg_offset = 0; |
| int pipe = (dbi_output->channel_num == 0) ? 0 : 2; |
| |
| dev_dbg(dev->dev, "pipe %d : %s, panel on: %s\n", |
| pipe, on ? "On" : "Off", |
| dbi_output->dbi_panel_on ? "True" : "False"); |
| |
| if (pipe == 2) { |
| if (on) |
| dev_priv->dual_mipi = true; |
| else |
| dev_priv->dual_mipi = false; |
| reg_offset = MIPIC_REG_OFFSET; |
| } else { |
| if (!on) |
| dev_priv->dual_mipi = false; |
| } |
| |
| if (!gma_power_begin(dev, true)) { |
| dev_err(dev->dev, "hw begin failed\n"); |
| return; |
| } |
| |
| if (on) { |
| if (dbi_output->dbi_panel_on) |
| goto out_err; |
| |
| ret = mdfld_dsi_dbi_update_power(dbi_output, DRM_MODE_DPMS_ON); |
| if (ret) { |
| dev_err(dev->dev, "power on error\n"); |
| goto out_err; |
| } |
| |
| dbi_output->dbi_panel_on = true; |
| |
| if (pipe == 2) |
| dev_priv->dbi_panel_on2 = true; |
| else |
| dev_priv->dbi_panel_on = true; |
| mdfld_enable_te(dev, pipe); |
| } else { |
| if (!dbi_output->dbi_panel_on && !dbi_output->first_boot) |
| goto out_err; |
| |
| dbi_output->dbi_panel_on = false; |
| dbi_output->first_boot = false; |
| |
| if (pipe == 2) |
| dev_priv->dbi_panel_on2 = false; |
| else |
| dev_priv->dbi_panel_on = false; |
| |
| mdfld_disable_te(dev, pipe); |
| |
| ret = mdfld_dsi_dbi_update_power(dbi_output, DRM_MODE_DPMS_OFF); |
| if (ret) { |
| dev_err(dev->dev, "power on error\n"); |
| goto out_err; |
| } |
| } |
| |
| out_err: |
| gma_power_end(dev); |
| |
| if (ret) |
| dev_err(dev->dev, "failed\n"); |
| } |
| |
| |
| static void mdfld_dsi_dbi_mode_set(struct drm_encoder *encoder, |
| struct drm_display_mode *mode, |
| struct drm_display_mode *adjusted_mode) |
| { |
| int ret = 0; |
| struct drm_device *dev = encoder->dev; |
| struct drm_psb_private *dev_priv = dev->dev_private; |
| struct mdfld_dsi_encoder *dsi_encoder = MDFLD_DSI_ENCODER(encoder); |
| struct mdfld_dsi_dbi_output *dsi_output = |
| MDFLD_DSI_DBI_OUTPUT(dsi_encoder); |
| struct mdfld_dsi_config *dsi_config = |
| mdfld_dsi_encoder_get_config(dsi_encoder); |
| struct mdfld_dsi_connector *dsi_connector = dsi_config->connector; |
| int pipe = dsi_connector->pipe; |
| u8 param = 0; |
| |
| /* Regs */ |
| u32 mipi_reg = MIPI; |
| u32 dspcntr_reg = DSPACNTR; |
| u32 pipeconf_reg = PIPEACONF; |
| u32 reg_offset = 0; |
| |
| /* Values */ |
| u32 dspcntr_val = dev_priv->dspcntr; |
| u32 pipeconf_val = dev_priv->pipeconf; |
| u32 h_active_area = mode->hdisplay; |
| u32 v_active_area = mode->vdisplay; |
| u32 mipi_val; |
| |
| mipi_val = (PASS_FROM_SPHY_TO_AFE | SEL_FLOPPED_HSTX | |
| TE_TRIGGER_GPIO_PIN); |
| |
| dev_dbg(dev->dev, "mipi_val =0x%x\n", mipi_val); |
| |
| dev_dbg(dev->dev, "type %s\n", (pipe == 2) ? "MIPI2" : "MIPI"); |
| dev_dbg(dev->dev, "h %d v %d\n", mode->hdisplay, mode->vdisplay); |
| |
| if (pipe == 2) { |
| mipi_reg = MIPI_C; |
| dspcntr_reg = DSPCCNTR; |
| pipeconf_reg = PIPECCONF; |
| |
| reg_offset = MIPIC_REG_OFFSET; |
| |
| dspcntr_val = dev_priv->dspcntr2; |
| pipeconf_val = dev_priv->pipeconf2; |
| } else { |
| mipi_val |= 0x2; /*two lanes for port A and C respectively*/ |
| } |
| |
| if (!gma_power_begin(dev, true)) { |
| dev_err(dev->dev, "hw begin failed\n"); |
| return; |
| } |
| |
| /* Set up pipe related registers */ |
| REG_WRITE(mipi_reg, mipi_val); |
| REG_READ(mipi_reg); |
| |
| mdfld_dsi_controller_dbi_init(dsi_config, pipe); |
| |
| msleep(20); |
| |
| REG_WRITE(dspcntr_reg, dspcntr_val); |
| REG_READ(dspcntr_reg); |
| |
| /* 20ms delay before sending exit_sleep_mode */ |
| msleep(20); |
| |
| /* Send exit_sleep_mode DCS */ |
| ret = mdfld_dsi_dbi_send_dcs(dsi_output, exit_sleep_mode, |
| NULL, 0, CMD_DATA_SRC_SYSTEM_MEM); |
| if (ret) { |
| dev_err(dev->dev, "sent exit_sleep_mode faild\n"); |
| goto out_err; |
| } |
| |
| /* Send set_tear_on DCS */ |
| ret = mdfld_dsi_dbi_send_dcs(dsi_output, set_tear_on, |
| ¶m, 1, CMD_DATA_SRC_SYSTEM_MEM); |
| if (ret) { |
| dev_err(dev->dev, "%s - sent set_tear_on faild\n", __func__); |
| goto out_err; |
| } |
| |
| /* Do some init stuff */ |
| mdfld_dsi_brightness_init(dsi_config, pipe); |
| |
| mdfld_dsi_gen_fifo_ready(dev, (MIPIA_GEN_FIFO_STAT_REG + reg_offset), |
| HS_CTRL_FIFO_EMPTY | HS_DATA_FIFO_EMPTY); |
| |
| REG_WRITE(pipeconf_reg, pipeconf_val | PIPEACONF_DSR); |
| REG_READ(pipeconf_reg); |
| |
| /* TODO: this looks ugly, try to move it to CRTC mode setting*/ |
| if (pipe == 2) |
| dev_priv->pipeconf2 |= PIPEACONF_DSR; |
| else |
| dev_priv->pipeconf |= PIPEACONF_DSR; |
| |
| dev_dbg(dev->dev, "pipeconf %x\n", REG_READ(pipeconf_reg)); |
| |
| ret = mdfld_dsi_dbi_update_area(dsi_output, 0, 0, |
| h_active_area - 1, v_active_area - 1); |
| if (ret) { |
| dev_err(dev->dev, "update area failed\n"); |
| goto out_err; |
| } |
| |
| out_err: |
| gma_power_end(dev); |
| |
| if (ret) |
| dev_err(dev->dev, "mode set failed\n"); |
| } |
| |
| static void mdfld_dsi_dbi_prepare(struct drm_encoder *encoder) |
| { |
| struct mdfld_dsi_encoder *dsi_encoder = MDFLD_DSI_ENCODER(encoder); |
| struct mdfld_dsi_dbi_output *dbi_output |
| = MDFLD_DSI_DBI_OUTPUT(dsi_encoder); |
| |
| dbi_output->mode_flags |= MODE_SETTING_IN_ENCODER; |
| dbi_output->mode_flags &= ~MODE_SETTING_ENCODER_DONE; |
| |
| mdfld_dsi_dbi_set_power(encoder, false); |
| } |
| |
| static void mdfld_dsi_dbi_commit(struct drm_encoder *encoder) |
| { |
| struct mdfld_dsi_encoder *dsi_encoder = MDFLD_DSI_ENCODER(encoder); |
| struct mdfld_dsi_dbi_output *dbi_output = |
| MDFLD_DSI_DBI_OUTPUT(dsi_encoder); |
| struct drm_device *dev = dbi_output->dev; |
| struct drm_psb_private *dev_priv = dev->dev_private; |
| struct psb_drm_dpu_rect rect; |
| |
| mdfld_dsi_dbi_set_power(encoder, true); |
| dbi_output->mode_flags &= ~MODE_SETTING_IN_ENCODER; |
| |
| rect.x = rect.y = 0; |
| rect.width = 864; |
| rect.height = 480; |
| |
| if (dbi_output->channel_num == 1) { |
| dev_priv->dsr_fb_update |= MDFLD_DSR_2D_3D_2; |
| #ifdef CONFIG_MDFLD_DSI_DPU |
| /*if dpu enabled report a fullscreen damage*/ |
| mdfld_dbi_dpu_report_damage(dev, MDFLD_PLANEC, &rect); |
| #endif |
| } else { |
| dev_priv->dsr_fb_update |= MDFLD_DSR_2D_3D_0; |
| #ifdef CONFIG_MDFLD_DSI_DPU |
| mdfld_dbi_dpu_report_damage(dev, MDFLD_PLANEA, &rect); |
| #endif |
| } |
| dbi_output->mode_flags |= MODE_SETTING_ENCODER_DONE; |
| } |
| |
| static void mdfld_dsi_dbi_dpms(struct drm_encoder *encoder, int mode) |
| { |
| struct mdfld_dsi_encoder *dsi_encoder = MDFLD_DSI_ENCODER(encoder); |
| struct mdfld_dsi_dbi_output *dbi_output |
| = MDFLD_DSI_DBI_OUTPUT(dsi_encoder); |
| struct drm_device *dev = dbi_output->dev; |
| struct drm_psb_private *dev_priv = dev->dev_private; |
| static bool bdispoff; |
| |
| dev_dbg(dev->dev, "%s\n", (mode == DRM_MODE_DPMS_ON ? "on" : "off")); |
| |
| if (mode == DRM_MODE_DPMS_ON) { |
| /* |
| * FIXME: in case I am wrong! |
| * we don't need to exit dsr here to wake up plane/pipe/pll |
| * if everything goes right, hw_begin will resume them all |
| * during set_power. |
| */ |
| if (bdispoff) |
| mdfld_dsi_dbi_exit_dsr(dev, MDFLD_DSR_2D_3D, 0, 0); |
| |
| mdfld_dsi_dbi_set_power(encoder, true); |
| /* FIXME if (gbgfxsuspended) |
| gbgfxsuspended = false; */ |
| bdispoff = false; |
| dev_priv->dispstatus = true; |
| } else { |
| /* |
| * I am not sure whether this is the perfect place to |
| * turn rpm on since we still have a lot of CRTC turnning |
| * on work to do. |
| */ |
| mdfld_dsi_dbi_set_power(encoder, false); |
| bdispoff = true; |
| dev_priv->dispstatus = false; |
| } |
| } |
| |
| |
| /* |
| * Update the DBI MIPI Panel Frame Buffer. |
| */ |
| static void mdfld_dsi_dbi_update_fb(struct mdfld_dsi_dbi_output *dbi_output, |
| int pipe) |
| { |
| struct mdfld_dsi_pkg_sender *sender = |
| mdfld_dsi_encoder_get_pkg_sender(&dbi_output->base); |
| struct drm_device *dev = dbi_output->dev; |
| struct drm_crtc *crtc = dbi_output->base.base.crtc; |
| struct psb_intel_crtc *psb_crtc = (crtc) ? |
| to_psb_intel_crtc(crtc) : NULL; |
| u32 dpll_reg = MRST_DPLL_A; |
| u32 dspcntr_reg = DSPACNTR; |
| u32 pipeconf_reg = PIPEACONF; |
| u32 dsplinoff_reg = DSPALINOFF; |
| u32 dspsurf_reg = DSPASURF; |
| u32 reg_offset = 0; |
| |
| /* If mode setting on-going, back off */ |
| if ((dbi_output->mode_flags & MODE_SETTING_ON_GOING) || |
| (psb_crtc && psb_crtc->mode_flags & MODE_SETTING_ON_GOING) || |
| !(dbi_output->mode_flags & MODE_SETTING_ENCODER_DONE)) |
| return; |
| |
| if (pipe == 2) { |
| dspcntr_reg = DSPCCNTR; |
| pipeconf_reg = PIPECCONF; |
| dsplinoff_reg = DSPCLINOFF; |
| dspsurf_reg = DSPCSURF; |
| reg_offset = MIPIC_REG_OFFSET; |
| } |
| |
| if (!gma_power_begin(dev, true)) { |
| dev_err(dev->dev, "hw begin failed\n"); |
| return; |
| } |
| |
| /* Check DBI FIFO status */ |
| if (!(REG_READ(dpll_reg) & DPLL_VCO_ENABLE) || |
| !(REG_READ(dspcntr_reg) & DISPLAY_PLANE_ENABLE) || |
| !(REG_READ(pipeconf_reg) & DISPLAY_PLANE_ENABLE)) |
| goto update_fb_out0; |
| |
| /* Refresh plane changes */ |
| REG_WRITE(dsplinoff_reg, REG_READ(dsplinoff_reg)); |
| REG_WRITE(dspsurf_reg, REG_READ(dspsurf_reg)); |
| REG_READ(dspsurf_reg); |
| |
| mdfld_dsi_send_dcs(sender, |
| write_mem_start, |
| NULL, |
| 0, |
| CMD_DATA_SRC_PIPE, |
| MDFLD_DSI_SEND_PACKAGE); |
| |
| dbi_output->dsr_fb_update_done = true; |
| update_fb_out0: |
| gma_power_end(dev); |
| } |
| |
| static int tpo_cmd_get_panel_info(struct drm_device *dev, |
| int pipe, |
| struct panel_info *pi) |
| { |
| if (!dev || !pi) |
| return -EINVAL; |
| |
| pi->width_mm = TPO_PANEL_WIDTH; |
| pi->height_mm = TPO_PANEL_HEIGHT; |
| |
| return 0; |
| } |
| |
| |
| /* TPO DBI encoder helper funcs */ |
| static const struct drm_encoder_helper_funcs mdfld_dsi_dbi_helper_funcs = { |
| .dpms = mdfld_dsi_dbi_dpms, |
| .mode_fixup = mdfld_dsi_dbi_mode_fixup, |
| .prepare = mdfld_dsi_dbi_prepare, |
| .mode_set = mdfld_dsi_dbi_mode_set, |
| .commit = mdfld_dsi_dbi_commit, |
| }; |
| |
| /* TPO DBI encoder funcs */ |
| static const struct drm_encoder_funcs mdfld_dsi_dbi_encoder_funcs = { |
| .destroy = drm_encoder_cleanup, |
| }; |
| |
| void tpo_cmd_init(struct drm_device *dev, struct panel_funcs *p_funcs) |
| { |
| p_funcs->encoder_funcs = &mdfld_dsi_dbi_encoder_funcs; |
| p_funcs->encoder_helper_funcs = &mdfld_dsi_dbi_helper_funcs; |
| p_funcs->get_config_mode = &tpo_cmd_get_config_mode; |
| p_funcs->update_fb = mdfld_dsi_dbi_update_fb; |
| p_funcs->get_panel_info = tpo_cmd_get_panel_info; |
| } |