1 // SPDX-License-Identifier: GPL-2.0+
8  * Rockchip version from rockchip/dw-mipi-dsi.c with phy & bridge APIs.
193 #define N_LANES(n)			(((n) - 1) & 0x3)
265 	struct dw_mipi_dsi *master; /* dual-dsi master ptr */
266 	struct dw_mipi_dsi *slave; /* dual-dsi slave ptr */  member
268 	struct drm_display_mode mode;  member
273  * Check if either a link to a master or slave is present
277 	return dsi->slave || dsi->master;  in dw_mipi_is_dual_mode()
284 static void dw_mipi_dsi_wait_for_two_frames(const struct drm_display_mode *mode)  in dw_mipi_dsi_wait_for_two_frames()  argument
288 	refresh = drm_mode_vrefresh(mode);  in dw_mipi_dsi_wait_for_two_frames()
305 	writel(val, dsi->base + reg);  in dsi_write()
310 	return readl(dsi->base + reg);  in dsi_read()
317 	const struct dw_mipi_dsi_plat_data *pdata = dsi->plat_data;  in dw_mipi_dsi_host_attach()
321 	if (device->lanes > dsi->plat_data->max_data_lanes) {  in dw_mipi_dsi_host_attach()
322 		dev_err(dsi->dev, "the number of data lanes(%u) is too many\n",  in dw_mipi_dsi_host_attach()
323 			device->lanes);  in dw_mipi_dsi_host_attach()
324 		return -EINVAL;  in dw_mipi_dsi_host_attach()
327 	dsi->lanes = device->lanes;  in dw_mipi_dsi_host_attach()
328 	dsi->channel = device->channel;  in dw_mipi_dsi_host_attach()
329 	dsi->format = device->format;  in dw_mipi_dsi_host_attach()
330 	dsi->mode_flags = device->mode_flags;  in dw_mipi_dsi_host_attach()
332 	bridge = devm_drm_of_get_bridge(dsi->dev, dsi->dev->of_node, 1, 0);  in dw_mipi_dsi_host_attach()
336 	bridge->pre_enable_prev_first = true;  in dw_mipi_dsi_host_attach()
337 	dsi->panel_bridge = bridge;  in dw_mipi_dsi_host_attach()
339 	drm_bridge_add(&dsi->bridge);  in dw_mipi_dsi_host_attach()
341 	if (pdata->host_ops && pdata->host_ops->attach) {  in dw_mipi_dsi_host_attach()
342 		ret = pdata->host_ops->attach(pdata->priv_data, device);  in dw_mipi_dsi_host_attach()
354 	const struct dw_mipi_dsi_plat_data *pdata = dsi->plat_data;  in dw_mipi_dsi_host_detach()
357 	if (pdata->host_ops && pdata->host_ops->detach) {  in dw_mipi_dsi_host_detach()
358 		ret = pdata->host_ops->detach(pdata->priv_data, device);  in dw_mipi_dsi_host_detach()
363 	drm_of_panel_bridge_remove(host->dev->of_node, 1, 0);  in dw_mipi_dsi_host_detach()
365 	drm_bridge_remove(&dsi->bridge);  in dw_mipi_dsi_host_detach()
373 	bool lpm = msg->flags & MIPI_DSI_MSG_USE_LPM;  in dw_mipi_message_config()
385 	if (msg->flags & MIPI_DSI_MSG_REQ_ACK)  in dw_mipi_message_config()
405 	ret = readl_poll_timeout(dsi->base + DSI_CMD_PKT_STATUS,  in dw_mipi_dsi_gen_pkt_hdr_write()
409 		dev_err(dsi->dev, "failed to get available command FIFO\n");  in dw_mipi_dsi_gen_pkt_hdr_write()
416 	ret = readl_poll_timeout(dsi->base + DSI_CMD_PKT_STATUS,  in dw_mipi_dsi_gen_pkt_hdr_write()
420 		dev_err(dsi->dev, "failed to write command FIFO\n");  in dw_mipi_dsi_gen_pkt_hdr_write()
430 	const u8 *tx_buf = packet->payload;  in dw_mipi_dsi_write()
431 	int len = packet->payload_length, pld_data_bytes = sizeof(u32), ret;  in dw_mipi_dsi_write()
445 			len -= pld_data_bytes;  in dw_mipi_dsi_write()
448 		ret = readl_poll_timeout(dsi->base + DSI_CMD_PKT_STATUS,  in dw_mipi_dsi_write()
452 			dev_err(dsi->dev,  in dw_mipi_dsi_write()
459 	memcpy(&word, packet->header, sizeof(packet->header));  in dw_mipi_dsi_write()
466 	int i, j, ret, len = msg->rx_len;  in dw_mipi_dsi_read()
467 	u8 *buf = msg->rx_buf;  in dw_mipi_dsi_read()
471 	ret = readl_poll_timeout(dsi->base + DSI_CMD_PKT_STATUS,  in dw_mipi_dsi_read()
475 		dev_err(dsi->dev, "Timeout during read operation\n");  in dw_mipi_dsi_read()
481 		ret = readl_poll_timeout(dsi->base + DSI_CMD_PKT_STATUS,  in dw_mipi_dsi_read()
485 			dev_err(dsi->dev, "Read payload FIFO is empty\n");  in dw_mipi_dsi_read()
506 		dev_err(dsi->dev, "failed to create packet: %d\n", ret);  in dw_mipi_dsi_host_transfer()
511 	if (dsi->slave)  in dw_mipi_dsi_host_transfer()
512 		dw_mipi_message_config(dsi->slave, msg);  in dw_mipi_dsi_host_transfer()
517 	if (dsi->slave) {  in dw_mipi_dsi_host_transfer()
518 		ret = dw_mipi_dsi_write(dsi->slave, &packet);  in dw_mipi_dsi_host_transfer()
523 	if (msg->rx_buf && msg->rx_len) {  in dw_mipi_dsi_host_transfer()
527 		nb_bytes = msg->rx_len;  in dw_mipi_dsi_host_transfer()
547 	 * enabling low power is panel-dependent, we should use the  in dw_mipi_dsi_video_mode_config()
552 	if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO_BURST)  in dw_mipi_dsi_video_mode_config()
554 	else if (dsi->mode_flags & MIPI_DSI_MODE_VIDEO_SYNC_PULSE)  in dw_mipi_dsi_video_mode_config()
560 	if (dsi->vpg_defs.vpg) {  in dw_mipi_dsi_video_mode_config()
562 		val |= dsi->vpg_defs.vpg_horizontal ?  in dw_mipi_dsi_video_mode_config()
564 		val |= dsi->vpg_defs.vpg_ber_pattern ? VID_MODE_VPG_MODE : 0;  in dw_mipi_dsi_video_mode_config()
586 	if (dsi->mode_flags & MIPI_DSI_CLOCK_NON_CONTINUOUS)  in dw_mipi_dsi_set_mode()
601 	const struct dw_mipi_dsi_phy_ops *phy_ops = dsi->plat_data->phy_ops;  in dw_mipi_dsi_init()
610 	if (phy_ops->get_esc_clk_rate) {  in dw_mipi_dsi_init()
611 		ret = phy_ops->get_esc_clk_rate(dsi->plat_data->priv_data,  in dw_mipi_dsi_init()
624 	esc_clk_division = (dsi->lane_mbps >> 3) / esc_rate + 1;  in dw_mipi_dsi_init()
638 				   const struct drm_display_mode *mode)  in dw_mipi_dsi_dpi_config()  argument
642 	switch (dsi->format) {  in dw_mipi_dsi_dpi_config()
657 	if (mode->flags & DRM_MODE_FLAG_NVSYNC)  in dw_mipi_dsi_dpi_config()
659 	if (mode->flags & DRM_MODE_FLAG_NHSYNC)  in dw_mipi_dsi_dpi_config()
662 	dsi_write(dsi, DSI_DPI_VCID, DPI_VCID(dsi->channel));  in dw_mipi_dsi_dpi_config()
673 					    const struct drm_display_mode *mode)  in dw_mipi_dsi_video_packet_config()  argument
677 	 * only burst mode is supported here. For non-burst video modes,  in dw_mipi_dsi_video_packet_config()
680 	 * non-burst video modes, see dw_mipi_dsi_video_mode_config()...  in dw_mipi_dsi_video_packet_config()
685 				VID_PKT_SIZE(mode->hdisplay / 2) :  in dw_mipi_dsi_video_packet_config()
686 				VID_PKT_SIZE(mode->hdisplay));  in dw_mipi_dsi_video_packet_config()
699 	 * the Bus-Turn-Around Timeout Counter should be computed  in dw_mipi_dsi_command_mode_config()
708 					   const struct drm_display_mode *mode,  in dw_mipi_dsi_get_hcomponent_lbcc()  argument
713 	lbcc = hcomponent * dsi->lane_mbps * MSEC_PER_SEC / 8;  in dw_mipi_dsi_get_hcomponent_lbcc()
715 	frac = lbcc % mode->clock;  in dw_mipi_dsi_get_hcomponent_lbcc()
716 	lbcc = lbcc / mode->clock;  in dw_mipi_dsi_get_hcomponent_lbcc()
724 					  const struct drm_display_mode *mode)  in dw_mipi_dsi_line_timer_config()  argument
728 	htotal = mode->htotal;  in dw_mipi_dsi_line_timer_config()
729 	hsa = mode->hsync_end - mode->hsync_start;  in dw_mipi_dsi_line_timer_config()
730 	hbp = mode->htotal - mode->hsync_end;  in dw_mipi_dsi_line_timer_config()
736 	lbcc = dw_mipi_dsi_get_hcomponent_lbcc(dsi, mode, htotal);  in dw_mipi_dsi_line_timer_config()
739 	lbcc = dw_mipi_dsi_get_hcomponent_lbcc(dsi, mode, hsa);  in dw_mipi_dsi_line_timer_config()
742 	lbcc = dw_mipi_dsi_get_hcomponent_lbcc(dsi, mode, hbp);  in dw_mipi_dsi_line_timer_config()
747 					const struct drm_display_mode *mode)  in dw_mipi_dsi_vertical_timing_config()  argument
751 	vactive = mode->vdisplay;  in dw_mipi_dsi_vertical_timing_config()
752 	vsa = mode->vsync_end - mode->vsync_start;  in dw_mipi_dsi_vertical_timing_config()
753 	vfp = mode->vsync_start - mode->vdisplay;  in dw_mipi_dsi_vertical_timing_config()
754 	vbp = mode->vtotal - mode->vsync_end;  in dw_mipi_dsi_vertical_timing_config()
764 	const struct dw_mipi_dsi_phy_ops *phy_ops = dsi->plat_data->phy_ops;  in dw_mipi_dsi_dphy_timing_config()
769 	ret = phy_ops->get_timing(dsi->plat_data->priv_data,  in dw_mipi_dsi_dphy_timing_config()
770 				  dsi->lane_mbps, &timing);  in dw_mipi_dsi_dphy_timing_config()
772 		DRM_DEV_ERROR(dsi->dev, "Retrieving phy timings failed\n");  in dw_mipi_dsi_dphy_timing_config()
777 	 * blankings and to the automatic clock lane control mode...  in dw_mipi_dsi_dphy_timing_config()
809 		  N_LANES(dsi->lanes));  in dw_mipi_dsi_dphy_interface_config()
830 	ret = readl_poll_timeout(dsi->base + DSI_PHY_STATUS, val,  in dw_mipi_dsi_dphy_enable()
835 	ret = readl_poll_timeout(dsi->base + DSI_PHY_STATUS,  in dw_mipi_dsi_dphy_enable()
854 	const struct dw_mipi_dsi_phy_ops *phy_ops = dsi->plat_data->phy_ops;  in dw_mipi_dsi_bridge_post_atomic_disable()
857 	 * Switch to command mode before panel-bridge post_disable &  in dw_mipi_dsi_bridge_post_atomic_disable()
859 	 * Note: panel-bridge disable & panel disable has been called  in dw_mipi_dsi_bridge_post_atomic_disable()
864 	if (phy_ops->power_off)  in dw_mipi_dsi_bridge_post_atomic_disable()
865 		phy_ops->power_off(dsi->plat_data->priv_data);  in dw_mipi_dsi_bridge_post_atomic_disable()
867 	if (dsi->slave) {  in dw_mipi_dsi_bridge_post_atomic_disable()
868 		dw_mipi_dsi_disable(dsi->slave);  in dw_mipi_dsi_bridge_post_atomic_disable()
869 		clk_disable_unprepare(dsi->slave->pclk);  in dw_mipi_dsi_bridge_post_atomic_disable()
870 		pm_runtime_put(dsi->slave->dev);  in dw_mipi_dsi_bridge_post_atomic_disable()
874 	clk_disable_unprepare(dsi->pclk);  in dw_mipi_dsi_bridge_post_atomic_disable()
875 	pm_runtime_put(dsi->dev);  in dw_mipi_dsi_bridge_post_atomic_disable()
880 	/* this instance is the slave, so add the master's lanes */  in dw_mipi_dsi_get_lanes()
881 	if (dsi->master)  in dw_mipi_dsi_get_lanes()
882 		return dsi->master->lanes + dsi->lanes;  in dw_mipi_dsi_get_lanes()
884 	/* this instance is the master, so add the slave's lanes */  in dw_mipi_dsi_get_lanes()
885 	if (dsi->slave)  in dw_mipi_dsi_get_lanes()
886 		return dsi->lanes + dsi->slave->lanes;  in dw_mipi_dsi_get_lanes()
888 	/* single-dsi, so no other instance to consider */  in dw_mipi_dsi_get_lanes()
889 	return dsi->lanes;  in dw_mipi_dsi_get_lanes()
895 	const struct dw_mipi_dsi_phy_ops *phy_ops = dsi->plat_data->phy_ops;  in dw_mipi_dsi_mode_set()
896 	void *priv_data = dsi->plat_data->priv_data;  in dw_mipi_dsi_mode_set()
900 	clk_prepare_enable(dsi->pclk);  in dw_mipi_dsi_mode_set()
902 	ret = phy_ops->get_lane_mbps(priv_data, adjusted_mode, dsi->mode_flags,  in dw_mipi_dsi_mode_set()
903 				     lanes, dsi->format, &dsi->lane_mbps);  in dw_mipi_dsi_mode_set()
907 	pm_runtime_get_sync(dsi->dev);  in dw_mipi_dsi_mode_set()
923 	ret = phy_ops->init(priv_data);  in dw_mipi_dsi_mode_set()
931 	/* Switch to cmd mode for panel-bridge pre_enable & panel prepare */  in dw_mipi_dsi_mode_set()
934 	if (phy_ops->power_on)  in dw_mipi_dsi_mode_set()
935 		phy_ops->power_on(dsi->plat_data->priv_data);  in dw_mipi_dsi_mode_set()
943 	/* Power up the dsi ctl into a command mode */  in dw_mipi_dsi_bridge_atomic_pre_enable()
944 	dw_mipi_dsi_mode_set(dsi, &dsi->mode);  in dw_mipi_dsi_bridge_atomic_pre_enable()
945 	if (dsi->slave)  in dw_mipi_dsi_bridge_atomic_pre_enable()
946 		dw_mipi_dsi_mode_set(dsi->slave, &dsi->mode);  in dw_mipi_dsi_bridge_atomic_pre_enable()
950 					const struct drm_display_mode *mode,  in dw_mipi_dsi_bridge_mode_set()  argument
955 	/* Store the display mode for later use in pre_enable callback */  in dw_mipi_dsi_bridge_mode_set()
956 	drm_mode_copy(&dsi->mode, adjusted_mode);  in dw_mipi_dsi_bridge_mode_set()
964 	/* Switch to video mode for panel-bridge enable & panel enable */  in dw_mipi_dsi_bridge_atomic_enable()
966 	if (dsi->slave)  in dw_mipi_dsi_bridge_atomic_enable()
967 		dw_mipi_dsi_set_mode(dsi->slave, MIPI_DSI_MODE_VIDEO);  in dw_mipi_dsi_bridge_atomic_enable()
973 			      const struct drm_display_mode *mode)  in dw_mipi_dsi_bridge_mode_valid()  argument
976 	const struct dw_mipi_dsi_plat_data *pdata = dsi->plat_data;  in dw_mipi_dsi_bridge_mode_valid()
979 	if (pdata->mode_valid)  in dw_mipi_dsi_bridge_mode_valid()
980 		mode_status = pdata->mode_valid(pdata->priv_data, mode,  in dw_mipi_dsi_bridge_mode_valid()
981 						dsi->mode_flags,  in dw_mipi_dsi_bridge_mode_valid()
983 						dsi->format);  in dw_mipi_dsi_bridge_mode_valid()
993 	if (!bridge->encoder) {  in dw_mipi_dsi_bridge_attach()
995 		return -ENODEV;  in dw_mipi_dsi_bridge_attach()
999 	bridge->encoder->encoder_type = DRM_MODE_ENCODER_DSI;  in dw_mipi_dsi_bridge_attach()
1001 	/* Attach the panel-bridge to the dsi bridge */  in dw_mipi_dsi_bridge_attach()
1002 	return drm_bridge_attach(bridge->encoder, dsi->panel_bridge, bridge,  in dw_mipi_dsi_bridge_attach()
1027 		return -ENODEV;  in dw_mipi_dsi_debugfs_write()
1029 	dsi = vpg->dsi;  in dw_mipi_dsi_debugfs_write()
1031 	*vpg->reg = (bool)val;  in dw_mipi_dsi_debugfs_write()
1035 	if (*vpg->reg)  in dw_mipi_dsi_debugfs_write()
1036 		mode_cfg |= vpg->mask;  in dw_mipi_dsi_debugfs_write()
1038 		mode_cfg &= ~vpg->mask;  in dw_mipi_dsi_debugfs_write()
1050 		return -ENODEV;  in dw_mipi_dsi_debugfs_show()
1052 	*val = *vpg->reg;  in dw_mipi_dsi_debugfs_show()
1070 	dsi->debugfs_vpg = kmemdup(debugfs, sizeof(debugfs), GFP_KERNEL);  in debugfs_create_files()
1071 	if (!dsi->debugfs_vpg)  in debugfs_create_files()
1075 		debugfs_create_file(dsi->debugfs_vpg[i].name, 0644,  in debugfs_create_files()
1076 				    dsi->debugfs, &dsi->debugfs_vpg[i],  in debugfs_create_files()
1082 	dsi->debugfs = debugfs_create_dir(dev_name(dsi->dev), NULL);  in dw_mipi_dsi_debugfs_init()
1083 	if (IS_ERR(dsi->debugfs)) {  in dw_mipi_dsi_debugfs_init()
1084 		dev_err(dsi->dev, "failed to create debugfs root\n");  in dw_mipi_dsi_debugfs_init()
1093 	debugfs_remove_recursive(dsi->debugfs);  in dw_mipi_dsi_debugfs_remove()
1094 	kfree(dsi->debugfs_vpg);  in dw_mipi_dsi_debugfs_remove()
1108 	struct device *dev = &pdev->dev;  in __dw_mipi_dsi_probe()
1115 		return ERR_PTR(-ENOMEM);  in __dw_mipi_dsi_probe()
1117 	dsi->dev = dev;  in __dw_mipi_dsi_probe()
1118 	dsi->plat_data = plat_data;  in __dw_mipi_dsi_probe()
1120 	if (!plat_data->phy_ops->init || !plat_data->phy_ops->get_lane_mbps ||  in __dw_mipi_dsi_probe()
1121 	    !plat_data->phy_ops->get_timing) {  in __dw_mipi_dsi_probe()
1123 		return ERR_PTR(-ENODEV);  in __dw_mipi_dsi_probe()
1126 	if (!plat_data->base) {  in __dw_mipi_dsi_probe()
1127 		dsi->base = devm_platform_ioremap_resource(pdev, 0);  in __dw_mipi_dsi_probe()
1128 		if (IS_ERR(dsi->base))  in __dw_mipi_dsi_probe()
1129 			return ERR_PTR(-ENODEV);  in __dw_mipi_dsi_probe()
1132 		dsi->base = plat_data->base;  in __dw_mipi_dsi_probe()
1135 	dsi->pclk = devm_clk_get(dev, "pclk");  in __dw_mipi_dsi_probe()
1136 	if (IS_ERR(dsi->pclk)) {  in __dw_mipi_dsi_probe()
1137 		ret = PTR_ERR(dsi->pclk);  in __dw_mipi_dsi_probe()
1150 		if (ret != -EPROBE_DEFER)  in __dw_mipi_dsi_probe()
1157 		ret = clk_prepare_enable(dsi->pclk);  in __dw_mipi_dsi_probe()
1167 		clk_disable_unprepare(dsi->pclk);  in __dw_mipi_dsi_probe()
1173 	dsi->dsi_host.ops = &dw_mipi_dsi_host_ops;  in __dw_mipi_dsi_probe()
1174 	dsi->dsi_host.dev = dev;  in __dw_mipi_dsi_probe()
1175 	ret = mipi_dsi_host_register(&dsi->dsi_host);  in __dw_mipi_dsi_probe()
1183 	dsi->bridge.driver_private = dsi;  in __dw_mipi_dsi_probe()
1184 	dsi->bridge.funcs = &dw_mipi_dsi_bridge_funcs;  in __dw_mipi_dsi_probe()
1186 	dsi->bridge.of_node = pdev->dev.of_node;  in __dw_mipi_dsi_probe()
1194 	mipi_dsi_host_unregister(&dsi->dsi_host);  in __dw_mipi_dsi_remove()
1196 	pm_runtime_disable(dsi->dev);  in __dw_mipi_dsi_remove()
1200 void dw_mipi_dsi_set_slave(struct dw_mipi_dsi *dsi, struct dw_mipi_dsi *slave)  in dw_mipi_dsi_set_slave()  argument
1203 	dsi->slave = slave;  in dw_mipi_dsi_set_slave()
1204 	dsi->slave->master = dsi;  in dw_mipi_dsi_set_slave()
1207 	dsi->slave->lanes = dsi->lanes;  in dw_mipi_dsi_set_slave()
1208 	dsi->slave->channel = dsi->channel;  in dw_mipi_dsi_set_slave()
1209 	dsi->slave->format = dsi->format;  in dw_mipi_dsi_set_slave()
1210 	dsi->slave->mode_flags = dsi->mode_flags;  in dw_mipi_dsi_set_slave()
1236 	return drm_bridge_attach(encoder, &dsi->bridge, NULL, 0);  in dw_mipi_dsi_bind()
1245 MODULE_AUTHOR("Chris Zhong <zyw@rock-chips.com>");
1249 MODULE_ALIAS("platform:dw-mipi-dsi");