linux/drivers/video/fbdev/omap2/omapfb/displays/panel-sony-acx565akm.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0-only
   2/*
   3 * Sony ACX565AKM LCD Panel driver
   4 *
   5 * Copyright (C) 2010 Nokia Corporation
   6 *
   7 * Original Driver Author: Imre Deak <imre.deak@nokia.com>
   8 * Based on panel-generic.c by Tomi Valkeinen <tomi.valkeinen@nokia.com>
   9 * Adapted to new DSS2 framework: Roger Quadros <roger.quadros@nokia.com>
  10 */
  11
  12#include <linux/kernel.h>
  13#include <linux/module.h>
  14#include <linux/platform_device.h>
  15#include <linux/delay.h>
  16#include <linux/spi/spi.h>
  17#include <linux/jiffies.h>
  18#include <linux/sched.h>
  19#include <linux/backlight.h>
  20#include <linux/fb.h>
  21#include <linux/gpio.h>
  22#include <linux/of.h>
  23#include <linux/of_gpio.h>
  24
  25#include <video/omapfb_dss.h>
  26#include <video/omap-panel-data.h>
  27
  28#define MIPID_CMD_READ_DISP_ID          0x04
  29#define MIPID_CMD_READ_RED              0x06
  30#define MIPID_CMD_READ_GREEN            0x07
  31#define MIPID_CMD_READ_BLUE             0x08
  32#define MIPID_CMD_READ_DISP_STATUS      0x09
  33#define MIPID_CMD_RDDSDR                0x0F
  34#define MIPID_CMD_SLEEP_IN              0x10
  35#define MIPID_CMD_SLEEP_OUT             0x11
  36#define MIPID_CMD_DISP_OFF              0x28
  37#define MIPID_CMD_DISP_ON               0x29
  38#define MIPID_CMD_WRITE_DISP_BRIGHTNESS 0x51
  39#define MIPID_CMD_READ_DISP_BRIGHTNESS  0x52
  40#define MIPID_CMD_WRITE_CTRL_DISP       0x53
  41
  42#define CTRL_DISP_BRIGHTNESS_CTRL_ON    (1 << 5)
  43#define CTRL_DISP_AMBIENT_LIGHT_CTRL_ON (1 << 4)
  44#define CTRL_DISP_BACKLIGHT_ON          (1 << 2)
  45#define CTRL_DISP_AUTO_BRIGHTNESS_ON    (1 << 1)
  46
  47#define MIPID_CMD_READ_CTRL_DISP        0x54
  48#define MIPID_CMD_WRITE_CABC            0x55
  49#define MIPID_CMD_READ_CABC             0x56
  50
  51#define MIPID_VER_LPH8923               3
  52#define MIPID_VER_LS041Y3               4
  53#define MIPID_VER_L4F00311              8
  54#define MIPID_VER_ACX565AKM             9
  55
  56struct panel_drv_data {
  57        struct omap_dss_device  dssdev;
  58        struct omap_dss_device *in;
  59
  60        int reset_gpio;
  61        int datapairs;
  62
  63        struct omap_video_timings videomode;
  64
  65        char            *name;
  66        int             enabled;
  67        int             model;
  68        int             revision;
  69        u8              display_id[3];
  70        unsigned        has_bc:1;
  71        unsigned        has_cabc:1;
  72        unsigned        cabc_mode;
  73        unsigned long   hw_guard_end;           /* next value of jiffies
  74                                                   when we can issue the
  75                                                   next sleep in/out command */
  76        unsigned long   hw_guard_wait;          /* max guard time in jiffies */
  77
  78        struct spi_device       *spi;
  79        struct mutex            mutex;
  80
  81        struct backlight_device *bl_dev;
  82};
  83
  84static const struct omap_video_timings acx565akm_panel_timings = {
  85        .x_res          = 800,
  86        .y_res          = 480,
  87        .pixelclock     = 24000000,
  88        .hfp            = 28,
  89        .hsw            = 4,
  90        .hbp            = 24,
  91        .vfp            = 3,
  92        .vsw            = 3,
  93        .vbp            = 4,
  94
  95        .vsync_level    = OMAPDSS_SIG_ACTIVE_LOW,
  96        .hsync_level    = OMAPDSS_SIG_ACTIVE_LOW,
  97
  98        .data_pclk_edge = OMAPDSS_DRIVE_SIG_RISING_EDGE,
  99        .de_level       = OMAPDSS_SIG_ACTIVE_HIGH,
 100        .sync_pclk_edge = OMAPDSS_DRIVE_SIG_FALLING_EDGE,
 101};
 102
 103#define to_panel_data(p) container_of(p, struct panel_drv_data, dssdev)
 104
 105static void acx565akm_transfer(struct panel_drv_data *ddata, int cmd,
 106                              const u8 *wbuf, int wlen, u8 *rbuf, int rlen)
 107{
 108        struct spi_message      m;
 109        struct spi_transfer     *x, xfer[5];
 110        int                     r;
 111
 112        BUG_ON(ddata->spi == NULL);
 113
 114        spi_message_init(&m);
 115
 116        memset(xfer, 0, sizeof(xfer));
 117        x = &xfer[0];
 118
 119        cmd &=  0xff;
 120        x->tx_buf = &cmd;
 121        x->bits_per_word = 9;
 122        x->len = 2;
 123
 124        if (rlen > 1 && wlen == 0) {
 125                /*
 126                 * Between the command and the response data there is a
 127                 * dummy clock cycle. Add an extra bit after the command
 128                 * word to account for this.
 129                 */
 130                x->bits_per_word = 10;
 131                cmd <<= 1;
 132        }
 133        spi_message_add_tail(x, &m);
 134
 135        if (wlen) {
 136                x++;
 137                x->tx_buf = wbuf;
 138                x->len = wlen;
 139                x->bits_per_word = 9;
 140                spi_message_add_tail(x, &m);
 141        }
 142
 143        if (rlen) {
 144                x++;
 145                x->rx_buf       = rbuf;
 146                x->len          = rlen;
 147                spi_message_add_tail(x, &m);
 148        }
 149
 150        r = spi_sync(ddata->spi, &m);
 151        if (r < 0)
 152                dev_dbg(&ddata->spi->dev, "spi_sync %d\n", r);
 153}
 154
 155static inline void acx565akm_cmd(struct panel_drv_data *ddata, int cmd)
 156{
 157        acx565akm_transfer(ddata, cmd, NULL, 0, NULL, 0);
 158}
 159
 160static inline void acx565akm_write(struct panel_drv_data *ddata,
 161                               int reg, const u8 *buf, int len)
 162{
 163        acx565akm_transfer(ddata, reg, buf, len, NULL, 0);
 164}
 165
 166static inline void acx565akm_read(struct panel_drv_data *ddata,
 167                              int reg, u8 *buf, int len)
 168{
 169        acx565akm_transfer(ddata, reg, NULL, 0, buf, len);
 170}
 171
 172static void hw_guard_start(struct panel_drv_data *ddata, int guard_msec)
 173{
 174        ddata->hw_guard_wait = msecs_to_jiffies(guard_msec);
 175        ddata->hw_guard_end = jiffies + ddata->hw_guard_wait;
 176}
 177
 178static void hw_guard_wait(struct panel_drv_data *ddata)
 179{
 180        unsigned long wait = ddata->hw_guard_end - jiffies;
 181
 182        if ((long)wait > 0 && wait <= ddata->hw_guard_wait) {
 183                set_current_state(TASK_UNINTERRUPTIBLE);
 184                schedule_timeout(wait);
 185        }
 186}
 187
 188static void set_sleep_mode(struct panel_drv_data *ddata, int on)
 189{
 190        int cmd;
 191
 192        if (on)
 193                cmd = MIPID_CMD_SLEEP_IN;
 194        else
 195                cmd = MIPID_CMD_SLEEP_OUT;
 196        /*
 197         * We have to keep 120msec between sleep in/out commands.
 198         * (8.2.15, 8.2.16).
 199         */
 200        hw_guard_wait(ddata);
 201        acx565akm_cmd(ddata, cmd);
 202        hw_guard_start(ddata, 120);
 203}
 204
 205static void set_display_state(struct panel_drv_data *ddata, int enabled)
 206{
 207        int cmd = enabled ? MIPID_CMD_DISP_ON : MIPID_CMD_DISP_OFF;
 208
 209        acx565akm_cmd(ddata, cmd);
 210}
 211
 212static int panel_enabled(struct panel_drv_data *ddata)
 213{
 214        u32 disp_status;
 215        int enabled;
 216
 217        acx565akm_read(ddata, MIPID_CMD_READ_DISP_STATUS,
 218                        (u8 *)&disp_status, 4);
 219        disp_status = __be32_to_cpu(disp_status);
 220        enabled = (disp_status & (1 << 17)) && (disp_status & (1 << 10));
 221        dev_dbg(&ddata->spi->dev,
 222                "LCD panel %senabled by bootloader (status 0x%04x)\n",
 223                enabled ? "" : "not ", disp_status);
 224        return enabled;
 225}
 226
 227static int panel_detect(struct panel_drv_data *ddata)
 228{
 229        acx565akm_read(ddata, MIPID_CMD_READ_DISP_ID, ddata->display_id, 3);
 230        dev_dbg(&ddata->spi->dev, "MIPI display ID: %02x%02x%02x\n",
 231                ddata->display_id[0],
 232                ddata->display_id[1],
 233                ddata->display_id[2]);
 234
 235        switch (ddata->display_id[0]) {
 236        case 0x10:
 237                ddata->model = MIPID_VER_ACX565AKM;
 238                ddata->name = "acx565akm";
 239                ddata->has_bc = 1;
 240                ddata->has_cabc = 1;
 241                break;
 242        case 0x29:
 243                ddata->model = MIPID_VER_L4F00311;
 244                ddata->name = "l4f00311";
 245                break;
 246        case 0x45:
 247                ddata->model = MIPID_VER_LPH8923;
 248                ddata->name = "lph8923";
 249                break;
 250        case 0x83:
 251                ddata->model = MIPID_VER_LS041Y3;
 252                ddata->name = "ls041y3";
 253                break;
 254        default:
 255                ddata->name = "unknown";
 256                dev_err(&ddata->spi->dev, "invalid display ID\n");
 257                return -ENODEV;
 258        }
 259
 260        ddata->revision = ddata->display_id[1];
 261
 262        dev_info(&ddata->spi->dev, "omapfb: %s rev %02x LCD detected\n",
 263                        ddata->name, ddata->revision);
 264
 265        return 0;
 266}
 267
 268/*----------------------Backlight Control-------------------------*/
 269
 270static void enable_backlight_ctrl(struct panel_drv_data *ddata, int enable)
 271{
 272        u16 ctrl;
 273
 274        acx565akm_read(ddata, MIPID_CMD_READ_CTRL_DISP, (u8 *)&ctrl, 1);
 275        if (enable) {
 276                ctrl |= CTRL_DISP_BRIGHTNESS_CTRL_ON |
 277                        CTRL_DISP_BACKLIGHT_ON;
 278        } else {
 279                ctrl &= ~(CTRL_DISP_BRIGHTNESS_CTRL_ON |
 280                          CTRL_DISP_BACKLIGHT_ON);
 281        }
 282
 283        ctrl |= 1 << 8;
 284        acx565akm_write(ddata, MIPID_CMD_WRITE_CTRL_DISP, (u8 *)&ctrl, 2);
 285}
 286
 287static void set_cabc_mode(struct panel_drv_data *ddata, unsigned mode)
 288{
 289        u16 cabc_ctrl;
 290
 291        ddata->cabc_mode = mode;
 292        if (!ddata->enabled)
 293                return;
 294        cabc_ctrl = 0;
 295        acx565akm_read(ddata, MIPID_CMD_READ_CABC, (u8 *)&cabc_ctrl, 1);
 296        cabc_ctrl &= ~3;
 297        cabc_ctrl |= (1 << 8) | (mode & 3);
 298        acx565akm_write(ddata, MIPID_CMD_WRITE_CABC, (u8 *)&cabc_ctrl, 2);
 299}
 300
 301static unsigned get_cabc_mode(struct panel_drv_data *ddata)
 302{
 303        return ddata->cabc_mode;
 304}
 305
 306static unsigned get_hw_cabc_mode(struct panel_drv_data *ddata)
 307{
 308        u8 cabc_ctrl;
 309
 310        acx565akm_read(ddata, MIPID_CMD_READ_CABC, &cabc_ctrl, 1);
 311        return cabc_ctrl & 3;
 312}
 313
 314static void acx565akm_set_brightness(struct panel_drv_data *ddata, int level)
 315{
 316        int bv;
 317
 318        bv = level | (1 << 8);
 319        acx565akm_write(ddata, MIPID_CMD_WRITE_DISP_BRIGHTNESS, (u8 *)&bv, 2);
 320
 321        if (level)
 322                enable_backlight_ctrl(ddata, 1);
 323        else
 324                enable_backlight_ctrl(ddata, 0);
 325}
 326
 327static int acx565akm_get_actual_brightness(struct panel_drv_data *ddata)
 328{
 329        u8 bv;
 330
 331        acx565akm_read(ddata, MIPID_CMD_READ_DISP_BRIGHTNESS, &bv, 1);
 332
 333        return bv;
 334}
 335
 336
 337static int acx565akm_bl_update_status(struct backlight_device *dev)
 338{
 339        struct panel_drv_data *ddata = dev_get_drvdata(&dev->dev);
 340        int level;
 341
 342        dev_dbg(&ddata->spi->dev, "%s\n", __func__);
 343
 344        if (dev->props.fb_blank == FB_BLANK_UNBLANK &&
 345                        dev->props.power == FB_BLANK_UNBLANK)
 346                level = dev->props.brightness;
 347        else
 348                level = 0;
 349
 350        if (ddata->has_bc)
 351                acx565akm_set_brightness(ddata, level);
 352        else
 353                return -ENODEV;
 354
 355        return 0;
 356}
 357
 358static int acx565akm_bl_get_intensity(struct backlight_device *dev)
 359{
 360        struct panel_drv_data *ddata = dev_get_drvdata(&dev->dev);
 361
 362        dev_dbg(&dev->dev, "%s\n", __func__);
 363
 364        if (!ddata->has_bc)
 365                return -ENODEV;
 366
 367        if (dev->props.fb_blank == FB_BLANK_UNBLANK &&
 368                        dev->props.power == FB_BLANK_UNBLANK) {
 369                if (ddata->has_bc)
 370                        return acx565akm_get_actual_brightness(ddata);
 371                else
 372                        return dev->props.brightness;
 373        }
 374
 375        return 0;
 376}
 377
 378static int acx565akm_bl_update_status_locked(struct backlight_device *dev)
 379{
 380        struct panel_drv_data *ddata = dev_get_drvdata(&dev->dev);
 381        int r;
 382
 383        mutex_lock(&ddata->mutex);
 384        r = acx565akm_bl_update_status(dev);
 385        mutex_unlock(&ddata->mutex);
 386
 387        return r;
 388}
 389
 390static int acx565akm_bl_get_intensity_locked(struct backlight_device *dev)
 391{
 392        struct panel_drv_data *ddata = dev_get_drvdata(&dev->dev);
 393        int r;
 394
 395        mutex_lock(&ddata->mutex);
 396        r = acx565akm_bl_get_intensity(dev);
 397        mutex_unlock(&ddata->mutex);
 398
 399        return r;
 400}
 401
 402static const struct backlight_ops acx565akm_bl_ops = {
 403        .get_brightness = acx565akm_bl_get_intensity_locked,
 404        .update_status  = acx565akm_bl_update_status_locked,
 405};
 406
 407/*--------------------Auto Brightness control via Sysfs---------------------*/
 408
 409static const char * const cabc_modes[] = {
 410        "off",          /* always used when CABC is not supported */
 411        "ui",
 412        "still-image",
 413        "moving-image",
 414};
 415
 416static ssize_t show_cabc_mode(struct device *dev,
 417                struct device_attribute *attr,
 418                char *buf)
 419{
 420        struct panel_drv_data *ddata = dev_get_drvdata(dev);
 421        const char *mode_str;
 422        int mode;
 423        int len;
 424
 425        if (!ddata->has_cabc)
 426                mode = 0;
 427        else
 428                mode = get_cabc_mode(ddata);
 429        mode_str = "unknown";
 430        if (mode >= 0 && mode < ARRAY_SIZE(cabc_modes))
 431                mode_str = cabc_modes[mode];
 432        len = snprintf(buf, PAGE_SIZE, "%s\n", mode_str);
 433
 434        return len < PAGE_SIZE - 1 ? len : PAGE_SIZE - 1;
 435}
 436
 437static ssize_t store_cabc_mode(struct device *dev,
 438                struct device_attribute *attr,
 439                const char *buf, size_t count)
 440{
 441        struct panel_drv_data *ddata = dev_get_drvdata(dev);
 442        int i;
 443
 444        for (i = 0; i < ARRAY_SIZE(cabc_modes); i++) {
 445                const char *mode_str = cabc_modes[i];
 446                int cmp_len = strlen(mode_str);
 447
 448                if (count > 0 && buf[count - 1] == '\n')
 449                        count--;
 450                if (count != cmp_len)
 451                        continue;
 452
 453                if (strncmp(buf, mode_str, cmp_len) == 0)
 454                        break;
 455        }
 456
 457        if (i == ARRAY_SIZE(cabc_modes))
 458                return -EINVAL;
 459
 460        if (!ddata->has_cabc && i != 0)
 461                return -EINVAL;
 462
 463        mutex_lock(&ddata->mutex);
 464        set_cabc_mode(ddata, i);
 465        mutex_unlock(&ddata->mutex);
 466
 467        return count;
 468}
 469
 470static ssize_t show_cabc_available_modes(struct device *dev,
 471                struct device_attribute *attr,
 472                char *buf)
 473{
 474        struct panel_drv_data *ddata = dev_get_drvdata(dev);
 475        int len;
 476        int i;
 477
 478        if (!ddata->has_cabc)
 479                return snprintf(buf, PAGE_SIZE, "%s\n", cabc_modes[0]);
 480
 481        for (i = 0, len = 0;
 482             len < PAGE_SIZE && i < ARRAY_SIZE(cabc_modes); i++)
 483                len += snprintf(&buf[len], PAGE_SIZE - len, "%s%s%s",
 484                        i ? " " : "", cabc_modes[i],
 485                        i == ARRAY_SIZE(cabc_modes) - 1 ? "\n" : "");
 486
 487        return len < PAGE_SIZE ? len : PAGE_SIZE - 1;
 488}
 489
 490static DEVICE_ATTR(cabc_mode, S_IRUGO | S_IWUSR,
 491                show_cabc_mode, store_cabc_mode);
 492static DEVICE_ATTR(cabc_available_modes, S_IRUGO,
 493                show_cabc_available_modes, NULL);
 494
 495static struct attribute *bldev_attrs[] = {
 496        &dev_attr_cabc_mode.attr,
 497        &dev_attr_cabc_available_modes.attr,
 498        NULL,
 499};
 500
 501static const struct attribute_group bldev_attr_group = {
 502        .attrs = bldev_attrs,
 503};
 504
 505static int acx565akm_connect(struct omap_dss_device *dssdev)
 506{
 507        struct panel_drv_data *ddata = to_panel_data(dssdev);
 508        struct omap_dss_device *in = ddata->in;
 509        int r;
 510
 511        if (omapdss_device_is_connected(dssdev))
 512                return 0;
 513
 514        r = in->ops.sdi->connect(in, dssdev);
 515        if (r)
 516                return r;
 517
 518        return 0;
 519}
 520
 521static void acx565akm_disconnect(struct omap_dss_device *dssdev)
 522{
 523        struct panel_drv_data *ddata = to_panel_data(dssdev);
 524        struct omap_dss_device *in = ddata->in;
 525
 526        if (!omapdss_device_is_connected(dssdev))
 527                return;
 528
 529        in->ops.sdi->disconnect(in, dssdev);
 530}
 531
 532static int acx565akm_panel_power_on(struct omap_dss_device *dssdev)
 533{
 534        struct panel_drv_data *ddata = to_panel_data(dssdev);
 535        struct omap_dss_device *in = ddata->in;
 536        int r;
 537
 538        dev_dbg(&ddata->spi->dev, "%s\n", __func__);
 539
 540        in->ops.sdi->set_timings(in, &ddata->videomode);
 541
 542        if (ddata->datapairs > 0)
 543                in->ops.sdi->set_datapairs(in, ddata->datapairs);
 544
 545        r = in->ops.sdi->enable(in);
 546        if (r) {
 547                pr_err("%s sdi enable failed\n", __func__);
 548                return r;
 549        }
 550
 551        /*FIXME tweak me */
 552        msleep(50);
 553
 554        if (gpio_is_valid(ddata->reset_gpio))
 555                gpio_set_value(ddata->reset_gpio, 1);
 556
 557        if (ddata->enabled) {
 558                dev_dbg(&ddata->spi->dev, "panel already enabled\n");
 559                return 0;
 560        }
 561
 562        /*
 563         * We have to meet all the following delay requirements:
 564         * 1. tRW: reset pulse width 10usec (7.12.1)
 565         * 2. tRT: reset cancel time 5msec (7.12.1)
 566         * 3. Providing PCLK,HS,VS signals for 2 frames = ~50msec worst
 567         *    case (7.6.2)
 568         * 4. 120msec before the sleep out command (7.12.1)
 569         */
 570        msleep(120);
 571
 572        set_sleep_mode(ddata, 0);
 573        ddata->enabled = 1;
 574
 575        /* 5msec between sleep out and the next command. (8.2.16) */
 576        usleep_range(5000, 10000);
 577        set_display_state(ddata, 1);
 578        set_cabc_mode(ddata, ddata->cabc_mode);
 579
 580        return acx565akm_bl_update_status(ddata->bl_dev);
 581}
 582
 583static void acx565akm_panel_power_off(struct omap_dss_device *dssdev)
 584{
 585        struct panel_drv_data *ddata = to_panel_data(dssdev);
 586        struct omap_dss_device *in = ddata->in;
 587
 588        dev_dbg(dssdev->dev, "%s\n", __func__);
 589
 590        if (!ddata->enabled)
 591                return;
 592
 593        set_display_state(ddata, 0);
 594        set_sleep_mode(ddata, 1);
 595        ddata->enabled = 0;
 596        /*
 597         * We have to provide PCLK,HS,VS signals for 2 frames (worst case
 598         * ~50msec) after sending the sleep in command and asserting the
 599         * reset signal. We probably could assert the reset w/o the delay
 600         * but we still delay to avoid possible artifacts. (7.6.1)
 601         */
 602        msleep(50);
 603
 604        if (gpio_is_valid(ddata->reset_gpio))
 605                gpio_set_value(ddata->reset_gpio, 0);
 606
 607        /* FIXME need to tweak this delay */
 608        msleep(100);
 609
 610        in->ops.sdi->disable(in);
 611}
 612
 613static int acx565akm_enable(struct omap_dss_device *dssdev)
 614{
 615        struct panel_drv_data *ddata = to_panel_data(dssdev);
 616        int r;
 617
 618        dev_dbg(dssdev->dev, "%s\n", __func__);
 619
 620        if (!omapdss_device_is_connected(dssdev))
 621                return -ENODEV;
 622
 623        if (omapdss_device_is_enabled(dssdev))
 624                return 0;
 625
 626        mutex_lock(&ddata->mutex);
 627        r = acx565akm_panel_power_on(dssdev);
 628        mutex_unlock(&ddata->mutex);
 629        if (r)
 630                return r;
 631
 632        dssdev->state = OMAP_DSS_DISPLAY_ACTIVE;
 633
 634        return 0;
 635}
 636
 637static void acx565akm_disable(struct omap_dss_device *dssdev)
 638{
 639        struct panel_drv_data *ddata = to_panel_data(dssdev);
 640
 641        dev_dbg(dssdev->dev, "%s\n", __func__);
 642
 643        if (!omapdss_device_is_enabled(dssdev))
 644                return;
 645
 646        mutex_lock(&ddata->mutex);
 647        acx565akm_panel_power_off(dssdev);
 648        mutex_unlock(&ddata->mutex);
 649
 650        dssdev->state = OMAP_DSS_DISPLAY_DISABLED;
 651}
 652
 653static void acx565akm_set_timings(struct omap_dss_device *dssdev,
 654                struct omap_video_timings *timings)
 655{
 656        struct panel_drv_data *ddata = to_panel_data(dssdev);
 657        struct omap_dss_device *in = ddata->in;
 658
 659        ddata->videomode = *timings;
 660        dssdev->panel.timings = *timings;
 661
 662        in->ops.sdi->set_timings(in, timings);
 663}
 664
 665static void acx565akm_get_timings(struct omap_dss_device *dssdev,
 666                struct omap_video_timings *timings)
 667{
 668        struct panel_drv_data *ddata = to_panel_data(dssdev);
 669
 670        *timings = ddata->videomode;
 671}
 672
 673static int acx565akm_check_timings(struct omap_dss_device *dssdev,
 674                struct omap_video_timings *timings)
 675{
 676        struct panel_drv_data *ddata = to_panel_data(dssdev);
 677        struct omap_dss_device *in = ddata->in;
 678
 679        return in->ops.sdi->check_timings(in, timings);
 680}
 681
 682static struct omap_dss_driver acx565akm_ops = {
 683        .connect        = acx565akm_connect,
 684        .disconnect     = acx565akm_disconnect,
 685
 686        .enable         = acx565akm_enable,
 687        .disable        = acx565akm_disable,
 688
 689        .set_timings    = acx565akm_set_timings,
 690        .get_timings    = acx565akm_get_timings,
 691        .check_timings  = acx565akm_check_timings,
 692
 693        .get_resolution = omapdss_default_get_resolution,
 694};
 695
 696static int acx565akm_probe_pdata(struct spi_device *spi)
 697{
 698        const struct panel_acx565akm_platform_data *pdata;
 699        struct panel_drv_data *ddata = dev_get_drvdata(&spi->dev);
 700        struct omap_dss_device *dssdev, *in;
 701
 702        pdata = dev_get_platdata(&spi->dev);
 703
 704        ddata->reset_gpio = pdata->reset_gpio;
 705
 706        in = omap_dss_find_output(pdata->source);
 707        if (in == NULL) {
 708                dev_err(&spi->dev, "failed to find video source '%s'\n",
 709                                pdata->source);
 710                return -EPROBE_DEFER;
 711        }
 712        ddata->in = in;
 713
 714        ddata->datapairs = pdata->datapairs;
 715
 716        dssdev = &ddata->dssdev;
 717        dssdev->name = pdata->name;
 718
 719        return 0;
 720}
 721
 722static int acx565akm_probe_of(struct spi_device *spi)
 723{
 724        struct panel_drv_data *ddata = dev_get_drvdata(&spi->dev);
 725        struct device_node *np = spi->dev.of_node;
 726
 727        ddata->reset_gpio = of_get_named_gpio(np, "reset-gpios", 0);
 728
 729        ddata->in = omapdss_of_find_source_for_first_ep(np);
 730        if (IS_ERR(ddata->in)) {
 731                dev_err(&spi->dev, "failed to find video source\n");
 732                return PTR_ERR(ddata->in);
 733        }
 734
 735        return 0;
 736}
 737
 738static int acx565akm_probe(struct spi_device *spi)
 739{
 740        struct panel_drv_data *ddata;
 741        struct omap_dss_device *dssdev;
 742        struct backlight_device *bldev;
 743        int max_brightness, brightness;
 744        struct backlight_properties props;
 745        int r;
 746
 747        dev_dbg(&spi->dev, "%s\n", __func__);
 748
 749        spi->mode = SPI_MODE_3;
 750
 751        ddata = devm_kzalloc(&spi->dev, sizeof(*ddata), GFP_KERNEL);
 752        if (ddata == NULL)
 753                return -ENOMEM;
 754
 755        dev_set_drvdata(&spi->dev, ddata);
 756
 757        ddata->spi = spi;
 758
 759        mutex_init(&ddata->mutex);
 760
 761        if (dev_get_platdata(&spi->dev)) {
 762                r = acx565akm_probe_pdata(spi);
 763                if (r)
 764                        return r;
 765        } else if (spi->dev.of_node) {
 766                r = acx565akm_probe_of(spi);
 767                if (r)
 768                        return r;
 769        } else {
 770                dev_err(&spi->dev, "platform data missing!\n");
 771                return -ENODEV;
 772        }
 773
 774        if (gpio_is_valid(ddata->reset_gpio)) {
 775                r = devm_gpio_request_one(&spi->dev, ddata->reset_gpio,
 776                                GPIOF_OUT_INIT_LOW, "lcd reset");
 777                if (r)
 778                        goto err_gpio;
 779        }
 780
 781        if (gpio_is_valid(ddata->reset_gpio))
 782                gpio_set_value(ddata->reset_gpio, 1);
 783
 784        /*
 785         * After reset we have to wait 5 msec before the first
 786         * command can be sent.
 787         */
 788        usleep_range(5000, 10000);
 789
 790        ddata->enabled = panel_enabled(ddata);
 791
 792        r = panel_detect(ddata);
 793
 794        if (!ddata->enabled && gpio_is_valid(ddata->reset_gpio))
 795                gpio_set_value(ddata->reset_gpio, 0);
 796
 797        if (r) {
 798                dev_err(&spi->dev, "%s panel detect error\n", __func__);
 799                goto err_detect;
 800        }
 801
 802        memset(&props, 0, sizeof(props));
 803        props.fb_blank = FB_BLANK_UNBLANK;
 804        props.power = FB_BLANK_UNBLANK;
 805        props.type = BACKLIGHT_RAW;
 806
 807        bldev = backlight_device_register("acx565akm", &ddata->spi->dev,
 808                        ddata, &acx565akm_bl_ops, &props);
 809        if (IS_ERR(bldev)) {
 810                r = PTR_ERR(bldev);
 811                goto err_reg_bl;
 812        }
 813        ddata->bl_dev = bldev;
 814        if (ddata->has_cabc) {
 815                r = sysfs_create_group(&bldev->dev.kobj, &bldev_attr_group);
 816                if (r) {
 817                        dev_err(&bldev->dev,
 818                                "%s failed to create sysfs files\n", __func__);
 819                        goto err_sysfs;
 820                }
 821                ddata->cabc_mode = get_hw_cabc_mode(ddata);
 822        }
 823
 824        max_brightness = 255;
 825
 826        if (ddata->has_bc)
 827                brightness = acx565akm_get_actual_brightness(ddata);
 828        else
 829                brightness = 0;
 830
 831        bldev->props.max_brightness = max_brightness;
 832        bldev->props.brightness = brightness;
 833
 834        acx565akm_bl_update_status(bldev);
 835
 836
 837        ddata->videomode = acx565akm_panel_timings;
 838
 839        dssdev = &ddata->dssdev;
 840        dssdev->dev = &spi->dev;
 841        dssdev->driver = &acx565akm_ops;
 842        dssdev->type = OMAP_DISPLAY_TYPE_SDI;
 843        dssdev->owner = THIS_MODULE;
 844        dssdev->panel.timings = ddata->videomode;
 845
 846        r = omapdss_register_display(dssdev);
 847        if (r) {
 848                dev_err(&spi->dev, "Failed to register panel\n");
 849                goto err_reg;
 850        }
 851
 852        return 0;
 853
 854err_reg:
 855        sysfs_remove_group(&bldev->dev.kobj, &bldev_attr_group);
 856err_sysfs:
 857        backlight_device_unregister(bldev);
 858err_reg_bl:
 859err_detect:
 860err_gpio:
 861        omap_dss_put_device(ddata->in);
 862        return r;
 863}
 864
 865static int acx565akm_remove(struct spi_device *spi)
 866{
 867        struct panel_drv_data *ddata = dev_get_drvdata(&spi->dev);
 868        struct omap_dss_device *dssdev = &ddata->dssdev;
 869        struct omap_dss_device *in = ddata->in;
 870
 871        dev_dbg(&ddata->spi->dev, "%s\n", __func__);
 872
 873        sysfs_remove_group(&ddata->bl_dev->dev.kobj, &bldev_attr_group);
 874        backlight_device_unregister(ddata->bl_dev);
 875
 876        omapdss_unregister_display(dssdev);
 877
 878        acx565akm_disable(dssdev);
 879        acx565akm_disconnect(dssdev);
 880
 881        omap_dss_put_device(in);
 882
 883        return 0;
 884}
 885
 886static const struct of_device_id acx565akm_of_match[] = {
 887        { .compatible = "omapdss,sony,acx565akm", },
 888        {},
 889};
 890MODULE_DEVICE_TABLE(of, acx565akm_of_match);
 891
 892static struct spi_driver acx565akm_driver = {
 893        .driver = {
 894                .name   = "acx565akm",
 895                .of_match_table = acx565akm_of_match,
 896                .suppress_bind_attrs = true,
 897        },
 898        .probe  = acx565akm_probe,
 899        .remove = acx565akm_remove,
 900};
 901
 902module_spi_driver(acx565akm_driver);
 903
 904MODULE_AUTHOR("Nokia Corporation");
 905MODULE_DESCRIPTION("acx565akm LCD Driver");
 906MODULE_LICENSE("GPL");
 907