Lines Matching refs:msm_host
256 static inline u32 dsi_read(struct msm_dsi_host *msm_host, u32 reg) in dsi_read() argument
258 return msm_readl(msm_host->ctrl_base + msm_host->cfg->io_offset + reg); in dsi_read()
260 static inline void dsi_write(struct msm_dsi_host *msm_host, u32 reg, u32 data) in dsi_write() argument
262 msm_writel(data, msm_host->ctrl_base + msm_host->cfg->io_offset + reg); in dsi_write()
265 static int dsi_host_regulator_enable(struct msm_dsi_host *msm_host);
266 static void dsi_host_regulator_disable(struct msm_dsi_host *msm_host);
268 static const struct dsi_config *dsi_get_config(struct msm_dsi_host *msm_host) in dsi_get_config() argument
275 gdsc_reg = regulator_get(&msm_host->pdev->dev, "gdsc"); in dsi_get_config()
286 ret = clk_prepare_enable(msm_host->ahb_clk); in dsi_get_config()
294 ret = dsi_get_version(msm_host->ctrl_base, &major, &minor); in dsi_get_config()
296 clk_disable_unprepare(msm_host->ahb_clk); in dsi_get_config()
320 static void dsi_host_regulator_disable(struct msm_dsi_host *msm_host) in dsi_host_regulator_disable() argument
322 struct regulator_bulk_data *s = msm_host->supplies; in dsi_host_regulator_disable()
323 const struct dsi_reg_entry *regs = msm_host->cfg->reg_cfg.regs; in dsi_host_regulator_disable()
324 int num = msm_host->cfg->reg_cfg.num; in dsi_host_regulator_disable()
336 static int dsi_host_regulator_enable(struct msm_dsi_host *msm_host) in dsi_host_regulator_enable() argument
338 struct regulator_bulk_data *s = msm_host->supplies; in dsi_host_regulator_enable()
339 const struct dsi_reg_entry *regs = msm_host->cfg->reg_cfg.regs; in dsi_host_regulator_enable()
340 int num = msm_host->cfg->reg_cfg.num; in dsi_host_regulator_enable()
370 static int dsi_regulator_init(struct msm_dsi_host *msm_host) in dsi_regulator_init() argument
372 struct regulator_bulk_data *s = msm_host->supplies; in dsi_regulator_init()
373 const struct dsi_reg_entry *regs = msm_host->cfg->reg_cfg.regs; in dsi_regulator_init()
374 int num = msm_host->cfg->reg_cfg.num; in dsi_regulator_init()
380 ret = devm_regulator_bulk_get(&msm_host->pdev->dev, num, s); in dsi_regulator_init()
402 static int dsi_clk_init(struct msm_dsi_host *msm_host) in dsi_clk_init() argument
404 struct device *dev = &msm_host->pdev->dev; in dsi_clk_init()
407 msm_host->mdp_core_clk = devm_clk_get(dev, "mdp_core_clk"); in dsi_clk_init()
408 if (IS_ERR(msm_host->mdp_core_clk)) { in dsi_clk_init()
409 ret = PTR_ERR(msm_host->mdp_core_clk); in dsi_clk_init()
415 msm_host->ahb_clk = devm_clk_get(dev, "iface_clk"); in dsi_clk_init()
416 if (IS_ERR(msm_host->ahb_clk)) { in dsi_clk_init()
417 ret = PTR_ERR(msm_host->ahb_clk); in dsi_clk_init()
423 msm_host->axi_clk = devm_clk_get(dev, "bus_clk"); in dsi_clk_init()
424 if (IS_ERR(msm_host->axi_clk)) { in dsi_clk_init()
425 ret = PTR_ERR(msm_host->axi_clk); in dsi_clk_init()
431 msm_host->mmss_misc_ahb_clk = devm_clk_get(dev, "core_mmss_clk"); in dsi_clk_init()
432 if (IS_ERR(msm_host->mmss_misc_ahb_clk)) { in dsi_clk_init()
433 ret = PTR_ERR(msm_host->mmss_misc_ahb_clk); in dsi_clk_init()
439 msm_host->byte_clk = devm_clk_get(dev, "byte_clk"); in dsi_clk_init()
440 if (IS_ERR(msm_host->byte_clk)) { in dsi_clk_init()
441 ret = PTR_ERR(msm_host->byte_clk); in dsi_clk_init()
444 msm_host->byte_clk = NULL; in dsi_clk_init()
448 msm_host->pixel_clk = devm_clk_get(dev, "pixel_clk"); in dsi_clk_init()
449 if (IS_ERR(msm_host->pixel_clk)) { in dsi_clk_init()
450 ret = PTR_ERR(msm_host->pixel_clk); in dsi_clk_init()
453 msm_host->pixel_clk = NULL; in dsi_clk_init()
457 msm_host->esc_clk = devm_clk_get(dev, "core_clk"); in dsi_clk_init()
458 if (IS_ERR(msm_host->esc_clk)) { in dsi_clk_init()
459 ret = PTR_ERR(msm_host->esc_clk); in dsi_clk_init()
462 msm_host->esc_clk = NULL; in dsi_clk_init()
470 static int dsi_bus_clk_enable(struct msm_dsi_host *msm_host) in dsi_bus_clk_enable() argument
474 DBG("id=%d", msm_host->id); in dsi_bus_clk_enable()
476 ret = clk_prepare_enable(msm_host->mdp_core_clk); in dsi_bus_clk_enable()
483 ret = clk_prepare_enable(msm_host->ahb_clk); in dsi_bus_clk_enable()
489 ret = clk_prepare_enable(msm_host->axi_clk); in dsi_bus_clk_enable()
495 ret = clk_prepare_enable(msm_host->mmss_misc_ahb_clk); in dsi_bus_clk_enable()
505 clk_disable_unprepare(msm_host->axi_clk); in dsi_bus_clk_enable()
507 clk_disable_unprepare(msm_host->ahb_clk); in dsi_bus_clk_enable()
509 clk_disable_unprepare(msm_host->mdp_core_clk); in dsi_bus_clk_enable()
514 static void dsi_bus_clk_disable(struct msm_dsi_host *msm_host) in dsi_bus_clk_disable() argument
517 clk_disable_unprepare(msm_host->mmss_misc_ahb_clk); in dsi_bus_clk_disable()
518 clk_disable_unprepare(msm_host->axi_clk); in dsi_bus_clk_disable()
519 clk_disable_unprepare(msm_host->ahb_clk); in dsi_bus_clk_disable()
520 clk_disable_unprepare(msm_host->mdp_core_clk); in dsi_bus_clk_disable()
523 static int dsi_link_clk_enable(struct msm_dsi_host *msm_host) in dsi_link_clk_enable() argument
528 msm_host->mode->clock, msm_host->byte_clk_rate); in dsi_link_clk_enable()
530 ret = clk_set_rate(msm_host->byte_clk, msm_host->byte_clk_rate); in dsi_link_clk_enable()
536 ret = clk_set_rate(msm_host->pixel_clk, msm_host->mode->clock * 1000); in dsi_link_clk_enable()
542 ret = clk_prepare_enable(msm_host->esc_clk); in dsi_link_clk_enable()
548 ret = clk_prepare_enable(msm_host->byte_clk); in dsi_link_clk_enable()
554 ret = clk_prepare_enable(msm_host->pixel_clk); in dsi_link_clk_enable()
563 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_enable()
565 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_enable()
570 static void dsi_link_clk_disable(struct msm_dsi_host *msm_host) in dsi_link_clk_disable() argument
572 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_disable()
573 clk_disable_unprepare(msm_host->pixel_clk); in dsi_link_clk_disable()
574 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_disable()
577 static int dsi_clk_ctrl(struct msm_dsi_host *msm_host, bool enable) in dsi_clk_ctrl() argument
581 mutex_lock(&msm_host->clk_mutex); in dsi_clk_ctrl()
583 ret = dsi_bus_clk_enable(msm_host); in dsi_clk_ctrl()
589 ret = dsi_link_clk_enable(msm_host); in dsi_clk_ctrl()
593 dsi_bus_clk_disable(msm_host); in dsi_clk_ctrl()
597 dsi_link_clk_disable(msm_host); in dsi_clk_ctrl()
598 dsi_bus_clk_disable(msm_host); in dsi_clk_ctrl()
602 mutex_unlock(&msm_host->clk_mutex); in dsi_clk_ctrl()
606 static int dsi_calc_clk_rate(struct msm_dsi_host *msm_host) in dsi_calc_clk_rate() argument
608 struct drm_display_mode *mode = msm_host->mode; in dsi_calc_clk_rate()
609 u8 lanes = msm_host->lanes; in dsi_calc_clk_rate()
610 u32 bpp = dsi_get_bpp(msm_host->format); in dsi_calc_clk_rate()
620 msm_host->byte_clk_rate = (pclk_rate * bpp) / (8 * lanes); in dsi_calc_clk_rate()
623 msm_host->byte_clk_rate = (pclk_rate * bpp) / 8; in dsi_calc_clk_rate()
626 DBG("pclk=%d, bclk=%d", pclk_rate, msm_host->byte_clk_rate); in dsi_calc_clk_rate()
631 static void dsi_phy_sw_reset(struct msm_dsi_host *msm_host) in dsi_phy_sw_reset() argument
634 dsi_write(msm_host, REG_DSI_PHY_RESET, DSI_PHY_RESET_RESET); in dsi_phy_sw_reset()
638 dsi_write(msm_host, REG_DSI_PHY_RESET, 0); in dsi_phy_sw_reset()
642 static void dsi_intr_ctrl(struct msm_dsi_host *msm_host, u32 mask, int enable) in dsi_intr_ctrl() argument
647 spin_lock_irqsave(&msm_host->intr_lock, flags); in dsi_intr_ctrl()
648 intr = dsi_read(msm_host, REG_DSI_INTR_CTRL); in dsi_intr_ctrl()
657 dsi_write(msm_host, REG_DSI_INTR_CTRL, intr); in dsi_intr_ctrl()
658 spin_unlock_irqrestore(&msm_host->intr_lock, flags); in dsi_intr_ctrl()
695 static void dsi_ctrl_config(struct msm_dsi_host *msm_host, bool enable, in dsi_ctrl_config() argument
698 u32 flags = msm_host->mode_flags; in dsi_ctrl_config()
699 enum mipi_dsi_pixel_format mipi_fmt = msm_host->format; in dsi_ctrl_config()
703 dsi_write(msm_host, REG_DSI_CTRL, 0); in dsi_ctrl_config()
723 data |= DSI_VID_CFG0_VIRT_CHANNEL(msm_host->channel); in dsi_ctrl_config()
724 dsi_write(msm_host, REG_DSI_VID_CFG0, data); in dsi_ctrl_config()
728 dsi_write(msm_host, REG_DSI_VID_CFG1, 0); in dsi_ctrl_config()
733 dsi_write(msm_host, REG_DSI_CMD_CFG0, data); in dsi_ctrl_config()
740 dsi_write(msm_host, REG_DSI_CMD_CFG1, data); in dsi_ctrl_config()
743 dsi_write(msm_host, REG_DSI_CMD_DMA_CTRL, in dsi_ctrl_config()
752 data |= DSI_TRIG_CTRL_STREAM(msm_host->channel); in dsi_ctrl_config()
753 if ((msm_host->cfg->major == MSM_DSI_VER_MAJOR_6G) && in dsi_ctrl_config()
754 (msm_host->cfg->minor >= MSM_DSI_6G_VER_MINOR_V1_2)) in dsi_ctrl_config()
756 dsi_write(msm_host, REG_DSI_TRIG_CTRL, data); in dsi_ctrl_config()
760 dsi_write(msm_host, REG_DSI_CLKOUT_TIMING_CTRL, data); in dsi_ctrl_config()
765 dsi_write(msm_host, REG_DSI_EOT_PACKET_CTRL, data); in dsi_ctrl_config()
768 dsi_write(msm_host, REG_DSI_ERR_INT_MASK0, 0x13ff3fe0); in dsi_ctrl_config()
770 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_ERROR, 1); in dsi_ctrl_config()
772 dsi_write(msm_host, REG_DSI_CLK_CTRL, DSI_CLK_CTRL_ENABLE_CLKS); in dsi_ctrl_config()
776 DBG("lane number=%d", msm_host->lanes); in dsi_ctrl_config()
777 if (msm_host->lanes == 2) { in dsi_ctrl_config()
780 dsi_write(msm_host, REG_DSI_LANE_SWAP_CTRL, in dsi_ctrl_config()
787 dsi_write(msm_host, REG_DSI_LANE_SWAP_CTRL, in dsi_ctrl_config()
792 dsi_write(msm_host, REG_DSI_CTRL, data); in dsi_ctrl_config()
795 static void dsi_timing_setup(struct msm_dsi_host *msm_host) in dsi_timing_setup() argument
797 struct drm_display_mode *mode = msm_host->mode; in dsi_timing_setup()
811 if (msm_host->mode_flags & MIPI_DSI_MODE_VIDEO) { in dsi_timing_setup()
812 dsi_write(msm_host, REG_DSI_ACTIVE_H, in dsi_timing_setup()
815 dsi_write(msm_host, REG_DSI_ACTIVE_V, in dsi_timing_setup()
818 dsi_write(msm_host, REG_DSI_TOTAL, in dsi_timing_setup()
822 dsi_write(msm_host, REG_DSI_ACTIVE_HSYNC, in dsi_timing_setup()
825 dsi_write(msm_host, REG_DSI_ACTIVE_VSYNC_HPOS, 0); in dsi_timing_setup()
826 dsi_write(msm_host, REG_DSI_ACTIVE_VSYNC_VPOS, in dsi_timing_setup()
831 wc = mode->hdisplay * dsi_get_bpp(msm_host->format) / 8 + 1; in dsi_timing_setup()
833 dsi_write(msm_host, REG_DSI_CMD_MDP_STREAM_CTRL, in dsi_timing_setup()
836 msm_host->channel) | in dsi_timing_setup()
840 dsi_write(msm_host, REG_DSI_CMD_MDP_STREAM_TOTAL, in dsi_timing_setup()
846 static void dsi_sw_reset(struct msm_dsi_host *msm_host) in dsi_sw_reset() argument
848 dsi_write(msm_host, REG_DSI_CLK_CTRL, DSI_CLK_CTRL_ENABLE_CLKS); in dsi_sw_reset()
851 dsi_write(msm_host, REG_DSI_RESET, 1); in dsi_sw_reset()
853 dsi_write(msm_host, REG_DSI_RESET, 0); in dsi_sw_reset()
856 static void dsi_op_mode_config(struct msm_dsi_host *msm_host, in dsi_op_mode_config() argument
861 dsi_ctrl = dsi_read(msm_host, REG_DSI_CTRL); in dsi_op_mode_config()
866 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_CMD_MDP_DONE | in dsi_op_mode_config()
873 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_CMD_MDP_DONE, 1); in dsi_op_mode_config()
878 dsi_write(msm_host, REG_DSI_CTRL, dsi_ctrl); in dsi_op_mode_config()
881 static void dsi_set_tx_power_mode(int mode, struct msm_dsi_host *msm_host) in dsi_set_tx_power_mode() argument
885 data = dsi_read(msm_host, REG_DSI_CMD_DMA_CTRL); in dsi_set_tx_power_mode()
892 dsi_write(msm_host, REG_DSI_CMD_DMA_CTRL, data); in dsi_set_tx_power_mode()
895 static void dsi_wait4video_done(struct msm_dsi_host *msm_host) in dsi_wait4video_done() argument
897 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_VIDEO_DONE, 1); in dsi_wait4video_done()
899 reinit_completion(&msm_host->video_comp); in dsi_wait4video_done()
901 wait_for_completion_timeout(&msm_host->video_comp, in dsi_wait4video_done()
904 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_VIDEO_DONE, 0); in dsi_wait4video_done()
907 static void dsi_wait4video_eng_busy(struct msm_dsi_host *msm_host) in dsi_wait4video_eng_busy() argument
909 if (!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO)) in dsi_wait4video_eng_busy()
912 if (msm_host->power_on) { in dsi_wait4video_eng_busy()
913 dsi_wait4video_done(msm_host); in dsi_wait4video_eng_busy()
920 static int dsi_tx_buf_alloc(struct msm_dsi_host *msm_host, int size) in dsi_tx_buf_alloc() argument
922 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_alloc()
927 msm_host->tx_gem_obj = msm_gem_new(dev, size, MSM_BO_UNCACHED); in dsi_tx_buf_alloc()
928 if (IS_ERR(msm_host->tx_gem_obj)) { in dsi_tx_buf_alloc()
929 ret = PTR_ERR(msm_host->tx_gem_obj); in dsi_tx_buf_alloc()
931 msm_host->tx_gem_obj = NULL; in dsi_tx_buf_alloc()
936 ret = msm_gem_get_iova_locked(msm_host->tx_gem_obj, 0, &iova); in dsi_tx_buf_alloc()
951 static void dsi_tx_buf_free(struct msm_dsi_host *msm_host) in dsi_tx_buf_free() argument
953 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_free()
955 if (msm_host->tx_gem_obj) { in dsi_tx_buf_free()
956 msm_gem_put_iova(msm_host->tx_gem_obj, 0); in dsi_tx_buf_free()
958 msm_gem_free_object(msm_host->tx_gem_obj); in dsi_tx_buf_free()
959 msm_host->tx_gem_obj = NULL; in dsi_tx_buf_free()
1059 static int dsi_cmd_dma_tx(struct msm_dsi_host *msm_host, int len) in dsi_cmd_dma_tx() argument
1065 ret = msm_gem_get_iova(msm_host->tx_gem_obj, 0, &iova); in dsi_cmd_dma_tx()
1071 reinit_completion(&msm_host->dma_comp); in dsi_cmd_dma_tx()
1073 dsi_wait4video_eng_busy(msm_host); in dsi_cmd_dma_tx()
1076 msm_host->id, iova, len); in dsi_cmd_dma_tx()
1078 ret = wait_for_completion_timeout(&msm_host->dma_comp, in dsi_cmd_dma_tx()
1091 static int dsi_cmd_dma_rx(struct msm_dsi_host *msm_host, in dsi_cmd_dma_rx() argument
1099 int buf_offset = buf - msm_host->rx_buf; in dsi_cmd_dma_rx()
1130 data = dsi_read(msm_host, REG_DSI_RDBK_DATA(i)); in dsi_cmd_dma_rx()
1141 static int dsi_cmds2buf_tx(struct msm_dsi_host *msm_host, in dsi_cmds2buf_tx() argument
1145 int bllp_len = msm_host->mode->hdisplay * in dsi_cmds2buf_tx()
1146 dsi_get_bpp(msm_host->format) / 8; in dsi_cmds2buf_tx()
1148 len = dsi_cmd_dma_add(msm_host->tx_gem_obj, msg); in dsi_cmds2buf_tx()
1164 if ((msm_host->mode_flags & MIPI_DSI_MODE_VIDEO) && (len > bllp_len)) { in dsi_cmds2buf_tx()
1170 ret = dsi_cmd_dma_tx(msm_host, len); in dsi_cmds2buf_tx()
1180 static void dsi_sw_reset_restore(struct msm_dsi_host *msm_host) in dsi_sw_reset_restore() argument
1184 data0 = dsi_read(msm_host, REG_DSI_CTRL); in dsi_sw_reset_restore()
1187 dsi_write(msm_host, REG_DSI_CTRL, data1); in dsi_sw_reset_restore()
1194 dsi_write(msm_host, REG_DSI_CLK_CTRL, DSI_CLK_CTRL_ENABLE_CLKS); in dsi_sw_reset_restore()
1198 dsi_write(msm_host, REG_DSI_RESET, 1); in dsi_sw_reset_restore()
1200 dsi_write(msm_host, REG_DSI_RESET, 0); in dsi_sw_reset_restore()
1202 dsi_write(msm_host, REG_DSI_CTRL, data0); in dsi_sw_reset_restore()
1208 struct msm_dsi_host *msm_host = in dsi_err_worker() local
1210 u32 status = msm_host->err_work_state; in dsi_err_worker()
1214 dsi_sw_reset_restore(msm_host); in dsi_err_worker()
1217 msm_host->err_work_state = 0; in dsi_err_worker()
1220 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_ERROR, 1); in dsi_err_worker()
1223 static void dsi_ack_err_status(struct msm_dsi_host *msm_host) in dsi_ack_err_status() argument
1227 status = dsi_read(msm_host, REG_DSI_ACK_ERR_STATUS); in dsi_ack_err_status()
1230 dsi_write(msm_host, REG_DSI_ACK_ERR_STATUS, status); in dsi_ack_err_status()
1232 dsi_write(msm_host, REG_DSI_ACK_ERR_STATUS, 0); in dsi_ack_err_status()
1233 msm_host->err_work_state |= DSI_ERR_STATE_ACK; in dsi_ack_err_status()
1237 static void dsi_timeout_status(struct msm_dsi_host *msm_host) in dsi_timeout_status() argument
1241 status = dsi_read(msm_host, REG_DSI_TIMEOUT_STATUS); in dsi_timeout_status()
1244 dsi_write(msm_host, REG_DSI_TIMEOUT_STATUS, status); in dsi_timeout_status()
1245 msm_host->err_work_state |= DSI_ERR_STATE_TIMEOUT; in dsi_timeout_status()
1249 static void dsi_dln0_phy_err(struct msm_dsi_host *msm_host) in dsi_dln0_phy_err() argument
1253 status = dsi_read(msm_host, REG_DSI_DLN0_PHY_ERR); in dsi_dln0_phy_err()
1256 dsi_write(msm_host, REG_DSI_DLN0_PHY_ERR, status); in dsi_dln0_phy_err()
1257 msm_host->err_work_state |= DSI_ERR_STATE_DLN0_PHY; in dsi_dln0_phy_err()
1261 static void dsi_fifo_status(struct msm_dsi_host *msm_host) in dsi_fifo_status() argument
1265 status = dsi_read(msm_host, REG_DSI_FIFO_STATUS); in dsi_fifo_status()
1269 dsi_write(msm_host, REG_DSI_FIFO_STATUS, status); in dsi_fifo_status()
1270 msm_host->err_work_state |= DSI_ERR_STATE_FIFO; in dsi_fifo_status()
1272 msm_host->err_work_state |= in dsi_fifo_status()
1277 static void dsi_status(struct msm_dsi_host *msm_host) in dsi_status() argument
1281 status = dsi_read(msm_host, REG_DSI_STATUS0); in dsi_status()
1284 dsi_write(msm_host, REG_DSI_STATUS0, status); in dsi_status()
1285 msm_host->err_work_state |= in dsi_status()
1290 static void dsi_clk_status(struct msm_dsi_host *msm_host) in dsi_clk_status() argument
1294 status = dsi_read(msm_host, REG_DSI_CLK_STATUS); in dsi_clk_status()
1297 dsi_write(msm_host, REG_DSI_CLK_STATUS, status); in dsi_clk_status()
1298 msm_host->err_work_state |= DSI_ERR_STATE_PLL_UNLOCKED; in dsi_clk_status()
1302 static void dsi_error(struct msm_dsi_host *msm_host) in dsi_error() argument
1305 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_ERROR, 0); in dsi_error()
1307 dsi_clk_status(msm_host); in dsi_error()
1308 dsi_fifo_status(msm_host); in dsi_error()
1309 dsi_ack_err_status(msm_host); in dsi_error()
1310 dsi_timeout_status(msm_host); in dsi_error()
1311 dsi_status(msm_host); in dsi_error()
1312 dsi_dln0_phy_err(msm_host); in dsi_error()
1314 queue_work(msm_host->workqueue, &msm_host->err_work); in dsi_error()
1319 struct msm_dsi_host *msm_host = ptr; in dsi_host_irq() local
1323 if (!msm_host->ctrl_base) in dsi_host_irq()
1326 spin_lock_irqsave(&msm_host->intr_lock, flags); in dsi_host_irq()
1327 isr = dsi_read(msm_host, REG_DSI_INTR_CTRL); in dsi_host_irq()
1328 dsi_write(msm_host, REG_DSI_INTR_CTRL, isr); in dsi_host_irq()
1329 spin_unlock_irqrestore(&msm_host->intr_lock, flags); in dsi_host_irq()
1331 DBG("isr=0x%x, id=%d", isr, msm_host->id); in dsi_host_irq()
1334 dsi_error(msm_host); in dsi_host_irq()
1337 complete(&msm_host->video_comp); in dsi_host_irq()
1340 complete(&msm_host->dma_comp); in dsi_host_irq()
1345 static int dsi_host_init_panel_gpios(struct msm_dsi_host *msm_host, in dsi_host_init_panel_gpios() argument
1350 msm_host->disp_en_gpio = devm_gpiod_get(panel_device, in dsi_host_init_panel_gpios()
1352 if (IS_ERR(msm_host->disp_en_gpio)) { in dsi_host_init_panel_gpios()
1354 PTR_ERR(msm_host->disp_en_gpio)); in dsi_host_init_panel_gpios()
1355 msm_host->disp_en_gpio = NULL; in dsi_host_init_panel_gpios()
1357 if (msm_host->disp_en_gpio) { in dsi_host_init_panel_gpios()
1358 ret = gpiod_direction_output(msm_host->disp_en_gpio, 0); in dsi_host_init_panel_gpios()
1365 msm_host->te_gpio = devm_gpiod_get(panel_device, "disp-te"); in dsi_host_init_panel_gpios()
1366 if (IS_ERR(msm_host->te_gpio)) { in dsi_host_init_panel_gpios()
1367 DBG("cannot get disp-te-gpios %ld", PTR_ERR(msm_host->te_gpio)); in dsi_host_init_panel_gpios()
1368 msm_host->te_gpio = NULL; in dsi_host_init_panel_gpios()
1371 if (msm_host->te_gpio) { in dsi_host_init_panel_gpios()
1372 ret = gpiod_direction_input(msm_host->te_gpio); in dsi_host_init_panel_gpios()
1386 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in dsi_host_attach() local
1389 msm_host->channel = dsi->channel; in dsi_host_attach()
1390 msm_host->lanes = dsi->lanes; in dsi_host_attach()
1391 msm_host->format = dsi->format; in dsi_host_attach()
1392 msm_host->mode_flags = dsi->mode_flags; in dsi_host_attach()
1394 msm_host->panel_node = dsi->dev.of_node; in dsi_host_attach()
1397 ret = dsi_host_init_panel_gpios(msm_host, &dsi->dev); in dsi_host_attach()
1401 DBG("id=%d", msm_host->id); in dsi_host_attach()
1402 if (msm_host->dev) in dsi_host_attach()
1403 drm_helper_hpd_irq_event(msm_host->dev); in dsi_host_attach()
1411 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in dsi_host_detach() local
1413 msm_host->panel_node = NULL; in dsi_host_detach()
1415 DBG("id=%d", msm_host->id); in dsi_host_detach()
1416 if (msm_host->dev) in dsi_host_detach()
1417 drm_helper_hpd_irq_event(msm_host->dev); in dsi_host_detach()
1425 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in dsi_host_transfer() local
1428 if (!msg || !msm_host->power_on) in dsi_host_transfer()
1431 mutex_lock(&msm_host->cmd_mutex); in dsi_host_transfer()
1432 ret = msm_dsi_manager_cmd_xfer(msm_host->id, msg); in dsi_host_transfer()
1433 mutex_unlock(&msm_host->cmd_mutex); in dsi_host_transfer()
1446 struct msm_dsi_host *msm_host = NULL; in msm_dsi_host_init() local
1450 msm_host = devm_kzalloc(&pdev->dev, sizeof(*msm_host), GFP_KERNEL); in msm_dsi_host_init()
1451 if (!msm_host) { in msm_dsi_host_init()
1459 "qcom,dsi-host-index", &msm_host->id); in msm_dsi_host_init()
1466 msm_host->pdev = pdev; in msm_dsi_host_init()
1468 ret = dsi_clk_init(msm_host); in msm_dsi_host_init()
1474 msm_host->ctrl_base = msm_ioremap(pdev, "dsi_ctrl", "DSI CTRL"); in msm_dsi_host_init()
1475 if (IS_ERR(msm_host->ctrl_base)) { in msm_dsi_host_init()
1477 ret = PTR_ERR(msm_host->ctrl_base); in msm_dsi_host_init()
1481 msm_host->cfg = dsi_get_config(msm_host); in msm_dsi_host_init()
1482 if (!msm_host->cfg) { in msm_dsi_host_init()
1488 ret = dsi_regulator_init(msm_host); in msm_dsi_host_init()
1494 msm_host->rx_buf = devm_kzalloc(&pdev->dev, SZ_4K, GFP_KERNEL); in msm_dsi_host_init()
1495 if (!msm_host->rx_buf) { in msm_dsi_host_init()
1500 init_completion(&msm_host->dma_comp); in msm_dsi_host_init()
1501 init_completion(&msm_host->video_comp); in msm_dsi_host_init()
1502 mutex_init(&msm_host->dev_mutex); in msm_dsi_host_init()
1503 mutex_init(&msm_host->cmd_mutex); in msm_dsi_host_init()
1504 mutex_init(&msm_host->clk_mutex); in msm_dsi_host_init()
1505 spin_lock_init(&msm_host->intr_lock); in msm_dsi_host_init()
1508 msm_host->workqueue = alloc_ordered_workqueue("dsi_drm_work", 0); in msm_dsi_host_init()
1509 INIT_WORK(&msm_host->err_work, dsi_err_worker); in msm_dsi_host_init()
1511 msm_dsi->phy = msm_dsi_phy_init(pdev, msm_host->cfg->phy_type, in msm_dsi_host_init()
1512 msm_host->id); in msm_dsi_host_init()
1518 msm_dsi->host = &msm_host->base; in msm_dsi_host_init()
1519 msm_dsi->id = msm_host->id; in msm_dsi_host_init()
1521 DBG("Dsi Host %d initialized", msm_host->id); in msm_dsi_host_init()
1530 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_destroy() local
1533 dsi_tx_buf_free(msm_host); in msm_dsi_host_destroy()
1534 if (msm_host->workqueue) { in msm_dsi_host_destroy()
1535 flush_workqueue(msm_host->workqueue); in msm_dsi_host_destroy()
1536 destroy_workqueue(msm_host->workqueue); in msm_dsi_host_destroy()
1537 msm_host->workqueue = NULL; in msm_dsi_host_destroy()
1540 mutex_destroy(&msm_host->clk_mutex); in msm_dsi_host_destroy()
1541 mutex_destroy(&msm_host->cmd_mutex); in msm_dsi_host_destroy()
1542 mutex_destroy(&msm_host->dev_mutex); in msm_dsi_host_destroy()
1548 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_modeset_init() local
1549 struct platform_device *pdev = msm_host->pdev; in msm_dsi_host_modeset_init()
1552 msm_host->irq = irq_of_parse_and_map(pdev->dev.of_node, 0); in msm_dsi_host_modeset_init()
1553 if (msm_host->irq < 0) { in msm_dsi_host_modeset_init()
1554 ret = msm_host->irq; in msm_dsi_host_modeset_init()
1559 ret = devm_request_irq(&pdev->dev, msm_host->irq, in msm_dsi_host_modeset_init()
1561 "dsi_isr", msm_host); in msm_dsi_host_modeset_init()
1564 msm_host->irq, ret); in msm_dsi_host_modeset_init()
1568 msm_host->dev = dev; in msm_dsi_host_modeset_init()
1569 ret = dsi_tx_buf_alloc(msm_host, SZ_4K); in msm_dsi_host_modeset_init()
1580 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_register() local
1585 if (!msm_host->registered) { in msm_dsi_host_register()
1586 host->dev = &msm_host->pdev->dev; in msm_dsi_host_register()
1592 msm_host->registered = true; in msm_dsi_host_register()
1601 node = of_get_child_by_name(msm_host->pdev->dev.of_node, in msm_dsi_host_register()
1615 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_unregister() local
1617 if (msm_host->registered) { in msm_dsi_host_unregister()
1621 msm_host->registered = false; in msm_dsi_host_unregister()
1628 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_xfer_prepare() local
1640 dsi_clk_ctrl(msm_host, 1); in msm_dsi_host_xfer_prepare()
1645 dsi_set_tx_power_mode(0, msm_host); in msm_dsi_host_xfer_prepare()
1647 msm_host->dma_cmd_ctrl_restore = dsi_read(msm_host, REG_DSI_CTRL); in msm_dsi_host_xfer_prepare()
1648 dsi_write(msm_host, REG_DSI_CTRL, in msm_dsi_host_xfer_prepare()
1649 msm_host->dma_cmd_ctrl_restore | in msm_dsi_host_xfer_prepare()
1652 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_CMD_DMA_DONE, 1); in msm_dsi_host_xfer_prepare()
1660 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_xfer_restore() local
1662 dsi_intr_ctrl(msm_host, DSI_IRQ_MASK_CMD_DMA_DONE, 0); in msm_dsi_host_xfer_restore()
1663 dsi_write(msm_host, REG_DSI_CTRL, msm_host->dma_cmd_ctrl_restore); in msm_dsi_host_xfer_restore()
1666 dsi_set_tx_power_mode(1, msm_host); in msm_dsi_host_xfer_restore()
1670 dsi_clk_ctrl(msm_host, 0); in msm_dsi_host_xfer_restore()
1676 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_cmd_tx() local
1678 return dsi_cmds2buf_tx(msm_host, msg); in msm_dsi_host_cmd_tx()
1684 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_cmd_rx() local
1705 buf = msm_host->rx_buf; in msm_dsi_host_cmd_rx()
1719 ret = dsi_cmds2buf_tx(msm_host, &max_pkt_size_msg); in msm_dsi_host_cmd_rx()
1726 if ((msm_host->cfg->major == MSM_DSI_VER_MAJOR_6G) && in msm_dsi_host_cmd_rx()
1727 (msm_host->cfg->minor >= MSM_DSI_6G_VER_MINOR_V1_1)) { in msm_dsi_host_cmd_rx()
1729 dsi_write(msm_host, REG_DSI_RDBK_DATA_CTRL, in msm_dsi_host_cmd_rx()
1732 dsi_write(msm_host, REG_DSI_RDBK_DATA_CTRL, 0); in msm_dsi_host_cmd_rx()
1736 ret = dsi_cmds2buf_tx(msm_host, msg); in msm_dsi_host_cmd_rx()
1749 dlen = dsi_cmd_dma_rx(msm_host, buf, rx_byte, pkt_size); in msm_dsi_host_cmd_rx()
1785 buf = msm_host->rx_buf + (10 - rlen); in msm_dsi_host_cmd_rx()
1787 buf = msm_host->rx_buf; in msm_dsi_host_cmd_rx()
1817 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_cmd_xfer_commit() local
1819 dsi_write(msm_host, REG_DSI_DMA_BASE, iova); in msm_dsi_host_cmd_xfer_commit()
1820 dsi_write(msm_host, REG_DSI_DMA_LEN, len); in msm_dsi_host_cmd_xfer_commit()
1821 dsi_write(msm_host, REG_DSI_TRIG_DMA, 1); in msm_dsi_host_cmd_xfer_commit()
1829 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_enable() local
1831 dsi_op_mode_config(msm_host, in msm_dsi_host_enable()
1832 !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO), true); in msm_dsi_host_enable()
1846 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_disable() local
1848 dsi_op_mode_config(msm_host, in msm_dsi_host_disable()
1849 !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO), false); in msm_dsi_host_disable()
1855 dsi_sw_reset(msm_host); in msm_dsi_host_disable()
1862 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_power_on() local
1866 mutex_lock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
1867 if (msm_host->power_on) { in msm_dsi_host_power_on()
1872 ret = dsi_calc_clk_rate(msm_host); in msm_dsi_host_power_on()
1878 ret = dsi_host_regulator_enable(msm_host); in msm_dsi_host_power_on()
1885 ret = dsi_bus_clk_enable(msm_host); in msm_dsi_host_power_on()
1891 dsi_phy_sw_reset(msm_host); in msm_dsi_host_power_on()
1892 ret = msm_dsi_manager_phy_enable(msm_host->id, in msm_dsi_host_power_on()
1893 msm_host->byte_clk_rate * 8, in msm_dsi_host_power_on()
1894 clk_get_rate(msm_host->esc_clk), in msm_dsi_host_power_on()
1896 dsi_bus_clk_disable(msm_host); in msm_dsi_host_power_on()
1902 ret = dsi_clk_ctrl(msm_host, 1); in msm_dsi_host_power_on()
1908 dsi_timing_setup(msm_host); in msm_dsi_host_power_on()
1909 dsi_sw_reset(msm_host); in msm_dsi_host_power_on()
1910 dsi_ctrl_config(msm_host, true, clk_pre, clk_post); in msm_dsi_host_power_on()
1912 if (msm_host->disp_en_gpio) in msm_dsi_host_power_on()
1913 gpiod_set_value(msm_host->disp_en_gpio, 1); in msm_dsi_host_power_on()
1915 msm_host->power_on = true; in msm_dsi_host_power_on()
1916 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
1921 dsi_host_regulator_disable(msm_host); in msm_dsi_host_power_on()
1923 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
1929 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_power_off() local
1931 mutex_lock(&msm_host->dev_mutex); in msm_dsi_host_power_off()
1932 if (!msm_host->power_on) { in msm_dsi_host_power_off()
1937 dsi_ctrl_config(msm_host, false, 0, 0); in msm_dsi_host_power_off()
1939 if (msm_host->disp_en_gpio) in msm_dsi_host_power_off()
1940 gpiod_set_value(msm_host->disp_en_gpio, 0); in msm_dsi_host_power_off()
1942 msm_dsi_manager_phy_disable(msm_host->id); in msm_dsi_host_power_off()
1944 dsi_clk_ctrl(msm_host, 0); in msm_dsi_host_power_off()
1946 dsi_host_regulator_disable(msm_host); in msm_dsi_host_power_off()
1950 msm_host->power_on = false; in msm_dsi_host_power_off()
1953 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_off()
1960 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_set_display_mode() local
1962 if (msm_host->mode) { in msm_dsi_host_set_display_mode()
1963 drm_mode_destroy(msm_host->dev, msm_host->mode); in msm_dsi_host_set_display_mode()
1964 msm_host->mode = NULL; in msm_dsi_host_set_display_mode()
1967 msm_host->mode = drm_mode_duplicate(msm_host->dev, mode); in msm_dsi_host_set_display_mode()
1968 if (IS_ERR(msm_host->mode)) { in msm_dsi_host_set_display_mode()
1970 return PTR_ERR(msm_host->mode); in msm_dsi_host_set_display_mode()
1979 struct msm_dsi_host *msm_host = to_msm_dsi_host(host); in msm_dsi_host_get_panel() local
1982 panel = of_drm_find_panel(msm_host->panel_node); in msm_dsi_host_get_panel()
1984 *panel_flags = msm_host->mode_flags; in msm_dsi_host_get_panel()