Lines Matching +full:te +full:- +full:gpios
1 // SPDX-License-Identifier: GPL-2.0-only
8 #include <linux/dma-mapping.h>
45 return -EINVAL; in dsi_get_version()
49 * makes all other registers 4-byte shifted down. in dsi_get_version()
53 * 0x1f0). In the case of DSIv2, this hast to be a non-zero value. In in dsi_get_version()
68 return -EINVAL; in dsi_get_version()
84 return -EINVAL; in dsi_get_version()
199 return msm_readl(msm_host->ctrl_base + reg); in dsi_read()
203 msm_writel(data, msm_host->ctrl_base + reg); in dsi_write()
210 struct device *dev = &msm_host->pdev->dev; in dsi_get_config()
215 ahb_clk = msm_clk_get(msm_host->pdev, "iface"); in dsi_get_config()
229 ret = dsi_get_version(msm_host->ctrl_base, &major, &minor); in dsi_get_config()
254 struct platform_device *pdev = msm_host->pdev; in dsi_clk_init_v2()
257 msm_host->src_clk = msm_clk_get(pdev, "src"); in dsi_clk_init_v2()
259 if (IS_ERR(msm_host->src_clk)) { in dsi_clk_init_v2()
260 ret = PTR_ERR(msm_host->src_clk); in dsi_clk_init_v2()
263 msm_host->src_clk = NULL; in dsi_clk_init_v2()
272 struct platform_device *pdev = msm_host->pdev; in dsi_clk_init_6g_v2()
275 msm_host->byte_intf_clk = msm_clk_get(pdev, "byte_intf"); in dsi_clk_init_6g_v2()
276 if (IS_ERR(msm_host->byte_intf_clk)) { in dsi_clk_init_6g_v2()
277 ret = PTR_ERR(msm_host->byte_intf_clk); in dsi_clk_init_6g_v2()
287 struct platform_device *pdev = msm_host->pdev; in dsi_clk_init()
288 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_clk_init()
289 const struct msm_dsi_config *cfg = cfg_hnd->cfg; in dsi_clk_init()
293 for (i = 0; i < cfg->num_bus_clks; i++) in dsi_clk_init()
294 msm_host->bus_clks[i].id = cfg->bus_clk_names[i]; in dsi_clk_init()
295 msm_host->num_bus_clks = cfg->num_bus_clks; in dsi_clk_init()
297 ret = devm_clk_bulk_get(&pdev->dev, msm_host->num_bus_clks, msm_host->bus_clks); in dsi_clk_init()
299 dev_err(&pdev->dev, "Unable to get clocks, ret = %d\n", ret); in dsi_clk_init()
304 msm_host->byte_clk = msm_clk_get(pdev, "byte"); in dsi_clk_init()
305 if (IS_ERR(msm_host->byte_clk)) { in dsi_clk_init()
306 ret = PTR_ERR(msm_host->byte_clk); in dsi_clk_init()
309 msm_host->byte_clk = NULL; in dsi_clk_init()
313 msm_host->pixel_clk = msm_clk_get(pdev, "pixel"); in dsi_clk_init()
314 if (IS_ERR(msm_host->pixel_clk)) { in dsi_clk_init()
315 ret = PTR_ERR(msm_host->pixel_clk); in dsi_clk_init()
318 msm_host->pixel_clk = NULL; in dsi_clk_init()
322 msm_host->esc_clk = msm_clk_get(pdev, "core"); in dsi_clk_init()
323 if (IS_ERR(msm_host->esc_clk)) { in dsi_clk_init()
324 ret = PTR_ERR(msm_host->esc_clk); in dsi_clk_init()
327 msm_host->esc_clk = NULL; in dsi_clk_init()
331 if (cfg_hnd->ops->clk_init_ver) in dsi_clk_init()
332 ret = cfg_hnd->ops->clk_init_ver(msm_host); in dsi_clk_init()
341 struct mipi_dsi_host *host = msm_dsi->host; in msm_dsi_runtime_suspend()
344 if (!msm_host->cfg_hnd) in msm_dsi_runtime_suspend()
347 clk_bulk_disable_unprepare(msm_host->num_bus_clks, msm_host->bus_clks); in msm_dsi_runtime_suspend()
356 struct mipi_dsi_host *host = msm_dsi->host; in msm_dsi_runtime_resume()
359 if (!msm_host->cfg_hnd) in msm_dsi_runtime_resume()
362 return clk_bulk_prepare_enable(msm_host->num_bus_clks, msm_host->bus_clks); in msm_dsi_runtime_resume()
370 msm_host->pixel_clk_rate, msm_host->byte_clk_rate); in dsi_link_clk_set_rate_6g()
372 ret = dev_pm_opp_set_rate(&msm_host->pdev->dev, in dsi_link_clk_set_rate_6g()
373 msm_host->byte_clk_rate); in dsi_link_clk_set_rate_6g()
379 ret = clk_set_rate(msm_host->pixel_clk, msm_host->pixel_clk_rate); in dsi_link_clk_set_rate_6g()
385 if (msm_host->byte_intf_clk) { in dsi_link_clk_set_rate_6g()
386 ret = clk_set_rate(msm_host->byte_intf_clk, msm_host->byte_intf_clk_rate); in dsi_link_clk_set_rate_6g()
402 ret = clk_prepare_enable(msm_host->esc_clk); in dsi_link_clk_enable_6g()
408 ret = clk_prepare_enable(msm_host->byte_clk); in dsi_link_clk_enable_6g()
414 ret = clk_prepare_enable(msm_host->pixel_clk); in dsi_link_clk_enable_6g()
420 ret = clk_prepare_enable(msm_host->byte_intf_clk); in dsi_link_clk_enable_6g()
430 clk_disable_unprepare(msm_host->pixel_clk); in dsi_link_clk_enable_6g()
432 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_enable_6g()
434 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_enable_6g()
444 msm_host->pixel_clk_rate, msm_host->byte_clk_rate, in dsi_link_clk_set_rate_v2()
445 msm_host->esc_clk_rate, msm_host->src_clk_rate); in dsi_link_clk_set_rate_v2()
447 ret = clk_set_rate(msm_host->byte_clk, msm_host->byte_clk_rate); in dsi_link_clk_set_rate_v2()
453 ret = clk_set_rate(msm_host->esc_clk, msm_host->esc_clk_rate); in dsi_link_clk_set_rate_v2()
459 ret = clk_set_rate(msm_host->src_clk, msm_host->src_clk_rate); in dsi_link_clk_set_rate_v2()
465 ret = clk_set_rate(msm_host->pixel_clk, msm_host->pixel_clk_rate); in dsi_link_clk_set_rate_v2()
478 ret = clk_prepare_enable(msm_host->byte_clk); in dsi_link_clk_enable_v2()
484 ret = clk_prepare_enable(msm_host->esc_clk); in dsi_link_clk_enable_v2()
490 ret = clk_prepare_enable(msm_host->src_clk); in dsi_link_clk_enable_v2()
496 ret = clk_prepare_enable(msm_host->pixel_clk); in dsi_link_clk_enable_v2()
505 clk_disable_unprepare(msm_host->src_clk); in dsi_link_clk_enable_v2()
507 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_enable_v2()
509 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_enable_v2()
517 dev_pm_opp_set_rate(&msm_host->pdev->dev, 0); in dsi_link_clk_disable_6g()
518 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_disable_6g()
519 clk_disable_unprepare(msm_host->pixel_clk); in dsi_link_clk_disable_6g()
520 clk_disable_unprepare(msm_host->byte_intf_clk); in dsi_link_clk_disable_6g()
521 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_disable_6g()
526 clk_disable_unprepare(msm_host->pixel_clk); in dsi_link_clk_disable_v2()
527 clk_disable_unprepare(msm_host->src_clk); in dsi_link_clk_disable_v2()
528 clk_disable_unprepare(msm_host->esc_clk); in dsi_link_clk_disable_v2()
529 clk_disable_unprepare(msm_host->byte_clk); in dsi_link_clk_disable_v2()
535 int new_hdisplay = DIV_ROUND_UP(mode->hdisplay * drm_dsc_get_bpp_int(dsc), in dsi_adjust_pclk_for_compression()
536 dsc->bits_per_component * 3); in dsi_adjust_pclk_for_compression()
538 int new_htotal = mode->htotal - mode->hdisplay + new_hdisplay; in dsi_adjust_pclk_for_compression()
540 return mult_frac(mode->clock * 1000u, new_htotal, mode->htotal); in dsi_adjust_pclk_for_compression()
548 pclk_rate = mode->clock * 1000u; in dsi_get_pclk_rate()
569 u8 lanes = msm_host->lanes; in dsi_byte_clk_get_rate()
570 u32 bpp = dsi_get_bpp(msm_host->format); in dsi_byte_clk_get_rate()
571 unsigned long pclk_rate = dsi_get_pclk_rate(mode, msm_host->dsc, is_bonded_dsi); in dsi_byte_clk_get_rate()
580 if (msm_host->cphy_mode) in dsi_byte_clk_get_rate()
590 msm_host->pixel_clk_rate = dsi_get_pclk_rate(msm_host->mode, msm_host->dsc, is_bonded_dsi); in dsi_calc_pclk()
591 msm_host->byte_clk_rate = dsi_byte_clk_get_rate(&msm_host->base, is_bonded_dsi, in dsi_calc_pclk()
592 msm_host->mode); in dsi_calc_pclk()
594 DBG("pclk=%lu, bclk=%lu", msm_host->pixel_clk_rate, in dsi_calc_pclk()
595 msm_host->byte_clk_rate); in dsi_calc_pclk()
601 if (!msm_host->mode) { in dsi_calc_clk_rate_6g()
603 return -EINVAL; in dsi_calc_clk_rate_6g()
607 msm_host->esc_clk_rate = clk_get_rate(msm_host->esc_clk); in dsi_calc_clk_rate_6g()
613 u32 bpp = dsi_get_bpp(msm_host->format); in dsi_calc_clk_rate_v2()
619 msm_host->src_clk_rate = mult_frac(msm_host->pixel_clk_rate, bpp, 8); in dsi_calc_clk_rate_v2()
630 byte_mhz = msm_host->byte_clk_rate / 1000000; in dsi_calc_clk_rate_v2()
632 for (esc_mhz = 20; esc_mhz >= 5; esc_mhz--) { in dsi_calc_clk_rate_v2()
646 return -EINVAL; in dsi_calc_clk_rate_v2()
648 msm_host->esc_clk_rate = msm_host->byte_clk_rate / esc_div; in dsi_calc_clk_rate_v2()
650 DBG("esc=%lu, src=%lu", msm_host->esc_clk_rate, in dsi_calc_clk_rate_v2()
651 msm_host->src_clk_rate); in dsi_calc_clk_rate_v2()
661 spin_lock_irqsave(&msm_host->intr_lock, flags); in dsi_intr_ctrl()
672 spin_unlock_irqrestore(&msm_host->intr_lock, flags); in dsi_intr_ctrl()
717 u32 flags = msm_host->mode_flags; in dsi_ctrl_enable()
718 enum mipi_dsi_pixel_format mipi_fmt = msm_host->format; in dsi_ctrl_enable()
719 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_ctrl_enable()
738 data |= DSI_VID_CFG0_VIRT_CHANNEL(msm_host->channel); in dsi_ctrl_enable()
757 if (msm_host->cfg_hnd->major == MSM_DSI_VER_MAJOR_6G && in dsi_ctrl_enable()
758 msm_host->cfg_hnd->minor >= MSM_DSI_6G_VER_MINOR_V1_3) { in dsi_ctrl_enable()
770 /* Always assume dedicated TE pin */ in dsi_ctrl_enable()
774 data |= DSI_TRIG_CTRL_STREAM(msm_host->channel); in dsi_ctrl_enable()
775 if ((cfg_hnd->major == MSM_DSI_VER_MAJOR_6G) && in dsi_ctrl_enable()
776 (cfg_hnd->minor >= MSM_DSI_6G_VER_MINOR_V1_2)) in dsi_ctrl_enable()
780 data = DSI_CLKOUT_TIMING_CTRL_T_CLK_POST(phy_shared_timings->clk_post) | in dsi_ctrl_enable()
781 DSI_CLKOUT_TIMING_CTRL_T_CLK_PRE(phy_shared_timings->clk_pre); in dsi_ctrl_enable()
784 if ((cfg_hnd->major == MSM_DSI_VER_MAJOR_6G) && in dsi_ctrl_enable()
785 (cfg_hnd->minor > MSM_DSI_6G_VER_MINOR_V1_0) && in dsi_ctrl_enable()
786 phy_shared_timings->clk_pre_inc_by_2) in dsi_ctrl_enable()
795 /* allow only ack-err-status to generate interrupt */ in dsi_ctrl_enable()
804 DBG("lane number=%d", msm_host->lanes); in dsi_ctrl_enable()
805 data |= ((DSI_CTRL_LANE0 << msm_host->lanes) - DSI_CTRL_LANE0); in dsi_ctrl_enable()
808 DSI_LANE_SWAP_CTRL_DLN_SWAP_SEL(msm_host->dlane_swap)); in dsi_ctrl_enable()
824 if (msm_host->cphy_mode) in dsi_ctrl_enable()
830 struct drm_dsc_config *dsc = msm_host->dsc; in dsi_update_dsc_timing()
842 total_bytes_per_intf = dsc->slice_chunk_size * slice_per_intf; in dsi_update_dsc_timing()
843 bytes_per_pkt = dsc->slice_chunk_size; /* * slice_per_pkt; */ in dsi_update_dsc_timing()
876 reg_ctrl2 |= DSI_COMMAND_COMPRESSION_MODE_CTRL2_STREAM0_SLICE_WIDTH(dsc->slice_chunk_size); in dsi_update_dsc_timing()
888 struct drm_display_mode *mode = msm_host->mode; in dsi_timing_setup()
890 u32 h_total = mode->htotal; in dsi_timing_setup()
891 u32 v_total = mode->vtotal; in dsi_timing_setup()
892 u32 hs_end = mode->hsync_end - mode->hsync_start; in dsi_timing_setup()
893 u32 vs_end = mode->vsync_end - mode->vsync_start; in dsi_timing_setup()
894 u32 ha_start = h_total - mode->hsync_start; in dsi_timing_setup()
895 u32 ha_end = ha_start + mode->hdisplay; in dsi_timing_setup()
896 u32 va_start = v_total - mode->vsync_start; in dsi_timing_setup()
897 u32 va_end = va_start + mode->vdisplay; in dsi_timing_setup()
898 u32 hdisplay = mode->hdisplay; in dsi_timing_setup()
919 if (msm_host->dsc) { in dsi_timing_setup()
920 struct drm_dsc_config *dsc = msm_host->dsc; in dsi_timing_setup()
923 if (!dsc || !mode->hdisplay || !mode->vdisplay) { in dsi_timing_setup()
925 mode->hdisplay, mode->vdisplay); in dsi_timing_setup()
929 dsc->pic_width = mode->hdisplay; in dsi_timing_setup()
930 dsc->pic_height = mode->vdisplay; in dsi_timing_setup()
931 DBG("Mode %dx%d\n", dsc->pic_width, dsc->pic_height); in dsi_timing_setup()
943 h_total -= hdisplay; in dsi_timing_setup()
944 hdisplay = DIV_ROUND_UP(msm_dsc_get_bytes_per_line(msm_host->dsc), 3); in dsi_timing_setup()
949 if (msm_host->mode_flags & MIPI_DSI_MODE_VIDEO) { in dsi_timing_setup()
950 if (msm_host->dsc) in dsi_timing_setup()
951 dsi_update_dsc_timing(msm_host, false, mode->hdisplay); in dsi_timing_setup()
960 DSI_TOTAL_H_TOTAL(h_total - 1) | in dsi_timing_setup()
961 DSI_TOTAL_V_TOTAL(v_total - 1)); in dsi_timing_setup()
971 if (msm_host->dsc) in dsi_timing_setup()
972 dsi_update_dsc_timing(msm_host, true, mode->hdisplay); in dsi_timing_setup()
975 if (!msm_host->dsc) in dsi_timing_setup()
976 wc = hdisplay * dsi_get_bpp(msm_host->format) / 8 + 1; in dsi_timing_setup()
985 wc = msm_host->dsc->slice_chunk_size + 1; in dsi_timing_setup()
990 msm_host->channel) | in dsi_timing_setup()
996 DSI_CMD_MDP_STREAM0_TOTAL_V_TOTAL(mode->vdisplay)); in dsi_timing_setup()
1072 struct device *dev = &msm_host->pdev->dev; in dsi_wait4video_done()
1076 reinit_completion(&msm_host->video_comp); in dsi_wait4video_done()
1078 ret = wait_for_completion_timeout(&msm_host->video_comp, in dsi_wait4video_done()
1091 if (!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO)) in dsi_wait4video_eng_busy()
1104 if (msm_host->power_on && msm_host->enabled) { in dsi_wait4video_eng_busy()
1113 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_alloc_6g()
1114 struct msm_drm_private *priv = dev->dev_private; in dsi_tx_buf_alloc_6g()
1118 msm_host->aspace = msm_gem_address_space_get(priv->kms->aspace); in dsi_tx_buf_alloc_6g()
1121 msm_host->aspace, in dsi_tx_buf_alloc_6g()
1122 &msm_host->tx_gem_obj, &iova); in dsi_tx_buf_alloc_6g()
1125 msm_host->tx_gem_obj = NULL; in dsi_tx_buf_alloc_6g()
1129 msm_gem_object_set_name(msm_host->tx_gem_obj, "tx_gem"); in dsi_tx_buf_alloc_6g()
1131 msm_host->tx_size = msm_host->tx_gem_obj->size; in dsi_tx_buf_alloc_6g()
1138 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_alloc_v2()
1140 msm_host->tx_buf = dma_alloc_coherent(dev->dev, size, in dsi_tx_buf_alloc_v2()
1141 &msm_host->tx_buf_paddr, GFP_KERNEL); in dsi_tx_buf_alloc_v2()
1142 if (!msm_host->tx_buf) in dsi_tx_buf_alloc_v2()
1143 return -ENOMEM; in dsi_tx_buf_alloc_v2()
1145 msm_host->tx_size = size; in dsi_tx_buf_alloc_v2()
1153 struct drm_device *dev = msm_host->dev; in msm_dsi_tx_buf_free()
1164 if (msm_host->tx_gem_obj) { in msm_dsi_tx_buf_free()
1165 msm_gem_kernel_put(msm_host->tx_gem_obj, msm_host->aspace); in msm_dsi_tx_buf_free()
1166 msm_gem_address_space_put(msm_host->aspace); in msm_dsi_tx_buf_free()
1167 msm_host->tx_gem_obj = NULL; in msm_dsi_tx_buf_free()
1168 msm_host->aspace = NULL; in msm_dsi_tx_buf_free()
1171 if (msm_host->tx_buf) in msm_dsi_tx_buf_free()
1172 dma_free_coherent(dev->dev, msm_host->tx_size, msm_host->tx_buf, in msm_dsi_tx_buf_free()
1173 msm_host->tx_buf_paddr); in msm_dsi_tx_buf_free()
1178 return msm_gem_get_vaddr(msm_host->tx_gem_obj); in dsi_tx_buf_get_6g()
1183 return msm_host->tx_buf; in dsi_tx_buf_get_v2()
1188 msm_gem_put_vaddr(msm_host->tx_gem_obj); in dsi_tx_buf_put_6g()
1197 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_cmd_dma_add()
1210 if (len > msm_host->tx_size) { in dsi_cmd_dma_add()
1212 return -EINVAL; in dsi_cmd_dma_add()
1215 data = cfg_hnd->ops->tx_buf_get(msm_host); in dsi_cmd_dma_add()
1227 if (mipi_dsi_packet_format_is_long(msg->type)) in dsi_cmd_dma_add()
1229 if (msg->rx_buf && msg->rx_len) in dsi_cmd_dma_add()
1238 memset(data + packet.size, 0xff, len - packet.size); in dsi_cmd_dma_add()
1240 if (cfg_hnd->ops->tx_buf_put) in dsi_cmd_dma_add()
1241 cfg_hnd->ops->tx_buf_put(msm_host); in dsi_cmd_dma_add()
1251 u8 *data = msg->rx_buf; in dsi_short_read1_resp()
1252 if (data && (msg->rx_len >= 1)) { in dsi_short_read1_resp()
1257 __func__, msg->rx_len); in dsi_short_read1_resp()
1258 return -EINVAL; in dsi_short_read1_resp()
1267 u8 *data = msg->rx_buf; in dsi_short_read2_resp()
1268 if (data && (msg->rx_len >= 2)) { in dsi_short_read2_resp()
1274 __func__, msg->rx_len); in dsi_short_read2_resp()
1275 return -EINVAL; in dsi_short_read2_resp()
1282 if (msg->rx_buf && msg->rx_len) in dsi_long_read_resp()
1283 memcpy(msg->rx_buf, buf + 4, msg->rx_len); in dsi_long_read_resp()
1285 return msg->rx_len; in dsi_long_read_resp()
1290 struct drm_device *dev = msm_host->dev; in dsi_dma_base_get_6g()
1291 struct msm_drm_private *priv = dev->dev_private; in dsi_dma_base_get_6g()
1294 return -EINVAL; in dsi_dma_base_get_6g()
1296 return msm_gem_get_and_pin_iova(msm_host->tx_gem_obj, in dsi_dma_base_get_6g()
1297 priv->kms->aspace, dma_base); in dsi_dma_base_get_6g()
1303 return -EINVAL; in dsi_dma_base_get_v2()
1305 *dma_base = msm_host->tx_buf_paddr; in dsi_dma_base_get_v2()
1311 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_cmd_dma_tx()
1316 ret = cfg_hnd->ops->dma_base_get(msm_host, &dma_base); in dsi_cmd_dma_tx()
1322 reinit_completion(&msm_host->dma_comp); in dsi_cmd_dma_tx()
1327 msm_host->id, dma_base, len); in dsi_cmd_dma_tx()
1329 ret = wait_for_completion_timeout(&msm_host->dma_comp, in dsi_cmd_dma_tx()
1333 ret = -ETIMEDOUT; in dsi_cmd_dma_tx()
1350 int buf_offset = buf - msm_host->rx_buf; in dsi_cmd_dma_rx()
1375 bytes_shifted = read_cnt - 16; in dsi_cmd_dma_rx()
1376 repeated_bytes = buf_offset - bytes_shifted; in dsi_cmd_dma_rx()
1379 for (i = cnt - 1; i >= 0; i--) { in dsi_cmd_dma_rx()
1395 int bllp_len = msm_host->mode->hdisplay * in dsi_cmds2buf_tx()
1396 dsi_get_bpp(msm_host->format) / 8; in dsi_cmds2buf_tx()
1401 __func__, msg->type); in dsi_cmds2buf_tx()
1414 if ((msm_host->mode_flags & MIPI_DSI_MODE_VIDEO) && (len > bllp_len)) { in dsi_cmds2buf_tx()
1417 return -EINVAL; in dsi_cmds2buf_tx()
1423 __func__, msg->type, (*(u8 *)(msg->tx_buf)), len, ret); in dsi_cmds2buf_tx()
1427 __func__, msg->type, (*(u8 *)(msg->tx_buf)), ret, len); in dsi_cmds2buf_tx()
1428 return -EIO; in dsi_cmds2buf_tx()
1438 u32 status = msm_host->err_work_state; in dsi_err_worker()
1445 msm_host->err_work_state = 0; in dsi_err_worker()
1461 msm_host->err_work_state |= DSI_ERR_STATE_ACK; in dsi_ack_err_status()
1473 msm_host->err_work_state |= DSI_ERR_STATE_TIMEOUT; in dsi_timeout_status()
1489 msm_host->err_work_state |= DSI_ERR_STATE_DLN0_PHY; in dsi_dln0_phy_err()
1502 msm_host->err_work_state |= DSI_ERR_STATE_FIFO; in dsi_fifo_status()
1504 msm_host->err_work_state |= in dsi_fifo_status()
1517 msm_host->err_work_state |= in dsi_status()
1530 msm_host->err_work_state |= DSI_ERR_STATE_PLL_UNLOCKED; in dsi_clk_status()
1546 queue_work(msm_host->workqueue, &msm_host->err_work); in dsi_error()
1555 if (!msm_host->ctrl_base) in dsi_host_irq()
1558 spin_lock_irqsave(&msm_host->intr_lock, flags); in dsi_host_irq()
1561 spin_unlock_irqrestore(&msm_host->intr_lock, flags); in dsi_host_irq()
1563 DBG("isr=0x%x, id=%d", isr, msm_host->id); in dsi_host_irq()
1569 complete(&msm_host->video_comp); in dsi_host_irq()
1572 complete(&msm_host->dma_comp); in dsi_host_irq()
1580 msm_host->disp_en_gpio = devm_gpiod_get_optional(panel_device, in dsi_host_init_panel_gpios()
1581 "disp-enable", in dsi_host_init_panel_gpios()
1583 if (IS_ERR(msm_host->disp_en_gpio)) { in dsi_host_init_panel_gpios()
1584 DBG("cannot get disp-enable-gpios %ld", in dsi_host_init_panel_gpios()
1585 PTR_ERR(msm_host->disp_en_gpio)); in dsi_host_init_panel_gpios()
1586 return PTR_ERR(msm_host->disp_en_gpio); in dsi_host_init_panel_gpios()
1589 msm_host->te_gpio = devm_gpiod_get_optional(panel_device, "disp-te", in dsi_host_init_panel_gpios()
1591 if (IS_ERR(msm_host->te_gpio)) { in dsi_host_init_panel_gpios()
1592 DBG("cannot get disp-te-gpios %ld", PTR_ERR(msm_host->te_gpio)); in dsi_host_init_panel_gpios()
1593 return PTR_ERR(msm_host->te_gpio); in dsi_host_init_panel_gpios()
1605 if (dsi->lanes > msm_host->num_data_lanes) in dsi_host_attach()
1606 return -EINVAL; in dsi_host_attach()
1608 msm_host->channel = dsi->channel; in dsi_host_attach()
1609 msm_host->lanes = dsi->lanes; in dsi_host_attach()
1610 msm_host->format = dsi->format; in dsi_host_attach()
1611 msm_host->mode_flags = dsi->mode_flags; in dsi_host_attach()
1612 if (dsi->dsc) in dsi_host_attach()
1613 msm_host->dsc = dsi->dsc; in dsi_host_attach()
1615 /* Some gpios defined in panel DT need to be controlled by host */ in dsi_host_attach()
1616 ret = dsi_host_init_panel_gpios(msm_host, &dsi->dev); in dsi_host_attach()
1620 ret = dsi_dev_attach(msm_host->pdev); in dsi_host_attach()
1624 DBG("id=%d", msm_host->id); in dsi_host_attach()
1634 dsi_dev_detach(msm_host->pdev); in dsi_host_detach()
1636 DBG("id=%d", msm_host->id); in dsi_host_detach()
1647 if (!msg || !msm_host->power_on) in dsi_host_transfer()
1648 return -EINVAL; in dsi_host_transfer()
1650 mutex_lock(&msm_host->cmd_mutex); in dsi_host_transfer()
1651 ret = msm_dsi_manager_cmd_xfer(msm_host->id, msg); in dsi_host_transfer()
1652 mutex_unlock(&msm_host->cmd_mutex); in dsi_host_transfer()
1667 * "3012": Logic 3->Phys 0; Logic 0->Phys 1; Logic 1->Phys 2; Logic 2->Phys 3;
1683 struct device *dev = &msm_host->pdev->dev; in dsi_host_parse_lane_data()
1688 prop = of_find_property(ep, "data-lanes", &len); in dsi_host_parse_lane_data()
1693 msm_host->num_data_lanes = 4; in dsi_host_parse_lane_data()
1703 msm_host->num_data_lanes = num_lanes; in dsi_host_parse_lane_data()
1705 ret = of_property_read_u32_array(ep, "data-lanes", lane_map, in dsi_host_parse_lane_data()
1713 * compare DT specified physical-logical lane mappings with the ones in dsi_host_parse_lane_data()
1721 * the data-lanes array we get from DT has a logical->physical in dsi_host_parse_lane_data()
1723 * supported configurations in a physical->logical mapping. in dsi_host_parse_lane_data()
1737 msm_host->dlane_swap = i; in dsi_host_parse_lane_data()
1742 return -EINVAL; in dsi_host_parse_lane_data()
1749 if (dsc->bits_per_pixel & 0xf) { in dsi_populate_dsc_params()
1750 DRM_DEV_ERROR(&msm_host->pdev->dev, "DSI does not support fractional bits_per_pixel\n"); in dsi_populate_dsc_params()
1751 return -EINVAL; in dsi_populate_dsc_params()
1754 if (dsc->bits_per_component != 8) { in dsi_populate_dsc_params()
1755 DRM_DEV_ERROR(&msm_host->pdev->dev, "DSI does not support bits_per_component != 8 yet\n"); in dsi_populate_dsc_params()
1756 return -EOPNOTSUPP; in dsi_populate_dsc_params()
1759 dsc->simple_422 = 0; in dsi_populate_dsc_params()
1760 dsc->convert_rgb = 1; in dsi_populate_dsc_params()
1761 dsc->vbr_enable = 0; in dsi_populate_dsc_params()
1766 /* handle only bpp = bpc = 8, pre-SCR panels */ in dsi_populate_dsc_params()
1769 DRM_DEV_ERROR(&msm_host->pdev->dev, "could not find DSC RC parameters\n"); in dsi_populate_dsc_params()
1773 dsc->initial_scale_value = drm_dsc_initial_scale_value(dsc); in dsi_populate_dsc_params()
1774 dsc->line_buf_depth = dsc->bits_per_component + 1; in dsi_populate_dsc_params()
1781 struct device *dev = &msm_host->pdev->dev; in dsi_host_parse_dt()
1782 struct device_node *np = dev->of_node; in dsi_host_parse_dt()
1792 endpoint = of_graph_get_endpoint_by_regs(np, 1, -1); in dsi_host_parse_dt()
1802 ret = -EINVAL; in dsi_host_parse_dt()
1806 if (of_property_read_bool(np, "syscon-sfpb")) { in dsi_host_parse_dt()
1807 msm_host->sfpb = syscon_regmap_lookup_by_phandle(np, in dsi_host_parse_dt()
1808 "syscon-sfpb"); in dsi_host_parse_dt()
1809 if (IS_ERR(msm_host->sfpb)) { in dsi_host_parse_dt()
1812 ret = PTR_ERR(msm_host->sfpb); in dsi_host_parse_dt()
1824 struct platform_device *pdev = msm_host->pdev; in dsi_host_get_id()
1825 const struct msm_dsi_config *cfg = msm_host->cfg_hnd->cfg; in dsi_host_get_id()
1831 return -EINVAL; in dsi_host_get_id()
1835 if (cfg->io_start[i][j] == res->start) in dsi_host_get_id()
1838 return -EINVAL; in dsi_host_get_id()
1844 struct platform_device *pdev = msm_dsi->pdev; in msm_dsi_host_init()
1848 msm_host = devm_kzalloc(&pdev->dev, sizeof(*msm_host), GFP_KERNEL); in msm_dsi_host_init()
1850 return -ENOMEM; in msm_dsi_host_init()
1853 msm_host->pdev = pdev; in msm_dsi_host_init()
1854 msm_dsi->host = &msm_host->base; in msm_dsi_host_init()
1862 msm_host->ctrl_base = msm_ioremap_size(pdev, "dsi_ctrl", &msm_host->ctrl_size); in msm_dsi_host_init()
1863 if (IS_ERR(msm_host->ctrl_base)) { in msm_dsi_host_init()
1865 return PTR_ERR(msm_host->ctrl_base); in msm_dsi_host_init()
1868 pm_runtime_enable(&pdev->dev); in msm_dsi_host_init()
1870 msm_host->cfg_hnd = dsi_get_config(msm_host); in msm_dsi_host_init()
1871 if (!msm_host->cfg_hnd) { in msm_dsi_host_init()
1873 return -EINVAL; in msm_dsi_host_init()
1875 cfg = msm_host->cfg_hnd->cfg; in msm_dsi_host_init()
1877 msm_host->id = dsi_host_get_id(msm_host); in msm_dsi_host_init()
1878 if (msm_host->id < 0) { in msm_dsi_host_init()
1880 return msm_host->id; in msm_dsi_host_init()
1884 msm_host->ctrl_base += cfg->io_offset; in msm_dsi_host_init()
1886 ret = devm_regulator_bulk_get_const(&pdev->dev, cfg->num_regulators, in msm_dsi_host_init()
1887 cfg->regulator_data, in msm_dsi_host_init()
1888 &msm_host->supplies); in msm_dsi_host_init()
1898 msm_host->rx_buf = devm_kzalloc(&pdev->dev, SZ_4K, GFP_KERNEL); in msm_dsi_host_init()
1899 if (!msm_host->rx_buf) { in msm_dsi_host_init()
1901 return -ENOMEM; in msm_dsi_host_init()
1904 ret = devm_pm_opp_set_clkname(&pdev->dev, "byte"); in msm_dsi_host_init()
1908 ret = devm_pm_opp_of_add_table(&pdev->dev); in msm_dsi_host_init()
1909 if (ret && ret != -ENODEV) { in msm_dsi_host_init()
1910 dev_err(&pdev->dev, "invalid OPP table in device tree\n"); in msm_dsi_host_init()
1914 msm_host->irq = irq_of_parse_and_map(pdev->dev.of_node, 0); in msm_dsi_host_init()
1915 if (!msm_host->irq) { in msm_dsi_host_init()
1916 dev_err(&pdev->dev, "failed to get irq\n"); in msm_dsi_host_init()
1917 return -EINVAL; in msm_dsi_host_init()
1921 ret = devm_request_irq(&pdev->dev, msm_host->irq, dsi_host_irq, in msm_dsi_host_init()
1925 dev_err(&pdev->dev, "failed to request IRQ%u: %d\n", in msm_dsi_host_init()
1926 msm_host->irq, ret); in msm_dsi_host_init()
1930 init_completion(&msm_host->dma_comp); in msm_dsi_host_init()
1931 init_completion(&msm_host->video_comp); in msm_dsi_host_init()
1932 mutex_init(&msm_host->dev_mutex); in msm_dsi_host_init()
1933 mutex_init(&msm_host->cmd_mutex); in msm_dsi_host_init()
1934 spin_lock_init(&msm_host->intr_lock); in msm_dsi_host_init()
1937 msm_host->workqueue = alloc_ordered_workqueue("dsi_drm_work", 0); in msm_dsi_host_init()
1938 if (!msm_host->workqueue) in msm_dsi_host_init()
1939 return -ENOMEM; in msm_dsi_host_init()
1941 INIT_WORK(&msm_host->err_work, dsi_err_worker); in msm_dsi_host_init()
1943 msm_dsi->id = msm_host->id; in msm_dsi_host_init()
1945 DBG("Dsi Host %d initialized", msm_host->id); in msm_dsi_host_init()
1954 if (msm_host->workqueue) { in msm_dsi_host_destroy()
1955 destroy_workqueue(msm_host->workqueue); in msm_dsi_host_destroy()
1956 msm_host->workqueue = NULL; in msm_dsi_host_destroy()
1959 mutex_destroy(&msm_host->cmd_mutex); in msm_dsi_host_destroy()
1960 mutex_destroy(&msm_host->dev_mutex); in msm_dsi_host_destroy()
1962 pm_runtime_disable(&msm_host->pdev->dev); in msm_dsi_host_destroy()
1969 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_modeset_init()
1972 msm_host->dev = dev; in msm_dsi_host_modeset_init()
1974 ret = cfg_hnd->ops->tx_buf_alloc(msm_host, SZ_4K); in msm_dsi_host_modeset_init()
1989 if (!msm_host->registered) { in msm_dsi_host_register()
1990 host->dev = &msm_host->pdev->dev; in msm_dsi_host_register()
1991 host->ops = &dsi_host_ops; in msm_dsi_host_register()
1996 msm_host->registered = true; in msm_dsi_host_register()
2006 if (msm_host->registered) { in msm_dsi_host_unregister()
2008 host->dev = NULL; in msm_dsi_host_unregister()
2009 host->ops = NULL; in msm_dsi_host_unregister()
2010 msm_host->registered = false; in msm_dsi_host_unregister()
2018 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_xfer_prepare()
2030 pm_runtime_get_sync(&msm_host->pdev->dev); in msm_dsi_host_xfer_prepare()
2031 cfg_hnd->ops->link_clk_set_rate(msm_host); in msm_dsi_host_xfer_prepare()
2032 cfg_hnd->ops->link_clk_enable(msm_host); in msm_dsi_host_xfer_prepare()
2036 if (!(msg->flags & MIPI_DSI_MSG_USE_LPM)) in msm_dsi_host_xfer_prepare()
2039 msm_host->dma_cmd_ctrl_restore = dsi_read(msm_host, REG_DSI_CTRL); in msm_dsi_host_xfer_prepare()
2041 msm_host->dma_cmd_ctrl_restore | in msm_dsi_host_xfer_prepare()
2053 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_xfer_restore()
2056 dsi_write(msm_host, REG_DSI_CTRL, msm_host->dma_cmd_ctrl_restore); in msm_dsi_host_xfer_restore()
2058 if (!(msg->flags & MIPI_DSI_MSG_USE_LPM)) in msm_dsi_host_xfer_restore()
2063 cfg_hnd->ops->link_clk_disable(msm_host); in msm_dsi_host_xfer_restore()
2064 pm_runtime_put(&msm_host->pdev->dev); in msm_dsi_host_xfer_restore()
2079 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_cmd_rx()
2083 int rlen = msg->rx_len; in msm_dsi_host_cmd_rx()
2100 buf = msm_host->rx_buf; in msm_dsi_host_cmd_rx()
2105 .channel = msg->channel, in msm_dsi_host_cmd_rx()
2118 return -EINVAL; in msm_dsi_host_cmd_rx()
2121 if ((cfg_hnd->major == MSM_DSI_VER_MAJOR_6G) && in msm_dsi_host_cmd_rx()
2122 (cfg_hnd->minor >= MSM_DSI_6G_VER_MINOR_V1_1)) { in msm_dsi_host_cmd_rx()
2135 } else if (ret < msg->tx_len) { in msm_dsi_host_cmd_rx()
2137 return -ECOMM; in msm_dsi_host_cmd_rx()
2156 diff = data_byte - rlen; in msm_dsi_host_cmd_rx()
2160 rlen -= data_byte; in msm_dsi_host_cmd_rx()
2164 dlen -= 2; /* 2 crc */ in msm_dsi_host_cmd_rx()
2165 dlen -= diff; in msm_dsi_host_cmd_rx()
2183 buf = msm_host->rx_buf + (10 - rlen); in msm_dsi_host_cmd_rx()
2185 buf = msm_host->rx_buf; in msm_dsi_host_cmd_rx()
2231 msm_host->cphy_mode = src_phy->cphy_mode; in msm_dsi_host_set_phy_mode()
2252 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_get_phy_clk_req()
2255 ret = cfg_hnd->ops->calc_clk_rate(msm_host, is_bonded_dsi); in msm_dsi_host_get_phy_clk_req()
2262 * "byte_clk" is in units of 16-bits (see dsi_calc_pclk), in msm_dsi_host_get_phy_clk_req()
2265 if (msm_host->cphy_mode) in msm_dsi_host_get_phy_clk_req()
2266 clk_req->bitclk_rate = msm_host->byte_clk_rate * 7; in msm_dsi_host_get_phy_clk_req()
2268 clk_req->bitclk_rate = msm_host->byte_clk_rate * 8; in msm_dsi_host_get_phy_clk_req()
2269 clk_req->escclk_rate = msm_host->esc_clk_rate; in msm_dsi_host_get_phy_clk_req()
2276 enable_irq(msm_host->irq); in msm_dsi_host_enable_irq()
2283 disable_irq(msm_host->irq); in msm_dsi_host_disable_irq()
2291 !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO), true); in msm_dsi_host_enable()
2297 /* if (msm_panel->mode == MSM_DSI_CMD_MODE) { in msm_dsi_host_enable()
2299 * pm_runtime_put(&msm_host->pdev->dev); in msm_dsi_host_enable()
2302 msm_host->enabled = true; in msm_dsi_host_enable()
2310 msm_host->enabled = false; in msm_dsi_host_disable()
2312 !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO), false); in msm_dsi_host_disable()
2327 if (!msm_host->sfpb) in msm_dsi_sfpb_config()
2332 regmap_update_bits(msm_host->sfpb, REG_SFPB_GPREG, in msm_dsi_sfpb_config()
2342 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_power_on()
2345 mutex_lock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
2346 if (msm_host->power_on) { in msm_dsi_host_power_on()
2351 msm_host->byte_intf_clk_rate = msm_host->byte_clk_rate; in msm_dsi_host_power_on()
2352 if (phy_shared_timings->byte_intf_clk_div_2) in msm_dsi_host_power_on()
2353 msm_host->byte_intf_clk_rate /= 2; in msm_dsi_host_power_on()
2357 ret = regulator_bulk_enable(msm_host->cfg_hnd->cfg->num_regulators, in msm_dsi_host_power_on()
2358 msm_host->supplies); in msm_dsi_host_power_on()
2365 pm_runtime_get_sync(&msm_host->pdev->dev); in msm_dsi_host_power_on()
2366 ret = cfg_hnd->ops->link_clk_set_rate(msm_host); in msm_dsi_host_power_on()
2368 ret = cfg_hnd->ops->link_clk_enable(msm_host); in msm_dsi_host_power_on()
2375 ret = pinctrl_pm_select_default_state(&msm_host->pdev->dev); in msm_dsi_host_power_on()
2386 if (msm_host->disp_en_gpio) in msm_dsi_host_power_on()
2387 gpiod_set_value(msm_host->disp_en_gpio, 1); in msm_dsi_host_power_on()
2389 msm_host->power_on = true; in msm_dsi_host_power_on()
2390 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
2395 cfg_hnd->ops->link_clk_disable(msm_host); in msm_dsi_host_power_on()
2396 pm_runtime_put(&msm_host->pdev->dev); in msm_dsi_host_power_on()
2398 regulator_bulk_disable(msm_host->cfg_hnd->cfg->num_regulators, in msm_dsi_host_power_on()
2399 msm_host->supplies); in msm_dsi_host_power_on()
2401 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
2408 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_power_off()
2410 mutex_lock(&msm_host->dev_mutex); in msm_dsi_host_power_off()
2411 if (!msm_host->power_on) { in msm_dsi_host_power_off()
2418 if (msm_host->disp_en_gpio) in msm_dsi_host_power_off()
2419 gpiod_set_value(msm_host->disp_en_gpio, 0); in msm_dsi_host_power_off()
2421 pinctrl_pm_select_sleep_state(&msm_host->pdev->dev); in msm_dsi_host_power_off()
2423 cfg_hnd->ops->link_clk_disable(msm_host); in msm_dsi_host_power_off()
2424 pm_runtime_put(&msm_host->pdev->dev); in msm_dsi_host_power_off()
2426 regulator_bulk_disable(msm_host->cfg_hnd->cfg->num_regulators, in msm_dsi_host_power_off()
2427 msm_host->supplies); in msm_dsi_host_power_off()
2431 DBG("-"); in msm_dsi_host_power_off()
2433 msm_host->power_on = false; in msm_dsi_host_power_off()
2436 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_off()
2445 if (msm_host->mode) { in msm_dsi_host_set_display_mode()
2446 drm_mode_destroy(msm_host->dev, msm_host->mode); in msm_dsi_host_set_display_mode()
2447 msm_host->mode = NULL; in msm_dsi_host_set_display_mode()
2450 msm_host->mode = drm_mode_duplicate(msm_host->dev, mode); in msm_dsi_host_set_display_mode()
2451 if (!msm_host->mode) { in msm_dsi_host_set_display_mode()
2453 return -ENOMEM; in msm_dsi_host_set_display_mode()
2463 struct drm_dsc_config *dsc = msm_host->dsc; in msm_dsi_host_check_dsc()
2464 int pic_width = mode->hdisplay; in msm_dsi_host_check_dsc()
2465 int pic_height = mode->vdisplay; in msm_dsi_host_check_dsc()
2467 if (!msm_host->dsc) in msm_dsi_host_check_dsc()
2470 if (pic_width % dsc->slice_width) { in msm_dsi_host_check_dsc()
2472 pic_width, dsc->slice_width); in msm_dsi_host_check_dsc()
2476 if (pic_height % dsc->slice_height) { in msm_dsi_host_check_dsc()
2478 pic_height, dsc->slice_height); in msm_dsi_host_check_dsc()
2487 return to_msm_dsi_host(host)->mode_flags; in msm_dsi_host_get_mode_flags()
2494 pm_runtime_get_sync(&msm_host->pdev->dev); in msm_dsi_host_snapshot()
2496 msm_disp_snapshot_add_block(disp_state, msm_host->ctrl_size, in msm_dsi_host_snapshot()
2497 msm_host->ctrl_base, "dsi%d_ctrl", msm_host->id); in msm_dsi_host_snapshot()
2499 pm_runtime_put_sync(&msm_host->pdev->dev); in msm_dsi_host_snapshot()
2512 /* use 24-bit RGB test pttern */ in msm_dsi_host_video_test_pattern_setup()
2545 bool is_video_mode = !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO); in msm_dsi_host_test_pattern_en()
2567 return msm_host->dsc; in msm_dsi_host_get_dsc_config()