drivers/gpu/drm/gma500/tc35876x-dsi-lvds.c

   1 /*
   2  * Copyright © 2011 Intel Corporation
   3  *
   4  * Permission is hereby granted, free of charge, to any person obtaining a
   5  * copy of this software and associated documentation files (the "Software"),
   6  * to deal in the Software without restriction, including without limitation
   7  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
   8  * and/or sell copies of the Software, and to permit persons to whom the
   9  * Software is furnished to do so, subject to the following conditions:
  10  *
  11  * The above copyright notice and this permission notice (including the next
  12  * paragraph) shall be included in all copies or substantial portions of the
  13  * Software.
  14  *
  15  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  16  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  17  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
  18  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  19  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING
  20  * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER
  21  * DEALINGS IN THE SOFTWARE.
  22  *
  23  */
  24
  25 #include <linux/delay.h>
  26 #include <linux/kernel.h>
  27 #include <linux/module.h>
  28 #include <linux/gpio/consumer.h>
  29
  30 #include <asm/intel_scu_ipc.h>
  31
  32 #include "mdfld_dsi_dpi.h"
  33 #include "mdfld_dsi_pkg_sender.h"
  34 #include "mdfld_output.h"
  35 #include "tc35876x-dsi-lvds.h"
  36
  37 static struct i2c_client *tc35876x_client;
  38 static struct i2c_client *cmi_lcd_i2c_client;
  39 /* Panel GPIOs */
  40 static struct gpio_desc *bridge_reset;
  41 static struct gpio_desc *bridge_bl_enable;
  42 static struct gpio_desc *backlight_voltage;
  43
  44
  45 #define FLD_MASK(start, end)    (((1 << ((start) - (end) + 1)) - 1) << (end))
  46 #define FLD_VAL(val, start, end) (((val) << (end)) & FLD_MASK(start, end))
  47
  48 /* DSI D-PHY Layer Registers */
  49 #define D0W_DPHYCONTTX          0x0004
  50 #define CLW_DPHYCONTRX          0x0020
  51 #define D0W_DPHYCONTRX          0x0024
  52 #define D1W_DPHYCONTRX          0x0028
  53 #define D2W_DPHYCONTRX          0x002C
  54 #define D3W_DPHYCONTRX          0x0030
  55 #define COM_DPHYCONTRX          0x0038
  56 #define CLW_CNTRL               0x0040
  57 #define D0W_CNTRL               0x0044
  58 #define D1W_CNTRL               0x0048
  59 #define D2W_CNTRL               0x004C
  60 #define D3W_CNTRL               0x0050
  61 #define DFTMODE_CNTRL           0x0054
  62
  63 /* DSI PPI Layer Registers */
  64 #define PPI_STARTPPI            0x0104
  65 #define PPI_BUSYPPI             0x0108
  66 #define PPI_LINEINITCNT         0x0110
  67 #define PPI_LPTXTIMECNT         0x0114
  68 #define PPI_LANEENABLE          0x0134
  69 #define PPI_TX_RX_TA            0x013C
  70 #define PPI_CLS_ATMR            0x0140
  71 #define PPI_D0S_ATMR            0x0144
  72 #define PPI_D1S_ATMR            0x0148
  73 #define PPI_D2S_ATMR            0x014C
  74 #define PPI_D3S_ATMR            0x0150
  75 #define PPI_D0S_CLRSIPOCOUNT    0x0164
  76 #define PPI_D1S_CLRSIPOCOUNT    0x0168
  77 #define PPI_D2S_CLRSIPOCOUNT    0x016C
  78 #define PPI_D3S_CLRSIPOCOUNT    0x0170
  79 #define CLS_PRE                 0x0180
  80 #define D0S_PRE                 0x0184
  81 #define D1S_PRE                 0x0188
  82 #define D2S_PRE                 0x018C
  83 #define D3S_PRE                 0x0190
  84 #define CLS_PREP                0x01A0
  85 #define D0S_PREP                0x01A4
  86 #define D1S_PREP                0x01A8
  87 #define D2S_PREP                0x01AC
  88 #define D3S_PREP                0x01B0
  89 #define CLS_ZERO                0x01C0
  90 #define D0S_ZERO                0x01C4
  91 #define D1S_ZERO                0x01C8
  92 #define D2S_ZERO                0x01CC
  93 #define D3S_ZERO                0x01D0
  94 #define PPI_CLRFLG              0x01E0
  95 #define PPI_CLRSIPO             0x01E4
  96 #define HSTIMEOUT               0x01F0
  97 #define HSTIMEOUTENABLE         0x01F4
  98
  99 /* DSI Protocol Layer Registers */
 100 #define DSI_STARTDSI            0x0204
 101 #define DSI_BUSYDSI             0x0208
 102 #define DSI_LANEENABLE          0x0210
 103 #define DSI_LANESTATUS0         0x0214
 104 #define DSI_LANESTATUS1         0x0218
 105 #define DSI_INTSTATUS           0x0220
 106 #define DSI_INTMASK             0x0224
 107 #define DSI_INTCLR              0x0228
 108 #define DSI_LPTXTO              0x0230
 109
 110 /* DSI General Registers */
 111 #define DSIERRCNT               0x0300
 112
 113 /* DSI Application Layer Registers */
 114 #define APLCTRL                 0x0400
 115 #define RDPKTLN                 0x0404
 116
 117 /* Video Path Registers */
 118 #define VPCTRL                  0x0450
 119 #define HTIM1                   0x0454
 120 #define HTIM2                   0x0458
 121 #define VTIM1                   0x045C
 122 #define VTIM2                   0x0460
 123 #define VFUEN                   0x0464
 124
 125 /* LVDS Registers */
 126 #define LVMX0003                0x0480
 127 #define LVMX0407                0x0484
 128 #define LVMX0811                0x0488
 129 #define LVMX1215                0x048C
 130 #define LVMX1619                0x0490
 131 #define LVMX2023                0x0494
 132 #define LVMX2427                0x0498
 133 #define LVCFG                   0x049C
 134 #define LVPHY0                  0x04A0
 135 #define LVPHY1                  0x04A4
 136
 137 /* System Registers */
 138 #define SYSSTAT                 0x0500
 139 #define SYSRST                  0x0504
 140
 141 /* GPIO Registers */
 142 /*#define GPIOC                 0x0520*/
 143 #define GPIOO                   0x0524
 144 #define GPIOI                   0x0528
 145
 146 /* I2C Registers */
 147 #define I2CTIMCTRL              0x0540
 148 #define I2CMADDR                0x0544
 149 #define WDATAQ                  0x0548
 150 #define RDATAQ                  0x054C
 151
 152 /* Chip/Rev Registers */
 153 #define IDREG                   0x0580
 154
 155 /* Debug Registers */
 156 #define DEBUG00                 0x05A0
 157 #define DEBUG01                 0x05A4
 158
 159 /* Panel CABC registers */
 160 #define PANEL_PWM_CONTROL       0x90
 161 #define PANEL_FREQ_DIVIDER_HI   0x91
 162 #define PANEL_FREQ_DIVIDER_LO   0x92
 163 #define PANEL_DUTY_CONTROL      0x93
 164 #define PANEL_MODIFY_RGB        0x94
 165 #define PANEL_FRAMERATE_CONTROL 0x96
 166 #define PANEL_PWM_MIN           0x97
 167 #define PANEL_PWM_REF           0x98
 168 #define PANEL_PWM_MAX           0x99
 169 #define PANEL_ALLOW_DISTORT     0x9A
 170 #define PANEL_BYPASS_PWMI       0x9B
 171
 172 /* Panel color management registers */
 173 #define PANEL_CM_ENABLE         0x700
 174 #define PANEL_CM_HUE            0x701
 175 #define PANEL_CM_SATURATION     0x702
 176 #define PANEL_CM_INTENSITY      0x703
 177 #define PANEL_CM_BRIGHTNESS     0x704
 178 #define PANEL_CM_CE_ENABLE      0x705
 179 #define PANEL_CM_PEAK_EN        0x710
 180 #define PANEL_CM_GAIN           0x711
 181 #define PANEL_CM_HUETABLE_START 0x730
 182 #define PANEL_CM_HUETABLE_END   0x747 /* inclusive */
 183
 184 /* Input muxing for registers LVMX0003...LVMX2427 */
 185 enum {
 186         INPUT_R0,       /* 0 */
 187         INPUT_R1,
 188         INPUT_R2,
 189         INPUT_R3,
 190         INPUT_R4,
 191         INPUT_R5,
 192         INPUT_R6,
 193         INPUT_R7,
 194         INPUT_G0,       /* 8 */
 195         INPUT_G1,
 196         INPUT_G2,
 197         INPUT_G3,
 198         INPUT_G4,
 199         INPUT_G5,
 200         INPUT_G6,
 201         INPUT_G7,
 202         INPUT_B0,       /* 16 */
 203         INPUT_B1,
 204         INPUT_B2,
 205         INPUT_B3,
 206         INPUT_B4,
 207         INPUT_B5,
 208         INPUT_B6,
 209         INPUT_B7,
 210         INPUT_HSYNC,    /* 24 */
 211         INPUT_VSYNC,
 212         INPUT_DE,
 213         LOGIC_0,
 214         /* 28...31 undefined */
 215 };
 216
 217 #define INPUT_MUX(lvmx03, lvmx02, lvmx01, lvmx00)               \
 218         (FLD_VAL(lvmx03, 29, 24) | FLD_VAL(lvmx02, 20, 16) |    \
 219         FLD_VAL(lvmx01, 12, 8) | FLD_VAL(lvmx00, 4, 0))
 220
 221 /**
 222  * tc35876x_regw - Write DSI-LVDS bridge register using I2C
 223  * @client: struct i2c_client to use
 224  * @reg: register address
 225  * @value: value to write
 226  *
 227  * Returns 0 on success, or a negative error value.
 228  */
 229 static int tc35876x_regw(struct i2c_client *client, u16 reg, u32 value)
 230 {
 231         int r;
 232         u8 tx_data[] = {
 233                 /* NOTE: Register address big-endian, data little-endian. */
 234                 (reg >> 8) & 0xff,
 235                 reg & 0xff,
 236                 value & 0xff,
 237                 (value >> 8) & 0xff,
 238                 (value >> 16) & 0xff,
 239                 (value >> 24) & 0xff,
 240         };
 241         struct i2c_msg msgs[] = {
 242                 {
 243                         .addr = client->addr,
 244                         .flags = 0,
 245                         .buf = tx_data,
 246                         .len = ARRAY_SIZE(tx_data),
 247                 },
 248         };
 249
 250         r = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
 251         if (r < 0) {
 252                 dev_err(&client->dev, "%s: reg 0x%04x val 0x%08x error %d\n",
 253                         __func__, reg, value, r);
 254                 return r;
 255         }
 256
 257         if (r < ARRAY_SIZE(msgs)) {
 258                 dev_err(&client->dev, "%s: reg 0x%04x val 0x%08x msgs %d\n",
 259                         __func__, reg, value, r);
 260                 return -EAGAIN;
 261         }
 262
 263         dev_dbg(&client->dev, "%s: reg 0x%04x val 0x%08x\n",
 264                         __func__, reg, value);
 265
 266         return 0;
 267 }
 268
 269 /**
 270  * tc35876x_regr - Read DSI-LVDS bridge register using I2C
 271  * @client: struct i2c_client to use
 272  * @reg: register address
 273  * @value: pointer for storing the value
 274  *
 275  * Returns 0 on success, or a negative error value.
 276  */
 277 static int tc35876x_regr(struct i2c_client *client, u16 reg, u32 *value)
 278 {
 279         int r;
 280         u8 tx_data[] = {
 281                 (reg >> 8) & 0xff,
 282                 reg & 0xff,
 283         };
 284         u8 rx_data[4];
 285         struct i2c_msg msgs[] = {
 286                 {
 287                         .addr = client->addr,
 288                         .flags = 0,
 289                         .buf = tx_data,
 290                         .len = ARRAY_SIZE(tx_data),
 291                 },
 292                 {
 293                         .addr = client->addr,
 294                         .flags = I2C_M_RD,
 295                         .buf = rx_data,
 296                         .len = ARRAY_SIZE(rx_data),
 297                  },
 298         };
 299
 300         r = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
 301         if (r < 0) {
 302                 dev_err(&client->dev, "%s: reg 0x%04x error %d\n", __func__,
 303                         reg, r);
 304                 return r;
 305         }
 306
 307         if (r < ARRAY_SIZE(msgs)) {
 308                 dev_err(&client->dev, "%s: reg 0x%04x msgs %d\n", __func__,
 309                         reg, r);
 310                 return -EAGAIN;
 311         }
 312
 313         *value = rx_data[0] << 24 | rx_data[1] << 16 |
 314                 rx_data[2] << 8 | rx_data[3];
 315
 316         dev_dbg(&client->dev, "%s: reg 0x%04x value 0x%08x\n", __func__,
 317                 reg, *value);
 318
 319         return 0;
 320 }
 321
 322 void tc35876x_set_bridge_reset_state(struct drm_device *dev, int state)
 323 {
 324         if (WARN(!tc35876x_client, "%s called before probe", __func__))
 325                 return;
 326
 327         dev_dbg(&tc35876x_client->dev, "%s: state %d\n", __func__, state);
 328
 329         if (!bridge_reset)
 330                 return;
 331
 332         if (state) {
 333                 gpiod_set_value_cansleep(bridge_reset, 0);
 334                 mdelay(10);
 335         } else {
 336                 /* Pull MIPI Bridge reset pin to Low */
 337                 gpiod_set_value_cansleep(bridge_reset, 0);
 338                 mdelay(20);
 339                 /* Pull MIPI Bridge reset pin to High */
 340                 gpiod_set_value_cansleep(bridge_reset, 1);
 341                 mdelay(40);
 342         }
 343 }
 344
 345 void tc35876x_configure_lvds_bridge(struct drm_device *dev)
 346 {
 347         struct i2c_client *i2c = tc35876x_client;
 348         u32 ppi_lptxtimecnt;
 349         u32 txtagocnt;
 350         u32 txtasurecnt;
 351         u32 id;
 352
 353         if (WARN(!tc35876x_client, "%s called before probe", __func__))
 354                 return;
 355
 356         dev_dbg(&tc35876x_client->dev, "%s\n", __func__);
 357
 358         if (!tc35876x_regr(i2c, IDREG, &id))
 359                 dev_info(&tc35876x_client->dev, "tc35876x ID 0x%08x\n", id);
 360         else
 361                 dev_err(&tc35876x_client->dev, "Cannot read ID\n");
 362
 363         ppi_lptxtimecnt = 4;
 364         txtagocnt = (5 * ppi_lptxtimecnt - 3) / 4;
 365         txtasurecnt = 3 * ppi_lptxtimecnt / 2;
 366         tc35876x_regw(i2c, PPI_TX_RX_TA, FLD_VAL(txtagocnt, 26, 16) |
 367                 FLD_VAL(txtasurecnt, 10, 0));
 368         tc35876x_regw(i2c, PPI_LPTXTIMECNT, FLD_VAL(ppi_lptxtimecnt, 10, 0));
 369
 370         tc35876x_regw(i2c, PPI_D0S_CLRSIPOCOUNT, FLD_VAL(1, 5, 0));
 371         tc35876x_regw(i2c, PPI_D1S_CLRSIPOCOUNT, FLD_VAL(1, 5, 0));
 372         tc35876x_regw(i2c, PPI_D2S_CLRSIPOCOUNT, FLD_VAL(1, 5, 0));
 373         tc35876x_regw(i2c, PPI_D3S_CLRSIPOCOUNT, FLD_VAL(1, 5, 0));
 374
 375         /* Enabling MIPI & PPI lanes, Enable 4 lanes */
 376         tc35876x_regw(i2c, PPI_LANEENABLE,
 377                 BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0));
 378         tc35876x_regw(i2c, DSI_LANEENABLE,
 379                 BIT(4) | BIT(3) | BIT(2) | BIT(1) | BIT(0));
 380         tc35876x_regw(i2c, PPI_STARTPPI, BIT(0));
 381         tc35876x_regw(i2c, DSI_STARTDSI, BIT(0));
 382
 383         /* Setting LVDS output frequency */
 384         tc35876x_regw(i2c, LVPHY0, FLD_VAL(1, 20, 16) |
 385                 FLD_VAL(2, 15, 14) | FLD_VAL(6, 4, 0)); /* 0x00048006 */
 386
 387         /* Setting video panel control register,0x00000120 VTGen=ON ?!?!? */
 388         tc35876x_regw(i2c, VPCTRL, BIT(8) | BIT(5));
 389
 390         /* Horizontal back porch and horizontal pulse width. 0x00280028 */
 391         tc35876x_regw(i2c, HTIM1, FLD_VAL(40, 24, 16) | FLD_VAL(40, 8, 0));
 392
 393         /* Horizontal front porch and horizontal active video size. 0x00500500*/
 394         tc35876x_regw(i2c, HTIM2, FLD_VAL(80, 24, 16) | FLD_VAL(1280, 10, 0));
 395
 396         /* Vertical back porch and vertical sync pulse width. 0x000e000a */
 397         tc35876x_regw(i2c, VTIM1, FLD_VAL(14, 23, 16) | FLD_VAL(10, 7, 0));
 398
 399         /* Vertical front porch and vertical display size. 0x000e0320 */
 400         tc35876x_regw(i2c, VTIM2, FLD_VAL(14, 23, 16) | FLD_VAL(800, 10, 0));
 401
 402         /* Set above HTIM1, HTIM2, VTIM1, and VTIM2 at next VSYNC. */
 403         tc35876x_regw(i2c, VFUEN, BIT(0));
 404
 405         /* Soft reset LCD controller. */
 406         tc35876x_regw(i2c, SYSRST, BIT(2));
 407
 408         /* LVDS-TX input muxing */
 409         tc35876x_regw(i2c, LVMX0003,
 410                 INPUT_MUX(INPUT_R5, INPUT_R4, INPUT_R3, INPUT_R2));
 411         tc35876x_regw(i2c, LVMX0407,
 412                 INPUT_MUX(INPUT_G2, INPUT_R7, INPUT_R1, INPUT_R6));
 413         tc35876x_regw(i2c, LVMX0811,
 414                 INPUT_MUX(INPUT_G1, INPUT_G0, INPUT_G4, INPUT_G3));
 415         tc35876x_regw(i2c, LVMX1215,
 416                 INPUT_MUX(INPUT_B2, INPUT_G7, INPUT_G6, INPUT_G5));
 417         tc35876x_regw(i2c, LVMX1619,
 418                 INPUT_MUX(INPUT_B4, INPUT_B3, INPUT_B1, INPUT_B0));
 419         tc35876x_regw(i2c, LVMX2023,
 420                 INPUT_MUX(LOGIC_0,  INPUT_B7, INPUT_B6, INPUT_B5));
 421         tc35876x_regw(i2c, LVMX2427,
 422                 INPUT_MUX(INPUT_R0, INPUT_DE, INPUT_VSYNC, INPUT_HSYNC));
 423
 424         /* Enable LVDS transmitter. */
 425         tc35876x_regw(i2c, LVCFG, BIT(0));
 426
 427         /* Clear notifications. Don't write reserved bits. Was write 0xffffffff
 428          * to 0x0288, must be in error?! */
 429         tc35876x_regw(i2c, DSI_INTCLR, FLD_MASK(31, 30) | FLD_MASK(22, 0));
 430 }
 431
 432 #define GPIOPWMCTRL     0x38F
 433 #define PWM0CLKDIV0     0x62 /* low byte */
 434 #define PWM0CLKDIV1     0x61 /* high byte */
 435
 436 #define SYSTEMCLK       19200000UL /* 19.2 MHz */
 437 #define PWM_FREQUENCY   9600 /* Hz */
 438
 439 /* f = baseclk / (clkdiv + 1) => clkdiv = (baseclk - f) / f */
 440 static inline u16 calc_clkdiv(unsigned long baseclk, unsigned int f)
 441 {
 442         return (baseclk - f) / f;
 443 }
 444
 445 static void tc35876x_brightness_init(struct drm_device *dev)
 446 {
 447         int ret;
 448         u8 pwmctrl;
 449         u16 clkdiv;
 450
 451         /* Make sure the PWM reference is the 19.2 MHz system clock. Read first
 452          * instead of setting directly to catch potential conflicts between PWM
 453          * users. */
 454         ret = intel_scu_ipc_ioread8(GPIOPWMCTRL, &pwmctrl);
 455         if (ret || pwmctrl != 0x01) {
 456                 if (ret)
 457                         dev_err(&dev->pdev->dev, "GPIOPWMCTRL read failed\n");
 458                 else
 459                         dev_warn(&dev->pdev->dev, "GPIOPWMCTRL was not set to system clock (pwmctrl = 0x%02x)\n", pwmctrl);
 460
 461                 ret = intel_scu_ipc_iowrite8(GPIOPWMCTRL, 0x01);
 462                 if (ret)
 463                         dev_err(&dev->pdev->dev, "GPIOPWMCTRL set failed\n");
 464         }
 465
 466         clkdiv = calc_clkdiv(SYSTEMCLK, PWM_FREQUENCY);
 467
 468         ret = intel_scu_ipc_iowrite8(PWM0CLKDIV1, (clkdiv >> 8) & 0xff);
 469         if (!ret)
 470                 ret = intel_scu_ipc_iowrite8(PWM0CLKDIV0, clkdiv & 0xff);
 471
 472         if (ret)
 473                 dev_err(&dev->pdev->dev, "PWM0CLKDIV set failed\n");
 474         else
 475                 dev_dbg(&dev->pdev->dev, "PWM0CLKDIV set to 0x%04x (%d Hz)\n",
 476                         clkdiv, PWM_FREQUENCY);
 477 }
 478
 479 #define PWM0DUTYCYCLE                   0x67
 480
 481 void tc35876x_brightness_control(struct drm_device *dev, int level)
 482 {
 483         int ret;
 484         u8 duty_val;
 485         u8 panel_duty_val;
 486
 487         level = clamp(level, 0, MDFLD_DSI_BRIGHTNESS_MAX_LEVEL);
 488
 489         /* PWM duty cycle 0x00...0x63 corresponds to 0...99% */
 490         duty_val = level * 0x63 / MDFLD_DSI_BRIGHTNESS_MAX_LEVEL;
 491
 492         /* I won't pretend to understand this formula. The panel spec is quite
 493          * bad engrish.
 494          */
 495         panel_duty_val = (2 * level - 100) * 0xA9 /
 496                          MDFLD_DSI_BRIGHTNESS_MAX_LEVEL + 0x56;
 497
 498         ret = intel_scu_ipc_iowrite8(PWM0DUTYCYCLE, duty_val);
 499         if (ret)
 500                 dev_err(&tc35876x_client->dev, "%s: ipc write fail\n",
 501                         __func__);
 502
 503         if (cmi_lcd_i2c_client) {
 504                 ret = i2c_smbus_write_byte_data(cmi_lcd_i2c_client,
 505                                                 PANEL_PWM_MAX, panel_duty_val);
 506                 if (ret < 0)
 507                         dev_err(&cmi_lcd_i2c_client->dev, "%s: i2c write failed\n",
 508                                 __func__);
 509         }
 510 }
 511
 512 void tc35876x_toshiba_bridge_panel_off(struct drm_device *dev)
 513 {
 514         if (WARN(!tc35876x_client, "%s called before probe", __func__))
 515                 return;
 516
 517         dev_dbg(&tc35876x_client->dev, "%s\n", __func__);
 518
 519         if (bridge_bl_enable)
 520                 gpiod_set_value_cansleep(bridge_bl_enable, 0);
 521
 522         if (backlight_voltage)
 523                 gpiod_set_value_cansleep(backlight_voltage, 0);
 524 }
 525
 526 void tc35876x_toshiba_bridge_panel_on(struct drm_device *dev)
 527 {
 528         struct drm_psb_private *dev_priv = dev->dev_private;
 529
 530         if (WARN(!tc35876x_client, "%s called before probe", __func__))
 531                 return;
 532
 533         dev_dbg(&tc35876x_client->dev, "%s\n", __func__);
 534
 535         if (backlight_voltage) {
 536                 gpiod_set_value_cansleep(backlight_voltage, 1);
 537                 msleep(260);
 538         }
 539
 540         if (cmi_lcd_i2c_client) {
 541                 int ret;
 542                 dev_dbg(&cmi_lcd_i2c_client->dev, "setting TCON\n");
 543                 /* Bit 4 is average_saving. Setting it to 1, the brightness is
 544                  * referenced to the average of the frame content. 0 means
 545                  * reference to the maximum of frame contents. Bits 3:0 are
 546                  * allow_distort. When set to a nonzero value, all color values
 547                  * between 255-allow_distort*2 and 255 are mapped to the
 548                  * 255-allow_distort*2 value.
 549                  */
 550                 ret = i2c_smbus_write_byte_data(cmi_lcd_i2c_client,
 551                                                 PANEL_ALLOW_DISTORT, 0x10);
 552                 if (ret < 0)
 553                         dev_err(&cmi_lcd_i2c_client->dev,
 554                                 "i2c write failed (%d)\n", ret);
 555                 ret = i2c_smbus_write_byte_data(cmi_lcd_i2c_client,
 556                                                 PANEL_BYPASS_PWMI, 0);
 557                 if (ret < 0)
 558                         dev_err(&cmi_lcd_i2c_client->dev,
 559                                 "i2c write failed (%d)\n", ret);
 560                 /* Set minimum brightness value - this is tunable */
 561                 ret = i2c_smbus_write_byte_data(cmi_lcd_i2c_client,
 562                                                 PANEL_PWM_MIN, 0x35);
 563                 if (ret < 0)
 564                         dev_err(&cmi_lcd_i2c_client->dev,
 565                                 "i2c write failed (%d)\n", ret);
 566         }
 567
 568         if (bridge_bl_enable)
 569                 gpiod_set_value_cansleep(bridge_bl_enable, 1);
 570
 571         tc35876x_brightness_control(dev, dev_priv->brightness_adjusted);
 572 }
 573
 574 static struct drm_display_mode *tc35876x_get_config_mode(struct drm_device *dev)
 575 {
 576         struct drm_display_mode *mode;
 577
 578         dev_dbg(&dev->pdev->dev, "%s\n", __func__);
 579
 580         mode = kzalloc(sizeof(*mode), GFP_KERNEL);
 581         if (!mode)
 582                 return NULL;
 583
 584         /* FIXME: do this properly. */
 585         mode->hdisplay = 1280;
 586         mode->vdisplay = 800;
 587         mode->hsync_start = 1360;
 588         mode->hsync_end = 1400;
 589         mode->htotal = 1440;
 590         mode->vsync_start = 814;
 591         mode->vsync_end = 824;
 592         mode->vtotal = 838;
 593         mode->clock = 33324 << 1;
 594
 595         dev_info(&dev->pdev->dev, "hdisplay(w) = %d\n", mode->hdisplay);
 596         dev_info(&dev->pdev->dev, "vdisplay(h) = %d\n", mode->vdisplay);
 597         dev_info(&dev->pdev->dev, "HSS = %d\n", mode->hsync_start);
 598         dev_info(&dev->pdev->dev, "HSE = %d\n", mode->hsync_end);
 599         dev_info(&dev->pdev->dev, "htotal = %d\n", mode->htotal);
 600         dev_info(&dev->pdev->dev, "VSS = %d\n", mode->vsync_start);
 601         dev_info(&dev->pdev->dev, "VSE = %d\n", mode->vsync_end);
 602         dev_info(&dev->pdev->dev, "vtotal = %d\n", mode->vtotal);
 603         dev_info(&dev->pdev->dev, "clock = %d\n", mode->clock);
 604
 605         drm_mode_set_name(mode);
 606         drm_mode_set_crtcinfo(mode, 0);
 607
 608         mode->type |= DRM_MODE_TYPE_PREFERRED;
 609
 610         return mode;
 611 }
 612
 613 /* DV1 Active area 216.96 x 135.6 mm */
 614 #define DV1_PANEL_WIDTH 217
 615 #define DV1_PANEL_HEIGHT 136
 616
 617 static int tc35876x_get_panel_info(struct drm_device *dev, int pipe,
 618                                 struct panel_info *pi)
 619 {
 620         if (!dev || !pi)
 621                 return -EINVAL;
 622
 623         pi->width_mm = DV1_PANEL_WIDTH;
 624         pi->height_mm = DV1_PANEL_HEIGHT;
 625
 626         return 0;
 627 }
 628
 629 static int tc35876x_bridge_probe(struct i2c_client *client,
 630                                 const struct i2c_device_id *id)
 631 {
 632         dev_info(&client->dev, "%s\n", __func__);
 633
 634         if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
 635                 dev_err(&client->dev, "%s: i2c_check_functionality() failed\n",
 636                         __func__);
 637                 return -ENODEV;
 638         }
 639
 640         bridge_reset = devm_gpiod_get_optional(&client->dev, "bridge-reset", GPIOD_OUT_LOW);
 641         if (IS_ERR(bridge_reset))
 642                 return PTR_ERR(bridge_reset);
 643         if (bridge_reset)
 644                 gpiod_set_consumer_name(bridge_reset, "tc35876x bridge reset");
 645
 646         bridge_bl_enable = devm_gpiod_get_optional(&client->dev, "bl-en", GPIOD_OUT_LOW);
 647         if (IS_ERR(bridge_bl_enable))
 648                 return PTR_ERR(bridge_bl_enable);
 649         if (bridge_bl_enable)
 650                 gpiod_set_consumer_name(bridge_bl_enable, "tc35876x panel bl en");
 651
 652         backlight_voltage = devm_gpiod_get_optional(&client->dev, "vadd", GPIOD_OUT_LOW);
 653         if (IS_ERR(backlight_voltage))
 654                 return PTR_ERR(backlight_voltage);
 655         if (backlight_voltage)
 656                 gpiod_set_consumer_name(backlight_voltage, "tc35876x panel vadd");
 657
 658         tc35876x_client = client;
 659
 660         return 0;
 661 }
 662
 663 static int tc35876x_bridge_remove(struct i2c_client *client)
 664 {
 665         dev_dbg(&client->dev, "%s\n", __func__);
 666
 667         tc35876x_client = NULL;
 668
 669         return 0;
 670 }
 671
 672 static const struct i2c_device_id tc35876x_bridge_id[] = {
 673         { "i2c_disp_brig", 0 },
 674         { }
 675 };
 676 MODULE_DEVICE_TABLE(i2c, tc35876x_bridge_id);
 677
 678 static struct i2c_driver tc35876x_bridge_i2c_driver = {
 679         .driver = {
 680                 .name = "i2c_disp_brig",
 681         },
 682         .id_table = tc35876x_bridge_id,
 683         .probe = tc35876x_bridge_probe,
 684         .remove = tc35876x_bridge_remove,
 685 };
 686
 687 /* LCD panel I2C */
 688 static int cmi_lcd_i2c_probe(struct i2c_client *client,
 689                              const struct i2c_device_id *id)
 690 {
 691         dev_info(&client->dev, "%s\n", __func__);
 692
 693         if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) {
 694                 dev_err(&client->dev, "%s: i2c_check_functionality() failed\n",
 695                         __func__);
 696                 return -ENODEV;
 697         }
 698
 699         cmi_lcd_i2c_client = client;
 700
 701         return 0;
 702 }
 703
 704 static int cmi_lcd_i2c_remove(struct i2c_client *client)
 705 {
 706         dev_dbg(&client->dev, "%s\n", __func__);
 707
 708         cmi_lcd_i2c_client = NULL;
 709
 710         return 0;
 711 }
 712
 713 static const struct i2c_device_id cmi_lcd_i2c_id[] = {
 714         { "cmi-lcd", 0 },
 715         { }
 716 };
 717 MODULE_DEVICE_TABLE(i2c, cmi_lcd_i2c_id);
 718
 719 static struct i2c_driver cmi_lcd_i2c_driver = {
 720         .driver = {
 721                 .name = "cmi-lcd",
 722         },
 723         .id_table = cmi_lcd_i2c_id,
 724         .probe = cmi_lcd_i2c_probe,
 725         .remove = cmi_lcd_i2c_remove,
 726 };
 727
 728 /* HACK to create I2C device while it's not created by platform code */
 729 #define CMI_LCD_I2C_ADAPTER     2
 730 #define CMI_LCD_I2C_ADDR        0x60
 731
 732 static int cmi_lcd_hack_create_device(void)
 733 {
 734         struct i2c_adapter *adapter;
 735         struct i2c_client *client;
 736         struct i2c_board_info info = {
 737                 .type = "cmi-lcd",
 738                 .addr = CMI_LCD_I2C_ADDR,
 739         };
 740
 741         pr_debug("%s\n", __func__);
 742
 743         adapter = i2c_get_adapter(CMI_LCD_I2C_ADAPTER);
 744         if (!adapter) {
 745                 pr_err("%s: i2c_get_adapter(%d) failed\n", __func__,
 746                         CMI_LCD_I2C_ADAPTER);
 747                 return -EINVAL;
 748         }
 749
 750         client = i2c_new_device(adapter, &info);
 751         if (!client) {
 752                 pr_err("%s: i2c_new_device() failed\n", __func__);
 753                 i2c_put_adapter(adapter);
 754                 return -EINVAL;
 755         }
 756
 757         return 0;
 758 }
 759
 760 static const struct drm_encoder_helper_funcs tc35876x_encoder_helper_funcs = {
 761         .dpms = mdfld_dsi_dpi_dpms,
 762         .mode_fixup = mdfld_dsi_dpi_mode_fixup,
 763         .prepare = mdfld_dsi_dpi_prepare,
 764         .mode_set = mdfld_dsi_dpi_mode_set,
 765         .commit = mdfld_dsi_dpi_commit,
 766 };
 767
 768 static const struct drm_encoder_funcs tc35876x_encoder_funcs = {
 769         .destroy = drm_encoder_cleanup,
 770 };
 771
 772 const struct panel_funcs mdfld_tc35876x_funcs = {
 773         .encoder_funcs = &tc35876x_encoder_funcs,
 774         .encoder_helper_funcs = &tc35876x_encoder_helper_funcs,
 775         .get_config_mode = tc35876x_get_config_mode,
 776         .get_panel_info = tc35876x_get_panel_info,
 777 };
 778
 779 void tc35876x_init(struct drm_device *dev)
 780 {
 781         int r;
 782
 783         dev_dbg(&dev->pdev->dev, "%s\n", __func__);
 784
 785         cmi_lcd_hack_create_device();
 786
 787         r = i2c_add_driver(&cmi_lcd_i2c_driver);
 788         if (r < 0)
 789                 dev_err(&dev->pdev->dev,
 790                         "%s: i2c_add_driver() for %s failed (%d)\n",
 791                         __func__, cmi_lcd_i2c_driver.driver.name, r);
 792
 793         r = i2c_add_driver(&tc35876x_bridge_i2c_driver);
 794         if (r < 0)
 795                 dev_err(&dev->pdev->dev,
 796                         "%s: i2c_add_driver() for %s failed (%d)\n",
 797                         __func__, tc35876x_bridge_i2c_driver.driver.name, r);
 798
 799         tc35876x_brightness_init(dev);
 800 }
 801
 802 void tc35876x_exit(void)
 803 {
 804         pr_debug("%s\n", __func__);
 805
 806         i2c_del_driver(&tc35876x_bridge_i2c_driver);
 807
 808         if (cmi_lcd_i2c_client)
 809                 i2c_del_driver(&cmi_lcd_i2c_driver);
 810 }