imx-ldb.c 18.8 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 20 21
#include <drm/drmP.h>
#include <drm/drm_fb_helper.h>
#include <drm/drm_crtc_helper.h>
22
#include <drm/drm_of.h>
23
#include <drm/drm_panel.h>
S
Sascha Hauer 已提交
24 25 26
#include <linux/mfd/syscon.h>
#include <linux/mfd/syscon/imx6q-iomuxc-gpr.h>
#include <linux/of_device.h>
27
#include <linux/of_graph.h>
S
Sascha Hauer 已提交
28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59
#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)
#define enc_to_imx_ldb_ch(x) container_of(x, struct imx_ldb_channel, encoder)

struct imx_ldb;

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

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 */
83
	struct clk *clk_parent[4]; /* original parent of clk_sel */
S
Sascha Hauer 已提交
84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99
	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;
}

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;

100 101
	if (imx_ldb_ch->panel && imx_ldb_ch->panel->funcs &&
	    imx_ldb_ch->panel->funcs->get_modes) {
102 103
		struct drm_display_info *di = &connector->display_info;

104
		num_modes = imx_ldb_ch->panel->funcs->get_modes(imx_ldb_ch->panel);
105 106
		if (!imx_ldb_ch->bus_format && di->num_bus_formats)
			imx_ldb_ch->bus_format = di->bus_formats[0];
107 108 109 110
		if (num_modes > 0)
			return num_modes;
	}

111 112 113
	if (!imx_ldb_ch->edid && imx_ldb_ch->ddc)
		imx_ldb_ch->edid = drm_get_edid(connector, imx_ldb_ch->ddc);

S
Sascha Hauer 已提交
114 115 116 117 118 119 120 121 122 123
	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);
124 125
		if (!mode)
			return -EINVAL;
S
Sascha Hauer 已提交
126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168
		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);

	return &imx_ldb_ch->encoder;
}

static void imx_ldb_encoder_dpms(struct drm_encoder *encoder, int mode)
{
}

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]);
169
	if (ret)
170 171 172
		dev_err(ldb->dev,
			"unable to set di%d parent clock to ldb_di%d\n", mux,
			chno);
S
Sascha Hauer 已提交
173 174 175 176 177 178
}

static void imx_ldb_encoder_prepare(struct drm_encoder *encoder)
{
	struct imx_ldb_channel *imx_ldb_ch = enc_to_imx_ldb_ch(encoder);
	struct imx_ldb *ldb = imx_ldb_ch->ldb;
179
	int dual = ldb->ldb_ctrl & LDB_SPLIT_MODE_EN;
180
	u32 bus_format;
S
Sascha Hauer 已提交
181

182 183 184 185 186 187 188
	switch (imx_ldb_ch->bus_format) {
	default:
		dev_warn(ldb->dev,
			 "could not determine data mapping, default to 18-bit \"spwg\"\n");
		/* fallthrough */
	case MEDIA_BUS_FMT_RGB666_1X7X3_SPWG:
		bus_format = MEDIA_BUS_FMT_RGB666_1X18;
189
		break;
190 191 192 193 194 195
	case MEDIA_BUS_FMT_RGB888_1X7X4_SPWG:
		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;
196
		break;
197
	case MEDIA_BUS_FMT_RGB888_1X7X4_JEIDA:
198
		bus_format = MEDIA_BUS_FMT_RGB888_1X24;
199 200 201 202 203 204 205
		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;
206 207
	}

208
	imx_drm_set_bus_format(encoder, bus_format);
S
Sascha Hauer 已提交
209 210 211 212 213 214 215
}

static void imx_ldb_encoder_commit(struct drm_encoder *encoder)
{
	struct imx_ldb_channel *imx_ldb_ch = enc_to_imx_ldb_ch(encoder);
	struct imx_ldb *ldb = imx_ldb_ch->ldb;
	int dual = ldb->ldb_ctrl & LDB_SPLIT_MODE_EN;
216
	int mux = drm_of_encoder_active_port_id(imx_ldb_ch->child, encoder);
S
Sascha Hauer 已提交
217

218 219
	drm_panel_prepare(imx_ldb_ch->panel);

S
Sascha Hauer 已提交
220 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 251 252
	if (dual) {
		clk_prepare_enable(ldb->clk[0]);
		clk_prepare_enable(ldb->clk[1]);
	}

	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);
253 254

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

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

	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__);
	}

277 278 279 280 281 282 283 284 285 286
	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 已提交
287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305
	/* 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)
{
	struct imx_ldb_channel *imx_ldb_ch = enc_to_imx_ldb_ch(encoder);
	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 = {
S
Sascha Hauer 已提交
360 361 362
	.dpms = drm_helper_connector_dpms,
	.fill_modes = drm_helper_probe_single_connector_modes,
	.detect = imx_ldb_connector_detect,
363
	.destroy = imx_drm_connector_destroy,
S
Sascha Hauer 已提交
364 365
};

366
static const struct drm_connector_helper_funcs imx_ldb_connector_helper_funcs = {
S
Sascha Hauer 已提交
367 368 369 370
	.get_modes = imx_ldb_connector_get_modes,
	.best_encoder = imx_ldb_connector_best_encoder,
};

371
static const struct drm_encoder_funcs imx_ldb_encoder_funcs = {
372
	.destroy = imx_drm_encoder_destroy,
S
Sascha Hauer 已提交
373 374
};

375
static const struct drm_encoder_helper_funcs imx_ldb_encoder_helper_funcs = {
S
Sascha Hauer 已提交
376 377 378 379 380 381 382 383 384 385 386
	.dpms = imx_ldb_encoder_dpms,
	.prepare = imx_ldb_encoder_prepare,
	.commit = imx_ldb_encoder_commit,
	.mode_set = imx_ldb_encoder_mode_set,
	.disable = imx_ldb_encoder_disable,
};

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

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

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

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

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

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

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

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

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

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

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

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

	return 0;
}

enum {
	LVDS_BIT_MAP_SPWG,
	LVDS_BIT_MAP_JEIDA
};

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

449 450 451 452 453 454 455
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 已提交
456 457
{
	const char *bm;
458
	u32 datawidth = 0;
S
Sascha Hauer 已提交
459 460 461 462 463 464
	int ret, i;

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

465 466 467 468 469 470 471 472 473
	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 已提交
474

475
	return -ENOENT;
S
Sascha Hauer 已提交
476 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
}

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);

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

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

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

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

	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;

	/*
536
	 * There are three different possible clock mux configurations:
S
Sascha Hauer 已提交
537 538 539 540 541 542 543 544 545 546 547 548 549 550 551
	 * 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;
		}
552 553

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

	for_each_child_of_node(np, child) {
		struct imx_ldb_channel *channel;
560
		struct device_node *ddc_node;
561
		struct device_node *port;
S
Sascha Hauer 已提交
562 563 564 565 566 567

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

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

		if (!of_device_is_available(child))
			continue;

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

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

			endpoint = of_get_child_by_name(port, "endpoint");
			if (endpoint) {
				remote = of_graph_get_remote_port_parent(endpoint);
				if (remote)
					channel->panel = of_drm_find_panel(remote);
				else
					return -EPROBE_DEFER;
				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 630
		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,
							      0);
				if (!ret)
					channel->mode_valid = 1;
			}
S
Sascha Hauer 已提交
631 632
		}

633 634 635 636 637 638 639 640 641 642 643 644 645 646
		channel->bus_format = of_get_bus_format(dev, child);
		if (channel->bus_format == -EINVAL) {
			/*
			 * 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)
				channel->bus_format = 0;
		}
		if (channel->bus_format < 0) {
			dev_err(dev, "could not determine data mapping: %d\n",
				channel->bus_format);
			return channel->bus_format;
S
Sascha Hauer 已提交
647 648
		}

649
		ret = imx_ldb_register(drm, channel);
S
Sascha Hauer 已提交
650 651 652 653
		if (ret)
			return ret;
	}

654
	dev_set_drvdata(dev, imx_ldb);
S
Sascha Hauer 已提交
655 656 657 658

	return 0;
}

659 660
static void imx_ldb_unbind(struct device *dev, struct device *master,
	void *data)
S
Sascha Hauer 已提交
661
{
662
	struct imx_ldb *imx_ldb = dev_get_drvdata(dev);
S
Sascha Hauer 已提交
663 664 665 666 667
	int i;

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

668 669 670
		if (!channel->connector.funcs)
			continue;

671 672
		channel->connector.funcs->destroy(&channel->connector);
		channel->encoder.funcs->destroy(&channel->encoder);
673 674

		kfree(channel->edid);
675
		i2c_put_adapter(channel->ddc);
S
Sascha Hauer 已提交
676
	}
677
}
S
Sascha Hauer 已提交
678

679 680 681 682 683 684 685 686 687 688 689 690 691
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 已提交
692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708
	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");
709
MODULE_ALIAS("platform:" DRIVER_NAME);