apply.c 20.0 KB
Newer Older
T
Tomi Valkeinen 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40
/*
 * Copyright (C) 2011 Texas Instruments
 * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License version 2 as published by
 * the Free Software Foundation.
 *
 * 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.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program.  If not, see <http://www.gnu.org/licenses/>.
 */

#define DSS_SUBSYS_NAME "APPLY"

#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/spinlock.h>
#include <linux/jiffies.h>

#include <video/omapdss.h>

#include "dss.h"
#include "dss_features.h"

/*
 * We have 4 levels of cache for the dispc settings. First two are in SW and
 * the latter two in HW.
 *
 * +--------------------+
 * |overlay/manager_info|
 * +--------------------+
 *          v
 *        apply()
 *          v
 * +--------------------+
41
 * |       info         |
T
Tomi Valkeinen 已提交
42 43
 * +--------------------+
 *          v
44
 *      write_regs()
T
Tomi Valkeinen 已提交
45 46 47 48 49 50 51 52 53 54 55 56
 *          v
 * +--------------------+
 * |  shadow registers  |
 * +--------------------+
 *          v
 * VFP or lcd/digit_enable
 *          v
 * +--------------------+
 * |      registers     |
 * +--------------------+
 */

57
struct ovl_priv_data {
T
Tomi Valkeinen 已提交
58 59 60 61 62 63 64 65 66 67 68 69 70 71
	/* If true, cache changed, but not written to shadow registers. Set
	 * in apply(), cleared when registers written. */
	bool dirty;
	/* If true, shadow registers contain changed values not yet in real
	 * registers. Set when writing to shadow registers, cleared at
	 * VSYNC/EVSYNC */
	bool shadow_dirty;

	struct omap_overlay_info info;

	enum omap_channel channel;

	u32 fifo_low;
	u32 fifo_high;
72 73 74 75 76 77

	bool extra_info_dirty;
	bool shadow_extra_info_dirty;

	bool enabled;

T
Tomi Valkeinen 已提交
78 79
};

80
struct mgr_priv_data {
T
Tomi Valkeinen 已提交
81 82 83 84 85 86 87 88 89 90 91 92
	/* If true, cache changed, but not written to shadow registers. Set
	 * in apply(), cleared when registers written. */
	bool dirty;
	/* If true, shadow registers contain changed values not yet in real
	 * registers. Set when writing to shadow registers, cleared at
	 * VSYNC/EVSYNC */
	bool shadow_dirty;

	struct omap_overlay_manager_info info;

	bool manual_update;
	bool do_manual_update;
93

94 95 96 97
	/* If true, GO bit is up and shadow registers cannot be written.
	 * Never true for manual update displays */
	bool busy;

98 99
	/* If true, a display is enabled using this manager */
	bool enabled;
T
Tomi Valkeinen 已提交
100 101 102
};

static struct {
103
	struct ovl_priv_data ovl_priv_data_array[MAX_DSS_OVERLAYS];
104
	struct mgr_priv_data mgr_priv_data_array[MAX_DSS_MANAGERS];
T
Tomi Valkeinen 已提交
105 106

	bool irq_enabled;
107
} dss_data;
T
Tomi Valkeinen 已提交
108

109
/* protects dss_data */
110
static spinlock_t data_lock;
T
Tomi Valkeinen 已提交
111 112
/* lock for blocking functions */
static DEFINE_MUTEX(apply_lock);
113

114 115
static struct ovl_priv_data *get_ovl_priv(struct omap_overlay *ovl)
{
116
	return &dss_data.ovl_priv_data_array[ovl->id];
117 118
}

119 120
static struct mgr_priv_data *get_mgr_priv(struct omap_overlay_manager *mgr)
{
121
	return &dss_data.mgr_priv_data_array[mgr->id];
122 123
}

T
Tomi Valkeinen 已提交
124 125
void dss_apply_init(void)
{
126
	spin_lock_init(&data_lock);
T
Tomi Valkeinen 已提交
127 128 129 130 131 132 133 134 135 136 137 138 139 140 141
}

static bool ovl_manual_update(struct omap_overlay *ovl)
{
	return ovl->manager->device->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE;
}

static bool mgr_manual_update(struct omap_overlay_manager *mgr)
{
	return mgr->device->caps & OMAP_DSS_DISPLAY_CAP_MANUAL_UPDATE;
}

int dss_mgr_wait_for_go(struct omap_overlay_manager *mgr)
{
	unsigned long timeout = msecs_to_jiffies(500);
142
	struct mgr_priv_data *mp;
T
Tomi Valkeinen 已提交
143 144 145 146 147 148 149 150 151 152 153
	u32 irq;
	int r;
	int i;
	struct omap_dss_device *dssdev = mgr->device;

	if (!dssdev || dssdev->state != OMAP_DSS_DISPLAY_ACTIVE)
		return 0;

	if (mgr_manual_update(mgr))
		return 0;

154
	irq = dispc_mgr_get_vsync_irq(mgr->id);
T
Tomi Valkeinen 已提交
155

156
	mp = get_mgr_priv(mgr);
T
Tomi Valkeinen 已提交
157 158 159 160 161
	i = 0;
	while (1) {
		unsigned long flags;
		bool shadow_dirty, dirty;

162
		spin_lock_irqsave(&data_lock, flags);
163 164
		dirty = mp->dirty;
		shadow_dirty = mp->shadow_dirty;
165
		spin_unlock_irqrestore(&data_lock, flags);
T
Tomi Valkeinen 已提交
166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199

		if (!dirty && !shadow_dirty) {
			r = 0;
			break;
		}

		/* 4 iterations is the worst case:
		 * 1 - initial iteration, dirty = true (between VFP and VSYNC)
		 * 2 - first VSYNC, dirty = true
		 * 3 - dirty = false, shadow_dirty = true
		 * 4 - shadow_dirty = false */
		if (i++ == 3) {
			DSSERR("mgr(%d)->wait_for_go() not finishing\n",
					mgr->id);
			r = 0;
			break;
		}

		r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);
		if (r == -ERESTARTSYS)
			break;

		if (r) {
			DSSERR("mgr(%d)->wait_for_go() timeout\n", mgr->id);
			break;
		}
	}

	return r;
}

int dss_mgr_wait_for_go_ovl(struct omap_overlay *ovl)
{
	unsigned long timeout = msecs_to_jiffies(500);
200
	struct ovl_priv_data *op;
T
Tomi Valkeinen 已提交
201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216
	struct omap_dss_device *dssdev;
	u32 irq;
	int r;
	int i;

	if (!ovl->manager)
		return 0;

	dssdev = ovl->manager->device;

	if (!dssdev || dssdev->state != OMAP_DSS_DISPLAY_ACTIVE)
		return 0;

	if (ovl_manual_update(ovl))
		return 0;

217
	irq = dispc_mgr_get_vsync_irq(ovl->manager->id);
T
Tomi Valkeinen 已提交
218

219
	op = get_ovl_priv(ovl);
T
Tomi Valkeinen 已提交
220 221 222 223 224
	i = 0;
	while (1) {
		unsigned long flags;
		bool shadow_dirty, dirty;

225
		spin_lock_irqsave(&data_lock, flags);
226 227
		dirty = op->dirty;
		shadow_dirty = op->shadow_dirty;
228
		spin_unlock_irqrestore(&data_lock, flags);
T
Tomi Valkeinen 已提交
229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259

		if (!dirty && !shadow_dirty) {
			r = 0;
			break;
		}

		/* 4 iterations is the worst case:
		 * 1 - initial iteration, dirty = true (between VFP and VSYNC)
		 * 2 - first VSYNC, dirty = true
		 * 3 - dirty = false, shadow_dirty = true
		 * 4 - shadow_dirty = false */
		if (i++ == 3) {
			DSSERR("ovl(%d)->wait_for_go() not finishing\n",
					ovl->id);
			r = 0;
			break;
		}

		r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);
		if (r == -ERESTARTSYS)
			break;

		if (r) {
			DSSERR("ovl(%d)->wait_for_go() timeout\n", ovl->id);
			break;
		}
	}

	return r;
}

260
static int dss_ovl_write_regs(struct omap_overlay *ovl)
T
Tomi Valkeinen 已提交
261
{
262
	struct ovl_priv_data *op;
T
Tomi Valkeinen 已提交
263 264 265 266
	struct omap_overlay_info *oi;
	bool ilace, replication;
	int r;

267
	DSSDBGF("%d", ovl->id);
T
Tomi Valkeinen 已提交
268

269 270
	op = get_ovl_priv(ovl);
	oi = &op->info;
T
Tomi Valkeinen 已提交
271

272
	if (!op->enabled)
T
Tomi Valkeinen 已提交
273 274 275 276 277 278
		return 0;

	replication = dss_use_replication(ovl->manager->device, oi->color_mode);

	ilace = ovl->manager->device->type == OMAP_DISPLAY_TYPE_VENC;

279
	dispc_ovl_set_channel_out(ovl->id, op->channel);
T
Tomi Valkeinen 已提交
280

281
	r = dispc_ovl_setup(ovl->id, oi, ilace, replication);
T
Tomi Valkeinen 已提交
282 283
	if (r) {
		/* this shouldn't happen */
284 285
		DSSERR("dispc_ovl_setup failed for ovl %d\n", ovl->id);
		dispc_ovl_enable(ovl->id, 0);
T
Tomi Valkeinen 已提交
286 287 288
		return r;
	}

289
	dispc_ovl_set_fifo_threshold(ovl->id, op->fifo_low, op->fifo_high);
T
Tomi Valkeinen 已提交
290 291 292 293

	return 0;
}

294 295 296 297 298 299 300 301 302 303 304 305
static void dss_ovl_write_regs_extra(struct omap_overlay *ovl)
{
	struct ovl_priv_data *op = get_ovl_priv(ovl);

	DSSDBGF("%d", ovl->id);

	/* note: write also when op->enabled == false, so that the ovl gets
	 * disabled */

	dispc_ovl_enable(ovl->id, op->enabled);
}

306
static void dss_mgr_write_regs(struct omap_overlay_manager *mgr)
T
Tomi Valkeinen 已提交
307
{
308
	struct mgr_priv_data *mp;
T
Tomi Valkeinen 已提交
309 310
	struct omap_overlay_manager_info *mi;

311
	DSSDBGF("%d", mgr->id);
T
Tomi Valkeinen 已提交
312

313 314
	mp = get_mgr_priv(mgr);
	mi = &mp->info;
T
Tomi Valkeinen 已提交
315

316
	dispc_mgr_setup(mgr->id, mi);
T
Tomi Valkeinen 已提交
317 318
}

319
/* dss_write_regs() tries to write values from cache to shadow registers.
T
Tomi Valkeinen 已提交
320 321 322
 * It writes only to those managers/overlays that are not busy.
 * returns 0 if everything could be written to shadow registers.
 * returns 1 if not everything could be written to shadow registers. */
323
static int dss_write_regs(void)
T
Tomi Valkeinen 已提交
324
{
325 326
	struct omap_overlay *ovl;
	struct omap_overlay_manager *mgr;
327
	struct ovl_priv_data *op;
328
	struct mgr_priv_data *mp;
T
Tomi Valkeinen 已提交
329 330 331 332
	const int num_ovls = dss_feat_get_num_ovls();
	const int num_mgrs = dss_feat_get_num_mgrs();
	int i;
	int r;
333
	bool mgr_go[MAX_DSS_MANAGERS] = { false };
T
Tomi Valkeinen 已提交
334 335 336 337 338 339 340
	bool busy;

	r = 0;
	busy = false;

	/* Commit overlay settings */
	for (i = 0; i < num_ovls; ++i) {
341
		ovl = omap_dss_get_overlay(i);
342
		op = get_ovl_priv(ovl);
T
Tomi Valkeinen 已提交
343

344
		if (!op->dirty)
T
Tomi Valkeinen 已提交
345 346
			continue;

347 348 349
		mp = get_mgr_priv(ovl->manager);

		if (mp->manual_update && !mp->do_manual_update)
T
Tomi Valkeinen 已提交
350 351
			continue;

352
		if (mp->busy) {
T
Tomi Valkeinen 已提交
353 354 355 356
			busy = true;
			continue;
		}

357
		r = dss_ovl_write_regs(ovl);
T
Tomi Valkeinen 已提交
358
		if (r)
359
			DSSERR("dss_ovl_write_regs %d failed\n", i);
T
Tomi Valkeinen 已提交
360

361 362 363
		op->dirty = false;
		op->shadow_dirty = true;
		mgr_go[op->channel] = true;
T
Tomi Valkeinen 已提交
364 365
	}

366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389
	for (i = 0; i < num_ovls; ++i) {
		ovl = omap_dss_get_overlay(i);
		op = get_ovl_priv(ovl);

		if (!op->extra_info_dirty)
			continue;

		mp = get_mgr_priv(ovl->manager);

		if (mp->manual_update && !mp->do_manual_update)
			continue;

		if (mp->busy) {
			busy = true;
			continue;
		}

		dss_ovl_write_regs_extra(ovl);

		op->extra_info_dirty = false;
		op->shadow_extra_info_dirty = true;
		mgr_go[op->channel] = true;
	}

T
Tomi Valkeinen 已提交
390 391
	/* Commit manager settings */
	for (i = 0; i < num_mgrs; ++i) {
392
		mgr = omap_dss_get_overlay_manager(i);
393
		mp = get_mgr_priv(mgr);
T
Tomi Valkeinen 已提交
394

395
		if (!mp->dirty)
T
Tomi Valkeinen 已提交
396 397
			continue;

398
		if (mp->manual_update && !mp->do_manual_update)
T
Tomi Valkeinen 已提交
399 400
			continue;

401
		if (mp->busy) {
T
Tomi Valkeinen 已提交
402 403 404 405
			busy = true;
			continue;
		}

406
		dss_mgr_write_regs(mgr);
407 408
		mp->dirty = false;
		mp->shadow_dirty = true;
T
Tomi Valkeinen 已提交
409 410 411 412 413
		mgr_go[i] = true;
	}

	/* set GO */
	for (i = 0; i < num_mgrs; ++i) {
414 415
		mgr = omap_dss_get_overlay_manager(i);
		mp = get_mgr_priv(mgr);
T
Tomi Valkeinen 已提交
416 417 418 419 420 421 422

		if (!mgr_go[i])
			continue;

		/* We don't need GO with manual update display. LCD iface will
		 * always be turned off after frame, and new settings will be
		 * taken in to use at next update */
423 424
		if (!mp->manual_update) {
			mp->busy = true;
T
Tomi Valkeinen 已提交
425
			dispc_mgr_go(i);
426
		}
T
Tomi Valkeinen 已提交
427 428 429 430 431 432 433 434 435 436 437 438
	}

	if (busy)
		r = 1;
	else
		r = 0;

	return r;
}

void dss_mgr_start_update(struct omap_overlay_manager *mgr)
{
439
	struct mgr_priv_data *mp = get_mgr_priv(mgr);
440
	struct ovl_priv_data *op;
441
	struct omap_overlay *ovl;
442 443 444
	unsigned long flags;

	spin_lock_irqsave(&data_lock, flags);
T
Tomi Valkeinen 已提交
445

446
	mp->do_manual_update = true;
447
	dss_write_regs();
448
	mp->do_manual_update = false;
T
Tomi Valkeinen 已提交
449

450
	list_for_each_entry(ovl, &mgr->overlays, list) {
451 452
		op = get_ovl_priv(ovl);
		op->shadow_dirty = false;
453
		op->shadow_extra_info_dirty = false;
T
Tomi Valkeinen 已提交
454 455
	}

456
	mp->shadow_dirty = false;
T
Tomi Valkeinen 已提交
457

458
	dispc_mgr_enable(mgr->id, true);
459 460

	spin_unlock_irqrestore(&data_lock, flags);
T
Tomi Valkeinen 已提交
461 462
}

463 464 465 466
static void dss_apply_irq_handler(void *data, u32 mask);

static void dss_register_vsync_isr(void)
{
467
	const int num_mgrs = dss_feat_get_num_mgrs();
468
	u32 mask;
469
	int r, i;
470

471 472 473
	mask = 0;
	for (i = 0; i < num_mgrs; ++i)
		mask |= dispc_mgr_get_vsync_irq(i);
474 475 476 477

	r = omap_dispc_register_isr(dss_apply_irq_handler, NULL, mask);
	WARN_ON(r);

478
	dss_data.irq_enabled = true;
479 480 481 482
}

static void dss_unregister_vsync_isr(void)
{
483
	const int num_mgrs = dss_feat_get_num_mgrs();
484
	u32 mask;
485
	int r, i;
486

487 488 489
	mask = 0;
	for (i = 0; i < num_mgrs; ++i)
		mask |= dispc_mgr_get_vsync_irq(i);
490 491 492 493

	r = omap_dispc_unregister_isr(dss_apply_irq_handler, NULL, mask);
	WARN_ON(r);

494
	dss_data.irq_enabled = false;
495 496
}

T
Tomi Valkeinen 已提交
497 498
static void dss_apply_irq_handler(void *data, u32 mask)
{
499
	struct omap_overlay *ovl;
500 501
	struct omap_overlay_manager *mgr;
	struct mgr_priv_data *mp;
502
	struct ovl_priv_data *op;
T
Tomi Valkeinen 已提交
503 504 505 506
	const int num_ovls = dss_feat_get_num_ovls();
	const int num_mgrs = dss_feat_get_num_mgrs();
	int i, r;

507
	spin_lock(&data_lock);
T
Tomi Valkeinen 已提交
508

509 510 511 512 513 514 515
	for (i = 0; i < num_mgrs; i++) {
		mgr = omap_dss_get_overlay_manager(i);
		mp = get_mgr_priv(mgr);

		mp->busy = dispc_mgr_go_busy(i);
	}

T
Tomi Valkeinen 已提交
516
	for (i = 0; i < num_ovls; ++i) {
517 518
		ovl = omap_dss_get_overlay(i);
		op = get_ovl_priv(ovl);
519 520 521 522 523 524

		if (!op->enabled)
			continue;

		mp = get_mgr_priv(ovl->manager);

525
		if (!mp->busy) {
526
			op->shadow_dirty = false;
527 528
			op->shadow_extra_info_dirty = false;
		}
T
Tomi Valkeinen 已提交
529 530 531
	}

	for (i = 0; i < num_mgrs; ++i) {
532 533
		mgr = omap_dss_get_overlay_manager(i);
		mp = get_mgr_priv(mgr);
534 535

		if (!mp->busy)
536
			mp->shadow_dirty = false;
T
Tomi Valkeinen 已提交
537 538
	}

539
	r = dss_write_regs();
T
Tomi Valkeinen 已提交
540 541 542 543
	if (r == 1)
		goto end;

	/* re-read busy flags */
544 545 546 547 548 549
	for (i = 0; i < num_mgrs; i++) {
		mgr = omap_dss_get_overlay_manager(i);
		mp = get_mgr_priv(mgr);

		mp->busy = dispc_mgr_go_busy(i);
	}
T
Tomi Valkeinen 已提交
550 551 552 553

	/* keep running as long as there are busy managers, so that
	 * we can collect overlay-applied information */
	for (i = 0; i < num_mgrs; ++i) {
554 555 556 557
		mgr = omap_dss_get_overlay_manager(i);
		mp = get_mgr_priv(mgr);

		if (mp->busy)
T
Tomi Valkeinen 已提交
558 559 560
			goto end;
	}

561
	dss_unregister_vsync_isr();
T
Tomi Valkeinen 已提交
562 563

end:
564
	spin_unlock(&data_lock);
T
Tomi Valkeinen 已提交
565 566
}

567
static void omap_dss_mgr_apply_ovl(struct omap_overlay *ovl)
T
Tomi Valkeinen 已提交
568
{
569
	struct ovl_priv_data *op;
T
Tomi Valkeinen 已提交
570

571
	op = get_ovl_priv(ovl);
T
Tomi Valkeinen 已提交
572 573 574 575 576 577 578

	if (ovl->manager_changed) {
		ovl->manager_changed = false;
		ovl->info_dirty  = true;
	}

	if (!ovl->info_dirty)
579
		return;
T
Tomi Valkeinen 已提交
580 581

	ovl->info_dirty = false;
582 583
	op->dirty = true;
	op->info = ovl->info;
T
Tomi Valkeinen 已提交
584

585
	op->channel = ovl->manager->id;
T
Tomi Valkeinen 已提交
586 587 588 589
}

static void omap_dss_mgr_apply_mgr(struct omap_overlay_manager *mgr)
{
590
	struct mgr_priv_data *mp;
T
Tomi Valkeinen 已提交
591

592
	mp = get_mgr_priv(mgr);
T
Tomi Valkeinen 已提交
593 594 595 596 597 598 599 600 601 602 603 604 605

	if (mgr->device_changed) {
		mgr->device_changed = false;
		mgr->info_dirty  = true;
	}

	if (!mgr->info_dirty)
		return;

	if (!mgr->device)
		return;

	mgr->info_dirty = false;
606 607
	mp->dirty = true;
	mp->info = mgr->info;
T
Tomi Valkeinen 已提交
608

609
	mp->manual_update = mgr_manual_update(mgr);
T
Tomi Valkeinen 已提交
610 611 612 613
}

static void omap_dss_mgr_apply_ovl_fifos(struct omap_overlay *ovl)
{
614
	struct ovl_priv_data *op;
T
Tomi Valkeinen 已提交
615 616 617
	struct omap_dss_device *dssdev;
	u32 size, burst_size;

618
	op = get_ovl_priv(ovl);
T
Tomi Valkeinen 已提交
619 620 621 622 623 624 625 626 627 628 629 630 631 632

	dssdev = ovl->manager->device;

	size = dispc_ovl_get_fifo_size(ovl->id);

	burst_size = dispc_ovl_get_burst_size(ovl->id);

	switch (dssdev->type) {
	case OMAP_DISPLAY_TYPE_DPI:
	case OMAP_DISPLAY_TYPE_DBI:
	case OMAP_DISPLAY_TYPE_SDI:
	case OMAP_DISPLAY_TYPE_VENC:
	case OMAP_DISPLAY_TYPE_HDMI:
		default_get_overlay_fifo_thresholds(ovl->id, size,
633 634
				burst_size, &op->fifo_low,
				&op->fifo_high);
T
Tomi Valkeinen 已提交
635 636 637 638
		break;
#ifdef CONFIG_OMAP2_DSS_DSI
	case OMAP_DISPLAY_TYPE_DSI:
		dsi_get_overlay_fifo_thresholds(ovl->id, size,
639 640
				burst_size, &op->fifo_low,
				&op->fifo_high);
T
Tomi Valkeinen 已提交
641 642 643 644 645 646 647 648 649
		break;
#endif
	default:
		BUG();
	}
}

int omap_dss_mgr_apply(struct omap_overlay_manager *mgr)
{
650
	int r;
T
Tomi Valkeinen 已提交
651
	unsigned long flags;
652
	struct omap_overlay *ovl;
653
	struct mgr_priv_data *mp = get_mgr_priv(mgr);
T
Tomi Valkeinen 已提交
654 655 656 657 658 659 660

	DSSDBG("omap_dss_mgr_apply(%s)\n", mgr->name);

	r = dispc_runtime_get();
	if (r)
		return r;

661
	spin_lock_irqsave(&data_lock, flags);
T
Tomi Valkeinen 已提交
662 663

	/* Configure overlays */
664
	list_for_each_entry(ovl, &mgr->overlays, list)
T
Tomi Valkeinen 已提交
665 666 667 668 669 670
		omap_dss_mgr_apply_ovl(ovl);

	/* Configure manager */
	omap_dss_mgr_apply_mgr(mgr);

	/* Configure overlay fifos */
671
	list_for_each_entry(ovl, &mgr->overlays, list)
T
Tomi Valkeinen 已提交
672 673 674
		omap_dss_mgr_apply_ovl_fifos(ovl);

	r = 0;
675
	if (mp->enabled && !mgr_manual_update(mgr)) {
676
		if (!dss_data.irq_enabled)
677
			dss_register_vsync_isr();
T
Tomi Valkeinen 已提交
678

679
		dss_write_regs();
680
	}
T
Tomi Valkeinen 已提交
681

682
	spin_unlock_irqrestore(&data_lock, flags);
T
Tomi Valkeinen 已提交
683 684 685 686 687 688

	dispc_runtime_put();

	return r;
}

689 690
void dss_mgr_enable(struct omap_overlay_manager *mgr)
{
691 692 693
	struct mgr_priv_data *mp = get_mgr_priv(mgr);
	unsigned long flags;

T
Tomi Valkeinen 已提交
694 695
	mutex_lock(&apply_lock);

696 697
	if (!mgr_manual_update(mgr))
		dispc_mgr_enable(mgr->id, true);
698 699 700 701 702 703

	spin_lock_irqsave(&data_lock, flags);

	mp->enabled = true;

	spin_unlock_irqrestore(&data_lock, flags);
T
Tomi Valkeinen 已提交
704 705

	mutex_unlock(&apply_lock);
706 707 708 709
}

void dss_mgr_disable(struct omap_overlay_manager *mgr)
{
710 711 712
	struct mgr_priv_data *mp = get_mgr_priv(mgr);
	unsigned long flags;

T
Tomi Valkeinen 已提交
713 714
	mutex_lock(&apply_lock);

715 716
	if (!mgr_manual_update(mgr))
		dispc_mgr_enable(mgr->id, false);
717 718 719 720 721 722

	spin_lock_irqsave(&data_lock, flags);

	mp->enabled = false;

	spin_unlock_irqrestore(&data_lock, flags);
T
Tomi Valkeinen 已提交
723 724

	mutex_unlock(&apply_lock);
725 726
}

727 728 729
int dss_mgr_set_info(struct omap_overlay_manager *mgr,
		struct omap_overlay_manager_info *info)
{
730 731 732 733
	unsigned long flags;

	spin_lock_irqsave(&data_lock, flags);

734 735 736
	mgr->info = *info;
	mgr->info_dirty = true;

737 738
	spin_unlock_irqrestore(&data_lock, flags);

739 740 741 742 743 744
	return 0;
}

void dss_mgr_get_info(struct omap_overlay_manager *mgr,
		struct omap_overlay_manager_info *info)
{
745 746 747 748
	unsigned long flags;

	spin_lock_irqsave(&data_lock, flags);

749
	*info = mgr->info;
750 751

	spin_unlock_irqrestore(&data_lock, flags);
752 753 754 755 756 757 758
}

int dss_mgr_set_device(struct omap_overlay_manager *mgr,
		struct omap_dss_device *dssdev)
{
	int r;

T
Tomi Valkeinen 已提交
759 760
	mutex_lock(&apply_lock);

761 762 763
	if (dssdev->manager) {
		DSSERR("display '%s' already has a manager '%s'\n",
			       dssdev->name, dssdev->manager->name);
T
Tomi Valkeinen 已提交
764 765
		r = -EINVAL;
		goto err;
766 767 768 769 770
	}

	if ((mgr->supported_displays & dssdev->type) == 0) {
		DSSERR("display '%s' does not support manager '%s'\n",
			       dssdev->name, mgr->name);
T
Tomi Valkeinen 已提交
771 772
		r = -EINVAL;
		goto err;
773 774 775 776 777 778
	}

	dssdev->manager = mgr;
	mgr->device = dssdev;
	mgr->device_changed = true;

T
Tomi Valkeinen 已提交
779 780
	mutex_unlock(&apply_lock);

781
	return 0;
T
Tomi Valkeinen 已提交
782 783 784
err:
	mutex_unlock(&apply_lock);
	return r;
785 786 787 788
}

int dss_mgr_unset_device(struct omap_overlay_manager *mgr)
{
T
Tomi Valkeinen 已提交
789 790 791 792
	int r;

	mutex_lock(&apply_lock);

793 794
	if (!mgr->device) {
		DSSERR("failed to unset display, display not set.\n");
T
Tomi Valkeinen 已提交
795 796
		r = -EINVAL;
		goto err;
797 798 799 800 801 802
	}

	/*
	 * Don't allow currently enabled displays to have the overlay manager
	 * pulled out from underneath them
	 */
T
Tomi Valkeinen 已提交
803 804 805 806
	if (mgr->device->state != OMAP_DSS_DISPLAY_DISABLED) {
		r = -EINVAL;
		goto err;
	}
807 808 809 810 811

	mgr->device->manager = NULL;
	mgr->device = NULL;
	mgr->device_changed = true;

T
Tomi Valkeinen 已提交
812 813
	mutex_unlock(&apply_lock);

814
	return 0;
T
Tomi Valkeinen 已提交
815 816 817
err:
	mutex_unlock(&apply_lock);
	return r;
818 819 820 821
}



822 823 824
int dss_ovl_set_info(struct omap_overlay *ovl,
		struct omap_overlay_info *info)
{
825 826 827 828
	unsigned long flags;

	spin_lock_irqsave(&data_lock, flags);

829 830 831
	ovl->info = *info;
	ovl->info_dirty = true;

832 833
	spin_unlock_irqrestore(&data_lock, flags);

834 835 836 837 838 839
	return 0;
}

void dss_ovl_get_info(struct omap_overlay *ovl,
		struct omap_overlay_info *info)
{
840 841 842 843
	unsigned long flags;

	spin_lock_irqsave(&data_lock, flags);

844
	*info = ovl->info;
845 846

	spin_unlock_irqrestore(&data_lock, flags);
847 848 849 850 851
}

int dss_ovl_set_manager(struct omap_overlay *ovl,
		struct omap_overlay_manager *mgr)
{
852 853
	struct ovl_priv_data *op = get_ovl_priv(ovl);
	unsigned long flags;
T
Tomi Valkeinen 已提交
854 855
	int r;

856 857 858
	if (!mgr)
		return -EINVAL;

T
Tomi Valkeinen 已提交
859 860
	mutex_lock(&apply_lock);

861 862 863
	if (ovl->manager) {
		DSSERR("overlay '%s' already has a manager '%s'\n",
				ovl->name, ovl->manager->name);
T
Tomi Valkeinen 已提交
864 865
		r = -EINVAL;
		goto err;
866 867
	}

868 869 870 871
	spin_lock_irqsave(&data_lock, flags);

	if (op->enabled) {
		spin_unlock_irqrestore(&data_lock, flags);
872
		DSSERR("overlay has to be disabled to change the manager\n");
T
Tomi Valkeinen 已提交
873 874
		r = -EINVAL;
		goto err;
875 876 877 878 879 880
	}

	ovl->manager = mgr;
	list_add_tail(&ovl->list, &mgr->overlays);
	ovl->manager_changed = true;

881 882
	spin_unlock_irqrestore(&data_lock, flags);

883 884 885 886 887 888 889 890 891 892 893 894 895
	/* XXX: When there is an overlay on a DSI manual update display, and
	 * the overlay is first disabled, then moved to tv, and enabled, we
	 * seem to get SYNC_LOST_DIGIT error.
	 *
	 * Waiting doesn't seem to help, but updating the manual update display
	 * after disabling the overlay seems to fix this. This hints that the
	 * overlay is perhaps somehow tied to the LCD output until the output
	 * is updated.
	 *
	 * Userspace workaround for this is to update the LCD after disabling
	 * the overlay, but before moving the overlay to TV.
	 */

T
Tomi Valkeinen 已提交
896 897
	mutex_unlock(&apply_lock);

898
	return 0;
T
Tomi Valkeinen 已提交
899 900 901
err:
	mutex_unlock(&apply_lock);
	return r;
902 903 904 905
}

int dss_ovl_unset_manager(struct omap_overlay *ovl)
{
906 907
	struct ovl_priv_data *op = get_ovl_priv(ovl);
	unsigned long flags;
T
Tomi Valkeinen 已提交
908 909 910 911
	int r;

	mutex_lock(&apply_lock);

912 913
	if (!ovl->manager) {
		DSSERR("failed to detach overlay: manager not set\n");
T
Tomi Valkeinen 已提交
914 915
		r = -EINVAL;
		goto err;
916 917
	}

918 919 920 921
	spin_lock_irqsave(&data_lock, flags);

	if (op->enabled) {
		spin_unlock_irqrestore(&data_lock, flags);
922
		DSSERR("overlay has to be disabled to unset the manager\n");
T
Tomi Valkeinen 已提交
923 924
		r = -EINVAL;
		goto err;
925 926 927 928 929 930
	}

	ovl->manager = NULL;
	list_del(&ovl->list);
	ovl->manager_changed = true;

931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003
	spin_unlock_irqrestore(&data_lock, flags);

	mutex_unlock(&apply_lock);

	return 0;
err:
	mutex_unlock(&apply_lock);
	return r;
}

bool dss_ovl_is_enabled(struct omap_overlay *ovl)
{
	struct ovl_priv_data *op = get_ovl_priv(ovl);
	unsigned long flags;
	bool e;

	spin_lock_irqsave(&data_lock, flags);

	e = op->enabled;

	spin_unlock_irqrestore(&data_lock, flags);

	return e;
}

int dss_ovl_enable(struct omap_overlay *ovl)
{
	struct ovl_priv_data *op = get_ovl_priv(ovl);
	unsigned long flags;
	int r;

	mutex_lock(&apply_lock);

	if (ovl->manager == NULL || ovl->manager->device == NULL) {
		r = -EINVAL;
		goto err;
	}

	spin_lock_irqsave(&data_lock, flags);

	op->enabled = true;
	op->extra_info_dirty = true;

	spin_unlock_irqrestore(&data_lock, flags);

	mutex_unlock(&apply_lock);

	return 0;
err:
	mutex_unlock(&apply_lock);
	return r;
}

int dss_ovl_disable(struct omap_overlay *ovl)
{
	struct ovl_priv_data *op = get_ovl_priv(ovl);
	unsigned long flags;
	int r;

	mutex_lock(&apply_lock);

	if (ovl->manager == NULL || ovl->manager->device == NULL) {
		r = -EINVAL;
		goto err;
	}

	spin_lock_irqsave(&data_lock, flags);

	op->enabled = false;
	op->extra_info_dirty = true;

	spin_unlock_irqrestore(&data_lock, flags);

T
Tomi Valkeinen 已提交
1004 1005
	mutex_unlock(&apply_lock);

1006
	return 0;
1007

T
Tomi Valkeinen 已提交
1008 1009 1010
err:
	mutex_unlock(&apply_lock);
	return r;
1011 1012
}