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->mode->clock, 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->mode->clock, 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 new_htotal * mode->vtotal * drm_mode_vrefresh(mode); in dsi_adjust_pclk_for_compression()
548 pclk_rate = mode->clock * 1000; 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()
718 return msm_host->dsc && in msm_dsi_host_is_wide_bus_enabled()
719 (msm_host->cfg_hnd->major == MSM_DSI_VER_MAJOR_6G && in msm_dsi_host_is_wide_bus_enabled()
720 msm_host->cfg_hnd->minor >= MSM_DSI_6G_VER_MINOR_V2_5_0); in msm_dsi_host_is_wide_bus_enabled()
726 u32 flags = msm_host->mode_flags; in dsi_ctrl_enable()
727 enum mipi_dsi_pixel_format mipi_fmt = msm_host->format; in dsi_ctrl_enable()
728 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_ctrl_enable()
747 data |= DSI_VID_CFG0_VIRT_CHANNEL(msm_host->channel); in dsi_ctrl_enable()
766 if (cfg_hnd->major == MSM_DSI_VER_MAJOR_6G) { in dsi_ctrl_enable()
769 if (cfg_hnd->minor >= MSM_DSI_6G_VER_MINOR_V1_3) in dsi_ctrl_enable()
772 /* TODO: Allow for video-mode support once tested/fixed */ in dsi_ctrl_enable()
773 if (msm_dsi_host_is_wide_bus_enabled(&msm_host->base)) in dsi_ctrl_enable()
785 /* Always assume dedicated TE pin */ in dsi_ctrl_enable()
789 data |= DSI_TRIG_CTRL_STREAM(msm_host->channel); in dsi_ctrl_enable()
790 if ((cfg_hnd->major == MSM_DSI_VER_MAJOR_6G) && in dsi_ctrl_enable()
791 (cfg_hnd->minor >= MSM_DSI_6G_VER_MINOR_V1_2)) in dsi_ctrl_enable()
795 data = DSI_CLKOUT_TIMING_CTRL_T_CLK_POST(phy_shared_timings->clk_post) | in dsi_ctrl_enable()
796 DSI_CLKOUT_TIMING_CTRL_T_CLK_PRE(phy_shared_timings->clk_pre); in dsi_ctrl_enable()
799 if ((cfg_hnd->major == MSM_DSI_VER_MAJOR_6G) && in dsi_ctrl_enable()
800 (cfg_hnd->minor > MSM_DSI_6G_VER_MINOR_V1_0) && in dsi_ctrl_enable()
801 phy_shared_timings->clk_pre_inc_by_2) in dsi_ctrl_enable()
810 /* allow only ack-err-status to generate interrupt */ in dsi_ctrl_enable()
819 DBG("lane number=%d", msm_host->lanes); in dsi_ctrl_enable()
820 data |= ((DSI_CTRL_LANE0 << msm_host->lanes) - DSI_CTRL_LANE0); in dsi_ctrl_enable()
823 DSI_LANE_SWAP_CTRL_DLN_SWAP_SEL(msm_host->dlane_swap)); in dsi_ctrl_enable()
839 if (msm_host->cphy_mode) in dsi_ctrl_enable()
845 struct drm_dsc_config *dsc = msm_host->dsc; in dsi_update_dsc_timing()
856 total_bytes_per_intf = dsc->slice_chunk_size * slice_per_intf; in dsi_update_dsc_timing()
889 reg_ctrl2 |= DSI_COMMAND_COMPRESSION_MODE_CTRL2_STREAM0_SLICE_WIDTH(dsc->slice_chunk_size); in dsi_update_dsc_timing()
900 struct drm_display_mode *mode = msm_host->mode; in dsi_timing_setup()
902 u32 h_total = mode->htotal; in dsi_timing_setup()
903 u32 v_total = mode->vtotal; in dsi_timing_setup()
904 u32 hs_end = mode->hsync_end - mode->hsync_start; in dsi_timing_setup()
905 u32 vs_end = mode->vsync_end - mode->vsync_start; in dsi_timing_setup()
906 u32 ha_start = h_total - mode->hsync_start; in dsi_timing_setup()
907 u32 ha_end = ha_start + mode->hdisplay; in dsi_timing_setup()
908 u32 va_start = v_total - mode->vsync_start; in dsi_timing_setup()
909 u32 va_end = va_start + mode->vdisplay; in dsi_timing_setup()
910 u32 hdisplay = mode->hdisplay; in dsi_timing_setup()
913 bool wide_bus_enabled = msm_dsi_host_is_wide_bus_enabled(&msm_host->base); in dsi_timing_setup()
932 if (msm_host->dsc) { in dsi_timing_setup()
933 struct drm_dsc_config *dsc = msm_host->dsc; in dsi_timing_setup()
937 if (!dsc || !mode->hdisplay || !mode->vdisplay) { in dsi_timing_setup()
939 mode->hdisplay, mode->vdisplay); in dsi_timing_setup()
943 dsc->pic_width = mode->hdisplay; in dsi_timing_setup()
944 dsc->pic_height = mode->vdisplay; in dsi_timing_setup()
945 DBG("Mode %dx%d\n", dsc->pic_width, dsc->pic_height); in dsi_timing_setup()
957 h_total -= hdisplay; in dsi_timing_setup()
958 if (wide_bus_enabled && !(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO)) in dsi_timing_setup()
963 hdisplay = DIV_ROUND_UP(msm_dsc_get_bytes_per_line(msm_host->dsc), bytes_per_pclk); in dsi_timing_setup()
969 if (msm_host->mode_flags & MIPI_DSI_MODE_VIDEO) { in dsi_timing_setup()
970 if (msm_host->dsc) in dsi_timing_setup()
971 dsi_update_dsc_timing(msm_host, false, mode->hdisplay); in dsi_timing_setup()
980 DSI_TOTAL_H_TOTAL(h_total - 1) | in dsi_timing_setup()
981 DSI_TOTAL_V_TOTAL(v_total - 1)); in dsi_timing_setup()
991 if (msm_host->dsc) in dsi_timing_setup()
992 dsi_update_dsc_timing(msm_host, true, mode->hdisplay); in dsi_timing_setup()
995 if (!msm_host->dsc) in dsi_timing_setup()
996 wc = hdisplay * dsi_get_bpp(msm_host->format) / 8 + 1; in dsi_timing_setup()
1005 wc = msm_host->dsc->slice_chunk_size + 1; in dsi_timing_setup()
1010 msm_host->channel) | in dsi_timing_setup()
1016 DSI_CMD_MDP_STREAM0_TOTAL_V_TOTAL(mode->vdisplay)); in dsi_timing_setup()
1092 struct device *dev = &msm_host->pdev->dev; in dsi_wait4video_done()
1096 reinit_completion(&msm_host->video_comp); in dsi_wait4video_done()
1098 ret = wait_for_completion_timeout(&msm_host->video_comp, in dsi_wait4video_done()
1111 if (!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO)) in dsi_wait4video_eng_busy()
1124 if (msm_host->power_on && msm_host->enabled) { in dsi_wait4video_eng_busy()
1133 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_alloc_6g()
1134 struct msm_drm_private *priv = dev->dev_private; in dsi_tx_buf_alloc_6g()
1138 msm_host->aspace = msm_gem_address_space_get(priv->kms->aspace); in dsi_tx_buf_alloc_6g()
1141 msm_host->aspace, in dsi_tx_buf_alloc_6g()
1142 &msm_host->tx_gem_obj, &iova); in dsi_tx_buf_alloc_6g()
1145 msm_host->tx_gem_obj = NULL; in dsi_tx_buf_alloc_6g()
1149 msm_gem_object_set_name(msm_host->tx_gem_obj, "tx_gem"); in dsi_tx_buf_alloc_6g()
1151 msm_host->tx_size = msm_host->tx_gem_obj->size; in dsi_tx_buf_alloc_6g()
1158 struct drm_device *dev = msm_host->dev; in dsi_tx_buf_alloc_v2()
1160 msm_host->tx_buf = dma_alloc_coherent(dev->dev, size, in dsi_tx_buf_alloc_v2()
1161 &msm_host->tx_buf_paddr, GFP_KERNEL); in dsi_tx_buf_alloc_v2()
1162 if (!msm_host->tx_buf) in dsi_tx_buf_alloc_v2()
1163 return -ENOMEM; in dsi_tx_buf_alloc_v2()
1165 msm_host->tx_size = size; in dsi_tx_buf_alloc_v2()
1173 struct drm_device *dev = msm_host->dev; in msm_dsi_tx_buf_free()
1184 if (msm_host->tx_gem_obj) { in msm_dsi_tx_buf_free()
1185 msm_gem_kernel_put(msm_host->tx_gem_obj, msm_host->aspace); in msm_dsi_tx_buf_free()
1186 msm_gem_address_space_put(msm_host->aspace); in msm_dsi_tx_buf_free()
1187 msm_host->tx_gem_obj = NULL; in msm_dsi_tx_buf_free()
1188 msm_host->aspace = NULL; in msm_dsi_tx_buf_free()
1191 if (msm_host->tx_buf) in msm_dsi_tx_buf_free()
1192 dma_free_coherent(dev->dev, msm_host->tx_size, msm_host->tx_buf, in msm_dsi_tx_buf_free()
1193 msm_host->tx_buf_paddr); in msm_dsi_tx_buf_free()
1198 return msm_gem_get_vaddr(msm_host->tx_gem_obj); in dsi_tx_buf_get_6g()
1203 return msm_host->tx_buf; in dsi_tx_buf_get_v2()
1208 msm_gem_put_vaddr(msm_host->tx_gem_obj); in dsi_tx_buf_put_6g()
1217 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_cmd_dma_add()
1230 if (len > msm_host->tx_size) { in dsi_cmd_dma_add()
1232 return -EINVAL; in dsi_cmd_dma_add()
1235 data = cfg_hnd->ops->tx_buf_get(msm_host); in dsi_cmd_dma_add()
1247 if (mipi_dsi_packet_format_is_long(msg->type)) in dsi_cmd_dma_add()
1249 if (msg->rx_buf && msg->rx_len) in dsi_cmd_dma_add()
1258 memset(data + packet.size, 0xff, len - packet.size); in dsi_cmd_dma_add()
1260 if (cfg_hnd->ops->tx_buf_put) in dsi_cmd_dma_add()
1261 cfg_hnd->ops->tx_buf_put(msm_host); in dsi_cmd_dma_add()
1271 u8 *data = msg->rx_buf; in dsi_short_read1_resp()
1272 if (data && (msg->rx_len >= 1)) { in dsi_short_read1_resp()
1277 __func__, msg->rx_len); in dsi_short_read1_resp()
1278 return -EINVAL; in dsi_short_read1_resp()
1287 u8 *data = msg->rx_buf; in dsi_short_read2_resp()
1288 if (data && (msg->rx_len >= 2)) { in dsi_short_read2_resp()
1294 __func__, msg->rx_len); in dsi_short_read2_resp()
1295 return -EINVAL; in dsi_short_read2_resp()
1302 if (msg->rx_buf && msg->rx_len) in dsi_long_read_resp()
1303 memcpy(msg->rx_buf, buf + 4, msg->rx_len); in dsi_long_read_resp()
1305 return msg->rx_len; in dsi_long_read_resp()
1310 struct drm_device *dev = msm_host->dev; in dsi_dma_base_get_6g()
1311 struct msm_drm_private *priv = dev->dev_private; in dsi_dma_base_get_6g()
1314 return -EINVAL; in dsi_dma_base_get_6g()
1316 return msm_gem_get_and_pin_iova(msm_host->tx_gem_obj, in dsi_dma_base_get_6g()
1317 priv->kms->aspace, dma_base); in dsi_dma_base_get_6g()
1323 return -EINVAL; in dsi_dma_base_get_v2()
1325 *dma_base = msm_host->tx_buf_paddr; in dsi_dma_base_get_v2()
1331 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in dsi_cmd_dma_tx()
1336 ret = cfg_hnd->ops->dma_base_get(msm_host, &dma_base); in dsi_cmd_dma_tx()
1342 reinit_completion(&msm_host->dma_comp); in dsi_cmd_dma_tx()
1347 msm_host->id, dma_base, len); in dsi_cmd_dma_tx()
1349 ret = wait_for_completion_timeout(&msm_host->dma_comp, in dsi_cmd_dma_tx()
1353 ret = -ETIMEDOUT; in dsi_cmd_dma_tx()
1370 int buf_offset = buf - msm_host->rx_buf; in dsi_cmd_dma_rx()
1395 bytes_shifted = read_cnt - 16; in dsi_cmd_dma_rx()
1396 repeated_bytes = buf_offset - bytes_shifted; in dsi_cmd_dma_rx()
1399 for (i = cnt - 1; i >= 0; i--) { in dsi_cmd_dma_rx()
1415 int bllp_len = msm_host->mode->hdisplay * in dsi_cmds2buf_tx()
1416 dsi_get_bpp(msm_host->format) / 8; in dsi_cmds2buf_tx()
1421 __func__, msg->type); in dsi_cmds2buf_tx()
1434 if ((msm_host->mode_flags & MIPI_DSI_MODE_VIDEO) && (len > bllp_len)) { in dsi_cmds2buf_tx()
1437 return -EINVAL; in dsi_cmds2buf_tx()
1443 __func__, msg->type, (*(u8 *)(msg->tx_buf)), len, ret); in dsi_cmds2buf_tx()
1447 __func__, msg->type, (*(u8 *)(msg->tx_buf)), ret, len); in dsi_cmds2buf_tx()
1448 return -EIO; in dsi_cmds2buf_tx()
1458 u32 status = msm_host->err_work_state; in dsi_err_worker()
1465 msm_host->err_work_state = 0; in dsi_err_worker()
1481 msm_host->err_work_state |= DSI_ERR_STATE_ACK; in dsi_ack_err_status()
1493 msm_host->err_work_state |= DSI_ERR_STATE_TIMEOUT; in dsi_timeout_status()
1509 msm_host->err_work_state |= DSI_ERR_STATE_DLN0_PHY; in dsi_dln0_phy_err()
1522 msm_host->err_work_state |= DSI_ERR_STATE_FIFO; in dsi_fifo_status()
1524 msm_host->err_work_state |= in dsi_fifo_status()
1537 msm_host->err_work_state |= in dsi_status()
1550 msm_host->err_work_state |= DSI_ERR_STATE_PLL_UNLOCKED; in dsi_clk_status()
1566 queue_work(msm_host->workqueue, &msm_host->err_work); in dsi_error()
1575 if (!msm_host->ctrl_base) in dsi_host_irq()
1578 spin_lock_irqsave(&msm_host->intr_lock, flags); in dsi_host_irq()
1581 spin_unlock_irqrestore(&msm_host->intr_lock, flags); in dsi_host_irq()
1583 DBG("isr=0x%x, id=%d", isr, msm_host->id); in dsi_host_irq()
1589 complete(&msm_host->video_comp); in dsi_host_irq()
1592 complete(&msm_host->dma_comp); in dsi_host_irq()
1600 msm_host->disp_en_gpio = devm_gpiod_get_optional(panel_device, in dsi_host_init_panel_gpios()
1601 "disp-enable", in dsi_host_init_panel_gpios()
1603 if (IS_ERR(msm_host->disp_en_gpio)) { in dsi_host_init_panel_gpios()
1604 DBG("cannot get disp-enable-gpios %ld", in dsi_host_init_panel_gpios()
1605 PTR_ERR(msm_host->disp_en_gpio)); in dsi_host_init_panel_gpios()
1606 return PTR_ERR(msm_host->disp_en_gpio); in dsi_host_init_panel_gpios()
1609 msm_host->te_gpio = devm_gpiod_get_optional(panel_device, "disp-te", in dsi_host_init_panel_gpios()
1611 if (IS_ERR(msm_host->te_gpio)) { in dsi_host_init_panel_gpios()
1612 DBG("cannot get disp-te-gpios %ld", PTR_ERR(msm_host->te_gpio)); in dsi_host_init_panel_gpios()
1613 return PTR_ERR(msm_host->te_gpio); in dsi_host_init_panel_gpios()
1625 if (dsi->lanes > msm_host->num_data_lanes) in dsi_host_attach()
1626 return -EINVAL; in dsi_host_attach()
1628 msm_host->channel = dsi->channel; in dsi_host_attach()
1629 msm_host->lanes = dsi->lanes; in dsi_host_attach()
1630 msm_host->format = dsi->format; in dsi_host_attach()
1631 msm_host->mode_flags = dsi->mode_flags; in dsi_host_attach()
1632 if (dsi->dsc) in dsi_host_attach()
1633 msm_host->dsc = dsi->dsc; in dsi_host_attach()
1635 /* Some gpios defined in panel DT need to be controlled by host */ in dsi_host_attach()
1636 ret = dsi_host_init_panel_gpios(msm_host, &dsi->dev); in dsi_host_attach()
1640 ret = dsi_dev_attach(msm_host->pdev); in dsi_host_attach()
1644 DBG("id=%d", msm_host->id); in dsi_host_attach()
1654 dsi_dev_detach(msm_host->pdev); in dsi_host_detach()
1656 DBG("id=%d", msm_host->id); in dsi_host_detach()
1667 if (!msg || !msm_host->power_on) in dsi_host_transfer()
1668 return -EINVAL; in dsi_host_transfer()
1670 mutex_lock(&msm_host->cmd_mutex); in dsi_host_transfer()
1671 ret = msm_dsi_manager_cmd_xfer(msm_host->id, msg); in dsi_host_transfer()
1672 mutex_unlock(&msm_host->cmd_mutex); in dsi_host_transfer()
1687 * "3012": Logic 3->Phys 0; Logic 0->Phys 1; Logic 1->Phys 2; Logic 2->Phys 3;
1703 struct device *dev = &msm_host->pdev->dev; in dsi_host_parse_lane_data()
1708 prop = of_find_property(ep, "data-lanes", &len); in dsi_host_parse_lane_data()
1713 msm_host->num_data_lanes = 4; in dsi_host_parse_lane_data()
1723 msm_host->num_data_lanes = num_lanes; in dsi_host_parse_lane_data()
1725 ret = of_property_read_u32_array(ep, "data-lanes", lane_map, in dsi_host_parse_lane_data()
1733 * compare DT specified physical-logical lane mappings with the ones in dsi_host_parse_lane_data()
1741 * the data-lanes array we get from DT has a logical->physical in dsi_host_parse_lane_data()
1743 * supported configurations in a physical->logical mapping. in dsi_host_parse_lane_data()
1757 msm_host->dlane_swap = i; in dsi_host_parse_lane_data()
1762 return -EINVAL; in dsi_host_parse_lane_data()
1769 if (dsc->bits_per_pixel & 0xf) { in dsi_populate_dsc_params()
1770 DRM_DEV_ERROR(&msm_host->pdev->dev, "DSI does not support fractional bits_per_pixel\n"); in dsi_populate_dsc_params()
1771 return -EINVAL; in dsi_populate_dsc_params()
1774 if (dsc->bits_per_component != 8) { in dsi_populate_dsc_params()
1775 DRM_DEV_ERROR(&msm_host->pdev->dev, "DSI does not support bits_per_component != 8 yet\n"); in dsi_populate_dsc_params()
1776 return -EOPNOTSUPP; in dsi_populate_dsc_params()
1779 dsc->simple_422 = 0; in dsi_populate_dsc_params()
1780 dsc->convert_rgb = 1; in dsi_populate_dsc_params()
1781 dsc->vbr_enable = 0; in dsi_populate_dsc_params()
1786 /* handle only bpp = bpc = 8, pre-SCR panels */ in dsi_populate_dsc_params()
1789 DRM_DEV_ERROR(&msm_host->pdev->dev, "could not find DSC RC parameters\n"); in dsi_populate_dsc_params()
1793 dsc->initial_scale_value = drm_dsc_initial_scale_value(dsc); in dsi_populate_dsc_params()
1794 dsc->line_buf_depth = dsc->bits_per_component + 1; in dsi_populate_dsc_params()
1801 struct device *dev = &msm_host->pdev->dev; in dsi_host_parse_dt()
1802 struct device_node *np = dev->of_node; in dsi_host_parse_dt()
1812 endpoint = of_graph_get_endpoint_by_regs(np, 1, -1); in dsi_host_parse_dt()
1822 ret = -EINVAL; in dsi_host_parse_dt()
1826 if (of_property_read_bool(np, "syscon-sfpb")) { in dsi_host_parse_dt()
1827 msm_host->sfpb = syscon_regmap_lookup_by_phandle(np, in dsi_host_parse_dt()
1828 "syscon-sfpb"); in dsi_host_parse_dt()
1829 if (IS_ERR(msm_host->sfpb)) { in dsi_host_parse_dt()
1832 ret = PTR_ERR(msm_host->sfpb); in dsi_host_parse_dt()
1844 struct platform_device *pdev = msm_host->pdev; in dsi_host_get_id()
1845 const struct msm_dsi_config *cfg = msm_host->cfg_hnd->cfg; in dsi_host_get_id()
1851 return -EINVAL; in dsi_host_get_id()
1855 if (cfg->io_start[i][j] == res->start) in dsi_host_get_id()
1858 return -EINVAL; in dsi_host_get_id()
1864 struct platform_device *pdev = msm_dsi->pdev; in msm_dsi_host_init()
1868 msm_host = devm_kzalloc(&pdev->dev, sizeof(*msm_host), GFP_KERNEL); in msm_dsi_host_init()
1870 return -ENOMEM; in msm_dsi_host_init()
1873 msm_host->pdev = pdev; in msm_dsi_host_init()
1874 msm_dsi->host = &msm_host->base; in msm_dsi_host_init()
1882 msm_host->ctrl_base = msm_ioremap_size(pdev, "dsi_ctrl", &msm_host->ctrl_size); in msm_dsi_host_init()
1883 if (IS_ERR(msm_host->ctrl_base)) { in msm_dsi_host_init()
1885 return PTR_ERR(msm_host->ctrl_base); in msm_dsi_host_init()
1888 pm_runtime_enable(&pdev->dev); in msm_dsi_host_init()
1890 msm_host->cfg_hnd = dsi_get_config(msm_host); in msm_dsi_host_init()
1891 if (!msm_host->cfg_hnd) { in msm_dsi_host_init()
1893 return -EINVAL; in msm_dsi_host_init()
1895 cfg = msm_host->cfg_hnd->cfg; in msm_dsi_host_init()
1897 msm_host->id = dsi_host_get_id(msm_host); in msm_dsi_host_init()
1898 if (msm_host->id < 0) { in msm_dsi_host_init()
1900 return msm_host->id; in msm_dsi_host_init()
1904 msm_host->ctrl_base += cfg->io_offset; in msm_dsi_host_init()
1906 ret = devm_regulator_bulk_get_const(&pdev->dev, cfg->num_regulators, in msm_dsi_host_init()
1907 cfg->regulator_data, in msm_dsi_host_init()
1908 &msm_host->supplies); in msm_dsi_host_init()
1918 msm_host->rx_buf = devm_kzalloc(&pdev->dev, SZ_4K, GFP_KERNEL); in msm_dsi_host_init()
1919 if (!msm_host->rx_buf) { in msm_dsi_host_init()
1921 return -ENOMEM; in msm_dsi_host_init()
1924 ret = devm_pm_opp_set_clkname(&pdev->dev, "byte"); in msm_dsi_host_init()
1928 ret = devm_pm_opp_of_add_table(&pdev->dev); in msm_dsi_host_init()
1929 if (ret && ret != -ENODEV) { in msm_dsi_host_init()
1930 dev_err(&pdev->dev, "invalid OPP table in device tree\n"); in msm_dsi_host_init()
1934 msm_host->irq = irq_of_parse_and_map(pdev->dev.of_node, 0); in msm_dsi_host_init()
1935 if (!msm_host->irq) { in msm_dsi_host_init()
1936 dev_err(&pdev->dev, "failed to get irq\n"); in msm_dsi_host_init()
1937 return -EINVAL; in msm_dsi_host_init()
1941 ret = devm_request_irq(&pdev->dev, msm_host->irq, dsi_host_irq, in msm_dsi_host_init()
1945 dev_err(&pdev->dev, "failed to request IRQ%u: %d\n", in msm_dsi_host_init()
1946 msm_host->irq, ret); in msm_dsi_host_init()
1950 init_completion(&msm_host->dma_comp); in msm_dsi_host_init()
1951 init_completion(&msm_host->video_comp); in msm_dsi_host_init()
1952 mutex_init(&msm_host->dev_mutex); in msm_dsi_host_init()
1953 mutex_init(&msm_host->cmd_mutex); in msm_dsi_host_init()
1954 spin_lock_init(&msm_host->intr_lock); in msm_dsi_host_init()
1957 msm_host->workqueue = alloc_ordered_workqueue("dsi_drm_work", 0); in msm_dsi_host_init()
1958 if (!msm_host->workqueue) in msm_dsi_host_init()
1959 return -ENOMEM; in msm_dsi_host_init()
1961 INIT_WORK(&msm_host->err_work, dsi_err_worker); in msm_dsi_host_init()
1963 msm_dsi->id = msm_host->id; in msm_dsi_host_init()
1965 DBG("Dsi Host %d initialized", msm_host->id); in msm_dsi_host_init()
1974 if (msm_host->workqueue) { in msm_dsi_host_destroy()
1975 destroy_workqueue(msm_host->workqueue); in msm_dsi_host_destroy()
1976 msm_host->workqueue = NULL; in msm_dsi_host_destroy()
1979 mutex_destroy(&msm_host->cmd_mutex); in msm_dsi_host_destroy()
1980 mutex_destroy(&msm_host->dev_mutex); in msm_dsi_host_destroy()
1982 pm_runtime_disable(&msm_host->pdev->dev); in msm_dsi_host_destroy()
1989 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_modeset_init()
1992 msm_host->dev = dev; in msm_dsi_host_modeset_init()
1994 ret = cfg_hnd->ops->tx_buf_alloc(msm_host, SZ_4K); in msm_dsi_host_modeset_init()
2009 if (!msm_host->registered) { in msm_dsi_host_register()
2010 host->dev = &msm_host->pdev->dev; in msm_dsi_host_register()
2011 host->ops = &dsi_host_ops; in msm_dsi_host_register()
2016 msm_host->registered = true; in msm_dsi_host_register()
2026 if (msm_host->registered) { in msm_dsi_host_unregister()
2028 host->dev = NULL; in msm_dsi_host_unregister()
2029 host->ops = NULL; in msm_dsi_host_unregister()
2030 msm_host->registered = false; in msm_dsi_host_unregister()
2038 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_xfer_prepare()
2050 pm_runtime_get_sync(&msm_host->pdev->dev); in msm_dsi_host_xfer_prepare()
2051 cfg_hnd->ops->link_clk_set_rate(msm_host); in msm_dsi_host_xfer_prepare()
2052 cfg_hnd->ops->link_clk_enable(msm_host); in msm_dsi_host_xfer_prepare()
2056 if (!(msg->flags & MIPI_DSI_MSG_USE_LPM)) in msm_dsi_host_xfer_prepare()
2059 msm_host->dma_cmd_ctrl_restore = dsi_read(msm_host, REG_DSI_CTRL); in msm_dsi_host_xfer_prepare()
2061 msm_host->dma_cmd_ctrl_restore | in msm_dsi_host_xfer_prepare()
2073 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_xfer_restore()
2076 dsi_write(msm_host, REG_DSI_CTRL, msm_host->dma_cmd_ctrl_restore); in msm_dsi_host_xfer_restore()
2078 if (!(msg->flags & MIPI_DSI_MSG_USE_LPM)) in msm_dsi_host_xfer_restore()
2083 cfg_hnd->ops->link_clk_disable(msm_host); in msm_dsi_host_xfer_restore()
2084 pm_runtime_put(&msm_host->pdev->dev); in msm_dsi_host_xfer_restore()
2099 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_cmd_rx()
2103 int rlen = msg->rx_len; in msm_dsi_host_cmd_rx()
2120 buf = msm_host->rx_buf; in msm_dsi_host_cmd_rx()
2125 .channel = msg->channel, in msm_dsi_host_cmd_rx()
2138 return -EINVAL; in msm_dsi_host_cmd_rx()
2141 if ((cfg_hnd->major == MSM_DSI_VER_MAJOR_6G) && in msm_dsi_host_cmd_rx()
2142 (cfg_hnd->minor >= MSM_DSI_6G_VER_MINOR_V1_1)) { in msm_dsi_host_cmd_rx()
2155 } else if (ret < msg->tx_len) { in msm_dsi_host_cmd_rx()
2157 return -ECOMM; in msm_dsi_host_cmd_rx()
2176 diff = data_byte - rlen; in msm_dsi_host_cmd_rx()
2180 rlen -= data_byte; in msm_dsi_host_cmd_rx()
2184 dlen -= 2; /* 2 crc */ in msm_dsi_host_cmd_rx()
2185 dlen -= diff; in msm_dsi_host_cmd_rx()
2203 buf = msm_host->rx_buf + (10 - rlen); in msm_dsi_host_cmd_rx()
2205 buf = msm_host->rx_buf; in msm_dsi_host_cmd_rx()
2251 msm_host->cphy_mode = src_phy->cphy_mode; in msm_dsi_host_set_phy_mode()
2272 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_get_phy_clk_req()
2275 ret = cfg_hnd->ops->calc_clk_rate(msm_host, is_bonded_dsi); in msm_dsi_host_get_phy_clk_req()
2282 * "byte_clk" is in units of 16-bits (see dsi_calc_pclk), in msm_dsi_host_get_phy_clk_req()
2285 if (msm_host->cphy_mode) in msm_dsi_host_get_phy_clk_req()
2286 clk_req->bitclk_rate = msm_host->byte_clk_rate * 7; in msm_dsi_host_get_phy_clk_req()
2288 clk_req->bitclk_rate = msm_host->byte_clk_rate * 8; in msm_dsi_host_get_phy_clk_req()
2289 clk_req->escclk_rate = msm_host->esc_clk_rate; in msm_dsi_host_get_phy_clk_req()
2296 enable_irq(msm_host->irq); in msm_dsi_host_enable_irq()
2303 disable_irq(msm_host->irq); in msm_dsi_host_disable_irq()
2311 !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO), true); in msm_dsi_host_enable()
2317 /* if (msm_panel->mode == MSM_DSI_CMD_MODE) { in msm_dsi_host_enable()
2319 * pm_runtime_put(&msm_host->pdev->dev); in msm_dsi_host_enable()
2322 msm_host->enabled = true; in msm_dsi_host_enable()
2330 msm_host->enabled = false; in msm_dsi_host_disable()
2332 !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO), false); in msm_dsi_host_disable()
2347 if (!msm_host->sfpb) in msm_dsi_sfpb_config()
2352 regmap_update_bits(msm_host->sfpb, REG_SFPB_GPREG, in msm_dsi_sfpb_config()
2362 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_power_on()
2365 mutex_lock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
2366 if (msm_host->power_on) { in msm_dsi_host_power_on()
2371 msm_host->byte_intf_clk_rate = msm_host->byte_clk_rate; in msm_dsi_host_power_on()
2372 if (phy_shared_timings->byte_intf_clk_div_2) in msm_dsi_host_power_on()
2373 msm_host->byte_intf_clk_rate /= 2; in msm_dsi_host_power_on()
2377 ret = regulator_bulk_enable(msm_host->cfg_hnd->cfg->num_regulators, in msm_dsi_host_power_on()
2378 msm_host->supplies); in msm_dsi_host_power_on()
2385 pm_runtime_get_sync(&msm_host->pdev->dev); in msm_dsi_host_power_on()
2386 ret = cfg_hnd->ops->link_clk_set_rate(msm_host); in msm_dsi_host_power_on()
2388 ret = cfg_hnd->ops->link_clk_enable(msm_host); in msm_dsi_host_power_on()
2395 ret = pinctrl_pm_select_default_state(&msm_host->pdev->dev); in msm_dsi_host_power_on()
2406 if (msm_host->disp_en_gpio) in msm_dsi_host_power_on()
2407 gpiod_set_value(msm_host->disp_en_gpio, 1); in msm_dsi_host_power_on()
2409 msm_host->power_on = true; in msm_dsi_host_power_on()
2410 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
2415 cfg_hnd->ops->link_clk_disable(msm_host); in msm_dsi_host_power_on()
2416 pm_runtime_put(&msm_host->pdev->dev); in msm_dsi_host_power_on()
2418 regulator_bulk_disable(msm_host->cfg_hnd->cfg->num_regulators, in msm_dsi_host_power_on()
2419 msm_host->supplies); in msm_dsi_host_power_on()
2421 mutex_unlock(&msm_host->dev_mutex); in msm_dsi_host_power_on()
2428 const struct msm_dsi_cfg_handler *cfg_hnd = msm_host->cfg_hnd; in msm_dsi_host_power_off()
2430 mutex_lock(&msm_host->dev_mutex); in msm_dsi_host_power_off()
2431 if (!msm_host->power_on) { in msm_dsi_host_power_off()
2438 if (msm_host->disp_en_gpio) in msm_dsi_host_power_off()
2439 gpiod_set_value(msm_host->disp_en_gpio, 0); in msm_dsi_host_power_off()
2441 pinctrl_pm_select_sleep_state(&msm_host->pdev->dev); in msm_dsi_host_power_off()
2443 cfg_hnd->ops->link_clk_disable(msm_host); in msm_dsi_host_power_off()
2444 pm_runtime_put(&msm_host->pdev->dev); in msm_dsi_host_power_off()
2446 regulator_bulk_disable(msm_host->cfg_hnd->cfg->num_regulators, in msm_dsi_host_power_off()
2447 msm_host->supplies); 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()
2483 struct drm_dsc_config *dsc = msm_host->dsc; in msm_dsi_host_check_dsc()
2484 int pic_width = mode->hdisplay; in msm_dsi_host_check_dsc()
2485 int pic_height = mode->vdisplay; in msm_dsi_host_check_dsc()
2487 if (!msm_host->dsc) in msm_dsi_host_check_dsc()
2490 if (pic_width % dsc->slice_width) { in msm_dsi_host_check_dsc()
2492 pic_width, dsc->slice_width); in msm_dsi_host_check_dsc()
2496 if (pic_height % dsc->slice_height) { in msm_dsi_host_check_dsc()
2498 pic_height, dsc->slice_height); in msm_dsi_host_check_dsc()
2507 return to_msm_dsi_host(host)->mode_flags; in msm_dsi_host_get_mode_flags()
2514 pm_runtime_get_sync(&msm_host->pdev->dev); in msm_dsi_host_snapshot()
2516 msm_disp_snapshot_add_block(disp_state, msm_host->ctrl_size, in msm_dsi_host_snapshot()
2517 msm_host->ctrl_base, "dsi%d_ctrl", msm_host->id); in msm_dsi_host_snapshot()
2519 pm_runtime_put_sync(&msm_host->pdev->dev); in msm_dsi_host_snapshot()
2532 /* use 24-bit RGB test pttern */ in msm_dsi_host_video_test_pattern_setup()
2565 bool is_video_mode = !!(msm_host->mode_flags & MIPI_DSI_MODE_VIDEO); in msm_dsi_host_test_pattern_en()
2587 return msm_host->dsc; in msm_dsi_host_get_dsc_config()