kernel/drivers/video/fbdev/omap2/dss/apply.c

   1 /*
   2  * Copyright (C) 2011 Texas Instruments
   3  * Author: Tomi Valkeinen <tomi.valkeinen@ti.com>
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of the GNU General Public License version 2 as published by
   7  * the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  12  * more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program.  If not, see <http://www.gnu.org/licenses/>.
  16  */
  17
  18 #define DSS_SUBSYS_NAME "APPLY"
  19
  20 #include <linux/kernel.h>
  21 #include <linux/module.h>
  22 #include <linux/slab.h>
  23 #include <linux/spinlock.h>
  24 #include <linux/jiffies.h>
  25
  26 #include <video/omapdss.h>
  27
  28 #include "dss.h"
  29 #include "dss_features.h"
  30 #include "dispc-compat.h"
  31
  32 /*
  33  * We have 4 levels of cache for the dispc settings. First two are in SW and
  34  * the latter two in HW.
  35  *
  36  *       set_info()
  37  *          v
  38  * +--------------------+
  39  * |     user_info      |
  40  * +--------------------+
  41  *          v
  42  *        apply()
  43  *          v
  44  * +--------------------+
  45  * |       info         |
  46  * +--------------------+
  47  *          v
  48  *      write_regs()
  49  *          v
  50  * +--------------------+
  51  * |  shadow registers  |
  52  * +--------------------+
  53  *          v
  54  * VFP or lcd/digit_enable
  55  *          v
  56  * +--------------------+
  57  * |      registers     |
  58  * +--------------------+
  59  */
  60
  61 struct ovl_priv_data {
  62
  63         bool user_info_dirty;
  64         struct omap_overlay_info user_info;
  65
  66         bool info_dirty;
  67         struct omap_overlay_info info;
  68
  69         bool shadow_info_dirty;
  70
  71         bool extra_info_dirty;
  72         bool shadow_extra_info_dirty;
  73
  74         bool enabled;
  75         u32 fifo_low, fifo_high;
  76
  77         /*
  78          * True if overlay is to be enabled. Used to check and calculate configs
  79          * for the overlay before it is enabled in the HW.
  80          */
  81         bool enabling;
  82 };
  83
  84 struct mgr_priv_data {
  85
  86         bool user_info_dirty;
  87         struct omap_overlay_manager_info user_info;
  88
  89         bool info_dirty;
  90         struct omap_overlay_manager_info info;
  91
  92         bool shadow_info_dirty;
  93
  94         /* If true, GO bit is up and shadow registers cannot be written.
  95          * Never true for manual update displays */
  96         bool busy;
  97
  98         /* If true, dispc output is enabled */
  99         bool updating;
 100
 101         /* If true, a display is enabled using this manager */
 102         bool enabled;
 103
 104         bool extra_info_dirty;
 105         bool shadow_extra_info_dirty;
 106
 107         struct omap_video_timings timings;
 108         struct dss_lcd_mgr_config lcd_config;
 109
 110         void (*framedone_handler)(void *);
 111         void *framedone_handler_data;
 112 };
 113
 114 static struct {
 115         struct ovl_priv_data ovl_priv_data_array[MAX_DSS_OVERLAYS];
 116         struct mgr_priv_data mgr_priv_data_array[MAX_DSS_MANAGERS];
 117
 118         bool irq_enabled;
 119 } dss_data;
 120
 121 /* protects dss_data */
 122 static spinlock_t data_lock;
 123 /* lock for blocking functions */
 124 static DEFINE_MUTEX(apply_lock);
 125 static DECLARE_COMPLETION(extra_updated_completion);
 126
 127 static void dss_register_vsync_isr(void);
 128
 129 static struct ovl_priv_data *get_ovl_priv(struct omap_overlay *ovl)
 130 {
 131         return &dss_data.ovl_priv_data_array[ovl->id];
 132 }
 133
 134 static struct mgr_priv_data *get_mgr_priv(struct omap_overlay_manager *mgr)
 135 {
 136         return &dss_data.mgr_priv_data_array[mgr->id];
 137 }
 138
 139 static void apply_init_priv(void)
 140 {
 141         const int num_ovls = dss_feat_get_num_ovls();
 142         struct mgr_priv_data *mp;
 143         int i;
 144
 145         spin_lock_init(&data_lock);
 146
 147         for (i = 0; i < num_ovls; ++i) {
 148                 struct ovl_priv_data *op;
 149
 150                 op = &dss_data.ovl_priv_data_array[i];
 151
 152                 op->info.color_mode = OMAP_DSS_COLOR_RGB16;
 153                 op->info.rotation_type = OMAP_DSS_ROT_DMA;
 154
 155                 op->info.global_alpha = 255;
 156
 157                 switch (i) {
 158                 case 0:
 159                         op->info.zorder = 0;
 160                         break;
 161                 case 1:
 162                         op->info.zorder =
 163                                 dss_has_feature(FEAT_ALPHA_FREE_ZORDER) ? 3 : 0;
 164                         break;
 165                 case 2:
 166                         op->info.zorder =
 167                                 dss_has_feature(FEAT_ALPHA_FREE_ZORDER) ? 2 : 0;
 168                         break;
 169                 case 3:
 170                         op->info.zorder =
 171                                 dss_has_feature(FEAT_ALPHA_FREE_ZORDER) ? 1 : 0;
 172                         break;
 173                 }
 174
 175                 op->user_info = op->info;
 176         }
 177
 178         /*
 179          * Initialize some of the lcd_config fields for TV manager, this lets
 180          * us prevent checking if the manager is LCD or TV at some places
 181          */
 182         mp = &dss_data.mgr_priv_data_array[OMAP_DSS_CHANNEL_DIGIT];
 183
 184         mp->lcd_config.video_port_width = 24;
 185         mp->lcd_config.clock_info.lck_div = 1;
 186         mp->lcd_config.clock_info.pck_div = 1;
 187 }
 188
 189 /*
 190  * A LCD manager's stallmode decides whether it is in manual or auto update. TV
 191  * manager is always auto update, stallmode field for TV manager is false by
 192  * default
 193  */
 194 static bool ovl_manual_update(struct omap_overlay *ovl)
 195 {
 196         struct mgr_priv_data *mp = get_mgr_priv(ovl->manager);
 197
 198         return mp->lcd_config.stallmode;
 199 }
 200
 201 static bool mgr_manual_update(struct omap_overlay_manager *mgr)
 202 {
 203         struct mgr_priv_data *mp = get_mgr_priv(mgr);
 204
 205         return mp->lcd_config.stallmode;
 206 }
 207
 208 static int dss_check_settings_low(struct omap_overlay_manager *mgr,
 209                 bool applying)
 210 {
 211         struct omap_overlay_info *oi;
 212         struct omap_overlay_manager_info *mi;
 213         struct omap_overlay *ovl;
 214         struct omap_overlay_info *ois[MAX_DSS_OVERLAYS];
 215         struct ovl_priv_data *op;
 216         struct mgr_priv_data *mp;
 217
 218         mp = get_mgr_priv(mgr);
 219
 220         if (!mp->enabled)
 221                 return 0;
 222
 223         if (applying && mp->user_info_dirty)
 224                 mi = &mp->user_info;
 225         else
 226                 mi = &mp->info;
 227
 228         /* collect the infos to be tested into the array */
 229         list_for_each_entry(ovl, &mgr->overlays, list) {
 230                 op = get_ovl_priv(ovl);
 231
 232                 if (!op->enabled && !op->enabling)
 233                         oi = NULL;
 234                 else if (applying && op->user_info_dirty)
 235                         oi = &op->user_info;
 236                 else
 237                         oi = &op->info;
 238
 239                 ois[ovl->id] = oi;
 240         }
 241
 242         return dss_mgr_check(mgr, mi, &mp->timings, &mp->lcd_config, ois);
 243 }
 244
 245 /*
 246  * check manager and overlay settings using overlay_info from data->info
 247  */
 248 static int dss_check_settings(struct omap_overlay_manager *mgr)
 249 {
 250         return dss_check_settings_low(mgr, false);
 251 }
 252
 253 /*
 254  * check manager and overlay settings using overlay_info from ovl->info if
 255  * dirty and from data->info otherwise
 256  */
 257 static int dss_check_settings_apply(struct omap_overlay_manager *mgr)
 258 {
 259         return dss_check_settings_low(mgr, true);
 260 }
 261
 262 static bool need_isr(void)
 263 {
 264         const int num_mgrs = dss_feat_get_num_mgrs();
 265         int i;
 266
 267         for (i = 0; i < num_mgrs; ++i) {
 268                 struct omap_overlay_manager *mgr;
 269                 struct mgr_priv_data *mp;
 270                 struct omap_overlay *ovl;
 271
 272                 mgr = omap_dss_get_overlay_manager(i);
 273                 mp = get_mgr_priv(mgr);
 274
 275                 if (!mp->enabled)
 276                         continue;
 277
 278                 if (mgr_manual_update(mgr)) {
 279                         /* to catch FRAMEDONE */
 280                         if (mp->updating)
 281                                 return true;
 282                 } else {
 283                         /* to catch GO bit going down */
 284                         if (mp->busy)
 285                                 return true;
 286
 287                         /* to write new values to registers */
 288                         if (mp->info_dirty)
 289                                 return true;
 290
 291                         /* to set GO bit */
 292                         if (mp->shadow_info_dirty)
 293                                 return true;
 294
 295                         /*
 296                          * NOTE: we don't check extra_info flags for disabled
 297                          * managers, once the manager is enabled, the extra_info
 298                          * related manager changes will be taken in by HW.
 299                          */
 300
 301                         /* to write new values to registers */
 302                         if (mp->extra_info_dirty)
 303                                 return true;
 304
 305                         /* to set GO bit */
 306                         if (mp->shadow_extra_info_dirty)
 307                                 return true;
 308
 309                         list_for_each_entry(ovl, &mgr->overlays, list) {
 310                                 struct ovl_priv_data *op;
 311
 312                                 op = get_ovl_priv(ovl);
 313
 314                                 /*
 315                                  * NOTE: we check extra_info flags even for
 316                                  * disabled overlays, as extra_infos need to be
 317                                  * always written.
 318                                  */
 319
 320                                 /* to write new values to registers */
 321                                 if (op->extra_info_dirty)
 322                                         return true;
 323
 324                                 /* to set GO bit */
 325                                 if (op->shadow_extra_info_dirty)
 326                                         return true;
 327
 328                                 if (!op->enabled)
 329                                         continue;
 330
 331                                 /* to write new values to registers */
 332                                 if (op->info_dirty)
 333                                         return true;
 334
 335                                 /* to set GO bit */
 336                                 if (op->shadow_info_dirty)
 337                                         return true;
 338                         }
 339                 }
 340         }
 341
 342         return false;
 343 }
 344
 345 static bool need_go(struct omap_overlay_manager *mgr)
 346 {
 347         struct omap_overlay *ovl;
 348         struct mgr_priv_data *mp;
 349         struct ovl_priv_data *op;
 350
 351         mp = get_mgr_priv(mgr);
 352
 353         if (mp->shadow_info_dirty || mp->shadow_extra_info_dirty)
 354                 return true;
 355
 356         list_for_each_entry(ovl, &mgr->overlays, list) {
 357                 op = get_ovl_priv(ovl);
 358                 if (op->shadow_info_dirty || op->shadow_extra_info_dirty)
 359                         return true;
 360         }
 361
 362         return false;
 363 }
 364
 365 /* returns true if an extra_info field is currently being updated */
 366 static bool extra_info_update_ongoing(void)
 367 {
 368         const int num_mgrs = dss_feat_get_num_mgrs();
 369         int i;
 370
 371         for (i = 0; i < num_mgrs; ++i) {
 372                 struct omap_overlay_manager *mgr;
 373                 struct omap_overlay *ovl;
 374                 struct mgr_priv_data *mp;
 375
 376                 mgr = omap_dss_get_overlay_manager(i);
 377                 mp = get_mgr_priv(mgr);
 378
 379                 if (!mp->enabled)
 380                         continue;
 381
 382                 if (!mp->updating)
 383                         continue;
 384
 385                 if (mp->extra_info_dirty || mp->shadow_extra_info_dirty)
 386                         return true;
 387
 388                 list_for_each_entry(ovl, &mgr->overlays, list) {
 389                         struct ovl_priv_data *op = get_ovl_priv(ovl);
 390
 391                         if (op->extra_info_dirty || op->shadow_extra_info_dirty)
 392                                 return true;
 393                 }
 394         }
 395
 396         return false;
 397 }
 398
 399 /* wait until no extra_info updates are pending */
 400 static void wait_pending_extra_info_updates(void)
 401 {
 402         bool updating;
 403         unsigned long flags;
 404         unsigned long t;
 405         int r;
 406
 407         spin_lock_irqsave(&data_lock, flags);
 408
 409         updating = extra_info_update_ongoing();
 410
 411         if (!updating) {
 412                 spin_unlock_irqrestore(&data_lock, flags);
 413                 return;
 414         }
 415
 416         init_completion(&extra_updated_completion);
 417
 418         spin_unlock_irqrestore(&data_lock, flags);
 419
 420         t = msecs_to_jiffies(500);
 421         r = wait_for_completion_timeout(&extra_updated_completion, t);
 422         if (r == 0)
 423                 DSSWARN("timeout in wait_pending_extra_info_updates\n");
 424 }
 425
 426 static struct omap_dss_device *dss_mgr_get_device(struct omap_overlay_manager *mgr)
 427 {
 428         struct omap_dss_device *dssdev;
 429
 430         dssdev = mgr->output;
 431         if (dssdev == NULL)
 432                 return NULL;
 433
 434         while (dssdev->dst)
 435                 dssdev = dssdev->dst;
 436
 437         if (dssdev->driver)
 438                 return dssdev;
 439         else
 440                 return NULL;
 441 }
 442
 443 static struct omap_dss_device *dss_ovl_get_device(struct omap_overlay *ovl)
 444 {
 445         return ovl->manager ? dss_mgr_get_device(ovl->manager) : NULL;
 446 }
 447
 448 static int dss_mgr_wait_for_vsync(struct omap_overlay_manager *mgr)
 449 {
 450         unsigned long timeout = msecs_to_jiffies(500);
 451         u32 irq;
 452         int r;
 453
 454         if (mgr->output == NULL)
 455                 return -ENODEV;
 456
 457         r = dispc_runtime_get();
 458         if (r)
 459                 return r;
 460
 461         switch (mgr->output->id) {
 462         case OMAP_DSS_OUTPUT_VENC:
 463                 irq = DISPC_IRQ_EVSYNC_ODD;
 464                 break;
 465         case OMAP_DSS_OUTPUT_HDMI:
 466                 irq = DISPC_IRQ_EVSYNC_EVEN;
 467                 break;
 468         default:
 469                 irq = dispc_mgr_get_vsync_irq(mgr->id);
 470                 break;
 471         }
 472
 473         r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);
 474
 475         dispc_runtime_put();
 476
 477         return r;
 478 }
 479
 480 static int dss_mgr_wait_for_go(struct omap_overlay_manager *mgr)
 481 {
 482         unsigned long timeout = msecs_to_jiffies(500);
 483         struct mgr_priv_data *mp = get_mgr_priv(mgr);
 484         u32 irq;
 485         unsigned long flags;
 486         int r;
 487         int i;
 488
 489         spin_lock_irqsave(&data_lock, flags);
 490
 491         if (mgr_manual_update(mgr)) {
 492                 spin_unlock_irqrestore(&data_lock, flags);
 493                 return 0;
 494         }
 495
 496         if (!mp->enabled) {
 497                 spin_unlock_irqrestore(&data_lock, flags);
 498                 return 0;
 499         }
 500
 501         spin_unlock_irqrestore(&data_lock, flags);
 502
 503         r = dispc_runtime_get();
 504         if (r)
 505                 return r;
 506
 507         irq = dispc_mgr_get_vsync_irq(mgr->id);
 508
 509         i = 0;
 510         while (1) {
 511                 bool shadow_dirty, dirty;
 512
 513                 spin_lock_irqsave(&data_lock, flags);
 514                 dirty = mp->info_dirty;
 515                 shadow_dirty = mp->shadow_info_dirty;
 516                 spin_unlock_irqrestore(&data_lock, flags);
 517
 518                 if (!dirty && !shadow_dirty) {
 519                         r = 0;
 520                         break;
 521                 }
 522
 523                 /* 4 iterations is the worst case:
 524                  * 1 - initial iteration, dirty = true (between VFP and VSYNC)
 525                  * 2 - first VSYNC, dirty = true
 526                  * 3 - dirty = false, shadow_dirty = true
 527                  * 4 - shadow_dirty = false */
 528                 if (i++ == 3) {
 529                         DSSERR("mgr(%d)->wait_for_go() not finishing\n",
 530                                         mgr->id);
 531                         r = 0;
 532                         break;
 533                 }
 534
 535                 r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);
 536                 if (r == -ERESTARTSYS)
 537                         break;
 538
 539                 if (r) {
 540                         DSSERR("mgr(%d)->wait_for_go() timeout\n", mgr->id);
 541                         break;
 542                 }
 543         }
 544
 545         dispc_runtime_put();
 546
 547         return r;
 548 }
 549
 550 static int dss_mgr_wait_for_go_ovl(struct omap_overlay *ovl)
 551 {
 552         unsigned long timeout = msecs_to_jiffies(500);
 553         struct ovl_priv_data *op;
 554         struct mgr_priv_data *mp;
 555         u32 irq;
 556         unsigned long flags;
 557         int r;
 558         int i;
 559
 560         if (!ovl->manager)
 561                 return 0;
 562
 563         mp = get_mgr_priv(ovl->manager);
 564
 565         spin_lock_irqsave(&data_lock, flags);
 566
 567         if (ovl_manual_update(ovl)) {
 568                 spin_unlock_irqrestore(&data_lock, flags);
 569                 return 0;
 570         }
 571
 572         if (!mp->enabled) {
 573                 spin_unlock_irqrestore(&data_lock, flags);
 574                 return 0;
 575         }
 576
 577         spin_unlock_irqrestore(&data_lock, flags);
 578
 579         r = dispc_runtime_get();
 580         if (r)
 581                 return r;
 582
 583         irq = dispc_mgr_get_vsync_irq(ovl->manager->id);
 584
 585         op = get_ovl_priv(ovl);
 586         i = 0;
 587         while (1) {
 588                 bool shadow_dirty, dirty;
 589
 590                 spin_lock_irqsave(&data_lock, flags);
 591                 dirty = op->info_dirty;
 592                 shadow_dirty = op->shadow_info_dirty;
 593                 spin_unlock_irqrestore(&data_lock, flags);
 594
 595                 if (!dirty && !shadow_dirty) {
 596                         r = 0;
 597                         break;
 598                 }
 599
 600                 /* 4 iterations is the worst case:
 601                  * 1 - initial iteration, dirty = true (between VFP and VSYNC)
 602                  * 2 - first VSYNC, dirty = true
 603                  * 3 - dirty = false, shadow_dirty = true
 604                  * 4 - shadow_dirty = false */
 605                 if (i++ == 3) {
 606                         DSSERR("ovl(%d)->wait_for_go() not finishing\n",
 607                                         ovl->id);
 608                         r = 0;
 609                         break;
 610                 }
 611
 612                 r = omap_dispc_wait_for_irq_interruptible_timeout(irq, timeout);
 613                 if (r == -ERESTARTSYS)
 614                         break;
 615
 616                 if (r) {
 617                         DSSERR("ovl(%d)->wait_for_go() timeout\n", ovl->id);
 618                         break;
 619                 }
 620         }
 621
 622         dispc_runtime_put();
 623
 624         return r;
 625 }
 626
 627 static void dss_ovl_write_regs(struct omap_overlay *ovl)
 628 {
 629         struct ovl_priv_data *op = get_ovl_priv(ovl);
 630         struct omap_overlay_info *oi;
 631         bool replication;
 632         struct mgr_priv_data *mp;
 633         int r;
 634
 635         DSSDBG("writing ovl %d regs\n", ovl->id);
 636
 637         if (!op->enabled || !op->info_dirty)
 638                 return;
 639
 640         oi = &op->info;
 641
 642         mp = get_mgr_priv(ovl->manager);
 643
 644         replication = dss_ovl_use_replication(mp->lcd_config, oi->color_mode);
 645
 646         r = dispc_ovl_setup(ovl->id, oi, replication, &mp->timings, false);
 647         if (r) {
 648                 /*
 649                  * We can't do much here, as this function can be called from
 650                  * vsync interrupt.
 651                  */
 652                 DSSERR("dispc_ovl_setup failed for ovl %d\n", ovl->id);
 653
 654                 /* This will leave fifo configurations in a nonoptimal state */
 655                 op->enabled = false;
 656                 dispc_ovl_enable(ovl->id, false);
 657                 return;
 658         }
 659
 660         op->info_dirty = false;
 661         if (mp->updating)
 662                 op->shadow_info_dirty = true;
 663 }
 664
 665 static void dss_ovl_write_regs_extra(struct omap_overlay *ovl)
 666 {
 667         struct ovl_priv_data *op = get_ovl_priv(ovl);
 668         struct mgr_priv_data *mp;
 669
 670         DSSDBG("writing ovl %d regs extra\n", ovl->id);
 671
 672         if (!op->extra_info_dirty)
 673                 return;
 674
 675         /* note: write also when op->enabled == false, so that the ovl gets
 676          * disabled */
 677
 678         dispc_ovl_enable(ovl->id, op->enabled);
 679         dispc_ovl_set_fifo_threshold(ovl->id, op->fifo_low, op->fifo_high);
 680
 681         mp = get_mgr_priv(ovl->manager);
 682
 683         op->extra_info_dirty = false;
 684         if (mp->updating)
 685                 op->shadow_extra_info_dirty = true;
 686 }
 687
 688 static void dss_mgr_write_regs(struct omap_overlay_manager *mgr)
 689 {
 690         struct mgr_priv_data *mp = get_mgr_priv(mgr);
 691         struct omap_overlay *ovl;
 692
 693         DSSDBG("writing mgr %d regs\n", mgr->id);
 694
 695         if (!mp->enabled)
 696                 return;
 697
 698         WARN_ON(mp->busy);
 699
 700         /* Commit overlay settings */
 701         list_for_each_entry(ovl, &mgr->overlays, list) {
 702                 dss_ovl_write_regs(ovl);
 703                 dss_ovl_write_regs_extra(ovl);
 704         }
 705
 706         if (mp->info_dirty) {
 707                 dispc_mgr_setup(mgr->id, &mp->info);
 708
 709                 mp->info_dirty = false;
 710                 if (mp->updating)
 711                         mp->shadow_info_dirty = true;
 712         }
 713 }
 714
 715 static void dss_mgr_write_regs_extra(struct omap_overlay_manager *mgr)
 716 {
 717         struct mgr_priv_data *mp = get_mgr_priv(mgr);
 718
 719         DSSDBG("writing mgr %d regs extra\n", mgr->id);
 720
 721         if (!mp->extra_info_dirty)
 722                 return;
 723
 724         dispc_mgr_set_timings(mgr->id, &mp->timings);
 725
 726         /* lcd_config parameters */
 727         if (dss_mgr_is_lcd(mgr->id))
 728                 dispc_mgr_set_lcd_config(mgr->id, &mp->lcd_config);
 729
 730         mp->extra_info_dirty = false;
 731         if (mp->updating)
 732                 mp->shadow_extra_info_dirty = true;
 733 }
 734
 735 static void dss_write_regs(void)
 736 {
 737         const int num_mgrs = omap_dss_get_num_overlay_managers();
 738         int i;
 739
 740         for (i = 0; i < num_mgrs; ++i) {
 741                 struct omap_overlay_manager *mgr;
 742                 struct mgr_priv_data *mp;
 743                 int r;
 744
 745                 mgr = omap_dss_get_overlay_manager(i);
 746                 mp = get_mgr_priv(mgr);
 747
 748                 if (!mp->enabled || mgr_manual_update(mgr) || mp->busy)
 749                         continue;
 750
 751                 r = dss_check_settings(mgr);
 752                 if (r) {
 753                         DSSERR("cannot write registers for manager %s: "
 754                                         "illegal configuration\n", mgr->name);
 755                         continue;
 756                 }
 757
 758                 dss_mgr_write_regs(mgr);
 759                 dss_mgr_write_regs_extra(mgr);
 760         }
 761 }
 762
 763 static void dss_set_go_bits(void)
 764 {
 765         const int num_mgrs = omap_dss_get_num_overlay_managers();
 766         int i;
 767
 768         for (i = 0; i < num_mgrs; ++i) {
 769                 struct omap_overlay_manager *mgr;
 770                 struct mgr_priv_data *mp;
 771
 772                 mgr = omap_dss_get_overlay_manager(i);
 773                 mp = get_mgr_priv(mgr);
 774
 775                 if (!mp->enabled || mgr_manual_update(mgr) || mp->busy)
 776                         continue;
 777
 778                 if (!need_go(mgr))
 779                         continue;
 780
 781                 mp->busy = true;
 782
 783                 if (!dss_data.irq_enabled && need_isr())
 784                         dss_register_vsync_isr();
 785
 786                 dispc_mgr_go(mgr->id);
 787         }
 788
 789 }
 790
 791 static void mgr_clear_shadow_dirty(struct omap_overlay_manager *mgr)
 792 {
 793         struct omap_overlay *ovl;
 794         struct mgr_priv_data *mp;
 795         struct ovl_priv_data *op;
 796
 797         mp = get_mgr_priv(mgr);
 798         mp->shadow_info_dirty = false;
 799         mp->shadow_extra_info_dirty = false;
 800
 801         list_for_each_entry(ovl, &mgr->overlays, list) {
 802                 op = get_ovl_priv(ovl);
 803                 op->shadow_info_dirty = false;
 804                 op->shadow_extra_info_dirty = false;
 805         }
 806 }
 807
 808 static int dss_mgr_connect_compat(struct omap_overlay_manager *mgr,
 809                 struct omap_dss_device *dst)
 810 {
 811         return mgr->set_output(mgr, dst);
 812 }
 813
 814 static void dss_mgr_disconnect_compat(struct omap_overlay_manager *mgr,
 815                 struct omap_dss_device *dst)
 816 {
 817         mgr->unset_output(mgr);
 818 }
 819
 820 static void dss_mgr_start_update_compat(struct omap_overlay_manager *mgr)
 821 {
 822         struct mgr_priv_data *mp = get_mgr_priv(mgr);
 823         unsigned long flags;
 824         int r;
 825
 826         spin_lock_irqsave(&data_lock, flags);
 827
 828         WARN_ON(mp->updating);
 829
 830         r = dss_check_settings(mgr);
 831         if (r) {
 832                 DSSERR("cannot start manual update: illegal configuration\n");
 833                 spin_unlock_irqrestore(&data_lock, flags);
 834                 return;
 835         }
 836
 837         dss_mgr_write_regs(mgr);
 838         dss_mgr_write_regs_extra(mgr);
 839
 840         mp->updating = true;
 841
 842         if (!dss_data.irq_enabled && need_isr())
 843                 dss_register_vsync_isr();
 844
 845         dispc_mgr_enable_sync(mgr->id);
 846
 847         spin_unlock_irqrestore(&data_lock, flags);
 848 }
 849
 850 static void dss_apply_irq_handler(void *data, u32 mask);
 851
 852 static void dss_register_vsync_isr(void)
 853 {
 854         const int num_mgrs = dss_feat_get_num_mgrs();
 855         u32 mask;
 856         int r, i;
 857
 858         mask = 0;
 859         for (i = 0; i < num_mgrs; ++i)
 860                 mask |= dispc_mgr_get_vsync_irq(i);
 861
 862         for (i = 0; i < num_mgrs; ++i)
 863                 mask |= dispc_mgr_get_framedone_irq(i);
 864
 865         r = omap_dispc_register_isr(dss_apply_irq_handler, NULL, mask);
 866         WARN_ON(r);
 867
 868         dss_data.irq_enabled = true;
 869 }
 870
 871 static void dss_unregister_vsync_isr(void)
 872 {
 873         const int num_mgrs = dss_feat_get_num_mgrs();
 874         u32 mask;
 875         int r, i;
 876
 877         mask = 0;
 878         for (i = 0; i < num_mgrs; ++i)
 879                 mask |= dispc_mgr_get_vsync_irq(i);
 880
 881         for (i = 0; i < num_mgrs; ++i)
 882                 mask |= dispc_mgr_get_framedone_irq(i);
 883
 884         r = omap_dispc_unregister_isr(dss_apply_irq_handler, NULL, mask);
 885         WARN_ON(r);
 886
 887         dss_data.irq_enabled = false;
 888 }
 889
 890 static void dss_apply_irq_handler(void *data, u32 mask)
 891 {
 892         const int num_mgrs = dss_feat_get_num_mgrs();
 893         int i;
 894         bool extra_updating;
 895
 896         spin_lock(&data_lock);
 897
 898         /* clear busy, updating flags, shadow_dirty flags */
 899         for (i = 0; i < num_mgrs; i++) {
 900                 struct omap_overlay_manager *mgr;
 901                 struct mgr_priv_data *mp;
 902
 903                 mgr = omap_dss_get_overlay_manager(i);
 904                 mp = get_mgr_priv(mgr);
 905
 906                 if (!mp->enabled)
 907                         continue;
 908
 909                 mp->updating = dispc_mgr_is_enabled(i);
 910
 911                 if (!mgr_manual_update(mgr)) {
 912                         bool was_busy = mp->busy;
 913                         mp->busy = dispc_mgr_go_busy(i);
 914
 915                         if (was_busy && !mp->busy)
 916                                 mgr_clear_shadow_dirty(mgr);
 917                 }
 918         }
 919
 920         dss_write_regs();
 921         dss_set_go_bits();
 922
 923         extra_updating = extra_info_update_ongoing();
 924         if (!extra_updating)
 925                 complete_all(&extra_updated_completion);
 926
 927         /* call framedone handlers for manual update displays */
 928         for (i = 0; i < num_mgrs; i++) {
 929                 struct omap_overlay_manager *mgr;
 930                 struct mgr_priv_data *mp;
 931
 932                 mgr = omap_dss_get_overlay_manager(i);
 933                 mp = get_mgr_priv(mgr);
 934
 935                 if (!mgr_manual_update(mgr) || !mp->framedone_handler)
 936                         continue;
 937
 938                 if (mask & dispc_mgr_get_framedone_irq(i))
 939                         mp->framedone_handler(mp->framedone_handler_data);
 940         }
 941
 942         if (!need_isr())
 943                 dss_unregister_vsync_isr();
 944
 945         spin_unlock(&data_lock);
 946 }
 947
 948 static void omap_dss_mgr_apply_ovl(struct omap_overlay *ovl)
 949 {
 950         struct ovl_priv_data *op;
 951
 952         op = get_ovl_priv(ovl);
 953
 954         if (!op->user_info_dirty)
 955                 return;
 956
 957         op->user_info_dirty = false;
 958         op->info_dirty = true;
 959         op->info = op->user_info;
 960 }
 961
 962 static void omap_dss_mgr_apply_mgr(struct omap_overlay_manager *mgr)
 963 {
 964         struct mgr_priv_data *mp;
 965
 966         mp = get_mgr_priv(mgr);
 967
 968         if (!mp->user_info_dirty)
 969                 return;
 970
 971         mp->user_info_dirty = false;
 972         mp->info_dirty = true;
 973         mp->info = mp->user_info;
 974 }
 975
 976 static int omap_dss_mgr_apply(struct omap_overlay_manager *mgr)
 977 {
 978         unsigned long flags;
 979         struct omap_overlay *ovl;
 980         int r;
 981
 982         DSSDBG("omap_dss_mgr_apply(%s)\n", mgr->name);
 983
 984         spin_lock_irqsave(&data_lock, flags);
 985
 986         r = dss_check_settings_apply(mgr);
 987         if (r) {
 988                 spin_unlock_irqrestore(&data_lock, flags);
 989                 DSSERR("failed to apply settings: illegal configuration.\n");
 990                 return r;
 991         }
 992
 993         /* Configure overlays */
 994         list_for_each_entry(ovl, &mgr->overlays, list)
 995                 omap_dss_mgr_apply_ovl(ovl);
 996
 997         /* Configure manager */
 998         omap_dss_mgr_apply_mgr(mgr);
 999
1000         dss_write_regs();
1001         dss_set_go_bits();
1002
1003         spin_unlock_irqrestore(&data_lock, flags);
1004
1005         return 0;
1006 }
1007
1008 static void dss_apply_ovl_enable(struct omap_overlay *ovl, bool enable)
1009 {
1010         struct ovl_priv_data *op;
1011
1012         op = get_ovl_priv(ovl);
1013
1014         if (op->enabled == enable)
1015                 return;
1016
1017         op->enabled = enable;
1018         op->extra_info_dirty = true;
1019 }
1020
1021 static void dss_apply_ovl_fifo_thresholds(struct omap_overlay *ovl,
1022                 u32 fifo_low, u32 fifo_high)
1023 {
1024         struct ovl_priv_data *op = get_ovl_priv(ovl);
1025
1026         if (op->fifo_low == fifo_low && op->fifo_high == fifo_high)
1027                 return;
1028
1029         op->fifo_low = fifo_low;
1030         op->fifo_high = fifo_high;
1031         op->extra_info_dirty = true;
1032 }
1033
1034 static void dss_ovl_setup_fifo(struct omap_overlay *ovl)
1035 {
1036         struct ovl_priv_data *op = get_ovl_priv(ovl);
1037         u32 fifo_low, fifo_high;
1038         bool use_fifo_merge = false;
1039
1040         if (!op->enabled && !op->enabling)
1041                 return;
1042
1043         dispc_ovl_compute_fifo_thresholds(ovl->id, &fifo_low, &fifo_high,
1044                         use_fifo_merge, ovl_manual_update(ovl));
1045
1046         dss_apply_ovl_fifo_thresholds(ovl, fifo_low, fifo_high);
1047 }
1048
1049 static void dss_mgr_setup_fifos(struct omap_overlay_manager *mgr)
1050 {
1051         struct omap_overlay *ovl;
1052         struct mgr_priv_data *mp;
1053
1054         mp = get_mgr_priv(mgr);
1055
1056         if (!mp->enabled)
1057                 return;
1058
1059         list_for_each_entry(ovl, &mgr->overlays, list)
1060                 dss_ovl_setup_fifo(ovl);
1061 }
1062
1063 static void dss_setup_fifos(void)
1064 {
1065         const int num_mgrs = omap_dss_get_num_overlay_managers();
1066         struct omap_overlay_manager *mgr;
1067         int i;
1068
1069         for (i = 0; i < num_mgrs; ++i) {
1070                 mgr = omap_dss_get_overlay_manager(i);
1071                 dss_mgr_setup_fifos(mgr);
1072         }
1073 }
1074
1075 static int dss_mgr_enable_compat(struct omap_overlay_manager *mgr)
1076 {
1077         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1078         unsigned long flags;
1079         int r;
1080
1081         mutex_lock(&apply_lock);
1082
1083         if (mp->enabled)
1084                 goto out;
1085
1086         spin_lock_irqsave(&data_lock, flags);
1087
1088         mp->enabled = true;
1089
1090         r = dss_check_settings(mgr);
1091         if (r) {
1092                 DSSERR("failed to enable manager %d: check_settings failed\n",
1093                                 mgr->id);
1094                 goto err;
1095         }
1096
1097         dss_setup_fifos();
1098
1099         dss_write_regs();
1100         dss_set_go_bits();
1101
1102         if (!mgr_manual_update(mgr))
1103                 mp->updating = true;
1104
1105         if (!dss_data.irq_enabled && need_isr())
1106                 dss_register_vsync_isr();
1107
1108         spin_unlock_irqrestore(&data_lock, flags);
1109
1110         if (!mgr_manual_update(mgr))
1111                 dispc_mgr_enable_sync(mgr->id);
1112
1113 out:
1114         mutex_unlock(&apply_lock);
1115
1116         return 0;
1117
1118 err:
1119         mp->enabled = false;
1120         spin_unlock_irqrestore(&data_lock, flags);
1121         mutex_unlock(&apply_lock);
1122         return r;
1123 }
1124
1125 static void dss_mgr_disable_compat(struct omap_overlay_manager *mgr)
1126 {
1127         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1128         unsigned long flags;
1129
1130         mutex_lock(&apply_lock);
1131
1132         if (!mp->enabled)
1133                 goto out;
1134
1135         wait_pending_extra_info_updates();
1136
1137         if (!mgr_manual_update(mgr))
1138                 dispc_mgr_disable_sync(mgr->id);
1139
1140         spin_lock_irqsave(&data_lock, flags);
1141
1142         mp->updating = false;
1143         mp->enabled = false;
1144
1145         spin_unlock_irqrestore(&data_lock, flags);
1146
1147 out:
1148         mutex_unlock(&apply_lock);
1149 }
1150
1151 static int dss_mgr_set_info(struct omap_overlay_manager *mgr,
1152                 struct omap_overlay_manager_info *info)
1153 {
1154         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1155         unsigned long flags;
1156         int r;
1157
1158         r = dss_mgr_simple_check(mgr, info);
1159         if (r)
1160                 return r;
1161
1162         spin_lock_irqsave(&data_lock, flags);
1163
1164         mp->user_info = *info;
1165         mp->user_info_dirty = true;
1166
1167         spin_unlock_irqrestore(&data_lock, flags);
1168
1169         return 0;
1170 }
1171
1172 static void dss_mgr_get_info(struct omap_overlay_manager *mgr,
1173                 struct omap_overlay_manager_info *info)
1174 {
1175         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1176         unsigned long flags;
1177
1178         spin_lock_irqsave(&data_lock, flags);
1179
1180         *info = mp->user_info;
1181
1182         spin_unlock_irqrestore(&data_lock, flags);
1183 }
1184
1185 static int dss_mgr_set_output(struct omap_overlay_manager *mgr,
1186                 struct omap_dss_device *output)
1187 {
1188         int r;
1189
1190         mutex_lock(&apply_lock);
1191
1192         if (mgr->output) {
1193                 DSSERR("manager %s is already connected to an output\n",
1194                         mgr->name);
1195                 r = -EINVAL;
1196                 goto err;
1197         }
1198
1199         if ((mgr->supported_outputs & output->id) == 0) {
1200                 DSSERR("output does not support manager %s\n",
1201                         mgr->name);
1202                 r = -EINVAL;
1203                 goto err;
1204         }
1205
1206         output->manager = mgr;
1207         mgr->output = output;
1208
1209         mutex_unlock(&apply_lock);
1210
1211         return 0;
1212 err:
1213         mutex_unlock(&apply_lock);
1214         return r;
1215 }
1216
1217 static int dss_mgr_unset_output(struct omap_overlay_manager *mgr)
1218 {
1219         int r;
1220         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1221         unsigned long flags;
1222
1223         mutex_lock(&apply_lock);
1224
1225         if (!mgr->output) {
1226                 DSSERR("failed to unset output, output not set\n");
1227                 r = -EINVAL;
1228                 goto err;
1229         }
1230
1231         spin_lock_irqsave(&data_lock, flags);
1232
1233         if (mp->enabled) {
1234                 DSSERR("output can't be unset when manager is enabled\n");
1235                 r = -EINVAL;
1236                 goto err1;
1237         }
1238
1239         spin_unlock_irqrestore(&data_lock, flags);
1240
1241         mgr->output->manager = NULL;
1242         mgr->output = NULL;
1243
1244         mutex_unlock(&apply_lock);
1245
1246         return 0;
1247 err1:
1248         spin_unlock_irqrestore(&data_lock, flags);
1249 err:
1250         mutex_unlock(&apply_lock);
1251
1252         return r;
1253 }
1254
1255 static void dss_apply_mgr_timings(struct omap_overlay_manager *mgr,
1256                 const struct omap_video_timings *timings)
1257 {
1258         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1259
1260         mp->timings = *timings;
1261         mp->extra_info_dirty = true;
1262 }
1263
1264 static void dss_mgr_set_timings_compat(struct omap_overlay_manager *mgr,
1265                 const struct omap_video_timings *timings)
1266 {
1267         unsigned long flags;
1268         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1269
1270         spin_lock_irqsave(&data_lock, flags);
1271
1272         if (mp->updating) {
1273                 DSSERR("cannot set timings for %s: manager needs to be disabled\n",
1274                         mgr->name);
1275                 goto out;
1276         }
1277
1278         dss_apply_mgr_timings(mgr, timings);
1279 out:
1280         spin_unlock_irqrestore(&data_lock, flags);
1281 }
1282
1283 static void dss_apply_mgr_lcd_config(struct omap_overlay_manager *mgr,
1284                 const struct dss_lcd_mgr_config *config)
1285 {
1286         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1287
1288         mp->lcd_config = *config;
1289         mp->extra_info_dirty = true;
1290 }
1291
1292 static void dss_mgr_set_lcd_config_compat(struct omap_overlay_manager *mgr,
1293                 const struct dss_lcd_mgr_config *config)
1294 {
1295         unsigned long flags;
1296         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1297
1298         spin_lock_irqsave(&data_lock, flags);
1299
1300         if (mp->enabled) {
1301                 DSSERR("cannot apply lcd config for %s: manager needs to be disabled\n",
1302                         mgr->name);
1303                 goto out;
1304         }
1305
1306         dss_apply_mgr_lcd_config(mgr, config);
1307 out:
1308         spin_unlock_irqrestore(&data_lock, flags);
1309 }
1310
1311 static int dss_ovl_set_info(struct omap_overlay *ovl,
1312                 struct omap_overlay_info *info)
1313 {
1314         struct ovl_priv_data *op = get_ovl_priv(ovl);
1315         unsigned long flags;
1316         int r;
1317
1318         r = dss_ovl_simple_check(ovl, info);
1319         if (r)
1320                 return r;
1321
1322         spin_lock_irqsave(&data_lock, flags);
1323
1324         op->user_info = *info;
1325         op->user_info_dirty = true;
1326
1327         spin_unlock_irqrestore(&data_lock, flags);
1328
1329         return 0;
1330 }
1331
1332 static void dss_ovl_get_info(struct omap_overlay *ovl,
1333                 struct omap_overlay_info *info)
1334 {
1335         struct ovl_priv_data *op = get_ovl_priv(ovl);
1336         unsigned long flags;
1337
1338         spin_lock_irqsave(&data_lock, flags);
1339
1340         *info = op->user_info;
1341
1342         spin_unlock_irqrestore(&data_lock, flags);
1343 }
1344
1345 static int dss_ovl_set_manager(struct omap_overlay *ovl,
1346                 struct omap_overlay_manager *mgr)
1347 {
1348         struct ovl_priv_data *op = get_ovl_priv(ovl);
1349         unsigned long flags;
1350         int r;
1351
1352         if (!mgr)
1353                 return -EINVAL;
1354
1355         mutex_lock(&apply_lock);
1356
1357         if (ovl->manager) {
1358                 DSSERR("overlay '%s' already has a manager '%s'\n",
1359                                 ovl->name, ovl->manager->name);
1360                 r = -EINVAL;
1361                 goto err;
1362         }
1363
1364         r = dispc_runtime_get();
1365         if (r)
1366                 goto err;
1367
1368         spin_lock_irqsave(&data_lock, flags);
1369
1370         if (op->enabled) {
1371                 spin_unlock_irqrestore(&data_lock, flags);
1372                 DSSERR("overlay has to be disabled to change the manager\n");
1373                 r = -EINVAL;
1374                 goto err1;
1375         }
1376
1377         dispc_ovl_set_channel_out(ovl->id, mgr->id);
1378
1379         ovl->manager = mgr;
1380         list_add_tail(&ovl->list, &mgr->overlays);
1381
1382         spin_unlock_irqrestore(&data_lock, flags);
1383
1384         dispc_runtime_put();
1385
1386         mutex_unlock(&apply_lock);
1387
1388         return 0;
1389
1390 err1:
1391         dispc_runtime_put();
1392 err:
1393         mutex_unlock(&apply_lock);
1394         return r;
1395 }
1396
1397 static int dss_ovl_unset_manager(struct omap_overlay *ovl)
1398 {
1399         struct ovl_priv_data *op = get_ovl_priv(ovl);
1400         unsigned long flags;
1401         int r;
1402
1403         mutex_lock(&apply_lock);
1404
1405         if (!ovl->manager) {
1406                 DSSERR("failed to detach overlay: manager not set\n");
1407                 r = -EINVAL;
1408                 goto err;
1409         }
1410
1411         spin_lock_irqsave(&data_lock, flags);
1412
1413         if (op->enabled) {
1414                 spin_unlock_irqrestore(&data_lock, flags);
1415                 DSSERR("overlay has to be disabled to unset the manager\n");
1416                 r = -EINVAL;
1417                 goto err;
1418         }
1419
1420         spin_unlock_irqrestore(&data_lock, flags);
1421
1422         /* wait for pending extra_info updates to ensure the ovl is disabled */
1423         wait_pending_extra_info_updates();
1424
1425         /*
1426          * For a manual update display, there is no guarantee that the overlay
1427          * is really disabled in HW, we may need an extra update from this
1428          * manager before the configurations can go in. Return an error if the
1429          * overlay needed an update from the manager.
1430          *
1431          * TODO: Instead of returning an error, try to do a dummy manager update
1432          * here to disable the overlay in hardware. Use the *GATED fields in
1433          * the DISPC_CONFIG registers to do a dummy update.
1434          */
1435         spin_lock_irqsave(&data_lock, flags);
1436
1437         if (ovl_manual_update(ovl) && op->extra_info_dirty) {
1438                 spin_unlock_irqrestore(&data_lock, flags);
1439                 DSSERR("need an update to change the manager\n");
1440                 r = -EINVAL;
1441                 goto err;
1442         }
1443
1444         ovl->manager = NULL;
1445         list_del(&ovl->list);
1446
1447         spin_unlock_irqrestore(&data_lock, flags);
1448
1449         mutex_unlock(&apply_lock);
1450
1451         return 0;
1452 err:
1453         mutex_unlock(&apply_lock);
1454         return r;
1455 }
1456
1457 static bool dss_ovl_is_enabled(struct omap_overlay *ovl)
1458 {
1459         struct ovl_priv_data *op = get_ovl_priv(ovl);
1460         unsigned long flags;
1461         bool e;
1462
1463         spin_lock_irqsave(&data_lock, flags);
1464
1465         e = op->enabled;
1466
1467         spin_unlock_irqrestore(&data_lock, flags);
1468
1469         return e;
1470 }
1471
1472 static int dss_ovl_enable(struct omap_overlay *ovl)
1473 {
1474         struct ovl_priv_data *op = get_ovl_priv(ovl);
1475         unsigned long flags;
1476         int r;
1477
1478         mutex_lock(&apply_lock);
1479
1480         if (op->enabled) {
1481                 r = 0;
1482                 goto err1;
1483         }
1484
1485         if (ovl->manager == NULL || ovl->manager->output == NULL) {
1486                 r = -EINVAL;
1487                 goto err1;
1488         }
1489
1490         spin_lock_irqsave(&data_lock, flags);
1491
1492         op->enabling = true;
1493
1494         r = dss_check_settings(ovl->manager);
1495         if (r) {
1496                 DSSERR("failed to enable overlay %d: check_settings failed\n",
1497                                 ovl->id);
1498                 goto err2;
1499         }
1500
1501         dss_setup_fifos();
1502
1503         op->enabling = false;
1504         dss_apply_ovl_enable(ovl, true);
1505
1506         dss_write_regs();
1507         dss_set_go_bits();
1508
1509         spin_unlock_irqrestore(&data_lock, flags);
1510
1511         mutex_unlock(&apply_lock);
1512
1513         return 0;
1514 err2:
1515         op->enabling = false;
1516         spin_unlock_irqrestore(&data_lock, flags);
1517 err1:
1518         mutex_unlock(&apply_lock);
1519         return r;
1520 }
1521
1522 static int dss_ovl_disable(struct omap_overlay *ovl)
1523 {
1524         struct ovl_priv_data *op = get_ovl_priv(ovl);
1525         unsigned long flags;
1526         int r;
1527
1528         mutex_lock(&apply_lock);
1529
1530         if (!op->enabled) {
1531                 r = 0;
1532                 goto err;
1533         }
1534
1535         if (ovl->manager == NULL || ovl->manager->output == NULL) {
1536                 r = -EINVAL;
1537                 goto err;
1538         }
1539
1540         spin_lock_irqsave(&data_lock, flags);
1541
1542         dss_apply_ovl_enable(ovl, false);
1543         dss_write_regs();
1544         dss_set_go_bits();
1545
1546         spin_unlock_irqrestore(&data_lock, flags);
1547
1548         mutex_unlock(&apply_lock);
1549
1550         return 0;
1551
1552 err:
1553         mutex_unlock(&apply_lock);
1554         return r;
1555 }
1556
1557 static int dss_mgr_register_framedone_handler_compat(struct omap_overlay_manager *mgr,
1558                 void (*handler)(void *), void *data)
1559 {
1560         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1561
1562         if (mp->framedone_handler)
1563                 return -EBUSY;
1564
1565         mp->framedone_handler = handler;
1566         mp->framedone_handler_data = data;
1567
1568         return 0;
1569 }
1570
1571 static void dss_mgr_unregister_framedone_handler_compat(struct omap_overlay_manager *mgr,
1572                 void (*handler)(void *), void *data)
1573 {
1574         struct mgr_priv_data *mp = get_mgr_priv(mgr);
1575
1576         WARN_ON(mp->framedone_handler != handler ||
1577                         mp->framedone_handler_data != data);
1578
1579         mp->framedone_handler = NULL;
1580         mp->framedone_handler_data = NULL;
1581 }
1582
1583 static const struct dss_mgr_ops apply_mgr_ops = {
1584         .connect = dss_mgr_connect_compat,
1585         .disconnect = dss_mgr_disconnect_compat,
1586         .start_update = dss_mgr_start_update_compat,
1587         .enable = dss_mgr_enable_compat,
1588         .disable = dss_mgr_disable_compat,
1589         .set_timings = dss_mgr_set_timings_compat,
1590         .set_lcd_config = dss_mgr_set_lcd_config_compat,
1591         .register_framedone_handler = dss_mgr_register_framedone_handler_compat,
1592         .unregister_framedone_handler = dss_mgr_unregister_framedone_handler_compat,
1593 };
1594
1595 static int compat_refcnt;
1596 static DEFINE_MUTEX(compat_init_lock);
1597
1598 int omapdss_compat_init(void)
1599 {
1600         struct platform_device *pdev = dss_get_core_pdev();
1601         int i, r;
1602
1603         mutex_lock(&compat_init_lock);
1604
1605         if (compat_refcnt++ > 0)
1606                 goto out;
1607
1608         apply_init_priv();
1609
1610         dss_init_overlay_managers_sysfs(pdev);
1611         dss_init_overlays(pdev);
1612
1613         for (i = 0; i < omap_dss_get_num_overlay_managers(); i++) {
1614                 struct omap_overlay_manager *mgr;
1615
1616                 mgr = omap_dss_get_overlay_manager(i);
1617
1618                 mgr->set_output = &dss_mgr_set_output;
1619                 mgr->unset_output = &dss_mgr_unset_output;
1620                 mgr->apply = &omap_dss_mgr_apply;
1621                 mgr->set_manager_info = &dss_mgr_set_info;
1622                 mgr->get_manager_info = &dss_mgr_get_info;
1623                 mgr->wait_for_go = &dss_mgr_wait_for_go;
1624                 mgr->wait_for_vsync = &dss_mgr_wait_for_vsync;
1625                 mgr->get_device = &dss_mgr_get_device;
1626         }
1627
1628         for (i = 0; i < omap_dss_get_num_overlays(); i++) {
1629                 struct omap_overlay *ovl = omap_dss_get_overlay(i);
1630
1631                 ovl->is_enabled = &dss_ovl_is_enabled;
1632                 ovl->enable = &dss_ovl_enable;
1633                 ovl->disable = &dss_ovl_disable;
1634                 ovl->set_manager = &dss_ovl_set_manager;
1635                 ovl->unset_manager = &dss_ovl_unset_manager;
1636                 ovl->set_overlay_info = &dss_ovl_set_info;
1637                 ovl->get_overlay_info = &dss_ovl_get_info;
1638                 ovl->wait_for_go = &dss_mgr_wait_for_go_ovl;
1639                 ovl->get_device = &dss_ovl_get_device;
1640         }
1641
1642         r = dss_install_mgr_ops(&apply_mgr_ops);
1643         if (r)
1644                 goto err_mgr_ops;
1645
1646         r = display_init_sysfs(pdev);
1647         if (r)
1648                 goto err_disp_sysfs;
1649
1650         dispc_runtime_get();
1651
1652         r = dss_dispc_initialize_irq();
1653         if (r)
1654                 goto err_init_irq;
1655
1656         dispc_runtime_put();
1657
1658 out:
1659         mutex_unlock(&compat_init_lock);
1660
1661         return 0;
1662
1663 err_init_irq:
1664         dispc_runtime_put();
1665         display_uninit_sysfs(pdev);
1666
1667 err_disp_sysfs:
1668         dss_uninstall_mgr_ops();
1669
1670 err_mgr_ops:
1671         dss_uninit_overlay_managers_sysfs(pdev);
1672         dss_uninit_overlays(pdev);
1673
1674         compat_refcnt--;
1675
1676         mutex_unlock(&compat_init_lock);
1677
1678         return r;
1679 }
1680 EXPORT_SYMBOL(omapdss_compat_init);
1681
1682 void omapdss_compat_uninit(void)
1683 {
1684         struct platform_device *pdev = dss_get_core_pdev();
1685
1686         mutex_lock(&compat_init_lock);
1687
1688         if (--compat_refcnt > 0)
1689                 goto out;
1690
1691         dss_dispc_uninitialize_irq();
1692
1693         display_uninit_sysfs(pdev);
1694
1695         dss_uninstall_mgr_ops();
1696
1697         dss_uninit_overlay_managers_sysfs(pdev);
1698         dss_uninit_overlays(pdev);
1699 out:
1700         mutex_unlock(&compat_init_lock);
1701 }
1702 EXPORT_SYMBOL(omapdss_compat_uninit);