Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 1 | /* |
| 2 | * tdo24m - SPI-based drivers for Toppoly TDO24M series LCD panels |
| 3 | * |
| 4 | * Copyright (C) 2008 Marvell International Ltd. |
Jingoo Han | 97d9655 | 2012-12-17 16:00:33 -0800 | [diff] [blame] | 5 | * Eric Miao <eric.miao@marvell.com> |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 6 | * |
| 7 | * This program is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of the GNU General Public License version 2 as |
| 9 | * publishhed by the Free Software Foundation. |
| 10 | */ |
| 11 | |
| 12 | #include <linux/module.h> |
| 13 | #include <linux/kernel.h> |
| 14 | #include <linux/init.h> |
| 15 | #include <linux/device.h> |
| 16 | #include <linux/spi/spi.h> |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 17 | #include <linux/spi/tdo24m.h> |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 18 | #include <linux/fb.h> |
| 19 | #include <linux/lcd.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 20 | #include <linux/slab.h> |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 21 | |
| 22 | #define POWER_IS_ON(pwr) ((pwr) <= FB_BLANK_NORMAL) |
| 23 | |
| 24 | #define TDO24M_SPI_BUFF_SIZE (4) |
| 25 | #define MODE_QVGA 0 |
| 26 | #define MODE_VGA 1 |
| 27 | |
| 28 | struct tdo24m { |
| 29 | struct spi_device *spi_dev; |
| 30 | struct lcd_device *lcd_dev; |
| 31 | |
| 32 | struct spi_message msg; |
| 33 | struct spi_transfer xfer; |
| 34 | uint8_t *buf; |
| 35 | |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 36 | int (*adj_mode)(struct tdo24m *lcd, int mode); |
| 37 | int color_invert; |
| 38 | |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 39 | int power; |
| 40 | int mode; |
| 41 | }; |
| 42 | |
| 43 | /* use bit 30, 31 as the indicator of command parameter number */ |
| 44 | #define CMD0(x) ((0 << 30) | (x)) |
| 45 | #define CMD1(x, x1) ((1 << 30) | ((x) << 9) | 0x100 | (x1)) |
| 46 | #define CMD2(x, x1, x2) ((2 << 30) | ((x) << 18) | 0x20000 |\ |
| 47 | ((x1) << 9) | 0x100 | (x2)) |
| 48 | #define CMD_NULL (-1) |
| 49 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 50 | static const uint32_t lcd_panel_reset[] = { |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 51 | CMD0(0x1), /* reset */ |
| 52 | CMD0(0x0), /* nop */ |
| 53 | CMD0(0x0), /* nop */ |
| 54 | CMD0(0x0), /* nop */ |
| 55 | CMD_NULL, |
| 56 | }; |
| 57 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 58 | static const uint32_t lcd_panel_on[] = { |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 59 | CMD0(0x29), /* Display ON */ |
| 60 | CMD2(0xB8, 0xFF, 0xF9), /* Output Control */ |
| 61 | CMD0(0x11), /* Sleep out */ |
| 62 | CMD1(0xB0, 0x16), /* Wake */ |
| 63 | CMD_NULL, |
| 64 | }; |
| 65 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 66 | static const uint32_t lcd_panel_off[] = { |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 67 | CMD0(0x28), /* Display OFF */ |
| 68 | CMD2(0xB8, 0x80, 0x02), /* Output Control */ |
| 69 | CMD0(0x10), /* Sleep in */ |
| 70 | CMD1(0xB0, 0x00), /* Deep stand by in */ |
| 71 | CMD_NULL, |
| 72 | }; |
| 73 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 74 | static const uint32_t lcd_vga_pass_through_tdo24m[] = { |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 75 | CMD1(0xB0, 0x16), |
| 76 | CMD1(0xBC, 0x80), |
| 77 | CMD1(0xE1, 0x00), |
| 78 | CMD1(0x36, 0x50), |
| 79 | CMD1(0x3B, 0x00), |
| 80 | CMD_NULL, |
| 81 | }; |
| 82 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 83 | static const uint32_t lcd_qvga_pass_through_tdo24m[] = { |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 84 | CMD1(0xB0, 0x16), |
| 85 | CMD1(0xBC, 0x81), |
| 86 | CMD1(0xE1, 0x00), |
| 87 | CMD1(0x36, 0x50), |
| 88 | CMD1(0x3B, 0x22), |
| 89 | CMD_NULL, |
| 90 | }; |
| 91 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 92 | static const uint32_t lcd_vga_transfer_tdo24m[] = { |
Jingoo Han | 97d9655 | 2012-12-17 16:00:33 -0800 | [diff] [blame] | 93 | CMD1(0xcf, 0x02), /* Blanking period control (1) */ |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 94 | CMD2(0xd0, 0x08, 0x04), /* Blanking period control (2) */ |
| 95 | CMD1(0xd1, 0x01), /* CKV timing control on/off */ |
| 96 | CMD2(0xd2, 0x14, 0x00), /* CKV 1,2 timing control */ |
| 97 | CMD2(0xd3, 0x1a, 0x0f), /* OEV timing control */ |
| 98 | CMD2(0xd4, 0x1f, 0xaf), /* ASW timing control (1) */ |
| 99 | CMD1(0xd5, 0x14), /* ASW timing control (2) */ |
| 100 | CMD0(0x21), /* Invert for normally black display */ |
| 101 | CMD0(0x29), /* Display on */ |
| 102 | CMD_NULL, |
| 103 | }; |
| 104 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 105 | static const uint32_t lcd_qvga_transfer[] = { |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 106 | CMD1(0xd6, 0x02), /* Blanking period control (1) */ |
| 107 | CMD2(0xd7, 0x08, 0x04), /* Blanking period control (2) */ |
| 108 | CMD1(0xd8, 0x01), /* CKV timing control on/off */ |
| 109 | CMD2(0xd9, 0x00, 0x08), /* CKV 1,2 timing control */ |
| 110 | CMD2(0xde, 0x05, 0x0a), /* OEV timing control */ |
| 111 | CMD2(0xdf, 0x0a, 0x19), /* ASW timing control (1) */ |
| 112 | CMD1(0xe0, 0x0a), /* ASW timing control (2) */ |
| 113 | CMD0(0x21), /* Invert for normally black display */ |
| 114 | CMD0(0x29), /* Display on */ |
| 115 | CMD_NULL, |
| 116 | }; |
| 117 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 118 | static const uint32_t lcd_vga_pass_through_tdo35s[] = { |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 119 | CMD1(0xB0, 0x16), |
| 120 | CMD1(0xBC, 0x80), |
| 121 | CMD1(0xE1, 0x00), |
| 122 | CMD1(0x3B, 0x00), |
| 123 | CMD_NULL, |
| 124 | }; |
| 125 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 126 | static const uint32_t lcd_qvga_pass_through_tdo35s[] = { |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 127 | CMD1(0xB0, 0x16), |
| 128 | CMD1(0xBC, 0x81), |
| 129 | CMD1(0xE1, 0x00), |
| 130 | CMD1(0x3B, 0x22), |
| 131 | CMD_NULL, |
| 132 | }; |
| 133 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 134 | static const uint32_t lcd_vga_transfer_tdo35s[] = { |
Jingoo Han | 97d9655 | 2012-12-17 16:00:33 -0800 | [diff] [blame] | 135 | CMD1(0xcf, 0x02), /* Blanking period control (1) */ |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 136 | CMD2(0xd0, 0x08, 0x04), /* Blanking period control (2) */ |
| 137 | CMD1(0xd1, 0x01), /* CKV timing control on/off */ |
| 138 | CMD2(0xd2, 0x00, 0x1e), /* CKV 1,2 timing control */ |
| 139 | CMD2(0xd3, 0x14, 0x28), /* OEV timing control */ |
| 140 | CMD2(0xd4, 0x28, 0x64), /* ASW timing control (1) */ |
| 141 | CMD1(0xd5, 0x28), /* ASW timing control (2) */ |
| 142 | CMD0(0x21), /* Invert for normally black display */ |
| 143 | CMD0(0x29), /* Display on */ |
| 144 | CMD_NULL, |
| 145 | }; |
| 146 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 147 | static const uint32_t lcd_panel_config[] = { |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 148 | CMD2(0xb8, 0xff, 0xf9), /* Output control */ |
| 149 | CMD0(0x11), /* sleep out */ |
| 150 | CMD1(0xba, 0x01), /* Display mode (1) */ |
| 151 | CMD1(0xbb, 0x00), /* Display mode (2) */ |
| 152 | CMD1(0x3a, 0x60), /* Display mode 18-bit RGB */ |
| 153 | CMD1(0xbf, 0x10), /* Drive system change control */ |
| 154 | CMD1(0xb1, 0x56), /* Booster operation setup */ |
| 155 | CMD1(0xb2, 0x33), /* Booster mode setup */ |
| 156 | CMD1(0xb3, 0x11), /* Booster frequency setup */ |
| 157 | CMD1(0xb4, 0x02), /* Op amp/system clock */ |
| 158 | CMD1(0xb5, 0x35), /* VCS voltage */ |
| 159 | CMD1(0xb6, 0x40), /* VCOM voltage */ |
| 160 | CMD1(0xb7, 0x03), /* External display signal */ |
| 161 | CMD1(0xbd, 0x00), /* ASW slew rate */ |
| 162 | CMD1(0xbe, 0x00), /* Dummy data for QuadData operation */ |
| 163 | CMD1(0xc0, 0x11), /* Sleep out FR count (A) */ |
| 164 | CMD1(0xc1, 0x11), /* Sleep out FR count (B) */ |
| 165 | CMD1(0xc2, 0x11), /* Sleep out FR count (C) */ |
| 166 | CMD2(0xc3, 0x20, 0x40), /* Sleep out FR count (D) */ |
| 167 | CMD2(0xc4, 0x60, 0xc0), /* Sleep out FR count (E) */ |
| 168 | CMD2(0xc5, 0x10, 0x20), /* Sleep out FR count (F) */ |
| 169 | CMD1(0xc6, 0xc0), /* Sleep out FR count (G) */ |
| 170 | CMD2(0xc7, 0x33, 0x43), /* Gamma 1 fine tuning (1) */ |
| 171 | CMD1(0xc8, 0x44), /* Gamma 1 fine tuning (2) */ |
| 172 | CMD1(0xc9, 0x33), /* Gamma 1 inclination adjustment */ |
| 173 | CMD1(0xca, 0x00), /* Gamma 1 blue offset adjustment */ |
| 174 | CMD2(0xec, 0x01, 0xf0), /* Horizontal clock cycles */ |
| 175 | CMD_NULL, |
| 176 | }; |
| 177 | |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 178 | static int tdo24m_writes(struct tdo24m *lcd, const uint32_t *array) |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 179 | { |
| 180 | struct spi_transfer *x = &lcd->xfer; |
Jingoo Han | 53c7a2f | 2012-12-17 16:00:52 -0800 | [diff] [blame] | 181 | const uint32_t *p = array; |
| 182 | uint32_t data; |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 183 | int nparams, err = 0; |
| 184 | |
| 185 | for (; *p != CMD_NULL; p++) { |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 186 | if (!lcd->color_invert && *p == CMD0(0x21)) |
| 187 | continue; |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 188 | |
| 189 | nparams = (*p >> 30) & 0x3; |
| 190 | |
| 191 | data = *p << (7 - nparams); |
| 192 | switch (nparams) { |
| 193 | case 0: |
| 194 | lcd->buf[0] = (data >> 8) & 0xff; |
| 195 | lcd->buf[1] = data & 0xff; |
| 196 | break; |
| 197 | case 1: |
| 198 | lcd->buf[0] = (data >> 16) & 0xff; |
| 199 | lcd->buf[1] = (data >> 8) & 0xff; |
| 200 | lcd->buf[2] = data & 0xff; |
| 201 | break; |
| 202 | case 2: |
| 203 | lcd->buf[0] = (data >> 24) & 0xff; |
| 204 | lcd->buf[1] = (data >> 16) & 0xff; |
| 205 | lcd->buf[2] = (data >> 8) & 0xff; |
| 206 | lcd->buf[3] = data & 0xff; |
| 207 | break; |
| 208 | default: |
| 209 | continue; |
| 210 | } |
| 211 | x->len = nparams + 2; |
| 212 | err = spi_sync(lcd->spi_dev, &lcd->msg); |
| 213 | if (err) |
| 214 | break; |
| 215 | } |
| 216 | |
| 217 | return err; |
| 218 | } |
| 219 | |
| 220 | static int tdo24m_adj_mode(struct tdo24m *lcd, int mode) |
| 221 | { |
| 222 | switch (mode) { |
| 223 | case MODE_VGA: |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 224 | tdo24m_writes(lcd, lcd_vga_pass_through_tdo24m); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 225 | tdo24m_writes(lcd, lcd_panel_config); |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 226 | tdo24m_writes(lcd, lcd_vga_transfer_tdo24m); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 227 | break; |
| 228 | case MODE_QVGA: |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 229 | tdo24m_writes(lcd, lcd_qvga_pass_through_tdo24m); |
| 230 | tdo24m_writes(lcd, lcd_panel_config); |
| 231 | tdo24m_writes(lcd, lcd_qvga_transfer); |
| 232 | break; |
| 233 | default: |
| 234 | return -EINVAL; |
| 235 | } |
| 236 | |
| 237 | lcd->mode = mode; |
| 238 | return 0; |
| 239 | } |
| 240 | |
| 241 | static int tdo35s_adj_mode(struct tdo24m *lcd, int mode) |
| 242 | { |
| 243 | switch (mode) { |
| 244 | case MODE_VGA: |
| 245 | tdo24m_writes(lcd, lcd_vga_pass_through_tdo35s); |
| 246 | tdo24m_writes(lcd, lcd_panel_config); |
| 247 | tdo24m_writes(lcd, lcd_vga_transfer_tdo35s); |
| 248 | break; |
| 249 | case MODE_QVGA: |
| 250 | tdo24m_writes(lcd, lcd_qvga_pass_through_tdo35s); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 251 | tdo24m_writes(lcd, lcd_panel_config); |
| 252 | tdo24m_writes(lcd, lcd_qvga_transfer); |
| 253 | break; |
| 254 | default: |
| 255 | return -EINVAL; |
| 256 | } |
| 257 | |
| 258 | lcd->mode = mode; |
| 259 | return 0; |
| 260 | } |
| 261 | |
| 262 | static int tdo24m_power_on(struct tdo24m *lcd) |
| 263 | { |
| 264 | int err; |
| 265 | |
| 266 | err = tdo24m_writes(lcd, lcd_panel_on); |
| 267 | if (err) |
| 268 | goto out; |
| 269 | |
| 270 | err = tdo24m_writes(lcd, lcd_panel_reset); |
| 271 | if (err) |
| 272 | goto out; |
| 273 | |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 274 | err = lcd->adj_mode(lcd, lcd->mode); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 275 | out: |
| 276 | return err; |
| 277 | } |
| 278 | |
| 279 | static int tdo24m_power_off(struct tdo24m *lcd) |
| 280 | { |
| 281 | return tdo24m_writes(lcd, lcd_panel_off); |
| 282 | } |
| 283 | |
| 284 | static int tdo24m_power(struct tdo24m *lcd, int power) |
| 285 | { |
| 286 | int ret = 0; |
| 287 | |
| 288 | if (POWER_IS_ON(power) && !POWER_IS_ON(lcd->power)) |
| 289 | ret = tdo24m_power_on(lcd); |
| 290 | else if (!POWER_IS_ON(power) && POWER_IS_ON(lcd->power)) |
| 291 | ret = tdo24m_power_off(lcd); |
| 292 | |
| 293 | if (!ret) |
| 294 | lcd->power = power; |
| 295 | |
| 296 | return ret; |
| 297 | } |
| 298 | |
| 299 | |
| 300 | static int tdo24m_set_power(struct lcd_device *ld, int power) |
| 301 | { |
| 302 | struct tdo24m *lcd = lcd_get_data(ld); |
| 303 | return tdo24m_power(lcd, power); |
| 304 | } |
| 305 | |
| 306 | static int tdo24m_get_power(struct lcd_device *ld) |
| 307 | { |
| 308 | struct tdo24m *lcd = lcd_get_data(ld); |
| 309 | return lcd->power; |
| 310 | } |
| 311 | |
| 312 | static int tdo24m_set_mode(struct lcd_device *ld, struct fb_videomode *m) |
| 313 | { |
| 314 | struct tdo24m *lcd = lcd_get_data(ld); |
| 315 | int mode = MODE_QVGA; |
| 316 | |
| 317 | if (m->xres == 640 || m->xres == 480) |
| 318 | mode = MODE_VGA; |
| 319 | |
| 320 | if (lcd->mode == mode) |
| 321 | return 0; |
| 322 | |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 323 | return lcd->adj_mode(lcd, mode); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 324 | } |
| 325 | |
| 326 | static struct lcd_ops tdo24m_ops = { |
| 327 | .get_power = tdo24m_get_power, |
| 328 | .set_power = tdo24m_set_power, |
| 329 | .set_mode = tdo24m_set_mode, |
| 330 | }; |
| 331 | |
Bill Pemberton | 1b9e450 | 2012-11-19 13:21:46 -0500 | [diff] [blame] | 332 | static int tdo24m_probe(struct spi_device *spi) |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 333 | { |
| 334 | struct tdo24m *lcd; |
| 335 | struct spi_message *m; |
| 336 | struct spi_transfer *x; |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 337 | struct tdo24m_platform_data *pdata; |
| 338 | enum tdo24m_model model; |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 339 | int err; |
| 340 | |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 341 | pdata = spi->dev.platform_data; |
| 342 | if (pdata) |
| 343 | model = pdata->model; |
| 344 | else |
| 345 | model = TDO24M; |
| 346 | |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 347 | spi->bits_per_word = 8; |
| 348 | spi->mode = SPI_MODE_3; |
| 349 | err = spi_setup(spi); |
| 350 | if (err) |
| 351 | return err; |
| 352 | |
Jingoo Han | d073adc | 2012-05-29 15:07:24 -0700 | [diff] [blame] | 353 | lcd = devm_kzalloc(&spi->dev, sizeof(struct tdo24m), GFP_KERNEL); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 354 | if (!lcd) |
| 355 | return -ENOMEM; |
| 356 | |
| 357 | lcd->spi_dev = spi; |
| 358 | lcd->power = FB_BLANK_POWERDOWN; |
| 359 | lcd->mode = MODE_VGA; /* default to VGA */ |
| 360 | |
Jingoo Han | d073adc | 2012-05-29 15:07:24 -0700 | [diff] [blame] | 361 | lcd->buf = devm_kzalloc(&spi->dev, TDO24M_SPI_BUFF_SIZE, GFP_KERNEL); |
| 362 | if (lcd->buf == NULL) |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 363 | return -ENOMEM; |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 364 | |
| 365 | m = &lcd->msg; |
| 366 | x = &lcd->xfer; |
| 367 | |
| 368 | spi_message_init(m); |
| 369 | |
Mike Rapoport | f64dcac | 2009-11-24 10:25:33 +0200 | [diff] [blame] | 370 | x->cs_change = 1; |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 371 | x->tx_buf = &lcd->buf[0]; |
| 372 | spi_message_add_tail(x, m); |
| 373 | |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 374 | switch (model) { |
| 375 | case TDO24M: |
| 376 | lcd->color_invert = 1; |
| 377 | lcd->adj_mode = tdo24m_adj_mode; |
| 378 | break; |
| 379 | case TDO35S: |
| 380 | lcd->adj_mode = tdo35s_adj_mode; |
| 381 | lcd->color_invert = 0; |
| 382 | break; |
| 383 | default: |
| 384 | dev_err(&spi->dev, "Unsupported model"); |
Jingoo Han | d073adc | 2012-05-29 15:07:24 -0700 | [diff] [blame] | 385 | return -EINVAL; |
Mike Rapoport | f4f6bda | 2008-12-03 08:48:52 +0000 | [diff] [blame] | 386 | } |
| 387 | |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 388 | lcd->lcd_dev = lcd_device_register("tdo24m", &spi->dev, |
| 389 | lcd, &tdo24m_ops); |
Jingoo Han | d073adc | 2012-05-29 15:07:24 -0700 | [diff] [blame] | 390 | if (IS_ERR(lcd->lcd_dev)) |
| 391 | return PTR_ERR(lcd->lcd_dev); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 392 | |
Jingoo Han | 719d5b2 | 2013-02-21 16:43:37 -0800 | [diff] [blame] | 393 | spi_set_drvdata(spi, lcd); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 394 | err = tdo24m_power(lcd, FB_BLANK_UNBLANK); |
| 395 | if (err) |
| 396 | goto out_unregister; |
| 397 | |
| 398 | return 0; |
| 399 | |
| 400 | out_unregister: |
| 401 | lcd_device_unregister(lcd->lcd_dev); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 402 | return err; |
| 403 | } |
| 404 | |
Bill Pemberton | 7e4b9d0 | 2012-11-19 13:26:34 -0500 | [diff] [blame] | 405 | static int tdo24m_remove(struct spi_device *spi) |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 406 | { |
Jingoo Han | 719d5b2 | 2013-02-21 16:43:37 -0800 | [diff] [blame] | 407 | struct tdo24m *lcd = spi_get_drvdata(spi); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 408 | |
| 409 | tdo24m_power(lcd, FB_BLANK_POWERDOWN); |
| 410 | lcd_device_unregister(lcd->lcd_dev); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 411 | |
| 412 | return 0; |
| 413 | } |
| 414 | |
Jingoo Han | 3e14e68 | 2013-04-29 16:17:47 -0700 | [diff] [blame^] | 415 | #ifdef CONFIG_PM_SLEEP |
| 416 | static int tdo24m_suspend(struct device *dev) |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 417 | { |
Jingoo Han | 3e14e68 | 2013-04-29 16:17:47 -0700 | [diff] [blame^] | 418 | struct tdo24m *lcd = dev_get_drvdata(dev); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 419 | |
| 420 | return tdo24m_power(lcd, FB_BLANK_POWERDOWN); |
| 421 | } |
| 422 | |
Jingoo Han | 3e14e68 | 2013-04-29 16:17:47 -0700 | [diff] [blame^] | 423 | static int tdo24m_resume(struct device *dev) |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 424 | { |
Jingoo Han | 3e14e68 | 2013-04-29 16:17:47 -0700 | [diff] [blame^] | 425 | struct tdo24m *lcd = dev_get_drvdata(dev); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 426 | |
| 427 | return tdo24m_power(lcd, FB_BLANK_UNBLANK); |
| 428 | } |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 429 | #endif |
| 430 | |
Jingoo Han | 3e14e68 | 2013-04-29 16:17:47 -0700 | [diff] [blame^] | 431 | static SIMPLE_DEV_PM_OPS(tdo24m_pm_ops, tdo24m_suspend, tdo24m_resume); |
| 432 | |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 433 | /* Power down all displays on reboot, poweroff or halt */ |
| 434 | static void tdo24m_shutdown(struct spi_device *spi) |
| 435 | { |
Jingoo Han | 719d5b2 | 2013-02-21 16:43:37 -0800 | [diff] [blame] | 436 | struct tdo24m *lcd = spi_get_drvdata(spi); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 437 | |
| 438 | tdo24m_power(lcd, FB_BLANK_POWERDOWN); |
| 439 | } |
| 440 | |
| 441 | static struct spi_driver tdo24m_driver = { |
| 442 | .driver = { |
| 443 | .name = "tdo24m", |
| 444 | .owner = THIS_MODULE, |
Jingoo Han | 3e14e68 | 2013-04-29 16:17:47 -0700 | [diff] [blame^] | 445 | .pm = &tdo24m_pm_ops, |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 446 | }, |
| 447 | .probe = tdo24m_probe, |
Bill Pemberton | d1723fa | 2012-11-19 13:21:09 -0500 | [diff] [blame] | 448 | .remove = tdo24m_remove, |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 449 | .shutdown = tdo24m_shutdown, |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 450 | }; |
| 451 | |
Axel Lin | 462dd83 | 2012-03-23 15:01:59 -0700 | [diff] [blame] | 452 | module_spi_driver(tdo24m_driver); |
Eric Miao | dd89ccb | 2008-09-01 06:50:23 +0800 | [diff] [blame] | 453 | |
| 454 | MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"); |
| 455 | MODULE_DESCRIPTION("Driver for Toppoly TDO24M LCD Panel"); |
| 456 | MODULE_LICENSE("GPL"); |
Anton Vorontsov | e0626e3 | 2009-09-22 16:46:08 -0700 | [diff] [blame] | 457 | MODULE_ALIAS("spi:tdo24m"); |