imx-ldb.c 19.4 KB
Newer Older
S
Sascha Hauer 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17
/*
 * i.MX drm driver - LVDS display bridge
 *
 * Copyright (C) 2012 Sascha Hauer, Pengutronix
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include <linux/module.h>
#include <linux/clk.h>
18
#include <linux/component.h>
S
Sascha Hauer 已提交
19
#include <drm/drmP.h>
20
#include <drm/drm_atomic_helper.h>
S
Sascha Hauer 已提交
21 22
#include <drm/drm_fb_helper.h>
#include <drm/drm_crtc_helper.h>
23
#include <drm/drm_of.h>
24
#include <drm/drm_panel.h>
S
Sascha Hauer 已提交
25 26 27
#include <linux/mfd/syscon.h>
#include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
#include <linux/of_device.h>
28
#include <linux/of_graph.h>
29
#include <video/of_display_timing.h>
S
Sascha Hauer 已提交
30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53
#include <video/of_videomode.h>
#include <linux/regmap.h>
#include <linux/videodev2.h>

#include "imx-drm.h"

#define DRIVER_NAME "imx-ldb"

#define LDB_CH0_MODE_EN_TO_DI0		(1 << 0)
#define LDB_CH0_MODE_EN_TO_DI1		(3 << 0)
#define LDB_CH0_MODE_EN_MASK		(3 << 0)
#define LDB_CH1_MODE_EN_TO_DI0		(1 << 2)
#define LDB_CH1_MODE_EN_TO_DI1		(3 << 2)
#define LDB_CH1_MODE_EN_MASK		(3 << 2)
#define LDB_SPLIT_MODE_EN		(1 << 4)
#define LDB_DATA_WIDTH_CH0_24		(1 << 5)
#define LDB_BIT_MAP_CH0_JEIDA		(1 << 6)
#define LDB_DATA_WIDTH_CH1_24		(1 << 7)
#define LDB_BIT_MAP_CH1_JEIDA		(1 << 8)
#define LDB_DI0_VS_POL_ACT_LOW		(1 << 9)
#define LDB_DI1_VS_POL_ACT_LOW		(1 << 10)
#define LDB_BGREF_RMODE_INT		(1 << 15)

#define con_to_imx_ldb_ch(x) container_of(x, struct imx_ldb_channel, connector)
54 55
#define imx_enc_to_imx_ldb_ch(x)	\
			container_of(x, struct imx_ldb_channel, imx_encoder)
S
Sascha Hauer 已提交
56 57 58 59 60 61

struct imx_ldb;

struct imx_ldb_channel {
	struct imx_ldb *ldb;
	struct drm_connector connector;
62
	struct imx_drm_encoder imx_encoder;
63
	struct drm_panel *panel;
64
	struct device_node *child;
65
	struct i2c_adapter *ddc;
S
Sascha Hauer 已提交
66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84
	int chno;
	void *edid;
	int edid_len;
	struct drm_display_mode mode;
	int mode_valid;
};

struct bus_mux {
	int reg;
	int shift;
	int mask;
};

struct imx_ldb {
	struct regmap *regmap;
	struct device *dev;
	struct imx_ldb_channel channel[2];
	struct clk *clk[2]; /* our own clock */
	struct clk *clk_sel[4]; /* parent of display clock */
85
	struct clk *clk_parent[4]; /* original parent of clk_sel */
S
Sascha Hauer 已提交
86 87 88 89 90 91 92 93 94 95 96
	struct clk *clk_pll[2]; /* upstream clock we can adjust */
	u32 ldb_ctrl;
	const struct bus_mux *lvds_mux;
};

static enum drm_connector_status imx_ldb_connector_detect(
		struct drm_connector *connector, bool force)
{
	return connector_status_connected;
}

97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125
static void imx_ldb_bus_format_translation(struct imx_ldb_channel *imx_ldb_ch,
					   u32 bus_format)
{
	struct imx_ldb *ldb = imx_ldb_ch->ldb;
	int dual = ldb->ldb_ctrl & LDB_SPLIT_MODE_EN;

	switch (bus_format) {
	case MEDIA_BUS_FMT_RGB666_1X7X3_SPWG:
		imx_ldb_ch->imx_encoder.bus_format = MEDIA_BUS_FMT_RGB666_1X18;
		break;
	case MEDIA_BUS_FMT_RGB888_1X7X4_SPWG:
		imx_ldb_ch->imx_encoder.bus_format = MEDIA_BUS_FMT_RGB888_1X24;
		if (imx_ldb_ch->chno == 0 || dual)
			ldb->ldb_ctrl |= LDB_DATA_WIDTH_CH0_24;
		if (imx_ldb_ch->chno == 1 || dual)
			ldb->ldb_ctrl |= LDB_DATA_WIDTH_CH1_24;
		break;
	case MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA:
		imx_ldb_ch->imx_encoder.bus_format = MEDIA_BUS_FMT_RGB888_1X24;
		if (imx_ldb_ch->chno == 0 || dual)
			ldb->ldb_ctrl |= LDB_DATA_WIDTH_CH0_24 |
					 LDB_BIT_MAP_CH0_JEIDA;
		if (imx_ldb_ch->chno == 1 || dual)
			ldb->ldb_ctrl |= LDB_DATA_WIDTH_CH1_24 |
					 LDB_BIT_MAP_CH1_JEIDA;
		break;
	}
}

S
Sascha Hauer 已提交
126 127 128 129 130
static int imx_ldb_connector_get_modes(struct drm_connector *connector)
{
	struct imx_ldb_channel *imx_ldb_ch = con_to_imx_ldb_ch(connector);
	int num_modes = 0;

131 132
	if (imx_ldb_ch->panel && imx_ldb_ch->panel->funcs &&
	    imx_ldb_ch->panel->funcs->get_modes) {
133 134
		struct drm_display_info *di = &connector->display_info;

135
		num_modes = imx_ldb_ch->panel->funcs->get_modes(imx_ldb_ch->panel);
136 137 138
		if (!imx_ldb_ch->imx_encoder.bus_format && di->num_bus_formats)
			imx_ldb_bus_format_translation(imx_ldb_ch,
							di->bus_formats[0]);
139 140 141 142
		if (num_modes > 0)
			return num_modes;
	}

143 144 145
	if (!imx_ldb_ch->edid && imx_ldb_ch->ddc)
		imx_ldb_ch->edid = drm_get_edid(connector, imx_ldb_ch->ddc);

S
Sascha Hauer 已提交
146 147 148 149 150 151 152 153 154 155
	if (imx_ldb_ch->edid) {
		drm_mode_connector_update_edid_property(connector,
							imx_ldb_ch->edid);
		num_modes = drm_add_edid_modes(connector, imx_ldb_ch->edid);
	}

	if (imx_ldb_ch->mode_valid) {
		struct drm_display_mode *mode;

		mode = drm_mode_create(connector->dev);
156 157
		if (!mode)
			return -EINVAL;
S
Sascha Hauer 已提交
158 159 160 161 162 163 164 165 166 167 168 169 170 171
		drm_mode_copy(mode, &imx_ldb_ch->mode);
		mode->type |= DRM_MODE_TYPE_DRIVER | DRM_MODE_TYPE_PREFERRED;
		drm_mode_probed_add(connector, mode);
		num_modes++;
	}

	return num_modes;
}

static struct drm_encoder *imx_ldb_connector_best_encoder(
		struct drm_connector *connector)
{
	struct imx_ldb_channel *imx_ldb_ch = con_to_imx_ldb_ch(connector);

172
	return &imx_ldb_ch->imx_encoder.encoder;
S
Sascha Hauer 已提交
173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196
}

static void imx_ldb_set_clock(struct imx_ldb *ldb, int mux, int chno,
		unsigned long serial_clk, unsigned long di_clk)
{
	int ret;

	dev_dbg(ldb->dev, "%s: now: %ld want: %ld\n", __func__,
			clk_get_rate(ldb->clk_pll[chno]), serial_clk);
	clk_set_rate(ldb->clk_pll[chno], serial_clk);

	dev_dbg(ldb->dev, "%s after: %ld\n", __func__,
			clk_get_rate(ldb->clk_pll[chno]));

	dev_dbg(ldb->dev, "%s: now: %ld want: %ld\n", __func__,
			clk_get_rate(ldb->clk[chno]),
			(long int)di_clk);
	clk_set_rate(ldb->clk[chno], di_clk);

	dev_dbg(ldb->dev, "%s after: %ld\n", __func__,
			clk_get_rate(ldb->clk[chno]));

	/* set display clock mux to LDB input clock */
	ret = clk_set_parent(ldb->clk_sel[mux], ldb->clk[chno]);
197
	if (ret)
198 199 200
		dev_err(ldb->dev,
			"unable to set di%d parent clock to ldb_di%d\n", mux,
			chno);
S
Sascha Hauer 已提交
201 202
}

203
static void imx_ldb_encoder_enable(struct drm_encoder *encoder)
S
Sascha Hauer 已提交
204
{
205 206
	struct imx_drm_encoder *imx_encoder = enc_to_imx_enc(encoder);
	struct imx_ldb_channel *imx_ldb_ch = imx_enc_to_imx_ldb_ch(imx_encoder);
S
Sascha Hauer 已提交
207 208
	struct imx_ldb *ldb = imx_ldb_ch->ldb;
	int dual = ldb->ldb_ctrl & LDB_SPLIT_MODE_EN;
209
	int mux = drm_of_encoder_active_port_id(imx_ldb_ch->child, encoder);
S
Sascha Hauer 已提交
210

211 212
	drm_panel_prepare(imx_ldb_ch->panel);

S
Sascha Hauer 已提交
213
	if (dual) {
214 215 216
		clk_set_parent(ldb->clk_sel[mux], ldb->clk[0]);
		clk_set_parent(ldb->clk_sel[mux], ldb->clk[1]);

S
Sascha Hauer 已提交
217 218
		clk_prepare_enable(ldb->clk[0]);
		clk_prepare_enable(ldb->clk[1]);
219 220
	} else {
		clk_set_parent(ldb->clk_sel[mux], ldb->clk[imx_ldb_ch->chno]);
S
Sascha Hauer 已提交
221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250
	}

	if (imx_ldb_ch == &ldb->channel[0] || dual) {
		ldb->ldb_ctrl &= ~LDB_CH0_MODE_EN_MASK;
		if (mux == 0 || ldb->lvds_mux)
			ldb->ldb_ctrl |= LDB_CH0_MODE_EN_TO_DI0;
		else if (mux == 1)
			ldb->ldb_ctrl |= LDB_CH0_MODE_EN_TO_DI1;
	}
	if (imx_ldb_ch == &ldb->channel[1] || dual) {
		ldb->ldb_ctrl &= ~LDB_CH1_MODE_EN_MASK;
		if (mux == 1 || ldb->lvds_mux)
			ldb->ldb_ctrl |= LDB_CH1_MODE_EN_TO_DI1;
		else if (mux == 0)
			ldb->ldb_ctrl |= LDB_CH1_MODE_EN_TO_DI0;
	}

	if (ldb->lvds_mux) {
		const struct bus_mux *lvds_mux = NULL;

		if (imx_ldb_ch == &ldb->channel[0])
			lvds_mux = &ldb->lvds_mux[0];
		else if (imx_ldb_ch == &ldb->channel[1])
			lvds_mux = &ldb->lvds_mux[1];

		regmap_update_bits(ldb->regmap, lvds_mux->reg, lvds_mux->mask,
				   mux << lvds_mux->shift);
	}

	regmap_write(ldb->regmap, IOMUXC_GPR2, ldb->ldb_ctrl);
251 252

	drm_panel_enable(imx_ldb_ch->panel);
S
Sascha Hauer 已提交
253 254 255
}

static void imx_ldb_encoder_mode_set(struct drm_encoder *encoder,
256 257
			 struct drm_display_mode *orig_mode,
			 struct drm_display_mode *mode)
S
Sascha Hauer 已提交
258
{
259 260
	struct imx_drm_encoder *imx_encoder = enc_to_imx_enc(encoder);
	struct imx_ldb_channel *imx_ldb_ch = imx_enc_to_imx_ldb_ch(imx_encoder);
S
Sascha Hauer 已提交
261 262
	struct imx_ldb *ldb = imx_ldb_ch->ldb;
	int dual = ldb->ldb_ctrl & LDB_SPLIT_MODE_EN;
263 264
	unsigned long serial_clk;
	unsigned long di_clk = mode->clock * 1000;
265
	int mux = drm_of_encoder_active_port_id(imx_ldb_ch->child, encoder);
S
Sascha Hauer 已提交
266 267 268 269 270 271 272 273 274 275

	if (mode->clock > 170000) {
		dev_warn(ldb->dev,
			 "%s: mode exceeds 170 MHz pixel clock\n", __func__);
	}
	if (mode->clock > 85000 && !dual) {
		dev_warn(ldb->dev,
			 "%s: mode exceeds 85 MHz pixel clock\n", __func__);
	}

276 277 278 279 280 281 282 283 284 285
	if (dual) {
		serial_clk = 3500UL * mode->clock;
		imx_ldb_set_clock(ldb, mux, 0, serial_clk, di_clk);
		imx_ldb_set_clock(ldb, mux, 1, serial_clk, di_clk);
	} else {
		serial_clk = 7000UL * mode->clock;
		imx_ldb_set_clock(ldb, mux, imx_ldb_ch->chno, serial_clk,
				  di_clk);
	}

S
Sascha Hauer 已提交
286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302
	/* FIXME - assumes straight connections DI0 --> CH0, DI1 --> CH1 */
	if (imx_ldb_ch == &ldb->channel[0]) {
		if (mode->flags & DRM_MODE_FLAG_NVSYNC)
			ldb->ldb_ctrl |= LDB_DI0_VS_POL_ACT_LOW;
		else if (mode->flags & DRM_MODE_FLAG_PVSYNC)
			ldb->ldb_ctrl &= ~LDB_DI0_VS_POL_ACT_LOW;
	}
	if (imx_ldb_ch == &ldb->channel[1]) {
		if (mode->flags & DRM_MODE_FLAG_NVSYNC)
			ldb->ldb_ctrl |= LDB_DI1_VS_POL_ACT_LOW;
		else if (mode->flags & DRM_MODE_FLAG_PVSYNC)
			ldb->ldb_ctrl &= ~LDB_DI1_VS_POL_ACT_LOW;
	}
}

static void imx_ldb_encoder_disable(struct drm_encoder *encoder)
{
303 304
	struct imx_drm_encoder *imx_encoder = enc_to_imx_enc(encoder);
	struct imx_ldb_channel *imx_ldb_ch = imx_enc_to_imx_ldb_ch(imx_encoder);
S
Sascha Hauer 已提交
305
	struct imx_ldb *ldb = imx_ldb_ch->ldb;
306
	int mux, ret;
S
Sascha Hauer 已提交
307 308 309 310 311 312 313 314 315 316 317 318 319

	/*
	 * imx_ldb_encoder_disable is called by
	 * drm_helper_disable_unused_functions without
	 * the encoder being enabled before.
	 */
	if (imx_ldb_ch == &ldb->channel[0] &&
	    (ldb->ldb_ctrl & LDB_CH0_MODE_EN_MASK) == 0)
		return;
	else if (imx_ldb_ch == &ldb->channel[1] &&
		 (ldb->ldb_ctrl & LDB_CH1_MODE_EN_MASK) == 0)
		return;

320 321
	drm_panel_disable(imx_ldb_ch->panel);

S
Sascha Hauer 已提交
322 323 324 325 326 327 328 329 330 331 332
	if (imx_ldb_ch == &ldb->channel[0])
		ldb->ldb_ctrl &= ~LDB_CH0_MODE_EN_MASK;
	else if (imx_ldb_ch == &ldb->channel[1])
		ldb->ldb_ctrl &= ~LDB_CH1_MODE_EN_MASK;

	regmap_write(ldb->regmap, IOMUXC_GPR2, ldb->ldb_ctrl);

	if (ldb->ldb_ctrl & LDB_SPLIT_MODE_EN) {
		clk_disable_unprepare(ldb->clk[0]);
		clk_disable_unprepare(ldb->clk[1]);
	}
333

334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355
	if (ldb->lvds_mux) {
		const struct bus_mux *lvds_mux = NULL;

		if (imx_ldb_ch == &ldb->channel[0])
			lvds_mux = &ldb->lvds_mux[0];
		else if (imx_ldb_ch == &ldb->channel[1])
			lvds_mux = &ldb->lvds_mux[1];

		regmap_read(ldb->regmap, lvds_mux->reg, &mux);
		mux &= lvds_mux->mask;
		mux >>= lvds_mux->shift;
	} else {
		mux = (imx_ldb_ch == &ldb->channel[0]) ? 0 : 1;
	}

	/* set display clock mux back to original input clock */
	ret = clk_set_parent(ldb->clk_sel[mux], ldb->clk_parent[mux]);
	if (ret)
		dev_err(ldb->dev,
			"unable to set di%d parent clock to original parent\n",
			mux);

356
	drm_panel_unprepare(imx_ldb_ch->panel);
S
Sascha Hauer 已提交
357 358
}

359
static const struct drm_connector_funcs imx_ldb_connector_funcs = {
360
	.dpms = drm_atomic_helper_connector_dpms,
S
Sascha Hauer 已提交
361 362
	.fill_modes = drm_helper_probe_single_connector_modes,
	.detect = imx_ldb_connector_detect,
363
	.destroy = imx_drm_connector_destroy,
364 365 366
	.reset = drm_atomic_helper_connector_reset,
	.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
	.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
S
Sascha Hauer 已提交
367 368
};

369
static const struct drm_connector_helper_funcs imx_ldb_connector_helper_funcs = {
S
Sascha Hauer 已提交
370 371 372 373
	.get_modes = imx_ldb_connector_get_modes,
	.best_encoder = imx_ldb_connector_best_encoder,
};

374
static const struct drm_encoder_funcs imx_ldb_encoder_funcs = {
375
	.destroy = imx_drm_encoder_destroy,
S
Sascha Hauer 已提交
376 377
};

378
static const struct drm_encoder_helper_funcs imx_ldb_encoder_helper_funcs = {
S
Sascha Hauer 已提交
379
	.mode_set = imx_ldb_encoder_mode_set,
380
	.enable = imx_ldb_encoder_enable,
S
Sascha Hauer 已提交
381 382 383 384 385 386 387
	.disable = imx_ldb_encoder_disable,
};

static int imx_ldb_get_clk(struct imx_ldb *ldb, int chno)
{
	char clkname[16];

F
Fabio Estevam 已提交
388
	snprintf(clkname, sizeof(clkname), "di%d", chno);
S
Sascha Hauer 已提交
389 390 391 392
	ldb->clk[chno] = devm_clk_get(ldb->dev, clkname);
	if (IS_ERR(ldb->clk[chno]))
		return PTR_ERR(ldb->clk[chno]);

F
Fabio Estevam 已提交
393
	snprintf(clkname, sizeof(clkname), "di%d_pll", chno);
S
Sascha Hauer 已提交
394 395
	ldb->clk_pll[chno] = devm_clk_get(ldb->dev, clkname);

396
	return PTR_ERR_OR_ZERO(ldb->clk_pll[chno]);
S
Sascha Hauer 已提交
397 398
}

399 400
static int imx_ldb_register(struct drm_device *drm,
	struct imx_ldb_channel *imx_ldb_ch)
S
Sascha Hauer 已提交
401 402
{
	struct imx_ldb *ldb = imx_ldb_ch->ldb;
403 404
	int ret;

405
	ret = imx_drm_encoder_parse_of(drm, &imx_ldb_ch->imx_encoder.encoder,
406 407 408
				       imx_ldb_ch->child);
	if (ret)
		return ret;
S
Sascha Hauer 已提交
409 410 411 412

	ret = imx_ldb_get_clk(ldb, imx_ldb_ch->chno);
	if (ret)
		return ret;
413

S
Sascha Hauer 已提交
414
	if (ldb->ldb_ctrl & LDB_SPLIT_MODE_EN) {
415
		ret = imx_ldb_get_clk(ldb, 1);
S
Sascha Hauer 已提交
416 417 418 419
		if (ret)
			return ret;
	}

420
	drm_encoder_helper_add(&imx_ldb_ch->imx_encoder.encoder,
S
Sascha Hauer 已提交
421
			&imx_ldb_encoder_helper_funcs);
422 423
	drm_encoder_init(drm, &imx_ldb_ch->imx_encoder.encoder,
			 &imx_ldb_encoder_funcs, DRM_MODE_ENCODER_LVDS, NULL);
S
Sascha Hauer 已提交
424 425 426

	drm_connector_helper_add(&imx_ldb_ch->connector,
			&imx_ldb_connector_helper_funcs);
427 428
	drm_connector_init(drm, &imx_ldb_ch->connector,
			   &imx_ldb_connector_funcs, DRM_MODE_CONNECTOR_LVDS);
S
Sascha Hauer 已提交
429

430 431 432
	if (imx_ldb_ch->panel)
		drm_panel_attach(imx_ldb_ch->panel, &imx_ldb_ch->connector);

S
Sascha Hauer 已提交
433
	drm_mode_connector_attach_encoder(&imx_ldb_ch->connector,
434
			&imx_ldb_ch->imx_encoder.encoder);
S
Sascha Hauer 已提交
435 436 437 438 439 440 441 442 443

	return 0;
}

enum {
	LVDS_BIT_MAP_SPWG,
	LVDS_BIT_MAP_JEIDA
};

444 445 446 447
struct imx_ldb_bit_mapping {
	u32 bus_format;
	u32 datawidth;
	const char * const mapping;
S
Sascha Hauer 已提交
448 449
};

450 451 452 453 454 455 456
static const struct imx_ldb_bit_mapping imx_ldb_bit_mappings[] = {
	{ MEDIA_BUS_FMT_RGB666_1X7X3_SPWG,  18, "spwg" },
	{ MEDIA_BUS_FMT_RGB888_1X7X4_SPWG,  24, "spwg" },
	{ MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA, 24, "jeida" },
};

static u32 of_get_bus_format(struct device *dev, struct device_node *np)
S
Sascha Hauer 已提交
457 458
{
	const char *bm;
459
	u32 datawidth = 0;
S
Sascha Hauer 已提交
460 461 462 463 464 465
	int ret, i;

	ret = of_property_read_string(np, "fsl,data-mapping", &bm);
	if (ret < 0)
		return ret;

466 467 468 469 470 471 472 473 474
	of_property_read_u32(np, "fsl,data-width", &datawidth);

	for (i = 0; i < ARRAY_SIZE(imx_ldb_bit_mappings); i++) {
		if (!strcasecmp(bm, imx_ldb_bit_mappings[i].mapping) &&
		    datawidth == imx_ldb_bit_mappings[i].datawidth)
			return imx_ldb_bit_mappings[i].bus_format;
	}

	dev_err(dev, "invalid data mapping: %d-bit \"%s\"\n", datawidth, bm);
S
Sascha Hauer 已提交
475

476
	return -ENOENT;
S
Sascha Hauer 已提交
477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503
}

static struct bus_mux imx6q_lvds_mux[2] = {
	{
		.reg = IOMUXC_GPR3,
		.shift = 6,
		.mask = IMX6Q_GPR3_LVDS0_MUX_CTL_MASK,
	}, {
		.reg = IOMUXC_GPR3,
		.shift = 8,
		.mask = IMX6Q_GPR3_LVDS1_MUX_CTL_MASK,
	}
};

/*
 * For a device declaring compatible = "fsl,imx6q-ldb", "fsl,imx53-ldb",
 * of_match_device will walk through this list and take the first entry
 * matching any of its compatible values. Therefore, the more generic
 * entries (in this case fsl,imx53-ldb) need to be ordered last.
 */
static const struct of_device_id imx_ldb_dt_ids[] = {
	{ .compatible = "fsl,imx6q-ldb", .data = imx6q_lvds_mux, },
	{ .compatible = "fsl,imx53-ldb", .data = NULL, },
	{ }
};
MODULE_DEVICE_TABLE(of, imx_ldb_dt_ids);

504
static int imx_ldb_bind(struct device *dev, struct device *master, void *data)
S
Sascha Hauer 已提交
505
{
506
	struct drm_device *drm = data;
507
	struct device_node *np = dev->of_node;
S
Sascha Hauer 已提交
508
	const struct of_device_id *of_id =
509
			of_match_device(imx_ldb_dt_ids, dev);
S
Sascha Hauer 已提交
510 511 512 513 514 515 516
	struct device_node *child;
	const u8 *edidp;
	struct imx_ldb *imx_ldb;
	int dual;
	int ret;
	int i;

517
	imx_ldb = devm_kzalloc(dev, sizeof(*imx_ldb), GFP_KERNEL);
S
Sascha Hauer 已提交
518 519 520 521 522
	if (!imx_ldb)
		return -ENOMEM;

	imx_ldb->regmap = syscon_regmap_lookup_by_phandle(np, "gpr");
	if (IS_ERR(imx_ldb->regmap)) {
523
		dev_err(dev, "failed to get parent regmap\n");
S
Sascha Hauer 已提交
524 525 526
		return PTR_ERR(imx_ldb->regmap);
	}

527
	imx_ldb->dev = dev;
S
Sascha Hauer 已提交
528 529 530 531 532 533 534 535 536

	if (of_id)
		imx_ldb->lvds_mux = of_id->data;

	dual = of_property_read_bool(np, "fsl,dual-channel");
	if (dual)
		imx_ldb->ldb_ctrl |= LDB_SPLIT_MODE_EN;

	/*
537
	 * There are three different possible clock mux configurations:
S
Sascha Hauer 已提交
538 539 540 541 542 543 544 545 546 547 548 549 550 551 552
	 * i.MX53:  ipu1_di0_sel, ipu1_di1_sel
	 * i.MX6q:  ipu1_di0_sel, ipu1_di1_sel, ipu2_di0_sel, ipu2_di1_sel
	 * i.MX6dl: ipu1_di0_sel, ipu1_di1_sel, lcdif_sel
	 * Map them all to di0_sel...di3_sel.
	 */
	for (i = 0; i < 4; i++) {
		char clkname[16];

		sprintf(clkname, "di%d_sel", i);
		imx_ldb->clk_sel[i] = devm_clk_get(imx_ldb->dev, clkname);
		if (IS_ERR(imx_ldb->clk_sel[i])) {
			ret = PTR_ERR(imx_ldb->clk_sel[i]);
			imx_ldb->clk_sel[i] = NULL;
			break;
		}
553 554

		imx_ldb->clk_parent[i] = clk_get_parent(imx_ldb->clk_sel[i]);
S
Sascha Hauer 已提交
555 556 557 558 559 560
	}
	if (i == 0)
		return ret;

	for_each_child_of_node(np, child) {
		struct imx_ldb_channel *channel;
561
		struct device_node *ddc_node;
562
		struct device_node *ep;
563
		int bus_format;
S
Sascha Hauer 已提交
564 565 566 567 568 569

		ret = of_property_read_u32(child, "reg", &i);
		if (ret || i < 0 || i > 1)
			return -EINVAL;

		if (dual && i > 0) {
570
			dev_warn(dev, "dual-channel mode, ignoring second output\n");
S
Sascha Hauer 已提交
571 572 573 574 575 576 577 578 579
			continue;
		}

		if (!of_device_is_available(child))
			continue;

		channel = &imx_ldb->channel[i];
		channel->ldb = imx_ldb;
		channel->chno = i;
580
		channel->child = child;
S
Sascha Hauer 已提交
581

582 583 584 585
		/*
		 * The output port is port@4 with an external 4-port mux or
		 * port@2 with the internal 2-port mux.
		 */
586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602
		ep = of_graph_get_endpoint_by_regs(child,
						   imx_ldb->lvds_mux ? 4 : 2,
						   -1);
		if (ep) {
			struct device_node *remote;

			remote = of_graph_get_remote_port_parent(ep);
			of_node_put(ep);
			if (remote)
				channel->panel = of_drm_find_panel(remote);
			else
				return -EPROBE_DEFER;
			of_node_put(remote);
			if (!channel->panel) {
				dev_err(dev, "panel not found: %s\n",
					remote->full_name);
				return -EPROBE_DEFER;
603 604 605
			}
		}

606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629
		ddc_node = of_parse_phandle(child, "ddc-i2c-bus", 0);
		if (ddc_node) {
			channel->ddc = of_find_i2c_adapter_by_node(ddc_node);
			of_node_put(ddc_node);
			if (!channel->ddc) {
				dev_warn(dev, "failed to get ddc i2c adapter\n");
				return -EPROBE_DEFER;
			}
		}

		if (!channel->ddc) {
			/* if no DDC available, fallback to hardcoded EDID */
			dev_dbg(dev, "no ddc available\n");

			edidp = of_get_property(child, "edid",
						&channel->edid_len);
			if (edidp) {
				channel->edid = kmemdup(edidp,
							channel->edid_len,
							GFP_KERNEL);
			} else if (!channel->panel) {
				/* fallback to display-timings node */
				ret = of_get_drm_display_mode(child,
							      &channel->mode,
630
							      OF_USE_NATIVE_MODE);
631 632 633
				if (!ret)
					channel->mode_valid = 1;
			}
S
Sascha Hauer 已提交
634 635
		}

636 637
		bus_format = of_get_bus_format(dev, child);
		if (bus_format == -EINVAL) {
638 639 640 641 642 643
			/*
			 * If no bus format was specified in the device tree,
			 * we can still get it from the connected panel later.
			 */
			if (channel->panel && channel->panel->funcs &&
			    channel->panel->funcs->get_modes)
644
				bus_format = 0;
645
		}
646
		if (bus_format < 0) {
647
			dev_err(dev, "could not determine data mapping: %d\n",
648 649
				bus_format);
			return bus_format;
S
Sascha Hauer 已提交
650
		}
651 652 653 654
		imx_ldb_bus_format_translation(channel, bus_format);

		channel->imx_encoder.di_hsync_pin = 2;
		channel->imx_encoder.di_vsync_pin = 3;
S
Sascha Hauer 已提交
655

656
		ret = imx_ldb_register(drm, channel);
S
Sascha Hauer 已提交
657 658 659 660
		if (ret)
			return ret;
	}

661
	dev_set_drvdata(dev, imx_ldb);
S
Sascha Hauer 已提交
662 663 664 665

	return 0;
}

666 667
static void imx_ldb_unbind(struct device *dev, struct device *master,
	void *data)
S
Sascha Hauer 已提交
668
{
669
	struct imx_ldb *imx_ldb = dev_get_drvdata(dev);
S
Sascha Hauer 已提交
670 671 672 673 674
	int i;

	for (i = 0; i < 2; i++) {
		struct imx_ldb_channel *channel = &imx_ldb->channel[i];

675 676 677
		if (!channel->connector.funcs)
			continue;

678
		channel->connector.funcs->destroy(&channel->connector);
679 680
		channel->imx_encoder.encoder.funcs->destroy(
					&channel->imx_encoder.encoder);
681 682

		kfree(channel->edid);
683
		i2c_put_adapter(channel->ddc);
S
Sascha Hauer 已提交
684
	}
685
}
S
Sascha Hauer 已提交
686

687 688 689 690 691 692 693 694 695 696 697 698 699
static const struct component_ops imx_ldb_ops = {
	.bind	= imx_ldb_bind,
	.unbind	= imx_ldb_unbind,
};

static int imx_ldb_probe(struct platform_device *pdev)
{
	return component_add(&pdev->dev, &imx_ldb_ops);
}

static int imx_ldb_remove(struct platform_device *pdev)
{
	component_del(&pdev->dev, &imx_ldb_ops);
S
Sascha Hauer 已提交
700 701 702 703 704 705 706 707 708 709 710 711 712 713 714 715 716
	return 0;
}

static struct platform_driver imx_ldb_driver = {
	.probe		= imx_ldb_probe,
	.remove		= imx_ldb_remove,
	.driver		= {
		.of_match_table = imx_ldb_dt_ids,
		.name	= DRIVER_NAME,
	},
};

module_platform_driver(imx_ldb_driver);

MODULE_DESCRIPTION("i.MX LVDS driver");
MODULE_AUTHOR("Sascha Hauer, Pengutronix");
MODULE_LICENSE("GPL");
717
MODULE_ALIAS("platform:" DRIVER_NAME);