git.oblomov.eu Git - linux-2.6/blob - drivers/video/backlight/corgi_lcd.c

   1 /*
   2  *  LCD/Backlight Driver for Sharp Zaurus Handhelds (various models)
   3  *
   4  *  Copyright (c) 2004-2006 Richard Purdie
   5  *
   6  *  Based on Sharp's 2.4 Backlight Driver
   7  *
   8  *  Copyright (c) 2008 Marvell International Ltd.
   9  *      Converted to SPI device based LCD/Backlight device driver
  10  *      by Eric Miao <eric.miao@marvell.com>
  11  *
  12  *  This program is free software; you can redistribute it and/or modify
  13  *  it under the terms of the GNU General Public License version 2 as
  14  *  published by the Free Software Foundation.
  15  *
  16  */
  17
  18 #include <linux/module.h>
  19 #include <linux/kernel.h>
  20 #include <linux/init.h>
  21 #include <linux/delay.h>
  22 #include <linux/gpio.h>
  23 #include <linux/fb.h>
  24 #include <linux/lcd.h>
  25 #include <linux/spi/spi.h>
  26 #include <linux/spi/corgi_lcd.h>
  27 #include <asm/mach/sharpsl_param.h>
  28
  29 #define POWER_IS_ON(pwr)        ((pwr) <= FB_BLANK_NORMAL)
  30
  31 /* Register Addresses */
  32 #define RESCTL_ADRS     0x00
  33 #define PHACTRL_ADRS    0x01
  34 #define DUTYCTRL_ADRS   0x02
  35 #define POWERREG0_ADRS  0x03
  36 #define POWERREG1_ADRS  0x04
  37 #define GPOR3_ADRS      0x05
  38 #define PICTRL_ADRS     0x06
  39 #define POLCTRL_ADRS    0x07
  40
  41 /* Register Bit Definitions */
  42 #define RESCTL_QVGA     0x01
  43 #define RESCTL_VGA      0x00
  44
  45 #define POWER1_VW_ON    0x01  /* VW Supply FET ON */
  46 #define POWER1_GVSS_ON  0x02  /* GVSS(-8V) Power Supply ON */
  47 #define POWER1_VDD_ON   0x04  /* VDD(8V),SVSS(-4V) Power Supply ON */
  48
  49 #define POWER1_VW_OFF   0x00  /* VW Supply FET OFF */
  50 #define POWER1_GVSS_OFF 0x00  /* GVSS(-8V) Power Supply OFF */
  51 #define POWER1_VDD_OFF  0x00  /* VDD(8V),SVSS(-4V) Power Supply OFF */
  52
  53 #define POWER0_COM_DCLK 0x01  /* COM Voltage DC Bias DAC Serial Data Clock */
  54 #define POWER0_COM_DOUT 0x02  /* COM Voltage DC Bias DAC Serial Data Out */
  55 #define POWER0_DAC_ON   0x04  /* DAC Power Supply ON */
  56 #define POWER0_COM_ON   0x08  /* COM Power Supply ON */
  57 #define POWER0_VCC5_ON  0x10  /* VCC5 Power Supply ON */
  58
  59 #define POWER0_DAC_OFF  0x00  /* DAC Power Supply OFF */
  60 #define POWER0_COM_OFF  0x00  /* COM Power Supply OFF */
  61 #define POWER0_VCC5_OFF 0x00  /* VCC5 Power Supply OFF */
  62
  63 #define PICTRL_INIT_STATE      0x01
  64 #define PICTRL_INIOFF          0x02
  65 #define PICTRL_POWER_DOWN      0x04
  66 #define PICTRL_COM_SIGNAL_OFF  0x08
  67 #define PICTRL_DAC_SIGNAL_OFF  0x10
  68
  69 #define POLCTRL_SYNC_POL_FALL  0x01
  70 #define POLCTRL_EN_POL_FALL    0x02
  71 #define POLCTRL_DATA_POL_FALL  0x04
  72 #define POLCTRL_SYNC_ACT_H     0x08
  73 #define POLCTRL_EN_ACT_L       0x10
  74
  75 #define POLCTRL_SYNC_POL_RISE  0x00
  76 #define POLCTRL_EN_POL_RISE    0x00
  77 #define POLCTRL_DATA_POL_RISE  0x00
  78 #define POLCTRL_SYNC_ACT_L     0x00
  79 #define POLCTRL_EN_ACT_H       0x00
  80
  81 #define PHACTRL_PHASE_MANUAL   0x01
  82 #define DEFAULT_PHAD_QVGA     (9)
  83 #define DEFAULT_COMADJ        (125)
  84
  85 struct corgi_lcd {
  86         struct spi_device       *spi_dev;
  87         struct lcd_device       *lcd_dev;
  88         struct backlight_device *bl_dev;
  89
  90         int     limit_mask;
  91         int     intensity;
  92         int     power;
  93         int     mode;
  94         char    buf[2];
  95
  96         int     gpio_backlight_on;
  97         int     gpio_backlight_cont;
  98         int     gpio_backlight_cont_inverted;
  99
 100         void (*kick_battery)(void);
 101 };
 102
 103 static int corgi_ssp_lcdtg_send(struct corgi_lcd *lcd, int reg, uint8_t val);
 104
 105 static struct corgi_lcd *the_corgi_lcd;
 106 static unsigned long corgibl_flags;
 107 #define CORGIBL_SUSPENDED     0x01
 108 #define CORGIBL_BATTLOW       0x02
 109
 110 /*
 111  * This is only a psuedo I2C interface. We can't use the standard kernel
 112  * routines as the interface is write only. We just assume the data is acked...
 113  */
 114 static void lcdtg_ssp_i2c_send(struct corgi_lcd *lcd, uint8_t data)
 115 {
 116         corgi_ssp_lcdtg_send(lcd, POWERREG0_ADRS, data);
 117         udelay(10);
 118 }
 119
 120 static void lcdtg_i2c_send_bit(struct corgi_lcd *lcd, uint8_t data)
 121 {
 122         lcdtg_ssp_i2c_send(lcd, data);
 123         lcdtg_ssp_i2c_send(lcd, data | POWER0_COM_DCLK);
 124         lcdtg_ssp_i2c_send(lcd, data);
 125 }
 126
 127 static void lcdtg_i2c_send_start(struct corgi_lcd *lcd, uint8_t base)
 128 {
 129         lcdtg_ssp_i2c_send(lcd, base | POWER0_COM_DCLK | POWER0_COM_DOUT);
 130         lcdtg_ssp_i2c_send(lcd, base | POWER0_COM_DCLK);
 131         lcdtg_ssp_i2c_send(lcd, base);
 132 }
 133
 134 static void lcdtg_i2c_send_stop(struct corgi_lcd *lcd, uint8_t base)
 135 {
 136         lcdtg_ssp_i2c_send(lcd, base);
 137         lcdtg_ssp_i2c_send(lcd, base | POWER0_COM_DCLK);
 138         lcdtg_ssp_i2c_send(lcd, base | POWER0_COM_DCLK | POWER0_COM_DOUT);
 139 }
 140
 141 static void lcdtg_i2c_send_byte(struct corgi_lcd *lcd,
 142                                 uint8_t base, uint8_t data)
 143 {
 144         int i;
 145         for (i = 0; i < 8; i++) {
 146                 if (data & 0x80)
 147                         lcdtg_i2c_send_bit(lcd, base | POWER0_COM_DOUT);
 148                 else
 149                         lcdtg_i2c_send_bit(lcd, base);
 150                 data <<= 1;
 151         }
 152 }
 153
 154 static void lcdtg_i2c_wait_ack(struct corgi_lcd *lcd, uint8_t base)
 155 {
 156         lcdtg_i2c_send_bit(lcd, base);
 157 }
 158
 159 static void lcdtg_set_common_voltage(struct corgi_lcd *lcd,
 160                                      uint8_t base_data, uint8_t data)
 161 {
 162         /* Set Common Voltage to M62332FP via I2C */
 163         lcdtg_i2c_send_start(lcd, base_data);
 164         lcdtg_i2c_send_byte(lcd, base_data, 0x9c);
 165         lcdtg_i2c_wait_ack(lcd, base_data);
 166         lcdtg_i2c_send_byte(lcd, base_data, 0x00);
 167         lcdtg_i2c_wait_ack(lcd, base_data);
 168         lcdtg_i2c_send_byte(lcd, base_data, data);
 169         lcdtg_i2c_wait_ack(lcd, base_data);
 170         lcdtg_i2c_send_stop(lcd, base_data);
 171 }
 172
 173 static int corgi_ssp_lcdtg_send(struct corgi_lcd *lcd, int adrs, uint8_t data)
 174 {
 175         struct spi_message msg;
 176         struct spi_transfer xfer = {
 177                 .len            = 1,
 178                 .cs_change      = 1,
 179                 .tx_buf         = lcd->buf,
 180         };
 181
 182         lcd->buf[0] = ((adrs & 0x07) << 5) | (data & 0x1f);
 183         spi_message_init(&msg);
 184         spi_message_add_tail(&xfer, &msg);
 185
 186         return spi_sync(lcd->spi_dev, &msg);
 187 }
 188
 189 /* Set Phase Adjust */
 190 static void lcdtg_set_phadadj(struct corgi_lcd *lcd, int mode)
 191 {
 192         int adj;
 193
 194         switch(mode) {
 195         case CORGI_LCD_MODE_VGA:
 196                 /* Setting for VGA */
 197                 adj = sharpsl_param.phadadj;
 198                 adj = (adj < 0) ? PHACTRL_PHASE_MANUAL :
 199                                   PHACTRL_PHASE_MANUAL | ((adj & 0xf) << 1);
 200                 break;
 201         case CORGI_LCD_MODE_QVGA:
 202         default:
 203                 /* Setting for QVGA */
 204                 adj = (DEFAULT_PHAD_QVGA << 1) | PHACTRL_PHASE_MANUAL;
 205                 break;
 206         }
 207
 208         corgi_ssp_lcdtg_send(lcd, PHACTRL_ADRS, adj);
 209 }
 210
 211 static void corgi_lcd_power_on(struct corgi_lcd *lcd)
 212 {
 213         int comadj;
 214
 215         /* Initialize Internal Logic & Port */
 216         corgi_ssp_lcdtg_send(lcd, PICTRL_ADRS,
 217                         PICTRL_POWER_DOWN | PICTRL_INIOFF |
 218                         PICTRL_INIT_STATE | PICTRL_COM_SIGNAL_OFF |
 219                         PICTRL_DAC_SIGNAL_OFF);
 220
 221         corgi_ssp_lcdtg_send(lcd, POWERREG0_ADRS,
 222                         POWER0_COM_DCLK | POWER0_COM_DOUT | POWER0_DAC_OFF |
 223                         POWER0_COM_OFF | POWER0_VCC5_OFF);
 224
 225         corgi_ssp_lcdtg_send(lcd, POWERREG1_ADRS,
 226                         POWER1_VW_OFF | POWER1_GVSS_OFF | POWER1_VDD_OFF);
 227
 228         /* VDD(+8V), SVSS(-4V) ON */
 229         corgi_ssp_lcdtg_send(lcd, POWERREG1_ADRS,
 230                         POWER1_VW_OFF | POWER1_GVSS_OFF | POWER1_VDD_ON);
 231         mdelay(3);
 232
 233         /* DAC ON */
 234         corgi_ssp_lcdtg_send(lcd, POWERREG0_ADRS,
 235                         POWER0_COM_DCLK | POWER0_COM_DOUT | POWER0_DAC_ON |
 236                         POWER0_COM_OFF | POWER0_VCC5_OFF);
 237
 238         /* INIB = H, INI = L  */
 239         /* PICTL[0] = H , PICTL[1] = PICTL[2] = PICTL[4] = L */
 240         corgi_ssp_lcdtg_send(lcd, PICTRL_ADRS,
 241                         PICTRL_INIT_STATE | PICTRL_COM_SIGNAL_OFF);
 242
 243         /* Set Common Voltage */
 244         comadj = sharpsl_param.comadj;
 245         if (comadj < 0)
 246                 comadj = DEFAULT_COMADJ;
 247
 248         lcdtg_set_common_voltage(lcd, POWER0_DAC_ON | POWER0_COM_OFF |
 249                                  POWER0_VCC5_OFF, comadj);
 250
 251         /* VCC5 ON, DAC ON */
 252         corgi_ssp_lcdtg_send(lcd, POWERREG0_ADRS,
 253                         POWER0_COM_DCLK | POWER0_COM_DOUT | POWER0_DAC_ON |
 254                         POWER0_COM_OFF | POWER0_VCC5_ON);
 255
 256         /* GVSS(-8V) ON, VDD ON */
 257         corgi_ssp_lcdtg_send(lcd, POWERREG1_ADRS,
 258                         POWER1_VW_OFF | POWER1_GVSS_ON | POWER1_VDD_ON);
 259         mdelay(2);
 260
 261         /* COM SIGNAL ON (PICTL[3] = L) */
 262         corgi_ssp_lcdtg_send(lcd, PICTRL_ADRS, PICTRL_INIT_STATE);
 263
 264         /* COM ON, DAC ON, VCC5_ON */
 265         corgi_ssp_lcdtg_send(lcd, POWERREG0_ADRS,
 266                         POWER0_COM_DCLK | POWER0_COM_DOUT | POWER0_DAC_ON |
 267                         POWER0_COM_ON | POWER0_VCC5_ON);
 268
 269         /* VW ON, GVSS ON, VDD ON */
 270         corgi_ssp_lcdtg_send(lcd, POWERREG1_ADRS,
 271                         POWER1_VW_ON | POWER1_GVSS_ON | POWER1_VDD_ON);
 272
 273         /* Signals output enable */
 274         corgi_ssp_lcdtg_send(lcd, PICTRL_ADRS, 0);
 275
 276         /* Set Phase Adjust */
 277         lcdtg_set_phadadj(lcd, lcd->mode);
 278
 279         /* Initialize for Input Signals from ATI */
 280         corgi_ssp_lcdtg_send(lcd, POLCTRL_ADRS,
 281                         POLCTRL_SYNC_POL_RISE | POLCTRL_EN_POL_RISE |
 282                         POLCTRL_DATA_POL_RISE | POLCTRL_SYNC_ACT_L |
 283                         POLCTRL_EN_ACT_H);
 284         udelay(1000);
 285
 286         switch (lcd->mode) {
 287         case CORGI_LCD_MODE_VGA:
 288                 corgi_ssp_lcdtg_send(lcd, RESCTL_ADRS, RESCTL_VGA);
 289                 break;
 290         case CORGI_LCD_MODE_QVGA:
 291         default:
 292                 corgi_ssp_lcdtg_send(lcd, RESCTL_ADRS, RESCTL_QVGA);
 293                 break;
 294         }
 295 }
 296
 297 static void corgi_lcd_power_off(struct corgi_lcd *lcd)
 298 {
 299         /* 60Hz x 2 frame = 16.7msec x 2 = 33.4 msec */
 300         msleep(34);
 301
 302         /* (1)VW OFF */
 303         corgi_ssp_lcdtg_send(lcd, POWERREG1_ADRS,
 304                         POWER1_VW_OFF | POWER1_GVSS_ON | POWER1_VDD_ON);
 305
 306         /* (2)COM OFF */
 307         corgi_ssp_lcdtg_send(lcd, PICTRL_ADRS, PICTRL_COM_SIGNAL_OFF);
 308         corgi_ssp_lcdtg_send(lcd, POWERREG0_ADRS,
 309                         POWER0_DAC_ON | POWER0_COM_OFF | POWER0_VCC5_ON);
 310
 311         /* (3)Set Common Voltage Bias 0V */
 312         lcdtg_set_common_voltage(lcd, POWER0_DAC_ON | POWER0_COM_OFF |
 313                         POWER0_VCC5_ON, 0);
 314
 315         /* (4)GVSS OFF */
 316         corgi_ssp_lcdtg_send(lcd, POWERREG1_ADRS,
 317                         POWER1_VW_OFF | POWER1_GVSS_OFF | POWER1_VDD_ON);
 318
 319         /* (5)VCC5 OFF */
 320         corgi_ssp_lcdtg_send(lcd, POWERREG0_ADRS,
 321                         POWER0_DAC_ON | POWER0_COM_OFF | POWER0_VCC5_OFF);
 322
 323         /* (6)Set PDWN, INIOFF, DACOFF */
 324         corgi_ssp_lcdtg_send(lcd, PICTRL_ADRS,
 325                         PICTRL_INIOFF | PICTRL_DAC_SIGNAL_OFF |
 326                         PICTRL_POWER_DOWN | PICTRL_COM_SIGNAL_OFF);
 327
 328         /* (7)DAC OFF */
 329         corgi_ssp_lcdtg_send(lcd, POWERREG0_ADRS,
 330                         POWER0_DAC_OFF | POWER0_COM_OFF | POWER0_VCC5_OFF);
 331
 332         /* (8)VDD OFF */
 333         corgi_ssp_lcdtg_send(lcd, POWERREG1_ADRS,
 334                         POWER1_VW_OFF | POWER1_GVSS_OFF | POWER1_VDD_OFF);
 335 }
 336
 337 static int corgi_lcd_set_mode(struct lcd_device *ld, struct fb_videomode *m)
 338 {
 339         struct corgi_lcd *lcd = dev_get_drvdata(&ld->dev);
 340         int mode = CORGI_LCD_MODE_QVGA;
 341
 342         if (m->xres == 640 || m->xres == 480)
 343                 mode = CORGI_LCD_MODE_VGA;
 344
 345         if (lcd->mode == mode)
 346                 return 0;
 347
 348         lcdtg_set_phadadj(lcd, mode);
 349
 350         switch (mode) {
 351         case CORGI_LCD_MODE_VGA:
 352                 corgi_ssp_lcdtg_send(lcd, RESCTL_ADRS, RESCTL_VGA);
 353                 break;
 354         case CORGI_LCD_MODE_QVGA:
 355         default:
 356                 corgi_ssp_lcdtg_send(lcd, RESCTL_ADRS, RESCTL_QVGA);
 357                 break;
 358         }
 359
 360         lcd->mode = mode;
 361         return 0;
 362 }
 363
 364 static int corgi_lcd_set_power(struct lcd_device *ld, int power)
 365 {
 366         struct corgi_lcd *lcd = dev_get_drvdata(&ld->dev);
 367
 368         if (POWER_IS_ON(power) && !POWER_IS_ON(lcd->power))
 369                 corgi_lcd_power_on(lcd);
 370
 371         if (!POWER_IS_ON(power) && POWER_IS_ON(lcd->power))
 372                 corgi_lcd_power_off(lcd);
 373
 374         lcd->power = power;
 375         return 0;
 376 }
 377
 378 static int corgi_lcd_get_power(struct lcd_device *ld)
 379 {
 380         struct corgi_lcd *lcd = dev_get_drvdata(&ld->dev);
 381
 382         return lcd->power;
 383 }
 384
 385 static struct lcd_ops corgi_lcd_ops = {
 386         .get_power      = corgi_lcd_get_power,
 387         .set_power      = corgi_lcd_set_power,
 388         .set_mode       = corgi_lcd_set_mode,
 389 };
 390
 391 static int corgi_bl_get_intensity(struct backlight_device *bd)
 392 {
 393         struct corgi_lcd *lcd = dev_get_drvdata(&bd->dev);
 394
 395         return lcd->intensity;
 396 }
 397
 398 static int corgi_bl_set_intensity(struct corgi_lcd *lcd, int intensity)
 399 {
 400         int cont;
 401
 402         if (intensity > 0x10)
 403                 intensity += 0x10;
 404
 405         corgi_ssp_lcdtg_send(lcd, DUTYCTRL_ADRS, intensity);
 406
 407         /* Bit 5 via GPIO_BACKLIGHT_CONT */
 408         cont = !!(intensity & 0x20) ^ lcd->gpio_backlight_cont_inverted;
 409
 410         if (gpio_is_valid(lcd->gpio_backlight_cont))
 411                 gpio_set_value(lcd->gpio_backlight_cont, cont);
 412
 413         if (gpio_is_valid(lcd->gpio_backlight_on))
 414                 gpio_set_value(lcd->gpio_backlight_on, intensity);
 415
 416         if (lcd->kick_battery)
 417                 lcd->kick_battery();
 418
 419         lcd->intensity = intensity;
 420         return 0;
 421 }
 422
 423 static int corgi_bl_update_status(struct backlight_device *bd)
 424 {
 425         struct corgi_lcd *lcd = dev_get_drvdata(&bd->dev);
 426         int intensity = bd->props.brightness;
 427
 428         if (bd->props.power != FB_BLANK_UNBLANK)
 429                 intensity = 0;
 430
 431         if (bd->props.fb_blank != FB_BLANK_UNBLANK)
 432                 intensity = 0;
 433
 434         if (corgibl_flags & CORGIBL_SUSPENDED)
 435                 intensity = 0;
 436         if (corgibl_flags & CORGIBL_BATTLOW)
 437                 intensity &= lcd->limit_mask;
 438
 439         return corgi_bl_set_intensity(lcd, intensity);
 440 }
 441
 442 void corgibl_limit_intensity(int limit)
 443 {
 444         if (limit)
 445                 corgibl_flags |= CORGIBL_BATTLOW;
 446         else
 447                 corgibl_flags &= ~CORGIBL_BATTLOW;
 448
 449         backlight_update_status(the_corgi_lcd->bl_dev);
 450 }
 451 EXPORT_SYMBOL(corgibl_limit_intensity);
 452
 453 static struct backlight_ops corgi_bl_ops = {
 454         .get_brightness = corgi_bl_get_intensity,
 455         .update_status  = corgi_bl_update_status,
 456 };
 457
 458 #ifdef CONFIG_PM
 459 static int corgi_lcd_suspend(struct spi_device *spi, pm_message_t state)
 460 {
 461         struct corgi_lcd *lcd = dev_get_drvdata(&spi->dev);
 462
 463         corgibl_flags |= CORGIBL_SUSPENDED;
 464         corgi_bl_set_intensity(lcd, 0);
 465         corgi_lcd_set_power(lcd->lcd_dev, FB_BLANK_POWERDOWN);
 466         return 0;
 467 }
 468
 469 static int corgi_lcd_resume(struct spi_device *spi)
 470 {
 471         struct corgi_lcd *lcd = dev_get_drvdata(&spi->dev);
 472
 473         corgibl_flags &= ~CORGIBL_SUSPENDED;
 474         corgi_lcd_set_power(lcd->lcd_dev, FB_BLANK_UNBLANK);
 475         backlight_update_status(lcd->bl_dev);
 476         return 0;
 477 }
 478 #else
 479 #define corgi_lcd_suspend       NULL
 480 #define corgi_lcd_resume        NULL
 481 #endif
 482
 483 static int setup_gpio_backlight(struct corgi_lcd *lcd,
 484                                 struct corgi_lcd_platform_data *pdata)
 485 {
 486         struct spi_device *spi = lcd->spi_dev;
 487         int err;
 488
 489         lcd->gpio_backlight_on = -1;
 490         lcd->gpio_backlight_cont = -1;
 491
 492         if (gpio_is_valid(pdata->gpio_backlight_on)) {
 493                 err = gpio_request(pdata->gpio_backlight_on, "BL_ON");
 494                 if (err) {
 495                         dev_err(&spi->dev, "failed to request GPIO%d for "
 496                                 "backlight_on\n", pdata->gpio_backlight_on);
 497                         return err;
 498                 }
 499
 500                 lcd->gpio_backlight_on = pdata->gpio_backlight_on;
 501                 gpio_direction_output(lcd->gpio_backlight_on, 0);
 502         }
 503
 504         if (gpio_is_valid(pdata->gpio_backlight_cont)) {
 505                 err = gpio_request(pdata->gpio_backlight_cont, "BL_CONT");
 506                 if (err) {
 507                         dev_err(&spi->dev, "failed to request GPIO%d for "
 508                                 "backlight_cont\n", pdata->gpio_backlight_cont);
 509                         goto err_free_backlight_on;
 510                 }
 511
 512                 lcd->gpio_backlight_cont = pdata->gpio_backlight_cont;
 513
 514                 /* spitz and akita use both GPIOs for backlight, and
 515                  * have inverted polarity of GPIO_BACKLIGHT_CONT
 516                  */
 517                 if (gpio_is_valid(lcd->gpio_backlight_on)) {
 518                         lcd->gpio_backlight_cont_inverted = 1;
 519                         gpio_direction_output(lcd->gpio_backlight_cont, 1);
 520                 } else {
 521                         lcd->gpio_backlight_cont_inverted = 0;
 522                         gpio_direction_output(lcd->gpio_backlight_cont, 0);
 523                 }
 524         }
 525         return 0;
 526
 527 err_free_backlight_on:
 528         if (gpio_is_valid(lcd->gpio_backlight_on))
 529                 gpio_free(lcd->gpio_backlight_on);
 530         return err;
 531 }
 532
 533 static int __devinit corgi_lcd_probe(struct spi_device *spi)
 534 {
 535         struct corgi_lcd_platform_data *pdata = spi->dev.platform_data;
 536         struct corgi_lcd *lcd;
 537         int ret = 0;
 538
 539         if (pdata == NULL) {
 540                 dev_err(&spi->dev, "platform data not available\n");
 541                 return -EINVAL;
 542         }
 543
 544         lcd = kzalloc(sizeof(struct corgi_lcd), GFP_KERNEL);
 545         if (!lcd) {
 546                 dev_err(&spi->dev, "failed to allocate memory\n");
 547                 return -ENOMEM;
 548         }
 549
 550         lcd->spi_dev = spi;
 551
 552         lcd->lcd_dev = lcd_device_register("corgi_lcd", &spi->dev,
 553                                         lcd, &corgi_lcd_ops);
 554         if (IS_ERR(lcd->lcd_dev)) {
 555                 ret = PTR_ERR(lcd->lcd_dev);
 556                 goto err_free_lcd;
 557         }
 558         lcd->power = FB_BLANK_POWERDOWN;
 559         lcd->mode = (pdata) ? pdata->init_mode : CORGI_LCD_MODE_VGA;
 560
 561         lcd->bl_dev = backlight_device_register("corgi_bl", &spi->dev,
 562                                         lcd, &corgi_bl_ops);
 563         if (IS_ERR(lcd->bl_dev)) {
 564                 ret = PTR_ERR(lcd->bl_dev);
 565                 goto err_unregister_lcd;
 566         }
 567         lcd->bl_dev->props.max_brightness = pdata->max_intensity;
 568         lcd->bl_dev->props.brightness = pdata->default_intensity;
 569         lcd->bl_dev->props.power = FB_BLANK_UNBLANK;
 570
 571         ret = setup_gpio_backlight(lcd, pdata);
 572         if (ret)
 573                 goto err_unregister_bl;
 574
 575         lcd->kick_battery = pdata->kick_battery;
 576
 577         dev_set_drvdata(&spi->dev, lcd);
 578         corgi_lcd_set_power(lcd->lcd_dev, FB_BLANK_UNBLANK);
 579         backlight_update_status(lcd->bl_dev);
 580
 581         lcd->limit_mask = pdata->limit_mask;
 582         the_corgi_lcd = lcd;
 583         return 0;
 584
 585 err_unregister_bl:
 586         backlight_device_unregister(lcd->bl_dev);
 587 err_unregister_lcd:
 588         lcd_device_unregister(lcd->lcd_dev);
 589 err_free_lcd:
 590         kfree(lcd);
 591         return ret;
 592 }
 593
 594 static int __devexit corgi_lcd_remove(struct spi_device *spi)
 595 {
 596         struct corgi_lcd *lcd = dev_get_drvdata(&spi->dev);
 597
 598         lcd->bl_dev->props.power = FB_BLANK_UNBLANK;
 599         lcd->bl_dev->props.brightness = 0;
 600         backlight_update_status(lcd->bl_dev);
 601         backlight_device_unregister(lcd->bl_dev);
 602
 603         if (gpio_is_valid(lcd->gpio_backlight_on))
 604                 gpio_free(lcd->gpio_backlight_on);
 605
 606         if (gpio_is_valid(lcd->gpio_backlight_cont))
 607                 gpio_free(lcd->gpio_backlight_cont);
 608
 609         corgi_lcd_set_power(lcd->lcd_dev, FB_BLANK_POWERDOWN);
 610         lcd_device_unregister(lcd->lcd_dev);
 611         kfree(lcd);
 612
 613         return 0;
 614 }
 615
 616 static struct spi_driver corgi_lcd_driver = {
 617         .driver         = {
 618                 .name   = "corgi-lcd",
 619                 .owner  = THIS_MODULE,
 620         },
 621         .probe          = corgi_lcd_probe,
 622         .remove         = __devexit_p(corgi_lcd_remove),
 623         .suspend        = corgi_lcd_suspend,
 624         .resume         = corgi_lcd_resume,
 625 };
 626
 627 static int __init corgi_lcd_init(void)
 628 {
 629         return spi_register_driver(&corgi_lcd_driver);
 630 }
 631 module_init(corgi_lcd_init);
 632
 633 static void __exit corgi_lcd_exit(void)
 634 {
 635         spi_unregister_driver(&corgi_lcd_driver);
 636 }
 637 module_exit(corgi_lcd_exit);
 638
 639 MODULE_DESCRIPTION("LCD and backlight driver for SHARP C7x0/Cxx00");
 640 MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>");
 641 MODULE_LICENSE("GPL");