Lines Matching +full:dual +full:- +full:channel
1 // SPDX-License-Identifier: GPL-2.0+
3 * i.MX drm driver - LVDS display bridge
11 #include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
32 #include "imx-drm.h"
34 #define DRIVER_NAME "imx-ldb"
56 struct imx_ldb_channel *channel; member
80 return container_of(c, struct imx_ldb_encoder, connector)->channel; in con_to_imx_ldb_ch()
85 return container_of(e, struct imx_ldb_encoder, encoder)->channel; in enc_to_imx_ldb_ch()
97 struct imx_ldb_channel channel[2]; member
109 struct imx_ldb *ldb = imx_ldb_ch->ldb; in imx_ldb_ch_set_bus_format()
110 int dual = ldb->ldb_ctrl & LDB_SPLIT_MODE_EN; in imx_ldb_ch_set_bus_format() local
116 if (imx_ldb_ch->chno == 0 || dual) in imx_ldb_ch_set_bus_format()
117 ldb->ldb_ctrl |= LDB_DATA_WIDTH_CH0_24; in imx_ldb_ch_set_bus_format()
118 if (imx_ldb_ch->chno == 1 || dual) in imx_ldb_ch_set_bus_format()
119 ldb->ldb_ctrl |= LDB_DATA_WIDTH_CH1_24; in imx_ldb_ch_set_bus_format()
122 if (imx_ldb_ch->chno == 0 || dual) in imx_ldb_ch_set_bus_format()
123 ldb->ldb_ctrl |= LDB_DATA_WIDTH_CH0_24 | in imx_ldb_ch_set_bus_format()
125 if (imx_ldb_ch->chno == 1 || dual) in imx_ldb_ch_set_bus_format()
126 ldb->ldb_ctrl |= LDB_DATA_WIDTH_CH1_24 | in imx_ldb_ch_set_bus_format()
137 num_modes = drm_panel_get_modes(imx_ldb_ch->panel, connector); in imx_ldb_connector_get_modes()
141 if (!imx_ldb_ch->edid && imx_ldb_ch->ddc) in imx_ldb_connector_get_modes()
142 imx_ldb_ch->edid = drm_get_edid(connector, imx_ldb_ch->ddc); in imx_ldb_connector_get_modes()
144 if (imx_ldb_ch->edid) { in imx_ldb_connector_get_modes()
146 imx_ldb_ch->edid); in imx_ldb_connector_get_modes()
147 num_modes = drm_add_edid_modes(connector, imx_ldb_ch->edid); in imx_ldb_connector_get_modes()
150 if (imx_ldb_ch->mode_valid) { in imx_ldb_connector_get_modes()
153 mode = drm_mode_create(connector->dev); in imx_ldb_connector_get_modes()
155 return -EINVAL; in imx_ldb_connector_get_modes()
156 drm_mode_copy(mode, &imx_ldb_ch->mode); in imx_ldb_connector_get_modes()
157 mode->type |= DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED; in imx_ldb_connector_get_modes()
170 dev_dbg(ldb->dev, "%s: now: %ld want: %ld\n", __func__, in imx_ldb_set_clock()
171 clk_get_rate(ldb->clk_pll[chno]), serial_clk); in imx_ldb_set_clock()
172 clk_set_rate(ldb->clk_pll[chno], serial_clk); in imx_ldb_set_clock()
174 dev_dbg(ldb->dev, "%s after: %ld\n", __func__, in imx_ldb_set_clock()
175 clk_get_rate(ldb->clk_pll[chno])); in imx_ldb_set_clock()
177 dev_dbg(ldb->dev, "%s: now: %ld want: %ld\n", __func__, in imx_ldb_set_clock()
178 clk_get_rate(ldb->clk[chno]), in imx_ldb_set_clock()
180 clk_set_rate(ldb->clk[chno], di_clk); in imx_ldb_set_clock()
182 dev_dbg(ldb->dev, "%s after: %ld\n", __func__, in imx_ldb_set_clock()
183 clk_get_rate(ldb->clk[chno])); in imx_ldb_set_clock()
186 ret = clk_set_parent(ldb->clk_sel[mux], ldb->clk[chno]); in imx_ldb_set_clock()
188 dev_err(ldb->dev, in imx_ldb_set_clock()
196 struct imx_ldb *ldb = imx_ldb_ch->ldb; in imx_ldb_encoder_enable()
197 int dual = ldb->ldb_ctrl & LDB_SPLIT_MODE_EN; in imx_ldb_encoder_enable() local
198 int mux = drm_of_encoder_active_port_id(imx_ldb_ch->child, encoder); in imx_ldb_encoder_enable()
200 if (mux < 0 || mux >= ARRAY_SIZE(ldb->clk_sel)) { in imx_ldb_encoder_enable()
201 dev_warn(ldb->dev, "%s: invalid mux %d\n", __func__, mux); in imx_ldb_encoder_enable()
205 drm_panel_prepare(imx_ldb_ch->panel); in imx_ldb_encoder_enable()
207 if (dual) { in imx_ldb_encoder_enable()
208 clk_set_parent(ldb->clk_sel[mux], ldb->clk[0]); in imx_ldb_encoder_enable()
209 clk_set_parent(ldb->clk_sel[mux], ldb->clk[1]); in imx_ldb_encoder_enable()
211 clk_prepare_enable(ldb->clk[0]); in imx_ldb_encoder_enable()
212 clk_prepare_enable(ldb->clk[1]); in imx_ldb_encoder_enable()
214 clk_set_parent(ldb->clk_sel[mux], ldb->clk[imx_ldb_ch->chno]); in imx_ldb_encoder_enable()
217 if (imx_ldb_ch == &ldb->channel[0] || dual) { in imx_ldb_encoder_enable()
218 ldb->ldb_ctrl &= ~LDB_CH0_MODE_EN_MASK; in imx_ldb_encoder_enable()
219 if (mux == 0 || ldb->lvds_mux) in imx_ldb_encoder_enable()
220 ldb->ldb_ctrl |= LDB_CH0_MODE_EN_TO_DI0; in imx_ldb_encoder_enable()
222 ldb->ldb_ctrl |= LDB_CH0_MODE_EN_TO_DI1; in imx_ldb_encoder_enable()
224 if (imx_ldb_ch == &ldb->channel[1] || dual) { in imx_ldb_encoder_enable()
225 ldb->ldb_ctrl &= ~LDB_CH1_MODE_EN_MASK; in imx_ldb_encoder_enable()
226 if (mux == 1 || ldb->lvds_mux) in imx_ldb_encoder_enable()
227 ldb->ldb_ctrl |= LDB_CH1_MODE_EN_TO_DI1; in imx_ldb_encoder_enable()
229 ldb->ldb_ctrl |= LDB_CH1_MODE_EN_TO_DI0; in imx_ldb_encoder_enable()
232 if (ldb->lvds_mux) { in imx_ldb_encoder_enable()
235 if (imx_ldb_ch == &ldb->channel[0]) in imx_ldb_encoder_enable()
236 lvds_mux = &ldb->lvds_mux[0]; in imx_ldb_encoder_enable()
237 else if (imx_ldb_ch == &ldb->channel[1]) in imx_ldb_encoder_enable()
238 lvds_mux = &ldb->lvds_mux[1]; in imx_ldb_encoder_enable()
240 regmap_update_bits(ldb->regmap, lvds_mux->reg, lvds_mux->mask, in imx_ldb_encoder_enable()
241 mux << lvds_mux->shift); in imx_ldb_encoder_enable()
244 regmap_write(ldb->regmap, IOMUXC_GPR2, ldb->ldb_ctrl); in imx_ldb_encoder_enable()
246 drm_panel_enable(imx_ldb_ch->panel); in imx_ldb_encoder_enable()
255 struct drm_display_mode *mode = &crtc_state->adjusted_mode; in imx_ldb_encoder_atomic_mode_set()
256 struct imx_ldb *ldb = imx_ldb_ch->ldb; in imx_ldb_encoder_atomic_mode_set()
257 int dual = ldb->ldb_ctrl & LDB_SPLIT_MODE_EN; in imx_ldb_encoder_atomic_mode_set() local
259 unsigned long di_clk = mode->clock * 1000; in imx_ldb_encoder_atomic_mode_set()
260 int mux = drm_of_encoder_active_port_id(imx_ldb_ch->child, encoder); in imx_ldb_encoder_atomic_mode_set()
261 u32 bus_format = imx_ldb_ch->bus_format; in imx_ldb_encoder_atomic_mode_set()
263 if (mux < 0 || mux >= ARRAY_SIZE(ldb->clk_sel)) { in imx_ldb_encoder_atomic_mode_set()
264 dev_warn(ldb->dev, "%s: invalid mux %d\n", __func__, mux); in imx_ldb_encoder_atomic_mode_set()
268 if (mode->clock > 170000) { in imx_ldb_encoder_atomic_mode_set()
269 dev_warn(ldb->dev, in imx_ldb_encoder_atomic_mode_set()
272 if (mode->clock > 85000 && !dual) { in imx_ldb_encoder_atomic_mode_set()
273 dev_warn(ldb->dev, in imx_ldb_encoder_atomic_mode_set()
277 if (!IS_ALIGNED(mode->hdisplay, 8)) { in imx_ldb_encoder_atomic_mode_set()
278 dev_warn(ldb->dev, in imx_ldb_encoder_atomic_mode_set()
282 if (dual) { in imx_ldb_encoder_atomic_mode_set()
283 serial_clk = 3500UL * mode->clock; in imx_ldb_encoder_atomic_mode_set()
287 serial_clk = 7000UL * mode->clock; in imx_ldb_encoder_atomic_mode_set()
288 imx_ldb_set_clock(ldb, mux, imx_ldb_ch->chno, serial_clk, in imx_ldb_encoder_atomic_mode_set()
292 /* FIXME - assumes straight connections DI0 --> CH0, DI1 --> CH1 */ in imx_ldb_encoder_atomic_mode_set()
293 if (imx_ldb_ch == &ldb->channel[0] || dual) { in imx_ldb_encoder_atomic_mode_set()
294 if (mode->flags & DRM_MODE_FLAG_NVSYNC) in imx_ldb_encoder_atomic_mode_set()
295 ldb->ldb_ctrl |= LDB_DI0_VS_POL_ACT_LOW; in imx_ldb_encoder_atomic_mode_set()
296 else if (mode->flags & DRM_MODE_FLAG_PVSYNC) in imx_ldb_encoder_atomic_mode_set()
297 ldb->ldb_ctrl &= ~LDB_DI0_VS_POL_ACT_LOW; in imx_ldb_encoder_atomic_mode_set()
299 if (imx_ldb_ch == &ldb->channel[1] || dual) { in imx_ldb_encoder_atomic_mode_set()
300 if (mode->flags & DRM_MODE_FLAG_NVSYNC) in imx_ldb_encoder_atomic_mode_set()
301 ldb->ldb_ctrl |= LDB_DI1_VS_POL_ACT_LOW; in imx_ldb_encoder_atomic_mode_set()
302 else if (mode->flags & DRM_MODE_FLAG_PVSYNC) in imx_ldb_encoder_atomic_mode_set()
303 ldb->ldb_ctrl &= ~LDB_DI1_VS_POL_ACT_LOW; in imx_ldb_encoder_atomic_mode_set()
307 struct drm_connector *connector = connector_state->connector; in imx_ldb_encoder_atomic_mode_set()
308 struct drm_display_info *di = &connector->display_info; in imx_ldb_encoder_atomic_mode_set()
310 if (di->num_bus_formats) in imx_ldb_encoder_atomic_mode_set()
311 bus_format = di->bus_formats[0]; in imx_ldb_encoder_atomic_mode_set()
319 struct imx_ldb *ldb = imx_ldb_ch->ldb; in imx_ldb_encoder_disable()
320 int dual = ldb->ldb_ctrl & LDB_SPLIT_MODE_EN; in imx_ldb_encoder_disable() local
323 drm_panel_disable(imx_ldb_ch->panel); in imx_ldb_encoder_disable()
325 if (imx_ldb_ch == &ldb->channel[0] || dual) in imx_ldb_encoder_disable()
326 ldb->ldb_ctrl &= ~LDB_CH0_MODE_EN_MASK; in imx_ldb_encoder_disable()
327 if (imx_ldb_ch == &ldb->channel[1] || dual) in imx_ldb_encoder_disable()
328 ldb->ldb_ctrl &= ~LDB_CH1_MODE_EN_MASK; in imx_ldb_encoder_disable()
330 regmap_write(ldb->regmap, IOMUXC_GPR2, ldb->ldb_ctrl); in imx_ldb_encoder_disable()
332 if (dual) { in imx_ldb_encoder_disable()
333 clk_disable_unprepare(ldb->clk[0]); in imx_ldb_encoder_disable()
334 clk_disable_unprepare(ldb->clk[1]); in imx_ldb_encoder_disable()
337 if (ldb->lvds_mux) { in imx_ldb_encoder_disable()
340 if (imx_ldb_ch == &ldb->channel[0]) in imx_ldb_encoder_disable()
341 lvds_mux = &ldb->lvds_mux[0]; in imx_ldb_encoder_disable()
342 else if (imx_ldb_ch == &ldb->channel[1]) in imx_ldb_encoder_disable()
343 lvds_mux = &ldb->lvds_mux[1]; in imx_ldb_encoder_disable()
345 regmap_read(ldb->regmap, lvds_mux->reg, &mux); in imx_ldb_encoder_disable()
346 mux &= lvds_mux->mask; in imx_ldb_encoder_disable()
347 mux >>= lvds_mux->shift; in imx_ldb_encoder_disable()
349 mux = (imx_ldb_ch == &ldb->channel[0]) ? 0 : 1; in imx_ldb_encoder_disable()
353 ret = clk_set_parent(ldb->clk_sel[mux], ldb->clk_parent[mux]); in imx_ldb_encoder_disable()
355 dev_err(ldb->dev, in imx_ldb_encoder_disable()
359 drm_panel_unprepare(imx_ldb_ch->panel); in imx_ldb_encoder_disable()
368 struct drm_display_info *di = &conn_state->connector->display_info; in imx_ldb_encoder_atomic_check()
369 u32 bus_format = imx_ldb_ch->bus_format; in imx_ldb_encoder_atomic_check()
372 if (!bus_format && di->num_bus_formats) { in imx_ldb_encoder_atomic_check()
373 bus_format = di->bus_formats[0]; in imx_ldb_encoder_atomic_check()
374 imx_crtc_state->bus_flags = di->bus_flags; in imx_ldb_encoder_atomic_check()
376 bus_format = imx_ldb_ch->bus_format; in imx_ldb_encoder_atomic_check()
377 imx_crtc_state->bus_flags = imx_ldb_ch->bus_flags; in imx_ldb_encoder_atomic_check()
381 imx_crtc_state->bus_format = MEDIA_BUS_FMT_RGB666_1X18; in imx_ldb_encoder_atomic_check()
385 imx_crtc_state->bus_format = MEDIA_BUS_FMT_RGB888_1X24; in imx_ldb_encoder_atomic_check()
388 return -EINVAL; in imx_ldb_encoder_atomic_check()
391 imx_crtc_state->di_hsync_pin = 2; in imx_ldb_encoder_atomic_check()
392 imx_crtc_state->di_vsync_pin = 3; in imx_ldb_encoder_atomic_check()
422 ldb->clk[chno] = devm_clk_get(ldb->dev, clkname); in imx_ldb_get_clk()
423 if (IS_ERR(ldb->clk[chno])) in imx_ldb_get_clk()
424 return PTR_ERR(ldb->clk[chno]); in imx_ldb_get_clk()
427 ldb->clk_pll[chno] = devm_clk_get(ldb->dev, clkname); in imx_ldb_get_clk()
429 return PTR_ERR_OR_ZERO(ldb->clk_pll[chno]); in imx_ldb_get_clk()
435 struct imx_ldb *ldb = imx_ldb_ch->ldb; in imx_ldb_register()
446 ldb_encoder->channel = imx_ldb_ch; in imx_ldb_register()
447 connector = &ldb_encoder->connector; in imx_ldb_register()
448 encoder = &ldb_encoder->encoder; in imx_ldb_register()
450 ret = imx_drm_encoder_parse_of(drm, encoder, imx_ldb_ch->child); in imx_ldb_register()
454 ret = imx_ldb_get_clk(ldb, imx_ldb_ch->chno); in imx_ldb_register()
458 if (ldb->ldb_ctrl & LDB_SPLIT_MODE_EN) { in imx_ldb_register()
466 if (imx_ldb_ch->bridge) { in imx_ldb_register()
467 ret = drm_bridge_attach(encoder, imx_ldb_ch->bridge, NULL, 0); in imx_ldb_register()
482 imx_ldb_ch->ddc); in imx_ldb_register()
507 ret = of_property_read_string(np, "fsl,data-mapping", &bm); in of_get_bus_format()
511 of_property_read_u32(np, "fsl,data-width", &datawidth); in of_get_bus_format()
519 dev_err(dev, "invalid data mapping: %d-bit \"%s\"\n", datawidth, bm); in of_get_bus_format()
521 return -ENOENT; in of_get_bus_format()
537 * For a device declaring compatible = "fsl,imx6q-ldb", "fsl,imx53-ldb",
540 * entries (in this case fsl,imx53-ldb) need to be ordered last.
543 { .compatible = "fsl,imx6q-ldb", .data = imx6q_lvds_mux, },
544 { .compatible = "fsl,imx53-ldb", .data = NULL, },
550 struct imx_ldb_channel *channel, struct device_node *child) in imx_ldb_panel_ddc() argument
556 ddc_node = of_parse_phandle(child, "ddc-i2c-bus", 0); in imx_ldb_panel_ddc()
558 channel->ddc = of_find_i2c_adapter_by_node(ddc_node); in imx_ldb_panel_ddc()
560 if (!channel->ddc) { in imx_ldb_panel_ddc()
562 return -EPROBE_DEFER; in imx_ldb_panel_ddc()
566 if (!channel->ddc) { in imx_ldb_panel_ddc()
574 channel->edid = kmemdup(edidp, edid_len, GFP_KERNEL); in imx_ldb_panel_ddc()
575 } else if (!channel->panel) { in imx_ldb_panel_ddc()
576 /* fallback to display-timings node */ in imx_ldb_panel_ddc()
578 &channel->mode, in imx_ldb_panel_ddc()
579 &channel->bus_flags, in imx_ldb_panel_ddc()
582 channel->mode_valid = 1; in imx_ldb_panel_ddc()
596 struct imx_ldb_channel *channel = &imx_ldb->channel[i]; in imx_ldb_bind() local
598 if (!channel->ldb) in imx_ldb_bind()
601 ret = imx_ldb_register(drm, channel); in imx_ldb_bind()
615 struct device *dev = &pdev->dev; in imx_ldb_probe()
616 struct device_node *np = dev->of_node; in imx_ldb_probe()
620 int dual; in imx_ldb_probe() local
626 return -ENOMEM; in imx_ldb_probe()
628 imx_ldb->regmap = syscon_regmap_lookup_by_phandle(np, "gpr"); in imx_ldb_probe()
629 if (IS_ERR(imx_ldb->regmap)) { in imx_ldb_probe()
631 return PTR_ERR(imx_ldb->regmap); in imx_ldb_probe()
635 regmap_write(imx_ldb->regmap, IOMUXC_GPR2, 0); in imx_ldb_probe()
637 imx_ldb->dev = dev; in imx_ldb_probe()
640 imx_ldb->lvds_mux = of_id->data; in imx_ldb_probe()
642 dual = of_property_read_bool(np, "fsl,dual-channel"); in imx_ldb_probe()
643 if (dual) in imx_ldb_probe()
644 imx_ldb->ldb_ctrl |= LDB_SPLIT_MODE_EN; in imx_ldb_probe()
657 imx_ldb->clk_sel[i] = devm_clk_get(imx_ldb->dev, clkname); in imx_ldb_probe()
658 if (IS_ERR(imx_ldb->clk_sel[i])) { in imx_ldb_probe()
659 ret = PTR_ERR(imx_ldb->clk_sel[i]); in imx_ldb_probe()
660 imx_ldb->clk_sel[i] = NULL; in imx_ldb_probe()
664 imx_ldb->clk_parent[i] = clk_get_parent(imx_ldb->clk_sel[i]); in imx_ldb_probe()
670 struct imx_ldb_channel *channel; in imx_ldb_probe() local
675 ret = -EINVAL; in imx_ldb_probe()
682 if (dual && i > 0) { in imx_ldb_probe()
683 dev_warn(dev, "dual-channel mode, ignoring second output\n"); in imx_ldb_probe()
687 channel = &imx_ldb->channel[i]; in imx_ldb_probe()
688 channel->ldb = imx_ldb; in imx_ldb_probe()
689 channel->chno = i; in imx_ldb_probe()
692 * The output port is port@4 with an external 4-port mux or in imx_ldb_probe()
693 * port@2 with the internal 2-port mux. in imx_ldb_probe()
696 imx_ldb->lvds_mux ? 4 : 2, 0, in imx_ldb_probe()
697 &channel->panel, &channel->bridge); in imx_ldb_probe()
698 if (ret && ret != -ENODEV) in imx_ldb_probe()
702 if (!channel->bridge) { in imx_ldb_probe()
703 ret = imx_ldb_panel_ddc(dev, channel, child); in imx_ldb_probe()
709 if (bus_format == -EINVAL) { in imx_ldb_probe()
714 if (channel->panel && channel->panel->funcs && in imx_ldb_probe()
715 channel->panel->funcs->get_modes) in imx_ldb_probe()
724 channel->bus_format = bus_format; in imx_ldb_probe()
725 channel->child = child; in imx_ldb_probe()
730 return component_add(&pdev->dev, &imx_ldb_ops); in imx_ldb_probe()
743 struct imx_ldb_channel *channel = &imx_ldb->channel[i]; in imx_ldb_remove() local
745 kfree(channel->edid); in imx_ldb_remove()
746 i2c_put_adapter(channel->ddc); in imx_ldb_remove()
749 component_del(&pdev->dev, &imx_ldb_ops); in imx_ldb_remove()