Lines Matching refs:msm_host
152 static inline u32 dsi_read(struct msm_dsi_host *msm_host, u32 reg) in dsi_read() argument
154 return msm_readl(msm_host->ctrl_base + reg); in dsi_read()
156 static inline void dsi_write(struct msm_dsi_host *msm_host, u32 reg, u32 data) in dsi_write() argument
158 msm_writel(data, msm_host->ctrl_base + reg); in dsi_write()
161 static int dsi_host_regulator_enable(struct msm_dsi_host *msm_host);
162 static void dsi_host_regulator_disable(struct msm_dsi_host *msm_host);
165 struct msm_dsi_host *msm_host) in dsi_get_config() argument
172 gdsc_reg = regulator_get(&msm_host->pdev->dev, "gdsc"); in dsi_get_config()
182 ret = clk_prepare_enable(msm_host->ahb_clk); in dsi_get_config()
188 ret = dsi_get_version(msm_host->ctrl_base, &major, &minor); in dsi_get_config()
199 clk_disable_unprepare(msm_host->ahb_clk); in dsi_get_config()
213 static void dsi_host_regulator_disable(struct msm_dsi_host *msm_host) in dsi_host_regulator_disable() argument
215 struct regulator_bulk_data *s = msm_host->supplies; in dsi_host_regulator_disable()
216 const struct dsi_reg_entry *regs = msm_host->cfg_hnd->cfg->reg_cfg.regs; in dsi_host_regulator_disable()
217 int num = msm_host->cfg_hnd->cfg->reg_cfg.num; in dsi_host_regulator_disable()
229 static int dsi_host_regulator_enable(struct msm_dsi_host *msm_host) in dsi_host_regulator_enable() argument
231 struct regulator_bulk_data *s = msm_host->supplies; in dsi_host_regulator_enable()
232 const struct dsi_reg_entry *regs = msm_host->cfg_hnd->cfg->reg_cfg.regs; in dsi_host_regulator_enable()
233 int num = msm_host->cfg_hnd->cfg->reg_cfg.num; in dsi_host_regulator_enable()
263 static int dsi_regulator_init(struct msm_dsi_host *msm_host) in dsi_regulator_init() argument
265 struct regulator_bulk_data *s = msm_host->supplies; in dsi_regulator_init()
266 const struct dsi_reg_entry *regs = msm_host->cfg_hnd->cfg->reg_cfg.regs; in dsi_regulator_init()
267 int num = msm_host->cfg_hnd->cfg->reg_cfg.num; in dsi_regulator_init()
273 ret = devm_regulator_bulk_get(&msm_host->pdev->dev, num, s); in dsi_regulator_init()
295 static int dsi_clk_init(struct msm_dsi_host *msm_host) in dsi_clk_init() argument
297 struct device *dev = &msm_host->pdev->dev; in dsi_clk_init()
300 msm_host->mdp_core_clk = devm_clk_get(dev, "mdp_core_clk"); in dsi_clk_init()
301 if (IS_ERR(msm_host->mdp_core_clk)) { in dsi_clk_init()
302 ret = PTR_ERR(msm_host->mdp_core_clk); in dsi_clk_init()
308 msm_host->ahb_clk = devm_clk_get(dev, "iface_clk"); in dsi_clk_init()
309 if (IS_ERR(msm_host->ahb_clk)) { in dsi_clk_init()
310 ret = PTR_ERR(msm_host->ahb_clk); in dsi_clk_init()
316 msm_host->axi_clk = devm_clk_get(dev, "bus_clk"); in dsi_clk_init()
317 if (IS_ERR(msm_host->axi_clk)) { in dsi_clk_init()
318 ret = PTR_ERR(msm_host->axi_clk); in dsi_clk_init()
324 msm_host->mmss_misc_ahb_clk = devm_clk_get(dev, "core_mmss_clk"); in dsi_clk_init()
325 if (IS_ERR(msm_host->mmss_misc_ahb_clk)) { in dsi_clk_init()
326 ret = PTR_ERR(msm_host->mmss_misc_ahb_clk); in dsi_clk_init()
332 msm_host->byte_clk = devm_clk_get(dev, "byte_clk"); in dsi_clk_init()
333 if (IS_ERR(msm_host->byte_clk)) { in dsi_clk_init()
334 ret = PTR_ERR(msm_host->byte_clk); in dsi_clk_init()
337 msm_host->byte_clk = NULL; in dsi_clk_init()
341 msm_host->pixel_clk = devm_clk_get(dev, "pixel_clk"); in dsi_clk_init()
342 if (IS_ERR(msm_host->pixel_clk)) { in dsi_clk_init()
343 ret = PTR_ERR(msm_host->pixel_clk); in dsi_clk_init()
346 msm_host->pixel_clk = NULL; in dsi_clk_init()
350 msm_host->esc_clk = devm_clk_get(dev, "core_clk"); in dsi_clk_init()
351 if (IS_ERR(msm_host->esc_clk)) { in dsi_clk_init()
352 ret = PTR_ERR(msm_host->esc_clk); in dsi_clk_init()
355 msm_host->esc_clk = NULL; in dsi_clk_init()
359 msm_host->byte_clk_src = devm_clk_get(dev, "byte_clk_src"); in dsi_clk_init()
360 if (IS_ERR(msm_host->byte_clk_src)) { in dsi_clk_init()
361 ret = PTR_ERR(msm_host->byte_clk_src); in dsi_clk_init()
363 msm_host->byte_clk_src = NULL; in dsi_clk_init()
367 msm_host->pixel_clk_src = devm_clk_get(dev, "pixel_clk_src"); in dsi_clk_init()
368 if (IS_ERR(msm_host->pixel_clk_src)) { in dsi_clk_init()
369 ret = PTR_ERR(msm_host->pixel_clk_src); in dsi_clk_init()
371 msm_host->pixel_clk_src = NULL; in dsi_clk_init()
379 static int dsi_bus_clk_enable(struct msm_dsi_host *msm_host) in dsi_bus_clk_enable() argument
383 DBG("id=%d", msm_host->id); in dsi_bus_clk_enable()
385 ret = clk_prepare_enable(msm_host->mdp_core_clk); in dsi_bus_clk_enable()
392 ret = clk_prepare_enable(msm_host->ahb_clk); in dsi_bus_clk_enable()
398 ret = clk_prepare_enable(msm_host->axi_clk); in dsi_bus_clk_enable()
404 ret = clk_prepare_enable(msm_host->mmss_misc_ahb_clk); in dsi_bus_clk_enable()
414 clk_disable_unprepare(msm_host->axi_clk); in dsi_bus_clk_enable()
416 clk_disable_unprepare(msm_host->ahb_clk); in dsi_bus_clk_enable()
418 clk_disable_unprepare(msm_host->mdp_core_clk); in dsi_bus_clk_enable()
423 static void dsi_bus_clk_disable(struct msm_dsi_host *msm_host) in dsi_bus_clk_disable() argument
426 clk_disable_unprepare(msm_host->mmss_misc_ahb_clk); in dsi_bus_clk_disable()
427 clk_disable_unprepare(msm_host->axi_clk); in dsi_bus_clk_disable()
428 clk_disable_unprepare(msm_host->ahb_clk); in dsi_bus_clk_disable()
429 clk_disable_unprepare(msm_host->mdp_core_clk); in dsi_bus_clk_disable()
432 static int dsi_link_clk_enable(struct msm_dsi_host *msm_host) in dsi_link_clk_enable() argument
437 msm_host->mode->clock, msm_host->byte_clk_rate); in dsi_link_clk_enable()
439 ret = clk_set_rate(msm_host->byte_clk, msm_host->byte_clk_rate); in dsi_link_clk_enable()
445 ret = clk_set_rate(msm_host->pixel_clk, msm_host->mode->clock * 1000); in dsi_link_clk_enable()
451 ret = clk_prepare_enable(msm_host->esc_clk); in dsi_link_clk_enable()
457 ret = clk_prepare_enable(msm_host->byte_clk); in dsi_link_clk_enable()
463 ret = clk_prepare_enable(msm_host->pixel_clk); in dsi_link_clk_enable()
472 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_enable()
474 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_enable()
479 static void dsi_link_clk_disable(struct msm_dsi_host *msm_host) in dsi_link_clk_disable() argument
481 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_disable()
482 clk_disable_unprepare(msm_host->pixel_clk); in dsi_link_clk_disable()
483 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_disable()
486 static int dsi_clk_ctrl(struct msm_dsi_host *msm_host, bool enable) in dsi_clk_ctrl() argument
490 mutex_lock(&msm_host->clk_mutex); in dsi_clk_ctrl()
492 ret = dsi_bus_clk_enable(msm_host); in dsi_clk_ctrl()
498 ret = dsi_link_clk_enable(msm_host); in dsi_clk_ctrl()
502 dsi_bus_clk_disable(msm_host); in dsi_clk_ctrl()
506 dsi_link_clk_disable(msm_host); in dsi_clk_ctrl()
507 dsi_bus_clk_disable(msm_host); in dsi_clk_ctrl()
511 mutex_unlock(&msm_host->clk_mutex); in dsi_clk_ctrl()
515 static int dsi_calc_clk_rate(struct msm_dsi_host *msm_host) in dsi_calc_clk_rate() argument
517 struct drm_display_mode *mode = msm_host->mode; in dsi_calc_clk_rate()
518 u8 lanes = msm_host->lanes; in dsi_calc_clk_rate()
519 u32 bpp = dsi_get_bpp(msm_host->format); in dsi_calc_clk_rate()
529 msm_host->byte_clk_rate = (pclk_rate * bpp) / (8 * lanes); in dsi_calc_clk_rate()
532 msm_host->byte_clk_rate = (pclk_rate * bpp) / 8; in dsi_calc_clk_rate()
535 DBG("pclk=%d, bclk=%d", pclk_rate, msm_host->byte_clk_rate); in dsi_calc_clk_rate()
540 static void dsi_phy_sw_reset(struct msm_dsi_host *msm_host) in dsi_phy_sw_reset() argument
543 dsi_write(msm_host, REG_DSI_PHY_RESET, DSI_PHY_RESET_RESET); in dsi_phy_sw_reset()
547 dsi_write(msm_host, REG_DSI_PHY_RESET, 0); in dsi_phy_sw_reset()
551 static void dsi_intr_ctrl(struct msm_dsi_host *msm_host, u32 mask, int enable) in dsi_intr_ctrl() argument
556 spin_lock_irqsave(&msm_host->intr_lock, flags); in dsi_intr_ctrl()
557 intr = dsi_read(msm_host, REG_DSI_INTR_CTRL); in dsi_intr_ctrl()
566 dsi_write(msm_host, REG_DSI_INTR_CTRL, intr); in dsi_intr_ctrl()
567 spin_unlock_irqrestore(&msm_host->intr_lock, flags); in dsi_intr_ctrl()
604 static void dsi_ctrl_config(struct msm_dsi_host *msm_host, bool enable, in dsi_ctrl_config() argument
607 u32 flags = msm_host->mode_flags; in dsi_ctrl_config()
608 enum mipi_dsi_pixel_format mipi_fmt = msm_host->format; in dsi_ctrl_config()
609 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_ctrl_config()
613 dsi_write(msm_host, REG_DSI_CTRL, 0); in dsi_ctrl_config()
633 data |= DSI_VID_CFG0_VIRT_CHANNEL(msm_host->channel); in dsi_ctrl_config()
634 dsi_write(msm_host, REG_DSI_VID_CFG0, data); in dsi_ctrl_config()
638 dsi_write(msm_host, REG_DSI_VID_CFG1, 0); in dsi_ctrl_config()
643 dsi_write(msm_host, REG_DSI_CMD_CFG0, data); in dsi_ctrl_config()
650 dsi_write(msm_host, REG_DSI_CMD_CFG1, data); in dsi_ctrl_config()
653 dsi_write(msm_host, REG_DSI_CMD_DMA_CTRL, in dsi_ctrl_config()
662 data |= DSI_TRIG_CTRL_STREAM(msm_host->channel); in dsi_ctrl_config()
666 dsi_write(msm_host, REG_DSI_TRIG_CTRL, data); in dsi_ctrl_config()
670 dsi_write(msm_host, REG_DSI_CLKOUT_TIMING_CTRL, data); in dsi_ctrl_config()
675 dsi_write(msm_host, REG_DSI_EOT_PACKET_CTRL, data); in dsi_ctrl_config()
678 dsi_write(msm_host, REG_DSI_ERR_INT_MASK0, 0x13ff3fe0); in dsi_ctrl_config()
680 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_ERROR, 1); in dsi_ctrl_config()
682 dsi_write(msm_host, REG_DSI_CLK_CTRL, DSI_CLK_CTRL_ENABLE_CLKS); in dsi_ctrl_config()
686 DBG("lane number=%d", msm_host->lanes); in dsi_ctrl_config()
687 if (msm_host->lanes == 2) { in dsi_ctrl_config()
690 dsi_write(msm_host, REG_DSI_LANE_SWAP_CTRL, in dsi_ctrl_config()
697 dsi_write(msm_host, REG_DSI_LANE_SWAP_CTRL, in dsi_ctrl_config()
702 dsi_write(msm_host, REG_DSI_LANE_CTRL, in dsi_ctrl_config()
707 dsi_write(msm_host, REG_DSI_CTRL, data); in dsi_ctrl_config()
710 static void dsi_timing_setup(struct msm_dsi_host *msm_host) in dsi_timing_setup() argument
712 struct drm_display_mode *mode = msm_host->mode; in dsi_timing_setup()
726 if (msm_host->mode_flags & MIPI_DSI_MODE_VIDEO) { in dsi_timing_setup()
727 dsi_write(msm_host, REG_DSI_ACTIVE_H, in dsi_timing_setup()
730 dsi_write(msm_host, REG_DSI_ACTIVE_V, in dsi_timing_setup()
733 dsi_write(msm_host, REG_DSI_TOTAL, in dsi_timing_setup()
737 dsi_write(msm_host, REG_DSI_ACTIVE_HSYNC, in dsi_timing_setup()
740 dsi_write(msm_host, REG_DSI_ACTIVE_VSYNC_HPOS, 0); in dsi_timing_setup()
741 dsi_write(msm_host, REG_DSI_ACTIVE_VSYNC_VPOS, in dsi_timing_setup()
746 wc = mode->hdisplay * dsi_get_bpp(msm_host->format) / 8 + 1; in dsi_timing_setup()
748 dsi_write(msm_host, REG_DSI_CMD_MDP_STREAM_CTRL, in dsi_timing_setup()
751 msm_host->channel) | in dsi_timing_setup()
755 dsi_write(msm_host, REG_DSI_CMD_MDP_STREAM_TOTAL, in dsi_timing_setup()
761 static void dsi_sw_reset(struct msm_dsi_host *msm_host) in dsi_sw_reset() argument
763 dsi_write(msm_host, REG_DSI_CLK_CTRL, DSI_CLK_CTRL_ENABLE_CLKS); in dsi_sw_reset()
766 dsi_write(msm_host, REG_DSI_RESET, 1); in dsi_sw_reset()
768 dsi_write(msm_host, REG_DSI_RESET, 0); in dsi_sw_reset()
771 static void dsi_op_mode_config(struct msm_dsi_host *msm_host, in dsi_op_mode_config() argument
776 dsi_ctrl = dsi_read(msm_host, REG_DSI_CTRL); in dsi_op_mode_config()
781 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_CMD_MDP_DONE | in dsi_op_mode_config()
788 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_CMD_MDP_DONE, 1); in dsi_op_mode_config()
793 dsi_write(msm_host, REG_DSI_CTRL, dsi_ctrl); in dsi_op_mode_config()
796 static void dsi_set_tx_power_mode(int mode, struct msm_dsi_host *msm_host) in dsi_set_tx_power_mode() argument
800 data = dsi_read(msm_host, REG_DSI_CMD_DMA_CTRL); in dsi_set_tx_power_mode()
807 dsi_write(msm_host, REG_DSI_CMD_DMA_CTRL, data); in dsi_set_tx_power_mode()
810 static void dsi_wait4video_done(struct msm_dsi_host *msm_host) in dsi_wait4video_done() argument
812 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_VIDEO_DONE, 1); in dsi_wait4video_done()
814 reinit_completion(&msm_host->video_comp); in dsi_wait4video_done()
816 wait_for_completion_timeout(&msm_host->video_comp, in dsi_wait4video_done()
819 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_VIDEO_DONE, 0); in dsi_wait4video_done()
822 static void dsi_wait4video_eng_busy(struct msm_dsi_host *msm_host) in dsi_wait4video_eng_busy() argument
824 if (!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO)) in dsi_wait4video_eng_busy()
827 if (msm_host->power_on) { in dsi_wait4video_eng_busy()
828 dsi_wait4video_done(msm_host); in dsi_wait4video_eng_busy()
835 static int dsi_tx_buf_alloc(struct msm_dsi_host *msm_host, int size) in dsi_tx_buf_alloc() argument
837 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_alloc()
842 msm_host->tx_gem_obj = msm_gem_new(dev, size, MSM_BO_UNCACHED); in dsi_tx_buf_alloc()
843 if (IS_ERR(msm_host->tx_gem_obj)) { in dsi_tx_buf_alloc()
844 ret = PTR_ERR(msm_host->tx_gem_obj); in dsi_tx_buf_alloc()
846 msm_host->tx_gem_obj = NULL; in dsi_tx_buf_alloc()
851 ret = msm_gem_get_iova_locked(msm_host->tx_gem_obj, 0, &iova); in dsi_tx_buf_alloc()
866 static void dsi_tx_buf_free(struct msm_dsi_host *msm_host) in dsi_tx_buf_free() argument
868 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_free()
870 if (msm_host->tx_gem_obj) { in dsi_tx_buf_free()
871 msm_gem_put_iova(msm_host->tx_gem_obj, 0); in dsi_tx_buf_free()
873 msm_gem_free_object(msm_host->tx_gem_obj); in dsi_tx_buf_free()
874 msm_host->tx_gem_obj = NULL; in dsi_tx_buf_free()
974 static int dsi_cmd_dma_tx(struct msm_dsi_host *msm_host, int len) in dsi_cmd_dma_tx() argument
980 ret = msm_gem_get_iova(msm_host->tx_gem_obj, 0, &iova); in dsi_cmd_dma_tx()
986 reinit_completion(&msm_host->dma_comp); in dsi_cmd_dma_tx()
988 dsi_wait4video_eng_busy(msm_host); in dsi_cmd_dma_tx()
991 msm_host->id, iova, len); in dsi_cmd_dma_tx()
993 ret = wait_for_completion_timeout(&msm_host->dma_comp, in dsi_cmd_dma_tx()
1006 static int dsi_cmd_dma_rx(struct msm_dsi_host *msm_host, in dsi_cmd_dma_rx() argument
1014 int buf_offset = buf - msm_host->rx_buf; in dsi_cmd_dma_rx()
1045 data = dsi_read(msm_host, REG_DSI_RDBK_DATA(i)); in dsi_cmd_dma_rx()
1056 static int dsi_cmds2buf_tx(struct msm_dsi_host *msm_host, in dsi_cmds2buf_tx() argument
1060 int bllp_len = msm_host->mode->hdisplay * in dsi_cmds2buf_tx()
1061 dsi_get_bpp(msm_host->format) / 8; in dsi_cmds2buf_tx()
1063 len = dsi_cmd_dma_add(msm_host->tx_gem_obj, msg); in dsi_cmds2buf_tx()
1079 if ((msm_host->mode_flags & MIPI_DSI_MODE_VIDEO) && (len > bllp_len)) { in dsi_cmds2buf_tx()
1085 ret = dsi_cmd_dma_tx(msm_host, len); in dsi_cmds2buf_tx()
1095 static void dsi_sw_reset_restore(struct msm_dsi_host *msm_host) in dsi_sw_reset_restore() argument
1099 data0 = dsi_read(msm_host, REG_DSI_CTRL); in dsi_sw_reset_restore()
1102 dsi_write(msm_host, REG_DSI_CTRL, data1); in dsi_sw_reset_restore()
1109 dsi_write(msm_host, REG_DSI_CLK_CTRL, DSI_CLK_CTRL_ENABLE_CLKS); in dsi_sw_reset_restore()
1113 dsi_write(msm_host, REG_DSI_RESET, 1); in dsi_sw_reset_restore()
1115 dsi_write(msm_host, REG_DSI_RESET, 0); in dsi_sw_reset_restore()
1117 dsi_write(msm_host, REG_DSI_CTRL, data0); in dsi_sw_reset_restore()
1123 struct msm_dsi_host *msm_host = in dsi_err_worker() local
1125 u32 status = msm_host->err_work_state; in dsi_err_worker()
1129 dsi_sw_reset_restore(msm_host); in dsi_err_worker()
1132 msm_host->err_work_state = 0; in dsi_err_worker()
1135 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_ERROR, 1); in dsi_err_worker()
1138 static void dsi_ack_err_status(struct msm_dsi_host *msm_host) in dsi_ack_err_status() argument
1142 status = dsi_read(msm_host, REG_DSI_ACK_ERR_STATUS); in dsi_ack_err_status()
1145 dsi_write(msm_host, REG_DSI_ACK_ERR_STATUS, status); in dsi_ack_err_status()
1147 dsi_write(msm_host, REG_DSI_ACK_ERR_STATUS, 0); in dsi_ack_err_status()
1148 msm_host->err_work_state |= DSI_ERR_STATE_ACK; in dsi_ack_err_status()
1152 static void dsi_timeout_status(struct msm_dsi_host *msm_host) in dsi_timeout_status() argument
1156 status = dsi_read(msm_host, REG_DSI_TIMEOUT_STATUS); in dsi_timeout_status()
1159 dsi_write(msm_host, REG_DSI_TIMEOUT_STATUS, status); in dsi_timeout_status()
1160 msm_host->err_work_state |= DSI_ERR_STATE_TIMEOUT; in dsi_timeout_status()
1164 static void dsi_dln0_phy_err(struct msm_dsi_host *msm_host) in dsi_dln0_phy_err() argument
1168 status = dsi_read(msm_host, REG_DSI_DLN0_PHY_ERR); in dsi_dln0_phy_err()
1175 dsi_write(msm_host, REG_DSI_DLN0_PHY_ERR, status); in dsi_dln0_phy_err()
1176 msm_host->err_work_state |= DSI_ERR_STATE_DLN0_PHY; in dsi_dln0_phy_err()
1180 static void dsi_fifo_status(struct msm_dsi_host *msm_host) in dsi_fifo_status() argument
1184 status = dsi_read(msm_host, REG_DSI_FIFO_STATUS); in dsi_fifo_status()
1188 dsi_write(msm_host, REG_DSI_FIFO_STATUS, status); in dsi_fifo_status()
1189 msm_host->err_work_state |= DSI_ERR_STATE_FIFO; in dsi_fifo_status()
1191 msm_host->err_work_state |= in dsi_fifo_status()
1196 static void dsi_status(struct msm_dsi_host *msm_host) in dsi_status() argument
1200 status = dsi_read(msm_host, REG_DSI_STATUS0); in dsi_status()
1203 dsi_write(msm_host, REG_DSI_STATUS0, status); in dsi_status()
1204 msm_host->err_work_state |= in dsi_status()
1209 static void dsi_clk_status(struct msm_dsi_host *msm_host) in dsi_clk_status() argument
1213 status = dsi_read(msm_host, REG_DSI_CLK_STATUS); in dsi_clk_status()
1216 dsi_write(msm_host, REG_DSI_CLK_STATUS, status); in dsi_clk_status()
1217 msm_host->err_work_state |= DSI_ERR_STATE_PLL_UNLOCKED; in dsi_clk_status()
1221 static void dsi_error(struct msm_dsi_host *msm_host) in dsi_error() argument
1224 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_ERROR, 0); in dsi_error()
1226 dsi_clk_status(msm_host); in dsi_error()
1227 dsi_fifo_status(msm_host); in dsi_error()
1228 dsi_ack_err_status(msm_host); in dsi_error()
1229 dsi_timeout_status(msm_host); in dsi_error()
1230 dsi_status(msm_host); in dsi_error()
1231 dsi_dln0_phy_err(msm_host); in dsi_error()
1233 queue_work(msm_host->workqueue, &msm_host->err_work); in dsi_error()
1238 struct msm_dsi_host *msm_host = ptr; in dsi_host_irq() local
1242 if (!msm_host->ctrl_base) in dsi_host_irq()
1245 spin_lock_irqsave(&msm_host->intr_lock, flags); in dsi_host_irq()
1246 isr = dsi_read(msm_host, REG_DSI_INTR_CTRL); in dsi_host_irq()
1247 dsi_write(msm_host, REG_DSI_INTR_CTRL, isr); in dsi_host_irq()
1248 spin_unlock_irqrestore(&msm_host->intr_lock, flags); in dsi_host_irq()
1250 DBG("isr=0x%x, id=%d", isr, msm_host->id); in dsi_host_irq()
1253 dsi_error(msm_host); in dsi_host_irq()
1256 complete(&msm_host->video_comp); in dsi_host_irq()
1259 complete(&msm_host->dma_comp); in dsi_host_irq()
1264 static int dsi_host_init_panel_gpios(struct msm_dsi_host *msm_host, in dsi_host_init_panel_gpios() argument
1267 msm_host->disp_en_gpio = devm_gpiod_get_optional(panel_device, in dsi_host_init_panel_gpios()
1270 if (IS_ERR(msm_host->disp_en_gpio)) { in dsi_host_init_panel_gpios()
1272 PTR_ERR(msm_host->disp_en_gpio)); in dsi_host_init_panel_gpios()
1273 return PTR_ERR(msm_host->disp_en_gpio); in dsi_host_init_panel_gpios()
1276 msm_host->te_gpio = devm_gpiod_get_optional(panel_device, "disp-te", in dsi_host_init_panel_gpios()
1278 if (IS_ERR(msm_host->te_gpio)) { in dsi_host_init_panel_gpios()
1279 DBG("cannot get disp-te-gpios %ld", PTR_ERR(msm_host->te_gpio)); in dsi_host_init_panel_gpios()
1280 return PTR_ERR(msm_host->te_gpio); in dsi_host_init_panel_gpios()
1289 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in dsi_host_attach() local
1292 msm_host->channel = dsi->channel; in dsi_host_attach()
1293 msm_host->lanes = dsi->lanes; in dsi_host_attach()
1294 msm_host->format = dsi->format; in dsi_host_attach()
1295 msm_host->mode_flags = dsi->mode_flags; in dsi_host_attach()
1297 WARN_ON(dsi->dev.of_node != msm_host->device_node); in dsi_host_attach()
1300 ret = dsi_host_init_panel_gpios(msm_host, &dsi->dev); in dsi_host_attach()
1304 DBG("id=%d", msm_host->id); in dsi_host_attach()
1305 if (msm_host->dev) in dsi_host_attach()
1306 drm_helper_hpd_irq_event(msm_host->dev); in dsi_host_attach()
1314 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in dsi_host_detach() local
1316 msm_host->device_node = NULL; in dsi_host_detach()
1318 DBG("id=%d", msm_host->id); in dsi_host_detach()
1319 if (msm_host->dev) in dsi_host_detach()
1320 drm_helper_hpd_irq_event(msm_host->dev); in dsi_host_detach()
1328 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in dsi_host_transfer() local
1331 if (!msg || !msm_host->power_on) in dsi_host_transfer()
1334 mutex_lock(&msm_host->cmd_mutex); in dsi_host_transfer()
1335 ret = msm_dsi_manager_cmd_xfer(msm_host->id, msg); in dsi_host_transfer()
1336 mutex_unlock(&msm_host->cmd_mutex); in dsi_host_transfer()
1347 static int dsi_host_parse_dt(struct msm_dsi_host *msm_host) in dsi_host_parse_dt() argument
1349 struct device *dev = &msm_host->pdev->dev; in dsi_host_parse_dt()
1354 ret = of_property_read_u32(np, "qcom,dsi-host-index", &msm_host->id); in dsi_host_parse_dt()
1384 msm_host->device_node = device_node; in dsi_host_parse_dt()
1391 struct msm_dsi_host *msm_host = NULL; in msm_dsi_host_init() local
1395 msm_host = devm_kzalloc(&pdev->dev, sizeof(*msm_host), GFP_KERNEL); in msm_dsi_host_init()
1396 if (!msm_host) { in msm_dsi_host_init()
1403 msm_host->pdev = pdev; in msm_dsi_host_init()
1405 ret = dsi_host_parse_dt(msm_host); in msm_dsi_host_init()
1411 ret = dsi_clk_init(msm_host); in msm_dsi_host_init()
1417 msm_host->ctrl_base = msm_ioremap(pdev, "dsi_ctrl", "DSI CTRL"); in msm_dsi_host_init()
1418 if (IS_ERR(msm_host->ctrl_base)) { in msm_dsi_host_init()
1420 ret = PTR_ERR(msm_host->ctrl_base); in msm_dsi_host_init()
1424 msm_host->cfg_hnd = dsi_get_config(msm_host); in msm_dsi_host_init()
1425 if (!msm_host->cfg_hnd) { in msm_dsi_host_init()
1432 msm_host->ctrl_base += msm_host->cfg_hnd->cfg->io_offset; in msm_dsi_host_init()
1434 ret = dsi_regulator_init(msm_host); in msm_dsi_host_init()
1440 msm_host->rx_buf = devm_kzalloc(&pdev->dev, SZ_4K, GFP_KERNEL); in msm_dsi_host_init()
1441 if (!msm_host->rx_buf) { in msm_dsi_host_init()
1446 init_completion(&msm_host->dma_comp); in msm_dsi_host_init()
1447 init_completion(&msm_host->video_comp); in msm_dsi_host_init()
1448 mutex_init(&msm_host->dev_mutex); in msm_dsi_host_init()
1449 mutex_init(&msm_host->cmd_mutex); in msm_dsi_host_init()
1450 mutex_init(&msm_host->clk_mutex); in msm_dsi_host_init()
1451 spin_lock_init(&msm_host->intr_lock); in msm_dsi_host_init()
1454 msm_host->workqueue = alloc_ordered_workqueue("dsi_drm_work", 0); in msm_dsi_host_init()
1455 INIT_WORK(&msm_host->err_work, dsi_err_worker); in msm_dsi_host_init()
1457 msm_dsi->host = &msm_host->base; in msm_dsi_host_init()
1458 msm_dsi->id = msm_host->id; in msm_dsi_host_init()
1460 DBG("Dsi Host %d initialized", msm_host->id); in msm_dsi_host_init()
1469 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_destroy() local
1472 dsi_tx_buf_free(msm_host); in msm_dsi_host_destroy()
1473 if (msm_host->workqueue) { in msm_dsi_host_destroy()
1474 flush_workqueue(msm_host->workqueue); in msm_dsi_host_destroy()
1475 destroy_workqueue(msm_host->workqueue); in msm_dsi_host_destroy()
1476 msm_host->workqueue = NULL; in msm_dsi_host_destroy()
1479 mutex_destroy(&msm_host->clk_mutex); in msm_dsi_host_destroy()
1480 mutex_destroy(&msm_host->cmd_mutex); in msm_dsi_host_destroy()
1481 mutex_destroy(&msm_host->dev_mutex); in msm_dsi_host_destroy()
1487 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_modeset_init() local
1488 struct platform_device *pdev = msm_host->pdev; in msm_dsi_host_modeset_init()
1491 msm_host->irq = irq_of_parse_and_map(pdev->dev.of_node, 0); in msm_dsi_host_modeset_init()
1492 if (msm_host->irq < 0) { in msm_dsi_host_modeset_init()
1493 ret = msm_host->irq; in msm_dsi_host_modeset_init()
1498 ret = devm_request_irq(&pdev->dev, msm_host->irq, in msm_dsi_host_modeset_init()
1500 "dsi_isr", msm_host); in msm_dsi_host_modeset_init()
1503 msm_host->irq, ret); in msm_dsi_host_modeset_init()
1507 msm_host->dev = dev; in msm_dsi_host_modeset_init()
1508 ret = dsi_tx_buf_alloc(msm_host, SZ_4K); in msm_dsi_host_modeset_init()
1519 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_register() local
1523 if (!msm_host->registered) { in msm_dsi_host_register()
1524 host->dev = &msm_host->pdev->dev; in msm_dsi_host_register()
1530 msm_host->registered = true; in msm_dsi_host_register()
1540 if (check_defer && msm_host->device_node) { in msm_dsi_host_register()
1541 if (!of_drm_find_panel(msm_host->device_node)) in msm_dsi_host_register()
1542 if (!of_drm_find_bridge(msm_host->device_node)) in msm_dsi_host_register()
1552 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_unregister() local
1554 if (msm_host->registered) { in msm_dsi_host_unregister()
1558 msm_host->registered = false; in msm_dsi_host_unregister()
1565 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_xfer_prepare() local
1577 dsi_clk_ctrl(msm_host, 1); in msm_dsi_host_xfer_prepare()
1582 dsi_set_tx_power_mode(0, msm_host); in msm_dsi_host_xfer_prepare()
1584 msm_host->dma_cmd_ctrl_restore = dsi_read(msm_host, REG_DSI_CTRL); in msm_dsi_host_xfer_prepare()
1585 dsi_write(msm_host, REG_DSI_CTRL, in msm_dsi_host_xfer_prepare()
1586 msm_host->dma_cmd_ctrl_restore | in msm_dsi_host_xfer_prepare()
1589 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_CMD_DMA_DONE, 1); in msm_dsi_host_xfer_prepare()
1597 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_xfer_restore() local
1599 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_CMD_DMA_DONE, 0); in msm_dsi_host_xfer_restore()
1600 dsi_write(msm_host, REG_DSI_CTRL, msm_host->dma_cmd_ctrl_restore); in msm_dsi_host_xfer_restore()
1603 dsi_set_tx_power_mode(1, msm_host); in msm_dsi_host_xfer_restore()
1607 dsi_clk_ctrl(msm_host, 0); in msm_dsi_host_xfer_restore()
1613 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_cmd_tx() local
1615 return dsi_cmds2buf_tx(msm_host, msg); in msm_dsi_host_cmd_tx()
1621 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_cmd_rx() local
1622 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_cmd_rx()
1643 buf = msm_host->rx_buf; in msm_dsi_host_cmd_rx()
1657 ret = dsi_cmds2buf_tx(msm_host, &max_pkt_size_msg); in msm_dsi_host_cmd_rx()
1667 dsi_write(msm_host, REG_DSI_RDBK_DATA_CTRL, in msm_dsi_host_cmd_rx()
1670 dsi_write(msm_host, REG_DSI_RDBK_DATA_CTRL, 0); in msm_dsi_host_cmd_rx()
1674 ret = dsi_cmds2buf_tx(msm_host, msg); in msm_dsi_host_cmd_rx()
1687 dlen = dsi_cmd_dma_rx(msm_host, buf, rx_byte, pkt_size); in msm_dsi_host_cmd_rx()
1723 buf = msm_host->rx_buf + (10 - rlen); in msm_dsi_host_cmd_rx()
1725 buf = msm_host->rx_buf; in msm_dsi_host_cmd_rx()
1755 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_cmd_xfer_commit() local
1757 dsi_write(msm_host, REG_DSI_DMA_BASE, iova); in msm_dsi_host_cmd_xfer_commit()
1758 dsi_write(msm_host, REG_DSI_DMA_LEN, len); in msm_dsi_host_cmd_xfer_commit()
1759 dsi_write(msm_host, REG_DSI_TRIG_DMA, 1); in msm_dsi_host_cmd_xfer_commit()
1768 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_set_src_pll() local
1780 ret = clk_set_parent(msm_host->byte_clk_src, byte_clk_provider); in msm_dsi_host_set_src_pll()
1787 ret = clk_set_parent(msm_host->pixel_clk_src, pixel_clk_provider); in msm_dsi_host_set_src_pll()
1800 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_enable() local
1802 dsi_op_mode_config(msm_host, in msm_dsi_host_enable()
1803 !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO), true); in msm_dsi_host_enable()
1817 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_disable() local
1819 dsi_op_mode_config(msm_host, in msm_dsi_host_disable()
1820 !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO), false); in msm_dsi_host_disable()
1826 dsi_sw_reset(msm_host); in msm_dsi_host_disable()
1833 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_power_on() local
1837 mutex_lock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
1838 if (msm_host->power_on) { in msm_dsi_host_power_on()
1843 ret = dsi_calc_clk_rate(msm_host); in msm_dsi_host_power_on()
1849 ret = dsi_host_regulator_enable(msm_host); in msm_dsi_host_power_on()
1856 ret = dsi_bus_clk_enable(msm_host); in msm_dsi_host_power_on()
1862 dsi_phy_sw_reset(msm_host); in msm_dsi_host_power_on()
1863 ret = msm_dsi_manager_phy_enable(msm_host->id, in msm_dsi_host_power_on()
1864 msm_host->byte_clk_rate * 8, in msm_dsi_host_power_on()
1865 clk_get_rate(msm_host->esc_clk), in msm_dsi_host_power_on()
1867 dsi_bus_clk_disable(msm_host); in msm_dsi_host_power_on()
1873 ret = dsi_clk_ctrl(msm_host, 1); in msm_dsi_host_power_on()
1879 ret = pinctrl_pm_select_default_state(&msm_host->pdev->dev); in msm_dsi_host_power_on()
1886 dsi_timing_setup(msm_host); in msm_dsi_host_power_on()
1887 dsi_sw_reset(msm_host); in msm_dsi_host_power_on()
1888 dsi_ctrl_config(msm_host, true, clk_pre, clk_post); in msm_dsi_host_power_on()
1890 if (msm_host->disp_en_gpio) in msm_dsi_host_power_on()
1891 gpiod_set_value(msm_host->disp_en_gpio, 1); in msm_dsi_host_power_on()
1893 msm_host->power_on = true; in msm_dsi_host_power_on()
1894 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
1899 dsi_clk_ctrl(msm_host, 0); in msm_dsi_host_power_on()
1901 dsi_host_regulator_disable(msm_host); in msm_dsi_host_power_on()
1903 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
1909 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_power_off() local
1911 mutex_lock(&msm_host->dev_mutex); in msm_dsi_host_power_off()
1912 if (!msm_host->power_on) { in msm_dsi_host_power_off()
1917 dsi_ctrl_config(msm_host, false, 0, 0); in msm_dsi_host_power_off()
1919 if (msm_host->disp_en_gpio) in msm_dsi_host_power_off()
1920 gpiod_set_value(msm_host->disp_en_gpio, 0); in msm_dsi_host_power_off()
1922 pinctrl_pm_select_sleep_state(&msm_host->pdev->dev); in msm_dsi_host_power_off()
1924 msm_dsi_manager_phy_disable(msm_host->id); in msm_dsi_host_power_off()
1926 dsi_clk_ctrl(msm_host, 0); in msm_dsi_host_power_off()
1928 dsi_host_regulator_disable(msm_host); in msm_dsi_host_power_off()
1932 msm_host->power_on = false; in msm_dsi_host_power_off()
1935 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_off()
1942 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_set_display_mode() local
1944 if (msm_host->mode) { in msm_dsi_host_set_display_mode()
1945 drm_mode_destroy(msm_host->dev, msm_host->mode); in msm_dsi_host_set_display_mode()
1946 msm_host->mode = NULL; in msm_dsi_host_set_display_mode()
1949 msm_host->mode = drm_mode_duplicate(msm_host->dev, mode); in msm_dsi_host_set_display_mode()
1950 if (IS_ERR(msm_host->mode)) { in msm_dsi_host_set_display_mode()
1952 return PTR_ERR(msm_host->mode); in msm_dsi_host_set_display_mode()
1961 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_get_panel() local
1964 panel = of_drm_find_panel(msm_host->device_node); in msm_dsi_host_get_panel()
1966 *panel_flags = msm_host->mode_flags; in msm_dsi_host_get_panel()
1973 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_get_bridge() local
1975 return of_drm_find_bridge(msm_host->device_node); in msm_dsi_host_get_bridge()