Lines Matching +full:te +full:- +full:gpios
1 // SPDX-License-Identifier: GPL-2.0-only
8 #include <linux/dma-mapping.h>
37 return -EINVAL; in dsi_get_version()
41 * makes all other registers 4-byte shifted down. in dsi_get_version()
45 * 0x1f0). In the case of DSIv2, this hast to be a non-zero value. In in dsi_get_version()
60 return -EINVAL; in dsi_get_version()
76 return -EINVAL; in dsi_get_version()
192 return msm_readl(msm_host->ctrl_base + reg); in dsi_read()
196 msm_writel(data, msm_host->ctrl_base + reg); in dsi_write()
206 struct device *dev = &msm_host->pdev->dev; in dsi_get_config()
218 ahb_clk = msm_clk_get(msm_host->pdev, "iface"); in dsi_get_config()
238 ret = dsi_get_version(msm_host->ctrl_base, &major, &minor); in dsi_get_config()
266 struct regulator_bulk_data *s = msm_host->supplies; in dsi_host_regulator_disable()
267 const struct dsi_reg_entry *regs = msm_host->cfg_hnd->cfg->reg_cfg.regs; in dsi_host_regulator_disable()
268 int num = msm_host->cfg_hnd->cfg->reg_cfg.num; in dsi_host_regulator_disable()
272 for (i = num - 1; i >= 0; i--) in dsi_host_regulator_disable()
282 struct regulator_bulk_data *s = msm_host->supplies; in dsi_host_regulator_enable()
283 const struct dsi_reg_entry *regs = msm_host->cfg_hnd->cfg->reg_cfg.regs; in dsi_host_regulator_enable()
284 int num = msm_host->cfg_hnd->cfg->reg_cfg.num; in dsi_host_regulator_enable()
309 for (i--; i >= 0; i--) in dsi_host_regulator_enable()
316 struct regulator_bulk_data *s = msm_host->supplies; in dsi_regulator_init()
317 const struct dsi_reg_entry *regs = msm_host->cfg_hnd->cfg->reg_cfg.regs; in dsi_regulator_init()
318 int num = msm_host->cfg_hnd->cfg->reg_cfg.num; in dsi_regulator_init()
324 ret = devm_regulator_bulk_get(&msm_host->pdev->dev, num, s); in dsi_regulator_init()
336 struct platform_device *pdev = msm_host->pdev; in dsi_clk_init_v2()
339 msm_host->src_clk = msm_clk_get(pdev, "src"); in dsi_clk_init_v2()
341 if (IS_ERR(msm_host->src_clk)) { in dsi_clk_init_v2()
342 ret = PTR_ERR(msm_host->src_clk); in dsi_clk_init_v2()
345 msm_host->src_clk = NULL; in dsi_clk_init_v2()
349 msm_host->esc_clk_src = clk_get_parent(msm_host->esc_clk); in dsi_clk_init_v2()
350 if (!msm_host->esc_clk_src) { in dsi_clk_init_v2()
351 ret = -ENODEV; in dsi_clk_init_v2()
357 msm_host->dsi_clk_src = clk_get_parent(msm_host->src_clk); in dsi_clk_init_v2()
358 if (!msm_host->dsi_clk_src) { in dsi_clk_init_v2()
359 ret = -ENODEV; in dsi_clk_init_v2()
369 struct platform_device *pdev = msm_host->pdev; in dsi_clk_init_6g_v2()
372 msm_host->byte_intf_clk = msm_clk_get(pdev, "byte_intf"); in dsi_clk_init_6g_v2()
373 if (IS_ERR(msm_host->byte_intf_clk)) { in dsi_clk_init_6g_v2()
374 ret = PTR_ERR(msm_host->byte_intf_clk); in dsi_clk_init_6g_v2()
384 struct platform_device *pdev = msm_host->pdev; in dsi_clk_init()
385 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_clk_init()
386 const struct msm_dsi_config *cfg = cfg_hnd->cfg; in dsi_clk_init()
390 for (i = 0; i < cfg->num_bus_clks; i++) { in dsi_clk_init()
391 msm_host->bus_clks[i] = msm_clk_get(pdev, in dsi_clk_init()
392 cfg->bus_clk_names[i]); in dsi_clk_init()
393 if (IS_ERR(msm_host->bus_clks[i])) { in dsi_clk_init()
394 ret = PTR_ERR(msm_host->bus_clks[i]); in dsi_clk_init()
396 __func__, cfg->bus_clk_names[i], ret); in dsi_clk_init()
402 msm_host->byte_clk = msm_clk_get(pdev, "byte"); in dsi_clk_init()
403 if (IS_ERR(msm_host->byte_clk)) { in dsi_clk_init()
404 ret = PTR_ERR(msm_host->byte_clk); in dsi_clk_init()
407 msm_host->byte_clk = NULL; in dsi_clk_init()
411 msm_host->pixel_clk = msm_clk_get(pdev, "pixel"); in dsi_clk_init()
412 if (IS_ERR(msm_host->pixel_clk)) { in dsi_clk_init()
413 ret = PTR_ERR(msm_host->pixel_clk); in dsi_clk_init()
416 msm_host->pixel_clk = NULL; in dsi_clk_init()
420 msm_host->esc_clk = msm_clk_get(pdev, "core"); in dsi_clk_init()
421 if (IS_ERR(msm_host->esc_clk)) { in dsi_clk_init()
422 ret = PTR_ERR(msm_host->esc_clk); in dsi_clk_init()
425 msm_host->esc_clk = NULL; in dsi_clk_init()
429 msm_host->byte_clk_src = clk_get_parent(msm_host->byte_clk); in dsi_clk_init()
430 if (IS_ERR(msm_host->byte_clk_src)) { in dsi_clk_init()
431 ret = PTR_ERR(msm_host->byte_clk_src); in dsi_clk_init()
436 msm_host->pixel_clk_src = clk_get_parent(msm_host->pixel_clk); in dsi_clk_init()
437 if (IS_ERR(msm_host->pixel_clk_src)) { in dsi_clk_init()
438 ret = PTR_ERR(msm_host->pixel_clk_src); in dsi_clk_init()
443 if (cfg_hnd->ops->clk_init_ver) in dsi_clk_init()
444 ret = cfg_hnd->ops->clk_init_ver(msm_host); in dsi_clk_init()
451 const struct msm_dsi_config *cfg = msm_host->cfg_hnd->cfg; in dsi_bus_clk_enable()
454 DBG("id=%d", msm_host->id); in dsi_bus_clk_enable()
456 for (i = 0; i < cfg->num_bus_clks; i++) { in dsi_bus_clk_enable()
457 ret = clk_prepare_enable(msm_host->bus_clks[i]); in dsi_bus_clk_enable()
467 for (; i > 0; i--) in dsi_bus_clk_enable()
468 clk_disable_unprepare(msm_host->bus_clks[i]); in dsi_bus_clk_enable()
475 const struct msm_dsi_config *cfg = msm_host->cfg_hnd->cfg; in dsi_bus_clk_disable()
480 for (i = cfg->num_bus_clks - 1; i >= 0; i--) in dsi_bus_clk_disable()
481 clk_disable_unprepare(msm_host->bus_clks[i]); in dsi_bus_clk_disable()
488 struct mipi_dsi_host *host = msm_dsi->host; in msm_dsi_runtime_suspend()
491 if (!msm_host->cfg_hnd) in msm_dsi_runtime_suspend()
503 struct mipi_dsi_host *host = msm_dsi->host; in msm_dsi_runtime_resume()
506 if (!msm_host->cfg_hnd) in msm_dsi_runtime_resume()
517 msm_host->mode->clock, msm_host->byte_clk_rate); in dsi_link_clk_set_rate_6g()
519 ret = dev_pm_opp_set_rate(&msm_host->pdev->dev, in dsi_link_clk_set_rate_6g()
520 msm_host->byte_clk_rate); in dsi_link_clk_set_rate_6g()
526 ret = clk_set_rate(msm_host->pixel_clk, msm_host->pixel_clk_rate); in dsi_link_clk_set_rate_6g()
532 if (msm_host->byte_intf_clk) { in dsi_link_clk_set_rate_6g()
533 ret = clk_set_rate(msm_host->byte_intf_clk, in dsi_link_clk_set_rate_6g()
534 msm_host->byte_clk_rate / 2); in dsi_link_clk_set_rate_6g()
550 ret = clk_prepare_enable(msm_host->esc_clk); in dsi_link_clk_enable_6g()
556 ret = clk_prepare_enable(msm_host->byte_clk); in dsi_link_clk_enable_6g()
562 ret = clk_prepare_enable(msm_host->pixel_clk); in dsi_link_clk_enable_6g()
568 if (msm_host->byte_intf_clk) { in dsi_link_clk_enable_6g()
569 ret = clk_prepare_enable(msm_host->byte_intf_clk); in dsi_link_clk_enable_6g()
580 clk_disable_unprepare(msm_host->pixel_clk); in dsi_link_clk_enable_6g()
582 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_enable_6g()
584 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_enable_6g()
594 msm_host->mode->clock, msm_host->byte_clk_rate, in dsi_link_clk_set_rate_v2()
595 msm_host->esc_clk_rate, msm_host->src_clk_rate); in dsi_link_clk_set_rate_v2()
597 ret = clk_set_rate(msm_host->byte_clk, msm_host->byte_clk_rate); in dsi_link_clk_set_rate_v2()
603 ret = clk_set_rate(msm_host->esc_clk, msm_host->esc_clk_rate); in dsi_link_clk_set_rate_v2()
609 ret = clk_set_rate(msm_host->src_clk, msm_host->src_clk_rate); in dsi_link_clk_set_rate_v2()
615 ret = clk_set_rate(msm_host->pixel_clk, msm_host->pixel_clk_rate); in dsi_link_clk_set_rate_v2()
628 ret = clk_prepare_enable(msm_host->byte_clk); in dsi_link_clk_enable_v2()
634 ret = clk_prepare_enable(msm_host->esc_clk); in dsi_link_clk_enable_v2()
640 ret = clk_prepare_enable(msm_host->src_clk); in dsi_link_clk_enable_v2()
646 ret = clk_prepare_enable(msm_host->pixel_clk); in dsi_link_clk_enable_v2()
655 clk_disable_unprepare(msm_host->src_clk); in dsi_link_clk_enable_v2()
657 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_enable_v2()
659 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_enable_v2()
667 dev_pm_opp_set_rate(&msm_host->pdev->dev, 0); in dsi_link_clk_disable_6g()
668 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_disable_6g()
669 clk_disable_unprepare(msm_host->pixel_clk); in dsi_link_clk_disable_6g()
670 if (msm_host->byte_intf_clk) in dsi_link_clk_disable_6g()
671 clk_disable_unprepare(msm_host->byte_intf_clk); in dsi_link_clk_disable_6g()
672 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_disable_6g()
677 clk_disable_unprepare(msm_host->pixel_clk); in dsi_link_clk_disable_v2()
678 clk_disable_unprepare(msm_host->src_clk); in dsi_link_clk_disable_v2()
679 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_disable_v2()
680 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_disable_v2()
685 struct drm_display_mode *mode = msm_host->mode; in dsi_get_pclk_rate()
688 pclk_rate = mode->clock * 1000; in dsi_get_pclk_rate()
704 u8 lanes = msm_host->lanes; in dsi_calc_pclk()
705 u32 bpp = dsi_get_bpp(msm_host->format); in dsi_calc_pclk()
716 msm_host->pixel_clk_rate = pclk_rate; in dsi_calc_pclk()
717 msm_host->byte_clk_rate = pclk_bpp; in dsi_calc_pclk()
719 DBG("pclk=%d, bclk=%d", msm_host->pixel_clk_rate, in dsi_calc_pclk()
720 msm_host->byte_clk_rate); in dsi_calc_pclk()
726 if (!msm_host->mode) { in dsi_calc_clk_rate_6g()
728 return -EINVAL; in dsi_calc_clk_rate_6g()
732 msm_host->esc_clk_rate = clk_get_rate(msm_host->esc_clk); in dsi_calc_clk_rate_6g()
738 u32 bpp = dsi_get_bpp(msm_host->format); in dsi_calc_clk_rate_v2()
747 msm_host->src_clk_rate = pclk_bpp; in dsi_calc_clk_rate_v2()
758 byte_mhz = msm_host->byte_clk_rate / 1000000; in dsi_calc_clk_rate_v2()
760 for (esc_mhz = 20; esc_mhz >= 5; esc_mhz--) { in dsi_calc_clk_rate_v2()
774 return -EINVAL; in dsi_calc_clk_rate_v2()
776 msm_host->esc_clk_rate = msm_host->byte_clk_rate / esc_div; in dsi_calc_clk_rate_v2()
778 DBG("esc=%d, src=%d", msm_host->esc_clk_rate, in dsi_calc_clk_rate_v2()
779 msm_host->src_clk_rate); in dsi_calc_clk_rate_v2()
789 spin_lock_irqsave(&msm_host->intr_lock, flags); in dsi_intr_ctrl()
800 spin_unlock_irqrestore(&msm_host->intr_lock, flags); in dsi_intr_ctrl()
840 u32 flags = msm_host->mode_flags; in dsi_ctrl_config()
841 enum mipi_dsi_pixel_format mipi_fmt = msm_host->format; in dsi_ctrl_config()
842 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_ctrl_config()
866 data |= DSI_VID_CFG0_VIRT_CHANNEL(msm_host->channel); in dsi_ctrl_config()
891 /* Always assume dedicated TE pin */ in dsi_ctrl_config()
895 data |= DSI_TRIG_CTRL_STREAM(msm_host->channel); in dsi_ctrl_config()
896 if ((cfg_hnd->major == MSM_DSI_VER_MAJOR_6G) && in dsi_ctrl_config()
897 (cfg_hnd->minor >= MSM_DSI_6G_VER_MINOR_V1_2)) in dsi_ctrl_config()
901 data = DSI_CLKOUT_TIMING_CTRL_T_CLK_POST(phy_shared_timings->clk_post) | in dsi_ctrl_config()
902 DSI_CLKOUT_TIMING_CTRL_T_CLK_PRE(phy_shared_timings->clk_pre); in dsi_ctrl_config()
905 if ((cfg_hnd->major == MSM_DSI_VER_MAJOR_6G) && in dsi_ctrl_config()
906 (cfg_hnd->minor > MSM_DSI_6G_VER_MINOR_V1_0) && in dsi_ctrl_config()
907 phy_shared_timings->clk_pre_inc_by_2) in dsi_ctrl_config()
916 /* allow only ack-err-status to generate interrupt */ in dsi_ctrl_config()
925 DBG("lane number=%d", msm_host->lanes); in dsi_ctrl_config()
926 data |= ((DSI_CTRL_LANE0 << msm_host->lanes) - DSI_CTRL_LANE0); in dsi_ctrl_config()
929 DSI_LANE_SWAP_CTRL_DLN_SWAP_SEL(msm_host->dlane_swap)); in dsi_ctrl_config()
944 struct drm_display_mode *mode = msm_host->mode; in dsi_timing_setup()
946 u32 h_total = mode->htotal; in dsi_timing_setup()
947 u32 v_total = mode->vtotal; in dsi_timing_setup()
948 u32 hs_end = mode->hsync_end - mode->hsync_start; in dsi_timing_setup()
949 u32 vs_end = mode->vsync_end - mode->vsync_start; in dsi_timing_setup()
950 u32 ha_start = h_total - mode->hsync_start; in dsi_timing_setup()
951 u32 ha_end = ha_start + mode->hdisplay; in dsi_timing_setup()
952 u32 va_start = v_total - mode->vsync_start; in dsi_timing_setup()
953 u32 va_end = va_start + mode->vdisplay; in dsi_timing_setup()
954 u32 hdisplay = mode->hdisplay; in dsi_timing_setup()
974 if (msm_host->mode_flags & MIPI_DSI_MODE_VIDEO) { in dsi_timing_setup()
982 DSI_TOTAL_H_TOTAL(h_total - 1) | in dsi_timing_setup()
983 DSI_TOTAL_V_TOTAL(v_total - 1)); in dsi_timing_setup()
994 wc = hdisplay * dsi_get_bpp(msm_host->format) / 8 + 1; in dsi_timing_setup()
999 msm_host->channel) | in dsi_timing_setup()
1005 DSI_CMD_MDP_STREAM0_TOTAL_V_TOTAL(mode->vdisplay)); in dsi_timing_setup()
1061 struct device *dev = &msm_host->pdev->dev; in dsi_wait4video_done()
1065 reinit_completion(&msm_host->video_comp); in dsi_wait4video_done()
1067 ret = wait_for_completion_timeout(&msm_host->video_comp, in dsi_wait4video_done()
1078 if (!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO)) in dsi_wait4video_eng_busy()
1081 if (msm_host->power_on && msm_host->enabled) { in dsi_wait4video_eng_busy()
1090 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_alloc_6g()
1091 struct msm_drm_private *priv = dev->dev_private; in dsi_tx_buf_alloc_6g()
1096 priv->kms->aspace, in dsi_tx_buf_alloc_6g()
1097 &msm_host->tx_gem_obj, &iova); in dsi_tx_buf_alloc_6g()
1100 msm_host->tx_gem_obj = NULL; in dsi_tx_buf_alloc_6g()
1104 msm_gem_object_set_name(msm_host->tx_gem_obj, "tx_gem"); in dsi_tx_buf_alloc_6g()
1106 msm_host->tx_size = msm_host->tx_gem_obj->size; in dsi_tx_buf_alloc_6g()
1113 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_alloc_v2()
1115 msm_host->tx_buf = dma_alloc_coherent(dev->dev, size, in dsi_tx_buf_alloc_v2()
1116 &msm_host->tx_buf_paddr, GFP_KERNEL); in dsi_tx_buf_alloc_v2()
1117 if (!msm_host->tx_buf) in dsi_tx_buf_alloc_v2()
1118 return -ENOMEM; in dsi_tx_buf_alloc_v2()
1120 msm_host->tx_size = size; in dsi_tx_buf_alloc_v2()
1127 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_free()
1139 priv = dev->dev_private; in dsi_tx_buf_free()
1140 if (msm_host->tx_gem_obj) { in dsi_tx_buf_free()
1141 msm_gem_unpin_iova(msm_host->tx_gem_obj, priv->kms->aspace); in dsi_tx_buf_free()
1142 drm_gem_object_put(msm_host->tx_gem_obj); in dsi_tx_buf_free()
1143 msm_host->tx_gem_obj = NULL; in dsi_tx_buf_free()
1146 if (msm_host->tx_buf) in dsi_tx_buf_free()
1147 dma_free_coherent(dev->dev, msm_host->tx_size, msm_host->tx_buf, in dsi_tx_buf_free()
1148 msm_host->tx_buf_paddr); in dsi_tx_buf_free()
1153 return msm_gem_get_vaddr(msm_host->tx_gem_obj); in dsi_tx_buf_get_6g()
1158 return msm_host->tx_buf; in dsi_tx_buf_get_v2()
1163 msm_gem_put_vaddr(msm_host->tx_gem_obj); in dsi_tx_buf_put_6g()
1172 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_cmd_dma_add()
1185 if (len > msm_host->tx_size) { in dsi_cmd_dma_add()
1187 return -EINVAL; in dsi_cmd_dma_add()
1190 data = cfg_hnd->ops->tx_buf_get(msm_host); in dsi_cmd_dma_add()
1202 if (mipi_dsi_packet_format_is_long(msg->type)) in dsi_cmd_dma_add()
1204 if (msg->rx_buf && msg->rx_len) in dsi_cmd_dma_add()
1213 memset(data + packet.size, 0xff, len - packet.size); in dsi_cmd_dma_add()
1215 if (cfg_hnd->ops->tx_buf_put) in dsi_cmd_dma_add()
1216 cfg_hnd->ops->tx_buf_put(msm_host); in dsi_cmd_dma_add()
1226 u8 *data = msg->rx_buf; in dsi_short_read1_resp()
1227 if (data && (msg->rx_len >= 1)) { in dsi_short_read1_resp()
1232 __func__, msg->rx_len); in dsi_short_read1_resp()
1233 return -EINVAL; in dsi_short_read1_resp()
1242 u8 *data = msg->rx_buf; in dsi_short_read2_resp()
1243 if (data && (msg->rx_len >= 2)) { in dsi_short_read2_resp()
1249 __func__, msg->rx_len); in dsi_short_read2_resp()
1250 return -EINVAL; in dsi_short_read2_resp()
1257 if (msg->rx_buf && msg->rx_len) in dsi_long_read_resp()
1258 memcpy(msg->rx_buf, buf + 4, msg->rx_len); in dsi_long_read_resp()
1260 return msg->rx_len; in dsi_long_read_resp()
1265 struct drm_device *dev = msm_host->dev; in dsi_dma_base_get_6g()
1266 struct msm_drm_private *priv = dev->dev_private; in dsi_dma_base_get_6g()
1269 return -EINVAL; in dsi_dma_base_get_6g()
1271 return msm_gem_get_and_pin_iova(msm_host->tx_gem_obj, in dsi_dma_base_get_6g()
1272 priv->kms->aspace, dma_base); in dsi_dma_base_get_6g()
1278 return -EINVAL; in dsi_dma_base_get_v2()
1280 *dma_base = msm_host->tx_buf_paddr; in dsi_dma_base_get_v2()
1286 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_cmd_dma_tx()
1291 ret = cfg_hnd->ops->dma_base_get(msm_host, &dma_base); in dsi_cmd_dma_tx()
1297 reinit_completion(&msm_host->dma_comp); in dsi_cmd_dma_tx()
1302 msm_host->id, dma_base, len); in dsi_cmd_dma_tx()
1304 ret = wait_for_completion_timeout(&msm_host->dma_comp, in dsi_cmd_dma_tx()
1308 ret = -ETIMEDOUT; in dsi_cmd_dma_tx()
1325 int buf_offset = buf - msm_host->rx_buf; in dsi_cmd_dma_rx()
1350 bytes_shifted = read_cnt - 16; in dsi_cmd_dma_rx()
1351 repeated_bytes = buf_offset - bytes_shifted; in dsi_cmd_dma_rx()
1354 for (i = cnt - 1; i >= 0; i--) { in dsi_cmd_dma_rx()
1370 int bllp_len = msm_host->mode->hdisplay * in dsi_cmds2buf_tx()
1371 dsi_get_bpp(msm_host->format) / 8; in dsi_cmds2buf_tx()
1376 __func__, msg->type); in dsi_cmds2buf_tx()
1377 return -EINVAL; in dsi_cmds2buf_tx()
1389 if ((msm_host->mode_flags & MIPI_DSI_MODE_VIDEO) && (len > bllp_len)) { in dsi_cmds2buf_tx()
1392 return -EINVAL; in dsi_cmds2buf_tx()
1398 __func__, msg->type, (*(u8 *)(msg->tx_buf)), len); in dsi_cmds2buf_tx()
1399 return -ECOMM; in dsi_cmds2buf_tx()
1436 drm_helper_hpd_irq_event(msm_host->dev); in dsi_hpd_worker()
1443 u32 status = msm_host->err_work_state; in dsi_err_worker()
1450 msm_host->err_work_state = 0; in dsi_err_worker()
1466 msm_host->err_work_state |= DSI_ERR_STATE_ACK; in dsi_ack_err_status()
1478 msm_host->err_work_state |= DSI_ERR_STATE_TIMEOUT; in dsi_timeout_status()
1494 msm_host->err_work_state |= DSI_ERR_STATE_DLN0_PHY; in dsi_dln0_phy_err()
1507 msm_host->err_work_state |= DSI_ERR_STATE_FIFO; in dsi_fifo_status()
1509 msm_host->err_work_state |= in dsi_fifo_status()
1522 msm_host->err_work_state |= in dsi_status()
1535 msm_host->err_work_state |= DSI_ERR_STATE_PLL_UNLOCKED; in dsi_clk_status()
1551 queue_work(msm_host->workqueue, &msm_host->err_work); in dsi_error()
1560 if (!msm_host->ctrl_base) in dsi_host_irq()
1563 spin_lock_irqsave(&msm_host->intr_lock, flags); in dsi_host_irq()
1566 spin_unlock_irqrestore(&msm_host->intr_lock, flags); in dsi_host_irq()
1568 DBG("isr=0x%x, id=%d", isr, msm_host->id); in dsi_host_irq()
1574 complete(&msm_host->video_comp); in dsi_host_irq()
1577 complete(&msm_host->dma_comp); in dsi_host_irq()
1585 msm_host->disp_en_gpio = devm_gpiod_get_optional(panel_device, in dsi_host_init_panel_gpios()
1586 "disp-enable", in dsi_host_init_panel_gpios()
1588 if (IS_ERR(msm_host->disp_en_gpio)) { in dsi_host_init_panel_gpios()
1589 DBG("cannot get disp-enable-gpios %ld", in dsi_host_init_panel_gpios()
1590 PTR_ERR(msm_host->disp_en_gpio)); in dsi_host_init_panel_gpios()
1591 return PTR_ERR(msm_host->disp_en_gpio); in dsi_host_init_panel_gpios()
1594 msm_host->te_gpio = devm_gpiod_get_optional(panel_device, "disp-te", in dsi_host_init_panel_gpios()
1596 if (IS_ERR(msm_host->te_gpio)) { in dsi_host_init_panel_gpios()
1597 DBG("cannot get disp-te-gpios %ld", PTR_ERR(msm_host->te_gpio)); in dsi_host_init_panel_gpios()
1598 return PTR_ERR(msm_host->te_gpio); in dsi_host_init_panel_gpios()
1610 if (dsi->lanes > msm_host->num_data_lanes) in dsi_host_attach()
1611 return -EINVAL; in dsi_host_attach()
1613 msm_host->channel = dsi->channel; in dsi_host_attach()
1614 msm_host->lanes = dsi->lanes; in dsi_host_attach()
1615 msm_host->format = dsi->format; in dsi_host_attach()
1616 msm_host->mode_flags = dsi->mode_flags; in dsi_host_attach()
1618 /* Some gpios defined in panel DT need to be controlled by host */ in dsi_host_attach()
1619 ret = dsi_host_init_panel_gpios(msm_host, &dsi->dev); in dsi_host_attach()
1623 DBG("id=%d", msm_host->id); in dsi_host_attach()
1624 if (msm_host->dev) in dsi_host_attach()
1625 queue_work(msm_host->workqueue, &msm_host->hpd_work); in dsi_host_attach()
1635 msm_host->device_node = NULL; in dsi_host_detach()
1637 DBG("id=%d", msm_host->id); in dsi_host_detach()
1638 if (msm_host->dev) in dsi_host_detach()
1639 queue_work(msm_host->workqueue, &msm_host->hpd_work); in dsi_host_detach()
1650 if (!msg || !msm_host->power_on) in dsi_host_transfer()
1651 return -EINVAL; in dsi_host_transfer()
1653 mutex_lock(&msm_host->cmd_mutex); in dsi_host_transfer()
1654 ret = msm_dsi_manager_cmd_xfer(msm_host->id, msg); in dsi_host_transfer()
1655 mutex_unlock(&msm_host->cmd_mutex); in dsi_host_transfer()
1670 * "3012": Logic 3->Phys 0; Logic 0->Phys 1; Logic 1->Phys 2; Logic 2->Phys 3;
1686 struct device *dev = &msm_host->pdev->dev; in dsi_host_parse_lane_data()
1691 prop = of_find_property(ep, "data-lanes", &len); in dsi_host_parse_lane_data()
1702 return -EINVAL; in dsi_host_parse_lane_data()
1705 msm_host->num_data_lanes = num_lanes; in dsi_host_parse_lane_data()
1707 ret = of_property_read_u32_array(ep, "data-lanes", lane_map, in dsi_host_parse_lane_data()
1715 * compare DT specified physical-logical lane mappings with the ones in dsi_host_parse_lane_data()
1723 * the data-lanes array we get from DT has a logical->physical in dsi_host_parse_lane_data()
1725 * supported configurations in a physical->logical mapping. in dsi_host_parse_lane_data()
1739 msm_host->dlane_swap = i; in dsi_host_parse_lane_data()
1744 return -EINVAL; in dsi_host_parse_lane_data()
1749 struct device *dev = &msm_host->pdev->dev; in dsi_host_parse_dt()
1750 struct device_node *np = dev->of_node; in dsi_host_parse_dt()
1760 endpoint = of_graph_get_endpoint_by_regs(np, 1, -1); in dsi_host_parse_dt()
1770 ret = -EINVAL; in dsi_host_parse_dt()
1778 ret = -ENODEV; in dsi_host_parse_dt()
1782 msm_host->device_node = device_node; in dsi_host_parse_dt()
1784 if (of_property_read_bool(np, "syscon-sfpb")) { in dsi_host_parse_dt()
1785 msm_host->sfpb = syscon_regmap_lookup_by_phandle(np, in dsi_host_parse_dt()
1786 "syscon-sfpb"); in dsi_host_parse_dt()
1787 if (IS_ERR(msm_host->sfpb)) { in dsi_host_parse_dt()
1790 ret = PTR_ERR(msm_host->sfpb); in dsi_host_parse_dt()
1804 struct platform_device *pdev = msm_host->pdev; in dsi_host_get_id()
1805 const struct msm_dsi_config *cfg = msm_host->cfg_hnd->cfg; in dsi_host_get_id()
1811 return -EINVAL; in dsi_host_get_id()
1813 for (i = 0; i < cfg->num_dsi; i++) { in dsi_host_get_id()
1814 if (cfg->io_start[i] == res->start) in dsi_host_get_id()
1818 return -EINVAL; in dsi_host_get_id()
1824 struct platform_device *pdev = msm_dsi->pdev; in msm_dsi_host_init()
1827 msm_host = devm_kzalloc(&pdev->dev, sizeof(*msm_host), GFP_KERNEL); in msm_dsi_host_init()
1831 ret = -ENOMEM; in msm_dsi_host_init()
1835 msm_host->pdev = pdev; in msm_dsi_host_init()
1836 msm_dsi->host = &msm_host->base; in msm_dsi_host_init()
1844 msm_host->ctrl_base = msm_ioremap(pdev, "dsi_ctrl", "DSI CTRL"); in msm_dsi_host_init()
1845 if (IS_ERR(msm_host->ctrl_base)) { in msm_dsi_host_init()
1847 ret = PTR_ERR(msm_host->ctrl_base); in msm_dsi_host_init()
1851 pm_runtime_enable(&pdev->dev); in msm_dsi_host_init()
1853 msm_host->cfg_hnd = dsi_get_config(msm_host); in msm_dsi_host_init()
1854 if (!msm_host->cfg_hnd) { in msm_dsi_host_init()
1855 ret = -EINVAL; in msm_dsi_host_init()
1860 msm_host->id = dsi_host_get_id(msm_host); in msm_dsi_host_init()
1861 if (msm_host->id < 0) { in msm_dsi_host_init()
1862 ret = msm_host->id; in msm_dsi_host_init()
1868 msm_host->ctrl_base += msm_host->cfg_hnd->cfg->io_offset; in msm_dsi_host_init()
1882 msm_host->rx_buf = devm_kzalloc(&pdev->dev, SZ_4K, GFP_KERNEL); in msm_dsi_host_init()
1883 if (!msm_host->rx_buf) { in msm_dsi_host_init()
1884 ret = -ENOMEM; in msm_dsi_host_init()
1889 msm_host->opp_table = dev_pm_opp_set_clkname(&pdev->dev, "byte"); in msm_dsi_host_init()
1890 if (IS_ERR(msm_host->opp_table)) in msm_dsi_host_init()
1891 return PTR_ERR(msm_host->opp_table); in msm_dsi_host_init()
1893 ret = dev_pm_opp_of_add_table(&pdev->dev); in msm_dsi_host_init()
1895 msm_host->has_opp_table = true; in msm_dsi_host_init()
1896 } else if (ret != -ENODEV) { in msm_dsi_host_init()
1897 dev_err(&pdev->dev, "invalid OPP table in device tree\n"); in msm_dsi_host_init()
1898 dev_pm_opp_put_clkname(msm_host->opp_table); in msm_dsi_host_init()
1902 init_completion(&msm_host->dma_comp); in msm_dsi_host_init()
1903 init_completion(&msm_host->video_comp); in msm_dsi_host_init()
1904 mutex_init(&msm_host->dev_mutex); in msm_dsi_host_init()
1905 mutex_init(&msm_host->cmd_mutex); in msm_dsi_host_init()
1906 spin_lock_init(&msm_host->intr_lock); in msm_dsi_host_init()
1909 msm_host->workqueue = alloc_ordered_workqueue("dsi_drm_work", 0); in msm_dsi_host_init()
1910 INIT_WORK(&msm_host->err_work, dsi_err_worker); in msm_dsi_host_init()
1911 INIT_WORK(&msm_host->hpd_work, dsi_hpd_worker); in msm_dsi_host_init()
1913 msm_dsi->id = msm_host->id; in msm_dsi_host_init()
1915 DBG("Dsi Host %d initialized", msm_host->id); in msm_dsi_host_init()
1928 if (msm_host->workqueue) { in msm_dsi_host_destroy()
1929 flush_workqueue(msm_host->workqueue); in msm_dsi_host_destroy()
1930 destroy_workqueue(msm_host->workqueue); in msm_dsi_host_destroy()
1931 msm_host->workqueue = NULL; in msm_dsi_host_destroy()
1934 mutex_destroy(&msm_host->cmd_mutex); in msm_dsi_host_destroy()
1935 mutex_destroy(&msm_host->dev_mutex); in msm_dsi_host_destroy()
1937 if (msm_host->has_opp_table) in msm_dsi_host_destroy()
1938 dev_pm_opp_of_remove_table(&msm_host->pdev->dev); in msm_dsi_host_destroy()
1939 dev_pm_opp_put_clkname(msm_host->opp_table); in msm_dsi_host_destroy()
1940 pm_runtime_disable(&msm_host->pdev->dev); in msm_dsi_host_destroy()
1947 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_modeset_init()
1948 struct platform_device *pdev = msm_host->pdev; in msm_dsi_host_modeset_init()
1951 msm_host->irq = irq_of_parse_and_map(pdev->dev.of_node, 0); in msm_dsi_host_modeset_init()
1952 if (msm_host->irq < 0) { in msm_dsi_host_modeset_init()
1953 ret = msm_host->irq; in msm_dsi_host_modeset_init()
1954 DRM_DEV_ERROR(dev->dev, "failed to get irq: %d\n", ret); in msm_dsi_host_modeset_init()
1958 ret = devm_request_irq(&pdev->dev, msm_host->irq, in msm_dsi_host_modeset_init()
1962 DRM_DEV_ERROR(&pdev->dev, "failed to request IRQ%u: %d\n", in msm_dsi_host_modeset_init()
1963 msm_host->irq, ret); in msm_dsi_host_modeset_init()
1967 msm_host->dev = dev; in msm_dsi_host_modeset_init()
1968 ret = cfg_hnd->ops->tx_buf_alloc(msm_host, SZ_4K); in msm_dsi_host_modeset_init()
1983 if (!msm_host->registered) { in msm_dsi_host_register()
1984 host->dev = &msm_host->pdev->dev; in msm_dsi_host_register()
1985 host->ops = &dsi_host_ops; in msm_dsi_host_register()
1990 msm_host->registered = true; in msm_dsi_host_register()
2000 if (check_defer && msm_host->device_node) { in msm_dsi_host_register()
2001 if (IS_ERR(of_drm_find_panel(msm_host->device_node))) in msm_dsi_host_register()
2002 if (!of_drm_find_bridge(msm_host->device_node)) in msm_dsi_host_register()
2003 return -EPROBE_DEFER; in msm_dsi_host_register()
2014 if (msm_host->registered) { in msm_dsi_host_unregister()
2016 host->dev = NULL; in msm_dsi_host_unregister()
2017 host->ops = NULL; in msm_dsi_host_unregister()
2018 msm_host->registered = false; in msm_dsi_host_unregister()
2026 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_xfer_prepare()
2038 pm_runtime_get_sync(&msm_host->pdev->dev); in msm_dsi_host_xfer_prepare()
2039 cfg_hnd->ops->link_clk_set_rate(msm_host); in msm_dsi_host_xfer_prepare()
2040 cfg_hnd->ops->link_clk_enable(msm_host); in msm_dsi_host_xfer_prepare()
2044 if (!(msg->flags & MIPI_DSI_MSG_USE_LPM)) in msm_dsi_host_xfer_prepare()
2047 msm_host->dma_cmd_ctrl_restore = dsi_read(msm_host, REG_DSI_CTRL); in msm_dsi_host_xfer_prepare()
2049 msm_host->dma_cmd_ctrl_restore | in msm_dsi_host_xfer_prepare()
2061 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_xfer_restore()
2064 dsi_write(msm_host, REG_DSI_CTRL, msm_host->dma_cmd_ctrl_restore); in msm_dsi_host_xfer_restore()
2066 if (!(msg->flags & MIPI_DSI_MSG_USE_LPM)) in msm_dsi_host_xfer_restore()
2071 cfg_hnd->ops->link_clk_disable(msm_host); in msm_dsi_host_xfer_restore()
2072 pm_runtime_put_autosuspend(&msm_host->pdev->dev); in msm_dsi_host_xfer_restore()
2087 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_cmd_rx()
2091 int rlen = msg->rx_len; in msm_dsi_host_cmd_rx()
2108 buf = msm_host->rx_buf; in msm_dsi_host_cmd_rx()
2113 .channel = msg->channel, in msm_dsi_host_cmd_rx()
2126 return -EINVAL; in msm_dsi_host_cmd_rx()
2129 if ((cfg_hnd->major == MSM_DSI_VER_MAJOR_6G) && in msm_dsi_host_cmd_rx()
2130 (cfg_hnd->minor >= MSM_DSI_6G_VER_MINOR_V1_1)) { in msm_dsi_host_cmd_rx()
2140 if (ret < msg->tx_len) { in msm_dsi_host_cmd_rx()
2161 diff = data_byte - rlen; in msm_dsi_host_cmd_rx()
2165 rlen -= data_byte; in msm_dsi_host_cmd_rx()
2169 dlen -= 2; /* 2 crc */ in msm_dsi_host_cmd_rx()
2170 dlen -= diff; in msm_dsi_host_cmd_rx()
2188 buf = msm_host->rx_buf + (10 - rlen); in msm_dsi_host_cmd_rx()
2190 buf = msm_host->rx_buf; in msm_dsi_host_cmd_rx()
2246 ret = clk_set_parent(msm_host->byte_clk_src, byte_clk_provider); in msm_dsi_host_set_src_pll()
2253 ret = clk_set_parent(msm_host->pixel_clk_src, pixel_clk_provider); in msm_dsi_host_set_src_pll()
2260 if (msm_host->dsi_clk_src) { in msm_dsi_host_set_src_pll()
2261 ret = clk_set_parent(msm_host->dsi_clk_src, pixel_clk_provider); in msm_dsi_host_set_src_pll()
2269 if (msm_host->esc_clk_src) { in msm_dsi_host_set_src_pll()
2270 ret = clk_set_parent(msm_host->esc_clk_src, byte_clk_provider); in msm_dsi_host_set_src_pll()
2300 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_get_phy_clk_req()
2303 ret = cfg_hnd->ops->calc_clk_rate(msm_host, is_dual_dsi); in msm_dsi_host_get_phy_clk_req()
2309 clk_req->bitclk_rate = msm_host->byte_clk_rate * 8; in msm_dsi_host_get_phy_clk_req()
2310 clk_req->escclk_rate = msm_host->esc_clk_rate; in msm_dsi_host_get_phy_clk_req()
2318 !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO), true); in msm_dsi_host_enable()
2324 /* if (msm_panel->mode == MSM_DSI_CMD_MODE) { in msm_dsi_host_enable()
2326 * pm_runtime_put_autosuspend(&msm_host->pdev->dev); in msm_dsi_host_enable()
2329 msm_host->enabled = true; in msm_dsi_host_enable()
2337 msm_host->enabled = false; in msm_dsi_host_disable()
2339 !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO), false); in msm_dsi_host_disable()
2354 if (!msm_host->sfpb) in msm_dsi_sfpb_config()
2359 regmap_update_bits(msm_host->sfpb, REG_SFPB_GPREG, in msm_dsi_sfpb_config()
2369 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_power_on()
2372 mutex_lock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
2373 if (msm_host->power_on) { in msm_dsi_host_power_on()
2387 pm_runtime_get_sync(&msm_host->pdev->dev); in msm_dsi_host_power_on()
2388 ret = cfg_hnd->ops->link_clk_set_rate(msm_host); in msm_dsi_host_power_on()
2390 ret = cfg_hnd->ops->link_clk_enable(msm_host); in msm_dsi_host_power_on()
2397 ret = pinctrl_pm_select_default_state(&msm_host->pdev->dev); in msm_dsi_host_power_on()
2408 if (msm_host->disp_en_gpio) in msm_dsi_host_power_on()
2409 gpiod_set_value(msm_host->disp_en_gpio, 1); in msm_dsi_host_power_on()
2411 msm_host->power_on = true; in msm_dsi_host_power_on()
2412 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
2417 cfg_hnd->ops->link_clk_disable(msm_host); in msm_dsi_host_power_on()
2418 pm_runtime_put_autosuspend(&msm_host->pdev->dev); in msm_dsi_host_power_on()
2422 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
2429 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_power_off()
2431 mutex_lock(&msm_host->dev_mutex); in msm_dsi_host_power_off()
2432 if (!msm_host->power_on) { in msm_dsi_host_power_off()
2439 if (msm_host->disp_en_gpio) in msm_dsi_host_power_off()
2440 gpiod_set_value(msm_host->disp_en_gpio, 0); in msm_dsi_host_power_off()
2442 pinctrl_pm_select_sleep_state(&msm_host->pdev->dev); in msm_dsi_host_power_off()
2444 cfg_hnd->ops->link_clk_disable(msm_host); in msm_dsi_host_power_off()
2445 pm_runtime_put_autosuspend(&msm_host->pdev->dev); in msm_dsi_host_power_off()
2451 DBG("-"); in msm_dsi_host_power_off()
2453 msm_host->power_on = false; in msm_dsi_host_power_off()
2456 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_off()
2465 if (msm_host->mode) { in msm_dsi_host_set_display_mode()
2466 drm_mode_destroy(msm_host->dev, msm_host->mode); in msm_dsi_host_set_display_mode()
2467 msm_host->mode = NULL; in msm_dsi_host_set_display_mode()
2470 msm_host->mode = drm_mode_duplicate(msm_host->dev, mode); in msm_dsi_host_set_display_mode()
2471 if (!msm_host->mode) { in msm_dsi_host_set_display_mode()
2473 return -ENOMEM; in msm_dsi_host_set_display_mode()
2481 return of_drm_find_panel(to_msm_dsi_host(host)->device_node); in msm_dsi_host_get_panel()
2486 return to_msm_dsi_host(host)->mode_flags; in msm_dsi_host_get_mode_flags()
2493 return of_drm_find_bridge(msm_host->device_node); in msm_dsi_host_get_bridge()