drivers/video/omap2/dss/display.c

   1 /*
   2  * linux/drivers/video/omap2/dss/display.c
   3  *
   4  * Copyright (C) 2009 Nokia Corporation
   5  * Author: Tomi Valkeinen <tomi.valkeinen@nokia.com>
   6  *
   7  * Some code and ideas taken from drivers/video/omap/ driver
   8  * by Imre Deak.
   9  *
  10  * This program is free software; you can redistribute it and/or modify it
  11  * under the terms of the GNU General Public License version 2 as published by
  12  * the Free Software Foundation.
  13  *
  14  * This program is distributed in the hope that it will be useful, but WITHOUT
  15  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  16  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
  17  * more details.
  18  *
  19  * You should have received a copy of the GNU General Public License along with
  20  * this program.  If not, see <http://www.gnu.org/licenses/>.
  21  */
  22
  23 #define DSS_SUBSYS_NAME "DISPLAY"
  24
  25 #include <linux/kernel.h>
  26 #include <linux/module.h>
  27 #include <linux/jiffies.h>
  28 #include <linux/platform_device.h>
  29
  30 #include <video/omapdss.h>
  31 #include "dss.h"
  32 #include "dss_features.h"
  33
  34 static ssize_t display_enabled_show(struct device *dev,
  35                 struct device_attribute *attr, char *buf)
  36 {
  37         struct omap_dss_device *dssdev = to_dss_device(dev);
  38         bool enabled = dssdev->state != OMAP_DSS_DISPLAY_DISABLED;
  39
  40         return snprintf(buf, PAGE_SIZE, "%d\n", enabled);
  41 }
  42
  43 static ssize_t display_enabled_store(struct device *dev,
  44                 struct device_attribute *attr,
  45                 const char *buf, size_t size)
  46 {
  47         struct omap_dss_device *dssdev = to_dss_device(dev);
  48         int r;
  49         bool enabled;
  50
  51         r = strtobool(buf, &enabled);
  52         if (r)
  53                 return r;
  54
  55         if (enabled != (dssdev->state != OMAP_DSS_DISPLAY_DISABLED)) {
  56                 if (enabled) {
  57                         r = dssdev->driver->enable(dssdev);
  58                         if (r)
  59                                 return r;
  60                 } else {
  61                         dssdev->driver->disable(dssdev);
  62                 }
  63         }
  64
  65         return size;
  66 }
  67
  68 static ssize_t display_tear_show(struct device *dev,
  69                 struct device_attribute *attr, char *buf)
  70 {
  71         struct omap_dss_device *dssdev = to_dss_device(dev);
  72         return snprintf(buf, PAGE_SIZE, "%d\n",
  73                         dssdev->driver->get_te ?
  74                         dssdev->driver->get_te(dssdev) : 0);
  75 }
  76
  77 static ssize_t display_tear_store(struct device *dev,
  78                 struct device_attribute *attr, const char *buf, size_t size)
  79 {
  80         struct omap_dss_device *dssdev = to_dss_device(dev);
  81         int r;
  82         bool te;
  83
  84         if (!dssdev->driver->enable_te || !dssdev->driver->get_te)
  85                 return -ENOENT;
  86
  87         r = strtobool(buf, &te);
  88         if (r)
  89                 return r;
  90
  91         r = dssdev->driver->enable_te(dssdev, te);
  92         if (r)
  93                 return r;
  94
  95         return size;
  96 }
  97
  98 static ssize_t display_timings_show(struct device *dev,
  99                 struct device_attribute *attr, char *buf)
 100 {
 101         struct omap_dss_device *dssdev = to_dss_device(dev);
 102         struct omap_video_timings t;
 103
 104         if (!dssdev->driver->get_timings)
 105                 return -ENOENT;
 106
 107         dssdev->driver->get_timings(dssdev, &t);
 108
 109         return snprintf(buf, PAGE_SIZE, "%u,%u/%u/%u/%u,%u/%u/%u/%u\n",
 110                         t.pixel_clock,
 111                         t.x_res, t.hfp, t.hbp, t.hsw,
 112                         t.y_res, t.vfp, t.vbp, t.vsw);
 113 }
 114
 115 static ssize_t display_timings_store(struct device *dev,
 116                 struct device_attribute *attr, const char *buf, size_t size)
 117 {
 118         struct omap_dss_device *dssdev = to_dss_device(dev);
 119         struct omap_video_timings t;
 120         int r, found;
 121
 122         if (!dssdev->driver->set_timings || !dssdev->driver->check_timings)
 123                 return -ENOENT;
 124
 125         found = 0;
 126 #ifdef CONFIG_OMAP2_DSS_VENC
 127         if (strncmp("pal", buf, 3) == 0) {
 128                 t = omap_dss_pal_timings;
 129                 found = 1;
 130         } else if (strncmp("ntsc", buf, 4) == 0) {
 131                 t = omap_dss_ntsc_timings;
 132                 found = 1;
 133         }
 134 #endif
 135         if (!found && sscanf(buf, "%u,%hu/%hu/%hu/%hu,%hu/%hu/%hu/%hu",
 136                                 &t.pixel_clock,
 137                                 &t.x_res, &t.hfp, &t.hbp, &t.hsw,
 138                                 &t.y_res, &t.vfp, &t.vbp, &t.vsw) != 9)
 139                 return -EINVAL;
 140
 141         r = dssdev->driver->check_timings(dssdev, &t);
 142         if (r)
 143                 return r;
 144
 145         dssdev->driver->set_timings(dssdev, &t);
 146
 147         return size;
 148 }
 149
 150 static ssize_t display_rotate_show(struct device *dev,
 151                 struct device_attribute *attr, char *buf)
 152 {
 153         struct omap_dss_device *dssdev = to_dss_device(dev);
 154         int rotate;
 155         if (!dssdev->driver->get_rotate)
 156                 return -ENOENT;
 157         rotate = dssdev->driver->get_rotate(dssdev);
 158         return snprintf(buf, PAGE_SIZE, "%u\n", rotate);
 159 }
 160
 161 static ssize_t display_rotate_store(struct device *dev,
 162                 struct device_attribute *attr, const char *buf, size_t size)
 163 {
 164         struct omap_dss_device *dssdev = to_dss_device(dev);
 165         int rot, r;
 166
 167         if (!dssdev->driver->set_rotate || !dssdev->driver->get_rotate)
 168                 return -ENOENT;
 169
 170         r = kstrtoint(buf, 0, &rot);
 171         if (r)
 172                 return r;
 173
 174         r = dssdev->driver->set_rotate(dssdev, rot);
 175         if (r)
 176                 return r;
 177
 178         return size;
 179 }
 180
 181 static ssize_t display_mirror_show(struct device *dev,
 182                 struct device_attribute *attr, char *buf)
 183 {
 184         struct omap_dss_device *dssdev = to_dss_device(dev);
 185         int mirror;
 186         if (!dssdev->driver->get_mirror)
 187                 return -ENOENT;
 188         mirror = dssdev->driver->get_mirror(dssdev);
 189         return snprintf(buf, PAGE_SIZE, "%u\n", mirror);
 190 }
 191
 192 static ssize_t display_mirror_store(struct device *dev,
 193                 struct device_attribute *attr, const char *buf, size_t size)
 194 {
 195         struct omap_dss_device *dssdev = to_dss_device(dev);
 196         int r;
 197         bool mirror;
 198
 199         if (!dssdev->driver->set_mirror || !dssdev->driver->get_mirror)
 200                 return -ENOENT;
 201
 202         r = strtobool(buf, &mirror);
 203         if (r)
 204                 return r;
 205
 206         r = dssdev->driver->set_mirror(dssdev, mirror);
 207         if (r)
 208                 return r;
 209
 210         return size;
 211 }
 212
 213 static ssize_t display_wss_show(struct device *dev,
 214                 struct device_attribute *attr, char *buf)
 215 {
 216         struct omap_dss_device *dssdev = to_dss_device(dev);
 217         unsigned int wss;
 218
 219         if (!dssdev->driver->get_wss)
 220                 return -ENOENT;
 221
 222         wss = dssdev->driver->get_wss(dssdev);
 223
 224         return snprintf(buf, PAGE_SIZE, "0x%05x\n", wss);
 225 }
 226
 227 static ssize_t display_wss_store(struct device *dev,
 228                 struct device_attribute *attr, const char *buf, size_t size)
 229 {
 230         struct omap_dss_device *dssdev = to_dss_device(dev);
 231         u32 wss;
 232         int r;
 233
 234         if (!dssdev->driver->get_wss || !dssdev->driver->set_wss)
 235                 return -ENOENT;
 236
 237         r = kstrtou32(buf, 0, &wss);
 238         if (r)
 239                 return r;
 240
 241         if (wss > 0xfffff)
 242                 return -EINVAL;
 243
 244         r = dssdev->driver->set_wss(dssdev, wss);
 245         if (r)
 246                 return r;
 247
 248         return size;
 249 }
 250
 251 #include <linux/ctype.h>
 252
 253 static ssize_t display_dss_gamma_store(struct device *dev,
 254                 struct device_attribute *attr, const char *buf, size_t size)
 255 {
 256         struct omap_dss_device *dssdev = to_dss_device(dev);
 257         unsigned int table[256];
 258         char *end = NULL;
 259         int i, ret;
 260
 261         for (i = 0; i < 256; ) {
 262                 table[i++] = simple_strtoul(buf, &end, 0);
 263                 while (isspace(*end))
 264                         end++;
 265                 if (*end == 0)
 266                         break;
 267                 buf = end;
 268         }
 269
 270         ret = dispc_runtime_get();
 271         if (ret < 0)
 272                 return ret;
 273
 274         if (i == 1 && table[0] == 0)
 275                 dispc_set_gamma_table(NULL, 0);
 276         else if (i < 256) {
 277                 dev_err(dev, "not enough gamma values supplied (%d)\n", i);
 278                 dispc_set_gamma_table(NULL, 0);
 279         } else
 280                 dispc_set_gamma_table(table, 256 * 4);
 281
 282         dispc_mgr_go(dssdev->manager->id);
 283
 284         dispc_runtime_put();
 285
 286         return size;
 287 }
 288
 289 static DEVICE_ATTR(enabled, S_IRUGO|S_IWUSR,
 290                 display_enabled_show, display_enabled_store);
 291 static DEVICE_ATTR(tear_elim, S_IRUGO|S_IWUSR,
 292                 display_tear_show, display_tear_store);
 293 static DEVICE_ATTR(timings, S_IRUGO|S_IWUSR,
 294                 display_timings_show, display_timings_store);
 295 static DEVICE_ATTR(rotate, S_IRUGO|S_IWUSR,
 296                 display_rotate_show, display_rotate_store);
 297 static DEVICE_ATTR(mirror, S_IRUGO|S_IWUSR,
 298                 display_mirror_show, display_mirror_store);
 299 static DEVICE_ATTR(wss, S_IRUGO|S_IWUSR,
 300                 display_wss_show, display_wss_store);
 301 static DEVICE_ATTR(dss_gamma, S_IRUGO|S_IWUSR,
 302                 NULL, display_dss_gamma_store);
 303
 304 static struct device_attribute *display_sysfs_attrs[] = {
 305         &dev_attr_enabled,
 306         &dev_attr_tear_elim,
 307         &dev_attr_timings,
 308         &dev_attr_rotate,
 309         &dev_attr_mirror,
 310         &dev_attr_wss,
 311         NULL
 312 };
 313
 314 void omapdss_default_get_resolution(struct omap_dss_device *dssdev,
 315                         u16 *xres, u16 *yres)
 316 {
 317         *xres = dssdev->panel.timings.x_res;
 318         *yres = dssdev->panel.timings.y_res;
 319 }
 320 EXPORT_SYMBOL(omapdss_default_get_resolution);
 321
 322 void default_get_overlay_fifo_thresholds(enum omap_plane plane,
 323                 u32 fifo_size, u32 burst_size,
 324                 u32 *fifo_low, u32 *fifo_high)
 325 {
 326         unsigned buf_unit = dss_feat_get_buffer_size_unit();
 327
 328         *fifo_high = fifo_size - buf_unit;
 329         *fifo_low = fifo_size - burst_size;
 330 }
 331
 332 int omapdss_default_get_recommended_bpp(struct omap_dss_device *dssdev)
 333 {
 334         switch (dssdev->type) {
 335         case OMAP_DISPLAY_TYPE_DPI:
 336                 if (dssdev->phy.dpi.data_lines == 24)
 337                         return 24;
 338                 else
 339                         return 16;
 340
 341         case OMAP_DISPLAY_TYPE_DBI:
 342                 if (dssdev->ctrl.pixel_size == 24)
 343                         return 24;
 344                 else
 345                         return 16;
 346         case OMAP_DISPLAY_TYPE_DSI:
 347                 if (dsi_get_pixel_size(dssdev->panel.dsi_pix_fmt) > 16)
 348                         return 24;
 349                 else
 350                         return 16;
 351         case OMAP_DISPLAY_TYPE_VENC:
 352         case OMAP_DISPLAY_TYPE_SDI:
 353         case OMAP_DISPLAY_TYPE_HDMI:
 354                 return 24;
 355         default:
 356                 BUG();
 357         }
 358 }
 359 EXPORT_SYMBOL(omapdss_default_get_recommended_bpp);
 360
 361 void omapdss_default_get_timings(struct omap_dss_device *dssdev,
 362                 struct omap_video_timings *timings)
 363 {
 364         *timings = dssdev->panel.timings;
 365 }
 366 EXPORT_SYMBOL(omapdss_default_get_timings);
 367
 368 /* Checks if replication logic should be used. Only use for active matrix,
 369  * when overlay is in RGB12U or RGB16 mode, and LCD interface is
 370  * 18bpp or 24bpp */
 371 bool dss_use_replication(struct omap_dss_device *dssdev,
 372                 enum omap_color_mode mode)
 373 {
 374         int bpp;
 375
 376         if (mode != OMAP_DSS_COLOR_RGB12U && mode != OMAP_DSS_COLOR_RGB16)
 377                 return false;
 378
 379         if (dssdev->type == OMAP_DISPLAY_TYPE_DPI &&
 380                         (dssdev->panel.config & OMAP_DSS_LCD_TFT) == 0)
 381                 return false;
 382
 383         switch (dssdev->type) {
 384         case OMAP_DISPLAY_TYPE_DPI:
 385                 bpp = dssdev->phy.dpi.data_lines;
 386                 break;
 387         case OMAP_DISPLAY_TYPE_HDMI:
 388         case OMAP_DISPLAY_TYPE_VENC:
 389         case OMAP_DISPLAY_TYPE_SDI:
 390                 bpp = 24;
 391                 break;
 392         case OMAP_DISPLAY_TYPE_DBI:
 393                 bpp = dssdev->ctrl.pixel_size;
 394                 break;
 395         case OMAP_DISPLAY_TYPE_DSI:
 396                 bpp = dsi_get_pixel_size(dssdev->panel.dsi_pix_fmt);
 397                 break;
 398         default:
 399                 BUG();
 400         }
 401
 402         return bpp > 16;
 403 }
 404
 405 void dss_init_device(struct platform_device *pdev,
 406                 struct omap_dss_device *dssdev)
 407 {
 408         struct device_attribute *attr;
 409         int i;
 410         int r;
 411
 412         switch (dssdev->type) {
 413 #ifdef CONFIG_OMAP2_DSS_DPI
 414         case OMAP_DISPLAY_TYPE_DPI:
 415                 r = dpi_init_display(dssdev);
 416                 break;
 417 #endif
 418 #ifdef CONFIG_OMAP2_DSS_RFBI
 419         case OMAP_DISPLAY_TYPE_DBI:
 420                 r = rfbi_init_display(dssdev);
 421                 break;
 422 #endif
 423 #ifdef CONFIG_OMAP2_DSS_VENC
 424         case OMAP_DISPLAY_TYPE_VENC:
 425                 r = venc_init_display(dssdev);
 426                 break;
 427 #endif
 428 #ifdef CONFIG_OMAP2_DSS_SDI
 429         case OMAP_DISPLAY_TYPE_SDI:
 430                 r = sdi_init_display(dssdev);
 431                 break;
 432 #endif
 433 #ifdef CONFIG_OMAP2_DSS_DSI
 434         case OMAP_DISPLAY_TYPE_DSI:
 435                 r = dsi_init_display(dssdev);
 436                 break;
 437 #endif
 438         case OMAP_DISPLAY_TYPE_HDMI:
 439                 r = hdmi_init_display(dssdev);
 440                 break;
 441         default:
 442                 DSSERR("Support for display '%s' not compiled in.\n",
 443                                 dssdev->name);
 444                 return;
 445         }
 446
 447         if (r) {
 448                 DSSERR("failed to init display %s\n", dssdev->name);
 449                 return;
 450         }
 451
 452         /* create device sysfs files */
 453         i = 0;
 454         while ((attr = display_sysfs_attrs[i++]) != NULL) {
 455                 r = device_create_file(&dssdev->dev, attr);
 456                 if (r)
 457                         DSSERR("failed to create sysfs file\n");
 458         }
 459
 460         if (dssdev->channel == OMAP_DSS_CHANNEL_LCD) {
 461                 r = device_create_file(&dssdev->dev, &dev_attr_dss_gamma);
 462                 if (r)
 463                         DSSERR("failed to create sysfs file\n");
 464         }
 465
 466         /* create display? sysfs links */
 467         r = sysfs_create_link(&pdev->dev.kobj, &dssdev->dev.kobj,
 468                         dev_name(&dssdev->dev));
 469         if (r)
 470                 DSSERR("failed to create sysfs display link\n");
 471 }
 472
 473 void dss_uninit_device(struct platform_device *pdev,
 474                 struct omap_dss_device *dssdev)
 475 {
 476         struct device_attribute *attr;
 477         int i = 0;
 478
 479         sysfs_remove_link(&pdev->dev.kobj, dev_name(&dssdev->dev));
 480
 481         while ((attr = display_sysfs_attrs[i++]) != NULL)
 482                 device_remove_file(&dssdev->dev, attr);
 483
 484         if (dssdev->manager)
 485                 dssdev->manager->unset_device(dssdev->manager);
 486 }
 487
 488 static int dss_suspend_device(struct device *dev, void *data)
 489 {
 490         int r;
 491         struct omap_dss_device *dssdev = to_dss_device(dev);
 492
 493         if (dssdev->state != OMAP_DSS_DISPLAY_ACTIVE) {
 494                 dssdev->activate_after_resume = false;
 495                 return 0;
 496         }
 497
 498         if (!dssdev->driver->suspend) {
 499                 DSSERR("display '%s' doesn't implement suspend\n",
 500                                 dssdev->name);
 501                 return -ENOSYS;
 502         }
 503
 504         r = dssdev->driver->suspend(dssdev);
 505         if (r)
 506                 return r;
 507
 508         dssdev->activate_after_resume = true;
 509
 510         return 0;
 511 }
 512
 513 int dss_suspend_all_devices(void)
 514 {
 515         int r;
 516         struct bus_type *bus = dss_get_bus();
 517
 518         r = bus_for_each_dev(bus, NULL, NULL, dss_suspend_device);
 519         if (r) {
 520                 /* resume all displays that were suspended */
 521                 dss_resume_all_devices();
 522                 return r;
 523         }
 524
 525         return 0;
 526 }
 527
 528 static int dss_resume_device(struct device *dev, void *data)
 529 {
 530         int r;
 531         struct omap_dss_device *dssdev = to_dss_device(dev);
 532
 533         if (dssdev->activate_after_resume && dssdev->driver->resume) {
 534                 r = dssdev->driver->resume(dssdev);
 535                 if (r)
 536                         return r;
 537         }
 538
 539         dssdev->activate_after_resume = false;
 540
 541         return 0;
 542 }
 543
 544 int dss_resume_all_devices(void)
 545 {
 546         struct bus_type *bus = dss_get_bus();
 547
 548         return bus_for_each_dev(bus, NULL, NULL, dss_resume_device);
 549 }
 550
 551 static int dss_disable_device(struct device *dev, void *data)
 552 {
 553         struct omap_dss_device *dssdev = to_dss_device(dev);
 554
 555         if (dssdev->state != OMAP_DSS_DISPLAY_DISABLED)
 556                 dssdev->driver->disable(dssdev);
 557
 558         return 0;
 559 }
 560
 561 void dss_disable_all_devices(void)
 562 {
 563         struct bus_type *bus = dss_get_bus();
 564         bus_for_each_dev(bus, NULL, NULL, dss_disable_device);
 565 }
 566
 567
 568 void omap_dss_get_device(struct omap_dss_device *dssdev)
 569 {
 570         get_device(&dssdev->dev);
 571 }
 572 EXPORT_SYMBOL(omap_dss_get_device);
 573
 574 void omap_dss_put_device(struct omap_dss_device *dssdev)
 575 {
 576         put_device(&dssdev->dev);
 577 }
 578 EXPORT_SYMBOL(omap_dss_put_device);
 579
 580 /* ref count of the found device is incremented. ref count
 581  * of from-device is decremented. */
 582 struct omap_dss_device *omap_dss_get_next_device(struct omap_dss_device *from)
 583 {
 584         struct device *dev;
 585         struct device *dev_start = NULL;
 586         struct omap_dss_device *dssdev = NULL;
 587
 588         int match(struct device *dev, void *data)
 589         {
 590                 return 1;
 591         }
 592
 593         if (from)
 594                 dev_start = &from->dev;
 595         dev = bus_find_device(dss_get_bus(), dev_start, NULL, match);
 596         if (dev)
 597                 dssdev = to_dss_device(dev);
 598         if (from)
 599                 put_device(&from->dev);
 600
 601         return dssdev;
 602 }
 603 EXPORT_SYMBOL(omap_dss_get_next_device);
 604
 605 struct omap_dss_device *omap_dss_find_device(void *data,
 606                 int (*match)(struct omap_dss_device *dssdev, void *data))
 607 {
 608         struct omap_dss_device *dssdev = NULL;
 609
 610         while ((dssdev = omap_dss_get_next_device(dssdev)) != NULL) {
 611                 if (match(dssdev, data))
 612                         return dssdev;
 613         }
 614
 615         return NULL;
 616 }
 617 EXPORT_SYMBOL(omap_dss_find_device);
 618
 619 int omap_dss_start_device(struct omap_dss_device *dssdev)
 620 {
 621         if (!dssdev->driver) {
 622                 DSSDBG("no driver\n");
 623                 return -ENODEV;
 624         }
 625
 626         if (!try_module_get(dssdev->dev.driver->owner)) {
 627                 return -ENODEV;
 628         }
 629
 630         return 0;
 631 }
 632 EXPORT_SYMBOL(omap_dss_start_device);
 633
 634 void omap_dss_stop_device(struct omap_dss_device *dssdev)
 635 {
 636         module_put(dssdev->dev.driver->owner);
 637 }
 638 EXPORT_SYMBOL(omap_dss_stop_device);
 639