sh_mobile_lcdcfb.c 35.4 KB
Newer Older
M
Magnus Damm 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
/*
 * SuperH Mobile LCDC Framebuffer
 *
 * Copyright (c) 2008 Magnus Damm
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/mm.h>
#include <linux/clk.h>
16
#include <linux/pm_runtime.h>
M
Magnus Damm 已提交
17 18
#include <linux/platform_device.h>
#include <linux/dma-mapping.h>
19
#include <linux/interrupt.h>
20
#include <linux/vmalloc.h>
21
#include <linux/ioctl.h>
22
#include <linux/slab.h>
23
#include <linux/console.h>
24
#include <video/sh_mobile_lcdc.h>
25
#include <asm/atomic.h>
M
Magnus Damm 已提交
26

27 28
#include "sh_mobile_lcdcfb.h"

29 30
#define SIDE_B_OFFSET 0x1000
#define MIRROR_OFFSET 0x2000
M
Magnus Damm 已提交
31 32 33 34 35 36 37 38

/* shared registers */
#define _LDDCKR 0x410
#define _LDDCKSTPR 0x414
#define _LDINTR 0x468
#define _LDSR 0x46c
#define _LDCNT1R 0x470
#define _LDCNT2R 0x474
39
#define _LDRCNTR 0x478
M
Magnus Damm 已提交
40 41 42 43 44 45
#define _LDDDSR 0x47c
#define _LDDWD0R 0x800
#define _LDDRDR 0x840
#define _LDDWAR 0x900
#define _LDDRAR 0x904

46 47 48 49 50 51 52 53 54 55 56
/* shared registers and their order for context save/restore */
static int lcdc_shared_regs[] = {
	_LDDCKR,
	_LDDCKSTPR,
	_LDINTR,
	_LDDDSR,
	_LDCNT1R,
	_LDCNT2R,
};
#define NR_SHARED_REGS ARRAY_SIZE(lcdc_shared_regs)

57 58
#define MAX_XRES 1920
#define MAX_YRES 1080
M
Magnus Damm 已提交
59

60
static unsigned long lcdc_offs_mainlcd[NR_CH_REGS] = {
M
Magnus Damm 已提交
61 62 63 64 65 66 67
	[LDDCKPAT1R] = 0x400,
	[LDDCKPAT2R] = 0x404,
	[LDMT1R] = 0x418,
	[LDMT2R] = 0x41c,
	[LDMT3R] = 0x420,
	[LDDFR] = 0x424,
	[LDSM1R] = 0x428,
68
	[LDSM2R] = 0x42c,
M
Magnus Damm 已提交
69 70 71 72 73 74 75
	[LDSA1R] = 0x430,
	[LDMLSR] = 0x438,
	[LDHCNR] = 0x448,
	[LDHSYNR] = 0x44c,
	[LDVLNR] = 0x450,
	[LDVSYNR] = 0x454,
	[LDPMR] = 0x460,
76
	[LDHAJR] = 0x4a0,
M
Magnus Damm 已提交
77 78
};

79
static unsigned long lcdc_offs_sublcd[NR_CH_REGS] = {
M
Magnus Damm 已提交
80 81 82 83 84 85 86
	[LDDCKPAT1R] = 0x408,
	[LDDCKPAT2R] = 0x40c,
	[LDMT1R] = 0x600,
	[LDMT2R] = 0x604,
	[LDMT3R] = 0x608,
	[LDDFR] = 0x60c,
	[LDSM1R] = 0x610,
87
	[LDSM2R] = 0x614,
M
Magnus Damm 已提交
88 89 90 91 92 93 94 95 96 97 98 99 100
	[LDSA1R] = 0x618,
	[LDMLSR] = 0x620,
	[LDHCNR] = 0x624,
	[LDHSYNR] = 0x628,
	[LDVLNR] = 0x62c,
	[LDVSYNR] = 0x630,
	[LDPMR] = 0x63c,
};

#define START_LCDC	0x00000001
#define LCDC_RESET	0x00000100
#define DISPLAY_BEU	0x00000008
#define LCDC_ENABLE	0x00000001
101
#define LDINTR_FE	0x00000400
102 103
#define LDINTR_VSE	0x00000200
#define LDINTR_VEE	0x00000100
104
#define LDINTR_FS	0x00000004
105 106
#define LDINTR_VSS	0x00000002
#define LDINTR_VES	0x00000001
107 108 109 110
#define LDRCNTR_SRS	0x00020000
#define LDRCNTR_SRC	0x00010000
#define LDRCNTR_MRS	0x00000002
#define LDRCNTR_MRC	0x00000001
111
#define LDSR_MRS	0x00000100
M
Magnus Damm 已提交
112

113 114 115 116 117
static const struct fb_videomode default_720p = {
	.name = "HDMI 720p",
	.xres = 1280,
	.yres = 720,

118 119 120
	.left_margin = 220,
	.right_margin = 110,
	.hsync_len = 40,
121 122 123 124 125 126

	.upper_margin = 20,
	.lower_margin = 5,
	.vsync_len = 5,

	.pixclock = 13468,
127
	.refresh = 60,
128
	.sync = FB_SYNC_VERT_HIGH_ACT | FB_SYNC_HOR_HIGH_ACT,
129 130 131 132 133 134 135 136 137 138
};

struct sh_mobile_lcdc_priv {
	void __iomem *base;
	int irq;
	atomic_t hw_usecnt;
	struct device *dev;
	struct clk *dot_clk;
	unsigned long lddckr;
	struct sh_mobile_lcdc_chan ch[2];
139
	struct notifier_block notifier;
140 141
	unsigned long saved_shared_regs[NR_SHARED_REGS];
	int started;
142
	int forced_bpp; /* 2 channel LCDC must share bpp setting */
143 144
};

145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163
static bool banked(int reg_nr)
{
	switch (reg_nr) {
	case LDMT1R:
	case LDMT2R:
	case LDMT3R:
	case LDDFR:
	case LDSM1R:
	case LDSA1R:
	case LDMLSR:
	case LDHCNR:
	case LDHSYNR:
	case LDVLNR:
	case LDVSYNR:
		return true;
	}
	return false;
}

M
Magnus Damm 已提交
164 165 166 167
static void lcdc_write_chan(struct sh_mobile_lcdc_chan *chan,
			    int reg_nr, unsigned long data)
{
	iowrite32(data, chan->lcdc->base + chan->reg_offs[reg_nr]);
168 169 170 171 172 173 174 175 176 177
	if (banked(reg_nr))
		iowrite32(data, chan->lcdc->base + chan->reg_offs[reg_nr] +
			  SIDE_B_OFFSET);
}

static void lcdc_write_chan_mirror(struct sh_mobile_lcdc_chan *chan,
			    int reg_nr, unsigned long data)
{
	iowrite32(data, chan->lcdc->base + chan->reg_offs[reg_nr] +
		  MIRROR_OFFSET);
M
Magnus Damm 已提交
178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217
}

static unsigned long lcdc_read_chan(struct sh_mobile_lcdc_chan *chan,
				    int reg_nr)
{
	return ioread32(chan->lcdc->base + chan->reg_offs[reg_nr]);
}

static void lcdc_write(struct sh_mobile_lcdc_priv *priv,
		       unsigned long reg_offs, unsigned long data)
{
	iowrite32(data, priv->base + reg_offs);
}

static unsigned long lcdc_read(struct sh_mobile_lcdc_priv *priv,
			       unsigned long reg_offs)
{
	return ioread32(priv->base + reg_offs);
}

static void lcdc_wait_bit(struct sh_mobile_lcdc_priv *priv,
			  unsigned long reg_offs,
			  unsigned long mask, unsigned long until)
{
	while ((lcdc_read(priv, reg_offs) & mask) != until)
		cpu_relax();
}

static int lcdc_chan_is_sublcd(struct sh_mobile_lcdc_chan *chan)
{
	return chan->cfg.chan == LCDC_CHAN_SUBLCD;
}

static void lcdc_sys_write_index(void *handle, unsigned long data)
{
	struct sh_mobile_lcdc_chan *ch = handle;

	lcdc_write(ch->lcdc, _LDDWD0R, data | 0x10000000);
	lcdc_wait_bit(ch->lcdc, _LDSR, 2, 0);
	lcdc_write(ch->lcdc, _LDDWAR, 1 | (lcdc_chan_is_sublcd(ch) ? 2 : 0));
M
Magnus Damm 已提交
218
	lcdc_wait_bit(ch->lcdc, _LDSR, 2, 0);
M
Magnus Damm 已提交
219 220 221 222 223 224 225 226 227
}

static void lcdc_sys_write_data(void *handle, unsigned long data)
{
	struct sh_mobile_lcdc_chan *ch = handle;

	lcdc_write(ch->lcdc, _LDDWD0R, data | 0x11000000);
	lcdc_wait_bit(ch->lcdc, _LDSR, 2, 0);
	lcdc_write(ch->lcdc, _LDDWAR, 1 | (lcdc_chan_is_sublcd(ch) ? 2 : 0));
M
Magnus Damm 已提交
228
	lcdc_wait_bit(ch->lcdc, _LDSR, 2, 0);
M
Magnus Damm 已提交
229 230 231 232 233 234 235 236 237 238
}

static unsigned long lcdc_sys_read_data(void *handle)
{
	struct sh_mobile_lcdc_chan *ch = handle;

	lcdc_write(ch->lcdc, _LDDRDR, 0x01000000);
	lcdc_wait_bit(ch->lcdc, _LDSR, 2, 0);
	lcdc_write(ch->lcdc, _LDDRAR, 1 | (lcdc_chan_is_sublcd(ch) ? 2 : 0));
	udelay(1);
M
Magnus Damm 已提交
239
	lcdc_wait_bit(ch->lcdc, _LDSR, 2, 0);
M
Magnus Damm 已提交
240

241
	return lcdc_read(ch->lcdc, _LDDRDR) & 0x3ffff;
M
Magnus Damm 已提交
242 243 244 245 246 247 248 249
}

struct sh_mobile_lcdc_sys_bus_ops sh_mobile_lcdc_sys_bus_ops = {
	lcdc_sys_write_index,
	lcdc_sys_write_data,
	lcdc_sys_read_data,
};

250 251
static void sh_mobile_lcdc_clk_on(struct sh_mobile_lcdc_priv *priv)
{
252 253
	if (atomic_inc_and_test(&priv->hw_usecnt)) {
		pm_runtime_get_sync(priv->dev);
254 255 256 257 258 259 260
		if (priv->dot_clk)
			clk_enable(priv->dot_clk);
	}
}

static void sh_mobile_lcdc_clk_off(struct sh_mobile_lcdc_priv *priv)
{
261
	if (atomic_sub_return(1, &priv->hw_usecnt) == -1) {
262 263
		if (priv->dot_clk)
			clk_disable(priv->dot_clk);
264
		pm_runtime_put(priv->dev);
265 266 267
	}
}

268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283
static int sh_mobile_lcdc_sginit(struct fb_info *info,
				  struct list_head *pagelist)
{
	struct sh_mobile_lcdc_chan *ch = info->par;
	unsigned int nr_pages_max = info->fix.smem_len >> PAGE_SHIFT;
	struct page *page;
	int nr_pages = 0;

	sg_init_table(ch->sglist, nr_pages_max);

	list_for_each_entry(page, pagelist, lru)
		sg_set_page(&ch->sglist[nr_pages++], page, PAGE_SIZE, 0);

	return nr_pages;
}

284 285 286 287
static void sh_mobile_lcdc_deferred_io(struct fb_info *info,
				       struct list_head *pagelist)
{
	struct sh_mobile_lcdc_chan *ch = info->par;
288
	struct sh_mobile_lcdc_board_cfg	*bcfg = &ch->cfg.board_cfg;
289 290 291 292

	/* enable clocks before accessing hardware */
	sh_mobile_lcdc_clk_on(ch->lcdc);

293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312
	/*
	 * It's possible to get here without anything on the pagelist via
	 * sh_mobile_lcdc_deferred_io_touch() or via a userspace fsync()
	 * invocation. In the former case, the acceleration routines are
	 * stepped in to when using the framebuffer console causing the
	 * workqueue to be scheduled without any dirty pages on the list.
	 *
	 * Despite this, a panel update is still needed given that the
	 * acceleration routines have their own methods for writing in
	 * that still need to be updated.
	 *
	 * The fsync() and empty pagelist case could be optimized for,
	 * but we don't bother, as any application exhibiting such
	 * behaviour is fundamentally broken anyways.
	 */
	if (!list_empty(pagelist)) {
		unsigned int nr_pages = sh_mobile_lcdc_sginit(info, pagelist);

		/* trigger panel update */
		dma_map_sg(info->dev, ch->sglist, nr_pages, DMA_TO_DEVICE);
313 314 315
		if (bcfg->start_transfer)
			bcfg->start_transfer(bcfg->board_data, ch,
					     &sh_mobile_lcdc_sys_bus_ops);
316 317
		lcdc_write_chan(ch, LDSM2R, 1);
		dma_unmap_sg(info->dev, ch->sglist, nr_pages, DMA_TO_DEVICE);
318 319 320 321
	} else {
		if (bcfg->start_transfer)
			bcfg->start_transfer(bcfg->board_data, ch,
					     &sh_mobile_lcdc_sys_bus_ops);
322
		lcdc_write_chan(ch, LDSM2R, 1);
323
	}
324 325 326 327 328 329 330 331 332 333 334 335 336
}

static void sh_mobile_lcdc_deferred_io_touch(struct fb_info *info)
{
	struct fb_deferred_io *fbdefio = info->fbdefio;

	if (fbdefio)
		schedule_delayed_work(&info->deferred_work, fbdefio->delay);
}

static irqreturn_t sh_mobile_lcdc_irq(int irq, void *data)
{
	struct sh_mobile_lcdc_priv *priv = data;
337
	struct sh_mobile_lcdc_chan *ch;
338
	unsigned long tmp;
339
	unsigned long ldintr;
340 341
	int is_sub;
	int k;
342 343

	/* acknowledge interrupt */
344 345 346 347 348 349
	ldintr = tmp = lcdc_read(priv, _LDINTR);
	/*
	 * disable further VSYNC End IRQs, preserve all other enabled IRQs,
	 * write 0 to bits 0-6 to ack all triggered IRQs.
	 */
	tmp &= 0xffffff00 & ~LDINTR_VEE;
350 351
	lcdc_write(priv, _LDINTR, tmp);

352 353 354
	/* figure out if this interrupt is for main or sub lcd */
	is_sub = (lcdc_read(priv, _LDSR) & (1 << 10)) ? 1 : 0;

355
	/* wake up channel and disable clocks */
356 357 358 359 360 361
	for (k = 0; k < ARRAY_SIZE(priv->ch); k++) {
		ch = &priv->ch[k];

		if (!ch->enabled)
			continue;

362 363 364 365 366
		/* Frame Start */
		if (ldintr & LDINTR_FS) {
			if (is_sub == lcdc_chan_is_sublcd(ch)) {
				ch->frame_end = 1;
				wake_up(&ch->frame_end_wait);
367

368 369 370 371 372
				sh_mobile_lcdc_clk_off(priv);
			}
		}

		/* VSYNC End */
373 374
		if (ldintr & LDINTR_VES)
			complete(&ch->vsync_completion);
375 376
	}

377 378 379
	return IRQ_HANDLED;
}

M
Magnus Damm 已提交
380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407
static void sh_mobile_lcdc_start_stop(struct sh_mobile_lcdc_priv *priv,
				      int start)
{
	unsigned long tmp = lcdc_read(priv, _LDCNT2R);
	int k;

	/* start or stop the lcdc */
	if (start)
		lcdc_write(priv, _LDCNT2R, tmp | START_LCDC);
	else
		lcdc_write(priv, _LDCNT2R, tmp & ~START_LCDC);

	/* wait until power is applied/stopped on all channels */
	for (k = 0; k < ARRAY_SIZE(priv->ch); k++)
		if (lcdc_read(priv, _LDCNT2R) & priv->ch[k].enabled)
			while (1) {
				tmp = lcdc_read_chan(&priv->ch[k], LDPMR) & 3;
				if (start && tmp == 3)
					break;
				if (!start && tmp == 0)
					break;
				cpu_relax();
			}

	if (!start)
		lcdc_write(priv, _LDDCKSTPR, 1); /* stop dotclock */
}

408 409
static void sh_mobile_lcdc_geometry(struct sh_mobile_lcdc_chan *ch)
{
410 411
	struct fb_var_screeninfo *var = &ch->info->var, *display_var = &ch->display_var;
	unsigned long h_total, hsync_pos, display_h_total;
412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428
	u32 tmp;

	tmp = ch->ldmt1r_value;
	tmp |= (var->sync & FB_SYNC_VERT_HIGH_ACT) ? 0 : 1 << 28;
	tmp |= (var->sync & FB_SYNC_HOR_HIGH_ACT) ? 0 : 1 << 27;
	tmp |= (ch->cfg.flags & LCDC_FLAGS_DWPOL) ? 1 << 26 : 0;
	tmp |= (ch->cfg.flags & LCDC_FLAGS_DIPOL) ? 1 << 25 : 0;
	tmp |= (ch->cfg.flags & LCDC_FLAGS_DAPOL) ? 1 << 24 : 0;
	tmp |= (ch->cfg.flags & LCDC_FLAGS_HSCNT) ? 1 << 17 : 0;
	tmp |= (ch->cfg.flags & LCDC_FLAGS_DWCNT) ? 1 << 16 : 0;
	lcdc_write_chan(ch, LDMT1R, tmp);

	/* setup SYS bus */
	lcdc_write_chan(ch, LDMT2R, ch->cfg.sys_bus_cfg.ldmt2r);
	lcdc_write_chan(ch, LDMT3R, ch->cfg.sys_bus_cfg.ldmt3r);

	/* horizontal configuration */
429 430
	h_total = display_var->xres + display_var->hsync_len +
		display_var->left_margin + display_var->right_margin;
431
	tmp = h_total / 8; /* HTCN */
432
	tmp |= (min(display_var->xres, var->xres) / 8) << 16; /* HDCN */
433 434
	lcdc_write_chan(ch, LDHCNR, tmp);

435
	hsync_pos = display_var->xres + display_var->right_margin;
436
	tmp = hsync_pos / 8; /* HSYNP */
437
	tmp |= (display_var->hsync_len / 8) << 16; /* HSYNW */
438 439 440
	lcdc_write_chan(ch, LDHSYNR, tmp);

	/* vertical configuration */
441 442 443
	tmp = display_var->yres + display_var->vsync_len +
		display_var->upper_margin + display_var->lower_margin; /* VTLN */
	tmp |= min(display_var->yres, var->yres) << 16; /* VDLN */
444 445
	lcdc_write_chan(ch, LDVLNR, tmp);

446 447
	tmp = display_var->yres + display_var->lower_margin; /* VSYNP */
	tmp |= display_var->vsync_len << 16; /* VSYNW */
448 449 450
	lcdc_write_chan(ch, LDVSYNR, tmp);

	/* Adjust horizontal synchronisation for HDMI */
451 452 453 454 455
	display_h_total = display_var->xres + display_var->hsync_len +
		display_var->left_margin + display_var->right_margin;
	tmp = ((display_var->xres & 7) << 24) |
		((display_h_total & 7) << 16) |
		((display_var->hsync_len & 7) << 8) |
456 457 458 459
		hsync_pos;
	lcdc_write_chan(ch, LDHAJR, tmp);
}

M
Magnus Damm 已提交
460 461 462 463 464
static int sh_mobile_lcdc_start(struct sh_mobile_lcdc_priv *priv)
{
	struct sh_mobile_lcdc_chan *ch;
	struct sh_mobile_lcdc_board_cfg	*board_cfg;
	unsigned long tmp;
465
	int bpp = 0;
M
Magnus Damm 已提交
466 467 468
	int k, m;
	int ret = 0;

469
	/* enable clocks before accessing the hardware */
470 471
	for (k = 0; k < ARRAY_SIZE(priv->ch); k++) {
		if (priv->ch[k].enabled) {
472
			sh_mobile_lcdc_clk_on(priv);
473 474 475 476
			if (!bpp)
				bpp = priv->ch[k].info->var.bits_per_pixel;
		}
	}
477

M
Magnus Damm 已提交
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 504 505 506 507 508 509
	/* reset */
	lcdc_write(priv, _LDCNT2R, lcdc_read(priv, _LDCNT2R) | LCDC_RESET);
	lcdc_wait_bit(priv, _LDCNT2R, LCDC_RESET, 0);

	/* enable LCDC channels */
	tmp = lcdc_read(priv, _LDCNT2R);
	tmp |= priv->ch[0].enabled;
	tmp |= priv->ch[1].enabled;
	lcdc_write(priv, _LDCNT2R, tmp);

	/* read data from external memory, avoid using the BEU for now */
	lcdc_write(priv, _LDCNT2R, lcdc_read(priv, _LDCNT2R) & ~DISPLAY_BEU);

	/* stop the lcdc first */
	sh_mobile_lcdc_start_stop(priv, 0);

	/* configure clocks */
	tmp = priv->lddckr;
	for (k = 0; k < ARRAY_SIZE(priv->ch); k++) {
		ch = &priv->ch[k];

		if (!priv->ch[k].enabled)
			continue;

		m = ch->cfg.clock_divider;
		if (!m)
			continue;

		if (m == 1)
			m = 1 << 6;
		tmp |= m << (lcdc_chan_is_sublcd(ch) ? 8 : 0);

510
		/* FIXME: sh7724 can only use 42, 48, 54 and 60 for the divider denominator */
511
		lcdc_write_chan(ch, LDDCKPAT1R, 0);
M
Magnus Damm 已提交
512 513 514 515 516 517 518 519 520
		lcdc_write_chan(ch, LDDCKPAT2R, (1 << (m/2)) - 1);
	}

	lcdc_write(priv, _LDDCKR, tmp);

	/* start dotclock again */
	lcdc_write(priv, _LDDCKSTPR, 0);
	lcdc_wait_bit(priv, _LDDCKSTPR, ~0, 0);

521
	/* interrupts are disabled to begin with */
M
Magnus Damm 已提交
522 523 524 525 526 527 528 529
	lcdc_write(priv, _LDINTR, 0);

	for (k = 0; k < ARRAY_SIZE(priv->ch); k++) {
		ch = &priv->ch[k];

		if (!ch->enabled)
			continue;

530
		sh_mobile_lcdc_geometry(ch);
M
Magnus Damm 已提交
531 532 533 534 535 536 537 538 539 540 541 542 543

		/* power supply */
		lcdc_write_chan(ch, LDPMR, 0);

		board_cfg = &ch->cfg.board_cfg;
		if (board_cfg->setup_sys)
			ret = board_cfg->setup_sys(board_cfg->board_data, ch,
						   &sh_mobile_lcdc_sys_bus_ops);
		if (ret)
			return ret;
	}

	/* word and long word swap */
544 545 546 547 548 549 550 551 552 553 554
	switch (bpp) {
	case 16:
		lcdc_write(priv, _LDDDSR, lcdc_read(priv, _LDDDSR) | 6);
		break;
	case 24:
		lcdc_write(priv, _LDDDSR, lcdc_read(priv, _LDDDSR) | 7);
		break;
	case 32:
		lcdc_write(priv, _LDDDSR, lcdc_read(priv, _LDDDSR) | 4);
		break;
	}
M
Magnus Damm 已提交
555 556 557 558 559 560 561 562 563

	for (k = 0; k < ARRAY_SIZE(priv->ch); k++) {
		ch = &priv->ch[k];

		if (!priv->ch[k].enabled)
			continue;

		/* set bpp format in PKF[4:0] */
		tmp = lcdc_read_chan(ch, LDDFR);
564
		tmp &= ~0x0001001f;
565 566 567 568 569 570 571 572 573 574
		switch (ch->info->var.bits_per_pixel) {
		case 16:
			tmp |= 0x03;
			break;
		case 24:
			tmp |= 0x0b;
			break;
		case 32:
			break;
		}
M
Magnus Damm 已提交
575 576 577
		lcdc_write_chan(ch, LDDFR, tmp);

		/* point out our frame buffer */
578
		lcdc_write_chan(ch, LDSA1R, ch->info->fix.smem_start);
M
Magnus Damm 已提交
579 580

		/* set line size */
581
		lcdc_write_chan(ch, LDMLSR, ch->info->fix.line_length);
M
Magnus Damm 已提交
582

583 584 585 586 587
		/* setup deferred io if SYS bus */
		tmp = ch->cfg.sys_bus_cfg.deferred_io_msec;
		if (ch->ldmt1r_value & (1 << 12) && tmp) {
			ch->defio.deferred_io = sh_mobile_lcdc_deferred_io;
			ch->defio.delay = msecs_to_jiffies(tmp);
588 589
			ch->info->fbdefio = &ch->defio;
			fb_deferred_io_init(ch->info);
590 591 592 593 594 595 596 597 598 599 600

			/* one-shot mode */
			lcdc_write_chan(ch, LDSM1R, 1);

			/* enable "Frame End Interrupt Enable" bit */
			lcdc_write(priv, _LDINTR, LDINTR_FE);

		} else {
			/* continuous read mode */
			lcdc_write_chan(ch, LDSM1R, 0);
		}
M
Magnus Damm 已提交
601 602 603 604 605 606 607
	}

	/* display output */
	lcdc_write(priv, _LDCNT1R, LCDC_ENABLE);

	/* start the lcdc */
	sh_mobile_lcdc_start_stop(priv, 1);
608
	priv->started = 1;
M
Magnus Damm 已提交
609 610 611 612

	/* tell the board code to enable the panel */
	for (k = 0; k < ARRAY_SIZE(priv->ch); k++) {
		ch = &priv->ch[k];
M
Magnus Damm 已提交
613 614 615
		if (!ch->enabled)
			continue;

M
Magnus Damm 已提交
616
		board_cfg = &ch->cfg.board_cfg;
617
		if (try_module_get(board_cfg->owner) && board_cfg->display_on) {
618
			board_cfg->display_on(board_cfg->board_data, ch->info);
619 620
			module_put(board_cfg->owner);
		}
M
Magnus Damm 已提交
621 622 623 624 625 626 627 628 629 630 631
	}

	return 0;
}

static void sh_mobile_lcdc_stop(struct sh_mobile_lcdc_priv *priv)
{
	struct sh_mobile_lcdc_chan *ch;
	struct sh_mobile_lcdc_board_cfg	*board_cfg;
	int k;

632
	/* clean up deferred io and ask board code to disable panel */
M
Magnus Damm 已提交
633 634
	for (k = 0; k < ARRAY_SIZE(priv->ch); k++) {
		ch = &priv->ch[k];
M
Magnus Damm 已提交
635 636
		if (!ch->enabled)
			continue;
637

638 639 640 641
		/* deferred io mode:
		 * flush frame, and wait for frame end interrupt
		 * clean up deferred io and enable clock
		 */
642
		if (ch->info && ch->info->fbdefio) {
643
			ch->frame_end = 0;
644
			schedule_delayed_work(&ch->info->deferred_work, 0);
645
			wait_event(ch->frame_end_wait, ch->frame_end);
646 647
			fb_deferred_io_cleanup(ch->info);
			ch->info->fbdefio = NULL;
648
			sh_mobile_lcdc_clk_on(priv);
649
		}
650 651

		board_cfg = &ch->cfg.board_cfg;
652
		if (try_module_get(board_cfg->owner) && board_cfg->display_off) {
653
			board_cfg->display_off(board_cfg->board_data);
654 655
			module_put(board_cfg->owner);
		}
M
Magnus Damm 已提交
656 657 658
	}

	/* stop the lcdc */
659 660 661 662
	if (priv->started) {
		sh_mobile_lcdc_start_stop(priv, 0);
		priv->started = 0;
	}
663

664 665 666 667
	/* stop clocks */
	for (k = 0; k < ARRAY_SIZE(priv->ch); k++)
		if (priv->ch[k].enabled)
			sh_mobile_lcdc_clk_off(priv);
M
Magnus Damm 已提交
668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708 709
}

static int sh_mobile_lcdc_check_interface(struct sh_mobile_lcdc_chan *ch)
{
	int ifm, miftyp;

	switch (ch->cfg.interface_type) {
	case RGB8: ifm = 0; miftyp = 0; break;
	case RGB9: ifm = 0; miftyp = 4; break;
	case RGB12A: ifm = 0; miftyp = 5; break;
	case RGB12B: ifm = 0; miftyp = 6; break;
	case RGB16: ifm = 0; miftyp = 7; break;
	case RGB18: ifm = 0; miftyp = 10; break;
	case RGB24: ifm = 0; miftyp = 11; break;
	case SYS8A: ifm = 1; miftyp = 0; break;
	case SYS8B: ifm = 1; miftyp = 1; break;
	case SYS8C: ifm = 1; miftyp = 2; break;
	case SYS8D: ifm = 1; miftyp = 3; break;
	case SYS9: ifm = 1; miftyp = 4; break;
	case SYS12: ifm = 1; miftyp = 5; break;
	case SYS16A: ifm = 1; miftyp = 7; break;
	case SYS16B: ifm = 1; miftyp = 8; break;
	case SYS16C: ifm = 1; miftyp = 9; break;
	case SYS18: ifm = 1; miftyp = 10; break;
	case SYS24: ifm = 1; miftyp = 11; break;
	default: goto bad;
	}

	/* SUBLCD only supports SYS interface */
	if (lcdc_chan_is_sublcd(ch)) {
		if (ifm == 0)
			goto bad;
		else
			ifm = 0;
	}

	ch->ldmt1r_value = (ifm << 12) | miftyp;
	return 0;
 bad:
	return -EINVAL;
}

710 711
static int sh_mobile_lcdc_setup_clocks(struct platform_device *pdev,
				       int clock_source,
M
Magnus Damm 已提交
712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727
				       struct sh_mobile_lcdc_priv *priv)
{
	char *str;
	int icksel;

	switch (clock_source) {
	case LCDC_CLK_BUS: str = "bus_clk"; icksel = 0; break;
	case LCDC_CLK_PERIPHERAL: str = "peripheral_clk"; icksel = 1; break;
	case LCDC_CLK_EXTERNAL: str = NULL; icksel = 2; break;
	default:
		return -EINVAL;
	}

	priv->lddckr = icksel << 16;

	if (str) {
728 729 730 731
		priv->dot_clk = clk_get(&pdev->dev, str);
		if (IS_ERR(priv->dot_clk)) {
			dev_err(&pdev->dev, "cannot get dot clock %s\n", str);
			return PTR_ERR(priv->dot_clk);
M
Magnus Damm 已提交
732 733
		}
	}
734 735 736 737 738

	/* Runtime PM support involves two step for this driver:
	 * 1) Enable Runtime PM
	 * 2) Force Runtime PM Resume since hardware is accessed from probe()
	 */
739
	priv->dev = &pdev->dev;
740 741
	pm_runtime_enable(priv->dev);
	pm_runtime_resume(priv->dev);
M
Magnus Damm 已提交
742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773
	return 0;
}

static int sh_mobile_lcdc_setcolreg(u_int regno,
				    u_int red, u_int green, u_int blue,
				    u_int transp, struct fb_info *info)
{
	u32 *palette = info->pseudo_palette;

	if (regno >= PALETTE_NR)
		return -EINVAL;

	/* only FB_VISUAL_TRUECOLOR supported */

	red >>= 16 - info->var.red.length;
	green >>= 16 - info->var.green.length;
	blue >>= 16 - info->var.blue.length;
	transp >>= 16 - info->var.transp.length;

	palette[regno] = (red << info->var.red.offset) |
	  (green << info->var.green.offset) |
	  (blue << info->var.blue.offset) |
	  (transp << info->var.transp.offset);

	return 0;
}

static struct fb_fix_screeninfo sh_mobile_lcdc_fix  = {
	.id =		"SH Mobile LCDC",
	.type =		FB_TYPE_PACKED_PIXELS,
	.visual =	FB_VISUAL_TRUECOLOR,
	.accel =	FB_ACCEL_NONE,
774 775 776
	.xpanstep =	0,
	.ypanstep =	1,
	.ywrapstep =	0,
M
Magnus Damm 已提交
777 778
};

779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799
static void sh_mobile_lcdc_fillrect(struct fb_info *info,
				    const struct fb_fillrect *rect)
{
	sys_fillrect(info, rect);
	sh_mobile_lcdc_deferred_io_touch(info);
}

static void sh_mobile_lcdc_copyarea(struct fb_info *info,
				    const struct fb_copyarea *area)
{
	sys_copyarea(info, area);
	sh_mobile_lcdc_deferred_io_touch(info);
}

static void sh_mobile_lcdc_imageblit(struct fb_info *info,
				     const struct fb_image *image)
{
	sys_imageblit(info, image);
	sh_mobile_lcdc_deferred_io_touch(info);
}

800 801 802 803
static int sh_mobile_fb_pan_display(struct fb_var_screeninfo *var,
				     struct fb_info *info)
{
	struct sh_mobile_lcdc_chan *ch = info->par;
804 805 806 807 808 809
	struct sh_mobile_lcdc_priv *priv = ch->lcdc;
	unsigned long ldrcntr;
	unsigned long new_pan_offset;

	new_pan_offset = (var->yoffset * info->fix.line_length) +
		(var->xoffset * (info->var.bits_per_pixel / 8));
810

811
	if (new_pan_offset == ch->pan_offset)
812 813
		return 0;	/* No change, do nothing */

814
	ldrcntr = lcdc_read(priv, _LDRCNTR);
815

816 817 818 819 820 821 822 823 824 825
	/* Set the source address for the next refresh */
	lcdc_write_chan_mirror(ch, LDSA1R, ch->dma_handle + new_pan_offset);
	if (lcdc_chan_is_sublcd(ch))
		lcdc_write(ch->lcdc, _LDRCNTR, ldrcntr ^ LDRCNTR_SRS);
	else
		lcdc_write(ch->lcdc, _LDRCNTR, ldrcntr ^ LDRCNTR_MRS);

	ch->pan_offset = new_pan_offset;

	sh_mobile_lcdc_deferred_io_touch(info);
826 827 828 829

	return 0;
}

830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865
static int sh_mobile_wait_for_vsync(struct fb_info *info)
{
	struct sh_mobile_lcdc_chan *ch = info->par;
	unsigned long ldintr;
	int ret;

	/* Enable VSync End interrupt */
	ldintr = lcdc_read(ch->lcdc, _LDINTR);
	ldintr |= LDINTR_VEE;
	lcdc_write(ch->lcdc, _LDINTR, ldintr);

	ret = wait_for_completion_interruptible_timeout(&ch->vsync_completion,
							msecs_to_jiffies(100));
	if (!ret)
		return -ETIMEDOUT;

	return 0;
}

static int sh_mobile_ioctl(struct fb_info *info, unsigned int cmd,
		       unsigned long arg)
{
	int retval;

	switch (cmd) {
	case FBIO_WAITFORVSYNC:
		retval = sh_mobile_wait_for_vsync(info);
		break;

	default:
		retval = -ENOIOCTLCMD;
		break;
	}
	return retval;
}

866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887
static void sh_mobile_fb_reconfig(struct fb_info *info)
{
	struct sh_mobile_lcdc_chan *ch = info->par;
	struct fb_videomode mode1, mode2;
	struct fb_event event;
	int evnt = FB_EVENT_MODE_CHANGE_ALL;

	if (ch->use_count > 1 || (ch->use_count == 1 && !info->fbcon_par))
		/* More framebuffer users are active */
		return;

	fb_var_to_videomode(&mode1, &ch->display_var);
	fb_var_to_videomode(&mode2, &info->var);

	if (fb_mode_is_equal(&mode1, &mode2))
		return;

	/* Display has been re-plugged, framebuffer is free now, reconfigure */
	if (fb_set_var(info, &ch->display_var) < 0)
		/* Couldn't reconfigure, hopefully, can continue as before */
		return;

888
	info->fix.line_length = mode1.xres * (ch->cfg.bpp / 8);
889 890 891 892 893 894 895

	/*
	 * fb_set_var() calls the notifier change internally, only if
	 * FBINFO_MISC_USEREVENT flag is set. Since we do not want to fake a
	 * user event, we have to call the chain ourselves.
	 */
	event.info = info;
896
	event.data = &mode1;
897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940
	fb_notifier_call_chain(evnt, &event);
}

/*
 * Locking: both .fb_release() and .fb_open() are called with info->lock held if
 * user == 1, or with console sem held, if user == 0.
 */
static int sh_mobile_release(struct fb_info *info, int user)
{
	struct sh_mobile_lcdc_chan *ch = info->par;

	mutex_lock(&ch->open_lock);
	dev_dbg(info->dev, "%s(): %d users\n", __func__, ch->use_count);

	ch->use_count--;

	/* Nothing to reconfigure, when called from fbcon */
	if (user) {
		acquire_console_sem();
		sh_mobile_fb_reconfig(info);
		release_console_sem();
	}

	mutex_unlock(&ch->open_lock);

	return 0;
}

static int sh_mobile_open(struct fb_info *info, int user)
{
	struct sh_mobile_lcdc_chan *ch = info->par;

	mutex_lock(&ch->open_lock);
	ch->use_count++;

	dev_dbg(info->dev, "%s(): %d users\n", __func__, ch->use_count);
	mutex_unlock(&ch->open_lock);

	return 0;
}

static int sh_mobile_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
{
	struct sh_mobile_lcdc_chan *ch = info->par;
941
	struct sh_mobile_lcdc_priv *p = ch->lcdc;
942

943
	if (var->xres > MAX_XRES || var->yres > MAX_YRES ||
944
	    var->xres * var->yres * (ch->cfg.bpp / 8) * 2 > info->fix.smem_len) {
945
		dev_warn(info->dev, "Invalid info: %u-%u-%u-%u x %u-%u-%u-%u @ %lukHz!\n",
946 947 948
			 var->left_margin, var->xres, var->right_margin, var->hsync_len,
			 var->upper_margin, var->yres, var->lower_margin, var->vsync_len,
			 PICOS2KHZ(var->pixclock));
949 950
		return -EINVAL;
	}
951 952 953 954 955 956 957 958 959 960 961 962 963 964

	/* only accept the forced_bpp for dual channel configurations */
	if (p->forced_bpp && p->forced_bpp != var->bits_per_pixel)
		return -EINVAL;

	switch (var->bits_per_pixel) {
	case 16: /* PKF[4:0] = 00011 - RGB 565 */
	case 24: /* PKF[4:0] = 01011 - RGB 888 */
	case 32: /* PKF[4:0] = 00000 - RGBA 888 */
		break;
	default:
		return -EINVAL;
	}

965 966
	return 0;
}
967

M
Magnus Damm 已提交
968
static struct fb_ops sh_mobile_lcdc_ops = {
969
	.owner          = THIS_MODULE,
M
Magnus Damm 已提交
970
	.fb_setcolreg	= sh_mobile_lcdc_setcolreg,
971 972
	.fb_read        = fb_sys_read,
	.fb_write       = fb_sys_write,
973 974 975
	.fb_fillrect	= sh_mobile_lcdc_fillrect,
	.fb_copyarea	= sh_mobile_lcdc_copyarea,
	.fb_imageblit	= sh_mobile_lcdc_imageblit,
976
	.fb_pan_display = sh_mobile_fb_pan_display,
977
	.fb_ioctl       = sh_mobile_ioctl,
978 979 980
	.fb_open	= sh_mobile_open,
	.fb_release	= sh_mobile_release,
	.fb_check_var	= sh_mobile_check_var,
M
Magnus Damm 已提交
981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996
};

static int sh_mobile_lcdc_set_bpp(struct fb_var_screeninfo *var, int bpp)
{
	switch (bpp) {
	case 16: /* PKF[4:0] = 00011 - RGB 565 */
		var->red.offset = 11;
		var->red.length = 5;
		var->green.offset = 5;
		var->green.length = 6;
		var->blue.offset = 0;
		var->blue.length = 5;
		var->transp.offset = 0;
		var->transp.length = 0;
		break;

997 998
	case 24: /* PKF[4:0] = 01011 - RGB 888 */
		var->red.offset = 16;
M
Magnus Damm 已提交
999
		var->red.length = 8;
1000
		var->green.offset = 8;
M
Magnus Damm 已提交
1001
		var->green.length = 8;
1002
		var->blue.offset = 0;
M
Magnus Damm 已提交
1003 1004 1005 1006
		var->blue.length = 8;
		var->transp.offset = 0;
		var->transp.length = 0;
		break;
1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017

	case 32: /* PKF[4:0] = 00000 - RGBA 888 */
		var->red.offset = 16;
		var->red.length = 8;
		var->green.offset = 8;
		var->green.length = 8;
		var->blue.offset = 0;
		var->blue.length = 8;
		var->transp.offset = 24;
		var->transp.length = 8;
		break;
M
Magnus Damm 已提交
1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028
	default:
		return -EINVAL;
	}
	var->bits_per_pixel = bpp;
	var->red.msb_right = 0;
	var->green.msb_right = 0;
	var->blue.msb_right = 0;
	var->transp.msb_right = 0;
	return 0;
}

1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043
static int sh_mobile_lcdc_suspend(struct device *dev)
{
	struct platform_device *pdev = to_platform_device(dev);

	sh_mobile_lcdc_stop(platform_get_drvdata(pdev));
	return 0;
}

static int sh_mobile_lcdc_resume(struct device *dev)
{
	struct platform_device *pdev = to_platform_device(dev);

	return sh_mobile_lcdc_start(platform_get_drvdata(pdev));
}

1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091
static int sh_mobile_lcdc_runtime_suspend(struct device *dev)
{
	struct platform_device *pdev = to_platform_device(dev);
	struct sh_mobile_lcdc_priv *p = platform_get_drvdata(pdev);
	struct sh_mobile_lcdc_chan *ch;
	int k, n;

	/* save per-channel registers */
	for (k = 0; k < ARRAY_SIZE(p->ch); k++) {
		ch = &p->ch[k];
		if (!ch->enabled)
			continue;
		for (n = 0; n < NR_CH_REGS; n++)
			ch->saved_ch_regs[n] = lcdc_read_chan(ch, n);
	}

	/* save shared registers */
	for (n = 0; n < NR_SHARED_REGS; n++)
		p->saved_shared_regs[n] = lcdc_read(p, lcdc_shared_regs[n]);

	/* turn off LCDC hardware */
	lcdc_write(p, _LDCNT1R, 0);
	return 0;
}

static int sh_mobile_lcdc_runtime_resume(struct device *dev)
{
	struct platform_device *pdev = to_platform_device(dev);
	struct sh_mobile_lcdc_priv *p = platform_get_drvdata(pdev);
	struct sh_mobile_lcdc_chan *ch;
	int k, n;

	/* restore per-channel registers */
	for (k = 0; k < ARRAY_SIZE(p->ch); k++) {
		ch = &p->ch[k];
		if (!ch->enabled)
			continue;
		for (n = 0; n < NR_CH_REGS; n++)
			lcdc_write_chan(ch, n, ch->saved_ch_regs[n]);
	}

	/* restore shared registers */
	for (n = 0; n < NR_SHARED_REGS; n++)
		lcdc_write(p, lcdc_shared_regs[n], p->saved_shared_regs[n]);

	return 0;
}

1092
static const struct dev_pm_ops sh_mobile_lcdc_dev_pm_ops = {
1093 1094
	.suspend = sh_mobile_lcdc_suspend,
	.resume = sh_mobile_lcdc_resume,
1095 1096
	.runtime_suspend = sh_mobile_lcdc_runtime_suspend,
	.runtime_resume = sh_mobile_lcdc_runtime_resume,
1097 1098
};

1099
/* locking: called with info->lock held */
1100 1101 1102 1103 1104 1105 1106
static int sh_mobile_lcdc_notify(struct notifier_block *nb,
				 unsigned long action, void *data)
{
	struct fb_event *event = data;
	struct fb_info *info = event->info;
	struct sh_mobile_lcdc_chan *ch = info->par;
	struct sh_mobile_lcdc_board_cfg	*board_cfg = &ch->cfg.board_cfg;
1107
	int ret;
1108 1109

	if (&ch->lcdc->notifier != nb)
1110
		return NOTIFY_DONE;
1111 1112 1113 1114 1115 1116

	dev_dbg(info->dev, "%s(): action = %lu, data = %p\n",
		__func__, action, event->data);

	switch(action) {
	case FB_EVENT_SUSPEND:
1117
		if (try_module_get(board_cfg->owner) && board_cfg->display_off) {
1118
			board_cfg->display_off(board_cfg->board_data);
1119 1120
			module_put(board_cfg->owner);
		}
1121
		pm_runtime_put(info->device);
1122
		sh_mobile_lcdc_stop(ch->lcdc);
1123 1124
		break;
	case FB_EVENT_RESUME:
1125 1126 1127
		mutex_lock(&ch->open_lock);
		sh_mobile_fb_reconfig(info);
		mutex_unlock(&ch->open_lock);
1128 1129

		/* HDMI must be enabled before LCDC configuration */
1130
		if (try_module_get(board_cfg->owner) && board_cfg->display_on) {
1131
			board_cfg->display_on(board_cfg->board_data, info);
1132
			module_put(board_cfg->owner);
1133 1134
		}

1135 1136 1137
		ret = sh_mobile_lcdc_start(ch->lcdc);
		if (!ret)
			pm_runtime_get_sync(info->device);
1138 1139
	}

1140
	return NOTIFY_OK;
1141 1142
}

M
Magnus Damm 已提交
1143 1144
static int sh_mobile_lcdc_remove(struct platform_device *pdev);

1145
static int __devinit sh_mobile_lcdc_probe(struct platform_device *pdev)
M
Magnus Damm 已提交
1146 1147 1148
{
	struct fb_info *info;
	struct sh_mobile_lcdc_priv *priv;
1149
	struct sh_mobile_lcdc_info *pdata = pdev->dev.platform_data;
M
Magnus Damm 已提交
1150 1151 1152 1153 1154
	struct resource *res;
	int error;
	void *buf;
	int i, j;

1155
	if (!pdata) {
M
Magnus Damm 已提交
1156
		dev_err(&pdev->dev, "no platform data defined\n");
1157
		return -EINVAL;
M
Magnus Damm 已提交
1158 1159 1160
	}

	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1161 1162 1163
	i = platform_get_irq(pdev, 0);
	if (!res || i < 0) {
		dev_err(&pdev->dev, "cannot get platform resources\n");
1164
		return -ENOENT;
M
Magnus Damm 已提交
1165 1166 1167 1168 1169
	}

	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv) {
		dev_err(&pdev->dev, "cannot allocate device data\n");
1170
		return -ENOMEM;
M
Magnus Damm 已提交
1171 1172
	}

1173 1174
	platform_set_drvdata(pdev, priv);

1175
	error = request_irq(i, sh_mobile_lcdc_irq, IRQF_DISABLED,
1176
			    dev_name(&pdev->dev), priv);
1177 1178 1179 1180 1181 1182
	if (error) {
		dev_err(&pdev->dev, "unable to request irq\n");
		goto err1;
	}

	priv->irq = i;
1183
	atomic_set(&priv->hw_usecnt, -1);
M
Magnus Damm 已提交
1184 1185 1186

	j = 0;
	for (i = 0; i < ARRAY_SIZE(pdata->ch); i++) {
1187
		struct sh_mobile_lcdc_chan *ch = priv->ch + j;
M
Magnus Damm 已提交
1188

1189 1190
		ch->lcdc = priv;
		memcpy(&ch->cfg, &pdata->ch[i], sizeof(pdata->ch[i]));
M
Magnus Damm 已提交
1191

1192
		error = sh_mobile_lcdc_check_interface(ch);
M
Magnus Damm 已提交
1193 1194 1195 1196
		if (error) {
			dev_err(&pdev->dev, "unsupported interface type\n");
			goto err1;
		}
1197 1198 1199
		init_waitqueue_head(&ch->frame_end_wait);
		init_completion(&ch->vsync_completion);
		ch->pan_offset = 0;
M
Magnus Damm 已提交
1200 1201 1202

		switch (pdata->ch[i].chan) {
		case LCDC_CHAN_MAINLCD:
1203 1204
			ch->enabled = 1 << 1;
			ch->reg_offs = lcdc_offs_mainlcd;
M
Magnus Damm 已提交
1205 1206 1207
			j++;
			break;
		case LCDC_CHAN_SUBLCD:
1208 1209
			ch->enabled = 1 << 2;
			ch->reg_offs = lcdc_offs_sublcd;
M
Magnus Damm 已提交
1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220
			j++;
			break;
		}
	}

	if (!j) {
		dev_err(&pdev->dev, "no channels defined\n");
		error = -EINVAL;
		goto err1;
	}

1221 1222 1223 1224
	/* for dual channel LCDC (MAIN + SUB) force shared bpp setting */
	if (j == 2)
		priv->forced_bpp = pdata->ch[0].bpp;

1225 1226 1227 1228
	priv->base = ioremap_nocache(res->start, resource_size(res));
	if (!priv->base)
		goto err1;

1229
	error = sh_mobile_lcdc_setup_clocks(pdev, pdata->clock_source, priv);
M
Magnus Damm 已提交
1230 1231 1232 1233 1234 1235
	if (error) {
		dev_err(&pdev->dev, "unable to setup clocks\n");
		goto err1;
	}

	for (i = 0; i < j; i++) {
1236
		struct fb_var_screeninfo *var;
1237
		const struct fb_videomode *lcd_cfg, *max_cfg = NULL;
1238
		struct sh_mobile_lcdc_chan *ch = priv->ch + i;
1239 1240
		struct sh_mobile_lcdc_chan_cfg *cfg = &ch->cfg;
		const struct fb_videomode *mode = cfg->lcd_cfg;
1241 1242
		unsigned long max_size = 0;
		int k;
1243
		int num_cfg;
M
Magnus Damm 已提交
1244

1245 1246
		ch->info = framebuffer_alloc(0, &pdev->dev);
		if (!ch->info) {
1247 1248 1249 1250 1251
			dev_err(&pdev->dev, "unable to allocate fb_info\n");
			error = -ENOMEM;
			break;
		}

1252
		info = ch->info;
1253
		var = &info->var;
M
Magnus Damm 已提交
1254
		info->fbops = &sh_mobile_lcdc_ops;
1255
		info->par = ch;
1256 1257 1258

		mutex_init(&ch->open_lock);

1259 1260
		for (k = 0, lcd_cfg = mode;
		     k < cfg->num_cfg && lcd_cfg;
1261 1262 1263 1264 1265 1266 1267 1268 1269
		     k++, lcd_cfg++) {
			unsigned long size = lcd_cfg->yres * lcd_cfg->xres;

			if (size > max_size) {
				max_cfg = lcd_cfg;
				max_size = size;
			}
		}

1270
		if (!mode)
1271
			max_size = MAX_XRES * MAX_YRES;
1272 1273 1274
		else if (max_cfg)
			dev_dbg(&pdev->dev, "Found largest videomode %ux%u\n",
				max_cfg->xres, max_cfg->yres);
1275

M
Magnus Damm 已提交
1276
		info->fix = sh_mobile_lcdc_fix;
1277
		info->fix.smem_len = max_size * (cfg->bpp / 8) * 2;
M
Magnus Damm 已提交
1278

1279
		if (!mode) {
1280
			mode = &default_720p;
1281 1282
			num_cfg = 1;
		} else {
1283
			num_cfg = cfg->num_cfg;
1284 1285 1286
		}

		fb_videomode_to_modelist(mode, num_cfg, &info->modelist);
1287 1288

		fb_videomode_to_var(var, mode);
1289 1290
		var->width = cfg->lcd_size_cfg.width;
		var->height = cfg->lcd_size_cfg.height;
1291
		/* Default Y virtual resolution is 2x panel size */
1292 1293 1294 1295
		var->yres_virtual = var->yres * 2;
		var->activate = FB_ACTIVATE_NOW;

		error = sh_mobile_lcdc_set_bpp(var, cfg->bpp);
M
Magnus Damm 已提交
1296 1297 1298 1299
		if (error)
			break;

		buf = dma_alloc_coherent(&pdev->dev, info->fix.smem_len,
1300
					 &ch->dma_handle, GFP_KERNEL);
M
Magnus Damm 已提交
1301 1302 1303 1304 1305 1306
		if (!buf) {
			dev_err(&pdev->dev, "unable to allocate buffer\n");
			error = -ENOMEM;
			break;
		}

1307
		info->pseudo_palette = &ch->pseudo_palette;
M
Magnus Damm 已提交
1308 1309 1310 1311 1312 1313
		info->flags = FBINFO_FLAG_DEFAULT;

		error = fb_alloc_cmap(&info->cmap, PALETTE_NR, 0);
		if (error < 0) {
			dev_err(&pdev->dev, "unable to allocate cmap\n");
			dma_free_coherent(&pdev->dev, info->fix.smem_len,
1314
					  buf, ch->dma_handle);
M
Magnus Damm 已提交
1315 1316 1317
			break;
		}

1318
		info->fix.smem_start = ch->dma_handle;
1319
		info->fix.line_length = var->xres * (cfg->bpp / 8);
M
Magnus Damm 已提交
1320 1321
		info->screen_base = buf;
		info->device = &pdev->dev;
1322
		ch->display_var = *var;
M
Magnus Damm 已提交
1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334
	}

	if (error)
		goto err1;

	error = sh_mobile_lcdc_start(priv);
	if (error) {
		dev_err(&pdev->dev, "unable to start hardware\n");
		goto err1;
	}

	for (i = 0; i < j; i++) {
1335 1336
		struct sh_mobile_lcdc_chan *ch = priv->ch + i;

1337
		info = ch->info;
1338 1339

		if (info->fbdefio) {
1340
			ch->sglist = vmalloc(sizeof(struct scatterlist) *
1341
					info->fix.smem_len >> PAGE_SHIFT);
1342
			if (!ch->sglist) {
1343 1344 1345 1346 1347 1348
				dev_err(&pdev->dev, "cannot allocate sglist\n");
				goto err1;
			}
		}

		error = register_framebuffer(info);
M
Magnus Damm 已提交
1349 1350 1351 1352 1353 1354
		if (error < 0)
			goto err1;

		dev_info(info->dev,
			 "registered %s/%s as %dx%d %dbpp.\n",
			 pdev->name,
1355
			 (ch->cfg.chan == LCDC_CHAN_MAINLCD) ?
M
Magnus Damm 已提交
1356
			 "mainlcd" : "sublcd",
1357
			 info->var.xres, info->var.yres,
1358
			 ch->cfg.bpp);
1359 1360

		/* deferred io mode: disable clock to save power */
1361
		if (info->fbdefio || info->state == FBINFO_STATE_SUSPENDED)
1362
			sh_mobile_lcdc_clk_off(priv);
M
Magnus Damm 已提交
1363 1364
	}

1365 1366 1367 1368
	/* Failure ignored */
	priv->notifier.notifier_call = sh_mobile_lcdc_notify;
	fb_register_client(&priv->notifier);

M
Magnus Damm 已提交
1369
	return 0;
1370
err1:
M
Magnus Damm 已提交
1371
	sh_mobile_lcdc_remove(pdev);
1372

M
Magnus Damm 已提交
1373 1374 1375 1376 1377 1378 1379 1380 1381
	return error;
}

static int sh_mobile_lcdc_remove(struct platform_device *pdev)
{
	struct sh_mobile_lcdc_priv *priv = platform_get_drvdata(pdev);
	struct fb_info *info;
	int i;

1382 1383
	fb_unregister_client(&priv->notifier);

M
Magnus Damm 已提交
1384
	for (i = 0; i < ARRAY_SIZE(priv->ch); i++)
1385
		if (priv->ch[i].info && priv->ch[i].info->dev)
1386
			unregister_framebuffer(priv->ch[i].info);
M
Magnus Damm 已提交
1387 1388 1389 1390

	sh_mobile_lcdc_stop(priv);

	for (i = 0; i < ARRAY_SIZE(priv->ch); i++) {
1391
		info = priv->ch[i].info;
M
Magnus Damm 已提交
1392

1393
		if (!info || !info->device)
M
Magnus Damm 已提交
1394 1395
			continue;

1396 1397 1398
		if (priv->ch[i].sglist)
			vfree(priv->ch[i].sglist);

1399 1400 1401 1402
		if (info->screen_base)
			dma_free_coherent(&pdev->dev, info->fix.smem_len,
					  info->screen_base,
					  priv->ch[i].dma_handle);
M
Magnus Damm 已提交
1403
		fb_dealloc_cmap(&info->cmap);
1404
		framebuffer_release(info);
M
Magnus Damm 已提交
1405 1406
	}

1407 1408
	if (priv->dot_clk)
		clk_put(priv->dot_clk);
1409

1410 1411
	if (priv->dev)
		pm_runtime_disable(priv->dev);
M
Magnus Damm 已提交
1412 1413 1414 1415

	if (priv->base)
		iounmap(priv->base);

1416 1417
	if (priv->irq)
		free_irq(priv->irq, priv);
M
Magnus Damm 已提交
1418 1419 1420 1421 1422 1423 1424 1425
	kfree(priv);
	return 0;
}

static struct platform_driver sh_mobile_lcdc_driver = {
	.driver		= {
		.name		= "sh_mobile_lcdc_fb",
		.owner		= THIS_MODULE,
1426
		.pm		= &sh_mobile_lcdc_dev_pm_ops,
M
Magnus Damm 已提交
1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447
	},
	.probe		= sh_mobile_lcdc_probe,
	.remove		= sh_mobile_lcdc_remove,
};

static int __init sh_mobile_lcdc_init(void)
{
	return platform_driver_register(&sh_mobile_lcdc_driver);
}

static void __exit sh_mobile_lcdc_exit(void)
{
	platform_driver_unregister(&sh_mobile_lcdc_driver);
}

module_init(sh_mobile_lcdc_init);
module_exit(sh_mobile_lcdc_exit);

MODULE_DESCRIPTION("SuperH Mobile LCDC Framebuffer driver");
MODULE_AUTHOR("Magnus Damm <damm@opensource.se>");
MODULE_LICENSE("GPL v2");