]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame - drivers/gpu/drm/i915/intel_dsi_panel_vbt.c
drm/i915/dsi: don't debug log "missing" sequences
[mirror_ubuntu-zesty-kernel.git] / drivers / gpu / drm / i915 / intel_dsi_panel_vbt.c
CommitLineData
2ab8b458
SK
1/*
2 * Copyright © 2014 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 * Author: Shobhit Kumar <shobhit.kumar@intel.com>
24 *
25 */
26
27#include <drm/drmP.h>
28#include <drm/drm_crtc.h>
29#include <drm/drm_edid.h>
30#include <drm/i915_drm.h>
593e0622 31#include <drm/drm_panel.h>
2ab8b458
SK
32#include <linux/slab.h>
33#include <video/mipi_display.h>
34#include <asm/intel-mid.h>
35#include <video/mipi_display.h>
36#include "i915_drv.h"
37#include "intel_drv.h"
38#include "intel_dsi.h"
2ab8b458 39
593e0622
JN
40struct vbt_panel {
41 struct drm_panel panel;
42 struct intel_dsi *intel_dsi;
43};
44
45static inline struct vbt_panel *to_vbt_panel(struct drm_panel *panel)
46{
47 return container_of(panel, struct vbt_panel, panel);
48}
49
2ab8b458
SK
50#define MIPI_TRANSFER_MODE_SHIFT 0
51#define MIPI_VIRTUAL_CHANNEL_SHIFT 1
52#define MIPI_PORT_SHIFT 3
53
54#define PREPARE_CNT_MAX 0x3F
55#define EXIT_ZERO_CNT_MAX 0x3F
56#define CLK_ZERO_CNT_MAX 0xFF
57#define TRAIL_CNT_MAX 0x1F
58
59#define NS_KHZ_RATIO 1000000
60
b0c91cd0
JN
61/* base offsets for gpio pads */
62#define VLV_GPIO_NC_0_HV_DDI0_HPD 0x4130
63#define VLV_GPIO_NC_1_HV_DDI0_DDC_SDA 0x4120
64#define VLV_GPIO_NC_2_HV_DDI0_DDC_SCL 0x4110
65#define VLV_GPIO_NC_3_PANEL0_VDDEN 0x4140
66#define VLV_GPIO_NC_4_PANEL0_BKLTEN 0x4150
67#define VLV_GPIO_NC_5_PANEL0_BKLTCTL 0x4160
68#define VLV_GPIO_NC_6_HV_DDI1_HPD 0x4180
69#define VLV_GPIO_NC_7_HV_DDI1_DDC_SDA 0x4190
70#define VLV_GPIO_NC_8_HV_DDI1_DDC_SCL 0x4170
71#define VLV_GPIO_NC_9_PANEL1_VDDEN 0x4100
72#define VLV_GPIO_NC_10_PANEL1_BKLTEN 0x40E0
73#define VLV_GPIO_NC_11_PANEL1_BKLTCTL 0x40F0
74
75#define VLV_GPIO_PCONF0(base_offset) (base_offset)
76#define VLV_GPIO_PAD_VAL(base_offset) ((base_offset) + 8)
2ab8b458 77
b13d8e28 78struct gpio_map {
b0c91cd0
JN
79 u16 base_offset;
80 bool init;
2ab8b458
SK
81};
82
b13d8e28 83static struct gpio_map vlv_gpio_table[] = {
b0c91cd0
JN
84 { VLV_GPIO_NC_0_HV_DDI0_HPD },
85 { VLV_GPIO_NC_1_HV_DDI0_DDC_SDA },
86 { VLV_GPIO_NC_2_HV_DDI0_DDC_SCL },
87 { VLV_GPIO_NC_3_PANEL0_VDDEN },
88 { VLV_GPIO_NC_4_PANEL0_BKLTEN },
89 { VLV_GPIO_NC_5_PANEL0_BKLTCTL },
90 { VLV_GPIO_NC_6_HV_DDI1_HPD },
91 { VLV_GPIO_NC_7_HV_DDI1_DDC_SDA },
92 { VLV_GPIO_NC_8_HV_DDI1_DDC_SCL },
93 { VLV_GPIO_NC_9_PANEL1_VDDEN },
94 { VLV_GPIO_NC_10_PANEL1_BKLTEN },
95 { VLV_GPIO_NC_11_PANEL1_BKLTCTL },
2ab8b458
SK
96};
97
a0a6d4ff
JN
98#define CHV_GPIO_IDX_START_N 0
99#define CHV_GPIO_IDX_START_E 73
100#define CHV_GPIO_IDX_START_SW 100
101#define CHV_GPIO_IDX_START_SE 198
102
103#define CHV_VBT_MAX_PINS_PER_FMLY 15
104
105#define CHV_GPIO_PAD_CFG0(f, i) (0x4400 + (f) * 0x400 + (i) * 8)
106#define CHV_GPIO_GPIOEN (1 << 15)
107#define CHV_GPIO_GPIOCFG_GPIO (0 << 8)
108#define CHV_GPIO_GPIOCFG_GPO (1 << 8)
109#define CHV_GPIO_GPIOCFG_GPI (2 << 8)
110#define CHV_GPIO_GPIOCFG_HIZ (3 << 8)
111#define CHV_GPIO_GPIOTXSTATE(state) ((!!(state)) << 1)
112
113#define CHV_GPIO_PAD_CFG1(f, i) (0x4400 + (f) * 0x400 + (i) * 8 + 4)
114#define CHV_GPIO_CFGLOCK (1 << 31)
115
8f4d2683
GS
116static inline enum port intel_dsi_seq_port_to_port(u8 port)
117{
118 return port ? PORT_C : PORT_A;
119}
120
5b48ca0f
JN
121static const u8 *mipi_exec_send_packet(struct intel_dsi *intel_dsi,
122 const u8 *data)
2ab8b458 123{
759d10c2
JN
124 struct mipi_dsi_device *dsi_device;
125 u8 type, flags, seq_port;
2ab8b458 126 u16 len;
8f4d2683 127 enum port port;
2ab8b458 128
759d10c2
JN
129 flags = *data++;
130 type = *data++;
131
132 len = *((u16 *) data);
133 data += 2;
134
135 seq_port = (flags >> MIPI_PORT_SHIFT) & 3;
2ab8b458 136
f915084e
GS
137 /* For DSI single link on Port A & C, the seq_port value which is
138 * parsed from Sequence Block#53 of VBT has been set to 0
139 * Now, read/write of packets for the DSI single link on Port A and
140 * Port C will based on the DVO port from VBT block 2.
141 */
142 if (intel_dsi->ports == (1 << PORT_C))
143 port = PORT_C;
144 else
145 port = intel_dsi_seq_port_to_port(seq_port);
2ab8b458 146
759d10c2
JN
147 dsi_device = intel_dsi->dsi_hosts[port]->device;
148 if (!dsi_device) {
149 DRM_DEBUG_KMS("no dsi device for port %c\n", port_name(port));
150 goto out;
151 }
2ab8b458 152
759d10c2
JN
153 if ((flags >> MIPI_TRANSFER_MODE_SHIFT) & 1)
154 dsi_device->mode_flags &= ~MIPI_DSI_MODE_LPM;
155 else
156 dsi_device->mode_flags |= MIPI_DSI_MODE_LPM;
157
158 dsi_device->channel = (flags >> MIPI_VIRTUAL_CHANNEL_SHIFT) & 3;
2ab8b458
SK
159
160 switch (type) {
161 case MIPI_DSI_GENERIC_SHORT_WRITE_0_PARAM:
759d10c2 162 mipi_dsi_generic_write(dsi_device, NULL, 0);
2ab8b458
SK
163 break;
164 case MIPI_DSI_GENERIC_SHORT_WRITE_1_PARAM:
759d10c2 165 mipi_dsi_generic_write(dsi_device, data, 1);
2ab8b458
SK
166 break;
167 case MIPI_DSI_GENERIC_SHORT_WRITE_2_PARAM:
759d10c2 168 mipi_dsi_generic_write(dsi_device, data, 2);
2ab8b458
SK
169 break;
170 case MIPI_DSI_GENERIC_READ_REQUEST_0_PARAM:
171 case MIPI_DSI_GENERIC_READ_REQUEST_1_PARAM:
172 case MIPI_DSI_GENERIC_READ_REQUEST_2_PARAM:
173 DRM_DEBUG_DRIVER("Generic Read not yet implemented or used\n");
174 break;
175 case MIPI_DSI_GENERIC_LONG_WRITE:
759d10c2 176 mipi_dsi_generic_write(dsi_device, data, len);
2ab8b458
SK
177 break;
178 case MIPI_DSI_DCS_SHORT_WRITE:
759d10c2 179 mipi_dsi_dcs_write_buffer(dsi_device, data, 1);
2ab8b458
SK
180 break;
181 case MIPI_DSI_DCS_SHORT_WRITE_PARAM:
759d10c2 182 mipi_dsi_dcs_write_buffer(dsi_device, data, 2);
2ab8b458
SK
183 break;
184 case MIPI_DSI_DCS_READ:
185 DRM_DEBUG_DRIVER("DCS Read not yet implemented or used\n");
186 break;
187 case MIPI_DSI_DCS_LONG_WRITE:
759d10c2 188 mipi_dsi_dcs_write_buffer(dsi_device, data, len);
2ab8b458 189 break;
b5fbcd98 190 }
2ab8b458 191
759d10c2 192out:
2ab8b458
SK
193 data += len;
194
195 return data;
196}
197
5b48ca0f 198static const u8 *mipi_exec_delay(struct intel_dsi *intel_dsi, const u8 *data)
2ab8b458 199{
5b48ca0f 200 u32 delay = *((const u32 *) data);
2ab8b458
SK
201
202 usleep_range(delay, delay + 10);
203 data += 4;
204
205 return data;
206}
207
515d07de
JN
208static void vlv_exec_gpio(struct drm_i915_private *dev_priv,
209 u8 gpio_source, u8 gpio_index, bool value)
2ab8b458 210{
b13d8e28 211 struct gpio_map *map;
b0c91cd0 212 u16 pconf0, padval;
515d07de
JN
213 u32 tmp;
214 u8 port;
2ab8b458 215
b0c91cd0 216 if (gpio_index >= ARRAY_SIZE(vlv_gpio_table)) {
e37788fd 217 DRM_DEBUG_KMS("unknown gpio index %u\n", gpio_index);
515d07de 218 return;
96afef1d
JN
219 }
220
b13d8e28
JN
221 map = &vlv_gpio_table[gpio_index];
222
96afef1d 223 if (dev_priv->vbt.dsi.seq_version >= 3) {
4b541efe
JN
224 /* XXX: this assumes vlv_gpio_table only has NC GPIOs. */
225 port = IOSF_PORT_GPIO_NC;
1d96a4a8
JN
226 } else {
227 if (gpio_source == 0) {
228 port = IOSF_PORT_GPIO_NC;
229 } else if (gpio_source == 1) {
060d4c33
JN
230 DRM_DEBUG_KMS("SC gpio not supported\n");
231 return;
1d96a4a8
JN
232 } else {
233 DRM_DEBUG_KMS("unknown gpio source %u\n", gpio_source);
515d07de 234 return;
1d96a4a8 235 }
96afef1d
JN
236 }
237
b13d8e28
JN
238 pconf0 = VLV_GPIO_PCONF0(map->base_offset);
239 padval = VLV_GPIO_PAD_VAL(map->base_offset);
2ab8b458 240
a580516d 241 mutex_lock(&dev_priv->sb_lock);
b13d8e28 242 if (!map->init) {
2ab8b458 243 /* FIXME: remove constant below */
b0c91cd0 244 vlv_iosf_sb_write(dev_priv, port, pconf0, 0x2000CC00);
b13d8e28 245 map->init = true;
2ab8b458
SK
246 }
247
515d07de
JN
248 tmp = 0x4 | value;
249 vlv_iosf_sb_write(dev_priv, port, padval, tmp);
250 mutex_unlock(&dev_priv->sb_lock);
251}
252
a0a6d4ff
JN
253static void chv_exec_gpio(struct drm_i915_private *dev_priv,
254 u8 gpio_source, u8 gpio_index, bool value)
255{
256 u16 cfg0, cfg1;
257 u16 family_num;
258 u8 port;
259
260 if (dev_priv->vbt.dsi.seq_version >= 3) {
261 if (gpio_index >= CHV_GPIO_IDX_START_SE) {
262 /* XXX: it's unclear whether 255->57 is part of SE. */
263 gpio_index -= CHV_GPIO_IDX_START_SE;
264 port = CHV_IOSF_PORT_GPIO_SE;
265 } else if (gpio_index >= CHV_GPIO_IDX_START_SW) {
266 gpio_index -= CHV_GPIO_IDX_START_SW;
267 port = CHV_IOSF_PORT_GPIO_SW;
268 } else if (gpio_index >= CHV_GPIO_IDX_START_E) {
269 gpio_index -= CHV_GPIO_IDX_START_E;
270 port = CHV_IOSF_PORT_GPIO_E;
271 } else {
272 port = CHV_IOSF_PORT_GPIO_N;
273 }
274 } else {
275 /* XXX: The spec is unclear about CHV GPIO on seq v2 */
276 if (gpio_source != 0) {
277 DRM_DEBUG_KMS("unknown gpio source %u\n", gpio_source);
278 return;
279 }
280
281 if (gpio_index >= CHV_GPIO_IDX_START_E) {
282 DRM_DEBUG_KMS("invalid gpio index %u for GPIO N\n",
283 gpio_index);
284 return;
285 }
286
287 port = CHV_IOSF_PORT_GPIO_N;
288 }
289
290 family_num = gpio_index / CHV_VBT_MAX_PINS_PER_FMLY;
291 gpio_index = gpio_index % CHV_VBT_MAX_PINS_PER_FMLY;
292
293 cfg0 = CHV_GPIO_PAD_CFG0(family_num, gpio_index);
294 cfg1 = CHV_GPIO_PAD_CFG1(family_num, gpio_index);
295
296 mutex_lock(&dev_priv->sb_lock);
297 vlv_iosf_sb_write(dev_priv, port, cfg1, 0);
298 vlv_iosf_sb_write(dev_priv, port, cfg0,
299 CHV_GPIO_GPIOCFG_GPO | CHV_GPIO_GPIOTXSTATE(value));
300 mutex_unlock(&dev_priv->sb_lock);
301}
302
515d07de
JN
303static const u8 *mipi_exec_gpio(struct intel_dsi *intel_dsi, const u8 *data)
304{
305 struct drm_device *dev = intel_dsi->base.base.dev;
fac5e23e 306 struct drm_i915_private *dev_priv = to_i915(dev);
515d07de
JN
307 u8 gpio_source, gpio_index;
308 bool value;
309
310 if (dev_priv->vbt.dsi.seq_version >= 3)
311 data++;
312
313 gpio_index = *data++;
314
315 /* gpio source in sequence v2 only */
316 if (dev_priv->vbt.dsi.seq_version == 2)
317 gpio_source = (*data >> 1) & 3;
318 else
319 gpio_source = 0;
2ab8b458
SK
320
321 /* pull up/down */
515d07de
JN
322 value = *data++ & 1;
323
324 if (IS_VALLEYVIEW(dev_priv))
325 vlv_exec_gpio(dev_priv, gpio_source, gpio_index, value);
a0a6d4ff
JN
326 else if (IS_CHERRYVIEW(dev_priv))
327 chv_exec_gpio(dev_priv, gpio_source, gpio_index, value);
515d07de
JN
328 else
329 DRM_DEBUG_KMS("GPIO element not supported on this platform\n");
2ab8b458
SK
330
331 return data;
332}
333
29bbdcb0
JN
334static const u8 *mipi_exec_i2c_skip(struct intel_dsi *intel_dsi, const u8 *data)
335{
336 return data + *(data + 6) + 7;
337}
338
5b48ca0f
JN
339typedef const u8 * (*fn_mipi_elem_exec)(struct intel_dsi *intel_dsi,
340 const u8 *data);
2ab8b458 341static const fn_mipi_elem_exec exec_elem[] = {
28c72840
JN
342 [MIPI_SEQ_ELEM_SEND_PKT] = mipi_exec_send_packet,
343 [MIPI_SEQ_ELEM_DELAY] = mipi_exec_delay,
344 [MIPI_SEQ_ELEM_GPIO] = mipi_exec_gpio,
29bbdcb0 345 [MIPI_SEQ_ELEM_I2C] = mipi_exec_i2c_skip,
2ab8b458
SK
346};
347
348/*
349 * MIPI Sequence from VBT #53 parsing logic
350 * We have already separated each seqence during bios parsing
351 * Following is generic execution function for any sequence
352 */
353
354static const char * const seq_name[] = {
5cda0d20
JN
355 [MIPI_SEQ_ASSERT_RESET] = "MIPI_SEQ_ASSERT_RESET",
356 [MIPI_SEQ_INIT_OTP] = "MIPI_SEQ_INIT_OTP",
357 [MIPI_SEQ_DISPLAY_ON] = "MIPI_SEQ_DISPLAY_ON",
358 [MIPI_SEQ_DISPLAY_OFF] = "MIPI_SEQ_DISPLAY_OFF",
359 [MIPI_SEQ_DEASSERT_RESET] = "MIPI_SEQ_DEASSERT_RESET",
bc95ce7f
JN
360 [MIPI_SEQ_BACKLIGHT_ON] = "MIPI_SEQ_BACKLIGHT_ON",
361 [MIPI_SEQ_BACKLIGHT_OFF] = "MIPI_SEQ_BACKLIGHT_OFF",
362 [MIPI_SEQ_TEAR_ON] = "MIPI_SEQ_TEAR_ON",
363 [MIPI_SEQ_TEAR_OFF] = "MIPI_SEQ_TEAR_OFF",
364 [MIPI_SEQ_POWER_ON] = "MIPI_SEQ_POWER_ON",
365 [MIPI_SEQ_POWER_OFF] = "MIPI_SEQ_POWER_OFF",
2ab8b458
SK
366};
367
5cda0d20
JN
368static const char *sequence_name(enum mipi_seq seq_id)
369{
370 if (seq_id < ARRAY_SIZE(seq_name) && seq_name[seq_id])
371 return seq_name[seq_id];
372 else
373 return "(unknown)";
374}
375
c67fed85 376static void generic_exec_sequence(struct drm_panel *panel, enum mipi_seq seq_id)
2ab8b458 377{
c67fed85
JN
378 struct vbt_panel *vbt_panel = to_vbt_panel(panel);
379 struct intel_dsi *intel_dsi = vbt_panel->intel_dsi;
2a33d934 380 struct drm_i915_private *dev_priv = to_i915(intel_dsi->base.base.dev);
c67fed85 381 const u8 *data;
2ab8b458 382 fn_mipi_elem_exec mipi_elem_exec;
2ab8b458 383
c67fed85 384 if (WARN_ON(seq_id >= ARRAY_SIZE(dev_priv->vbt.dsi.sequence)))
2ab8b458
SK
385 return;
386
c67fed85 387 data = dev_priv->vbt.dsi.sequence[seq_id];
f7d3c970 388 if (!data)
c67fed85 389 return;
2ab8b458 390
c67fed85
JN
391 WARN_ON(*data != seq_id);
392
393 DRM_DEBUG_KMS("Starting MIPI sequence %d - %s\n",
394 seq_id, sequence_name(seq_id));
395
396 /* Skip Sequence Byte. */
2ab8b458
SK
397 data++;
398
2a33d934
JN
399 /* Skip Size of Sequence. */
400 if (dev_priv->vbt.dsi.seq_version >= 3)
401 data += 4;
402
2ab8b458 403 while (1) {
28c72840 404 u8 operation_byte = *data++;
40795782
JN
405 u8 operation_size = 0;
406
407 if (operation_byte == MIPI_SEQ_ELEM_END)
408 break;
409
410 if (operation_byte < ARRAY_SIZE(exec_elem))
411 mipi_elem_exec = exec_elem[operation_byte];
412 else
413 mipi_elem_exec = NULL;
414
415 /* Size of Operation. */
416 if (dev_priv->vbt.dsi.seq_version >= 3)
417 operation_size = *data++;
418
419 if (mipi_elem_exec) {
420 data = mipi_elem_exec(intel_dsi, data);
421 } else if (operation_size) {
422 /* We have size, skip. */
423 DRM_DEBUG_KMS("Unsupported MIPI operation byte %u\n",
424 operation_byte);
425 data += operation_size;
426 } else {
427 /* No size, can't skip without parsing. */
28c72840
JN
428 DRM_ERROR("Unsupported MIPI operation byte %u\n",
429 operation_byte);
2ab8b458
SK
430 return;
431 }
2ab8b458
SK
432 }
433}
434
593e0622
JN
435static int vbt_panel_prepare(struct drm_panel *panel)
436{
c67fed85
JN
437 generic_exec_sequence(panel, MIPI_SEQ_ASSERT_RESET);
438 generic_exec_sequence(panel, MIPI_SEQ_INIT_OTP);
593e0622
JN
439
440 return 0;
441}
442
443static int vbt_panel_unprepare(struct drm_panel *panel)
444{
c67fed85 445 generic_exec_sequence(panel, MIPI_SEQ_DEASSERT_RESET);
593e0622
JN
446
447 return 0;
448}
449
450static int vbt_panel_enable(struct drm_panel *panel)
451{
c67fed85 452 generic_exec_sequence(panel, MIPI_SEQ_DISPLAY_ON);
593e0622
JN
453
454 return 0;
455}
456
457static int vbt_panel_disable(struct drm_panel *panel)
458{
c67fed85 459 generic_exec_sequence(panel, MIPI_SEQ_DISPLAY_OFF);
593e0622
JN
460
461 return 0;
462}
463
464static int vbt_panel_get_modes(struct drm_panel *panel)
465{
466 struct vbt_panel *vbt_panel = to_vbt_panel(panel);
467 struct intel_dsi *intel_dsi = vbt_panel->intel_dsi;
468 struct drm_device *dev = intel_dsi->base.base.dev;
fac5e23e 469 struct drm_i915_private *dev_priv = to_i915(dev);
593e0622
JN
470 struct drm_display_mode *mode;
471
472 if (!panel->connector)
473 return 0;
474
475 mode = drm_mode_duplicate(dev, dev_priv->vbt.lfp_lvds_vbt_mode);
476 if (!mode)
477 return 0;
478
479 mode->type |= DRM_MODE_TYPE_PREFERRED;
480
481 drm_mode_probed_add(panel->connector, mode);
482
483 return 1;
484}
485
486static const struct drm_panel_funcs vbt_panel_funcs = {
487 .disable = vbt_panel_disable,
488 .unprepare = vbt_panel_unprepare,
489 .prepare = vbt_panel_prepare,
490 .enable = vbt_panel_enable,
491 .get_modes = vbt_panel_get_modes,
492};
493
494struct drm_panel *vbt_panel_init(struct intel_dsi *intel_dsi, u16 panel_id)
2ab8b458 495{
2ab8b458 496 struct drm_device *dev = intel_dsi->base.base.dev;
fac5e23e 497 struct drm_i915_private *dev_priv = to_i915(dev);
2ab8b458
SK
498 struct mipi_config *mipi_config = dev_priv->vbt.dsi.config;
499 struct mipi_pps_data *pps = dev_priv->vbt.dsi.pps;
500 struct drm_display_mode *mode = dev_priv->vbt.lfp_lvds_vbt_mode;
593e0622 501 struct vbt_panel *vbt_panel;
1e78aa01 502 u32 bpp;
2ab8b458
SK
503 u32 tlpx_ns, extra_byte_count, bitrate, tlpx_ui;
504 u32 ui_num, ui_den;
505 u32 prepare_cnt, exit_zero_cnt, clk_zero_cnt, trail_cnt;
506 u32 ths_prepare_ns, tclk_trail_ns;
507 u32 tclk_prepare_clkzero, ths_prepare_hszero;
508 u32 lp_to_hs_switch, hs_to_lp_switch;
7f0c8605
SK
509 u32 pclk, computed_ddr;
510 u16 burst_mode_ratio;
759d10c2 511 enum port port;
2ab8b458
SK
512
513 DRM_DEBUG_KMS("\n");
514
515 intel_dsi->eotp_pkt = mipi_config->eot_pkt_disabled ? 0 : 1;
516 intel_dsi->clock_stop = mipi_config->enable_clk_stop ? 1 : 0;
517 intel_dsi->lane_count = mipi_config->lane_cnt + 1;
43367ec9
R
518 intel_dsi->pixel_format =
519 pixel_format_from_register_bits(
520 mipi_config->videomode_color_format << 7);
1e78aa01
JN
521 bpp = mipi_dsi_pixel_format_to_bpp(intel_dsi->pixel_format);
522
369602d3 523 intel_dsi->dual_link = mipi_config->dual_link;
a9da9bce 524 intel_dsi->pixel_overlap = mipi_config->pixel_overlap;
2ab8b458
SK
525 intel_dsi->operation_mode = mipi_config->is_cmd_mode;
526 intel_dsi->video_mode_format = mipi_config->video_transfer_mode;
527 intel_dsi->escape_clk_div = mipi_config->byte_clk_sel;
528 intel_dsi->lp_rx_timeout = mipi_config->lp_rx_timeout;
529 intel_dsi->turn_arnd_val = mipi_config->turn_around_timeout;
530 intel_dsi->rst_timer_val = mipi_config->device_reset_timer;
531 intel_dsi->init_count = mipi_config->master_init_timer;
532 intel_dsi->bw_timer = mipi_config->dbi_bw_timer;
b5fbcd98
SK
533 intel_dsi->video_frmt_cfg_bits =
534 mipi_config->bta_enabled ? DISABLE_VIDEO_BTA : 0;
2ab8b458 535
7f0c8605
SK
536 pclk = mode->clock;
537
a9da9bce
GS
538 /* In dual link mode each port needs half of pixel clock */
539 if (intel_dsi->dual_link) {
540 pclk = pclk / 2;
541
542 /* we can enable pixel_overlap if needed by panel. In this
543 * case we need to increase the pixelclock for extra pixels
544 */
545 if (intel_dsi->dual_link == DSI_DUAL_LINK_FRONT_BACK) {
546 pclk += DIV_ROUND_UP(mode->vtotal *
547 intel_dsi->pixel_overlap *
548 60, 1000);
549 }
550 }
551
7f0c8605
SK
552 /* Burst Mode Ratio
553 * Target ddr frequency from VBT / non burst ddr freq
554 * multiply by 100 to preserve remainder
555 */
556 if (intel_dsi->video_mode_format == VIDEO_MODE_BURST) {
557 if (mipi_config->target_burst_mode_freq) {
1e78aa01 558 computed_ddr = (pclk * bpp) / intel_dsi->lane_count;
7f0c8605
SK
559
560 if (mipi_config->target_burst_mode_freq <
561 computed_ddr) {
562 DRM_ERROR("Burst mode freq is less than computed\n");
593e0622 563 return NULL;
7f0c8605
SK
564 }
565
566 burst_mode_ratio = DIV_ROUND_UP(
567 mipi_config->target_burst_mode_freq * 100,
568 computed_ddr);
569
570 pclk = DIV_ROUND_UP(pclk * burst_mode_ratio, 100);
571 } else {
572 DRM_ERROR("Burst mode target is not set\n");
593e0622 573 return NULL;
7f0c8605
SK
574 }
575 } else
576 burst_mode_ratio = 100;
577
578 intel_dsi->burst_mode_ratio = burst_mode_ratio;
579 intel_dsi->pclk = pclk;
580
1e78aa01 581 bitrate = (pclk * bpp) / intel_dsi->lane_count;
7f0c8605 582
2ab8b458
SK
583 switch (intel_dsi->escape_clk_div) {
584 case 0:
585 tlpx_ns = 50;
586 break;
587 case 1:
588 tlpx_ns = 100;
589 break;
590
591 case 2:
592 tlpx_ns = 200;
593 break;
594 default:
595 tlpx_ns = 50;
596 break;
597 }
598
599 switch (intel_dsi->lane_count) {
600 case 1:
601 case 2:
602 extra_byte_count = 2;
603 break;
604 case 3:
605 extra_byte_count = 4;
606 break;
607 case 4:
608 default:
609 extra_byte_count = 3;
610 break;
611 }
612
613 /*
614 * ui(s) = 1/f [f in hz]
615 * ui(ns) = 10^9 / (f*10^6) [f in Mhz] -> 10^3/f(Mhz)
616 */
617
618 /* in Kbps */
619 ui_num = NS_KHZ_RATIO;
620 ui_den = bitrate;
621
622 tclk_prepare_clkzero = mipi_config->tclk_prepare_clkzero;
623 ths_prepare_hszero = mipi_config->ths_prepare_hszero;
624
625 /*
626 * B060
627 * LP byte clock = TLPX/ (8UI)
628 */
629 intel_dsi->lp_byte_clk = DIV_ROUND_UP(tlpx_ns * ui_den, 8 * ui_num);
630
631 /* count values in UI = (ns value) * (bitrate / (2 * 10^6))
632 *
633 * Since txddrclkhs_i is 2xUI, all the count values programmed in
634 * DPHY param register are divided by 2
635 *
636 * prepare count
637 */
b5fbcd98
SK
638 ths_prepare_ns = max(mipi_config->ths_prepare,
639 mipi_config->tclk_prepare);
2ab8b458
SK
640 prepare_cnt = DIV_ROUND_UP(ths_prepare_ns * ui_den, ui_num * 2);
641
642 /* exit zero count */
643 exit_zero_cnt = DIV_ROUND_UP(
644 (ths_prepare_hszero - ths_prepare_ns) * ui_den,
645 ui_num * 2
646 );
647
648 /*
ebe69dd3 649 * Exit zero is unified val ths_zero and ths_exit
2ab8b458
SK
650 * minimum value for ths_exit = 110ns
651 * min (exit_zero_cnt * 2) = 110/UI
652 * exit_zero_cnt = 55/UI
653 */
ebe69dd3
CW
654 if (exit_zero_cnt < (55 * ui_den / ui_num) && (55 * ui_den) % ui_num)
655 exit_zero_cnt += 1;
2ab8b458
SK
656
657 /* clk zero count */
658 clk_zero_cnt = DIV_ROUND_UP(
659 (tclk_prepare_clkzero - ths_prepare_ns)
660 * ui_den, 2 * ui_num);
661
662 /* trail count */
663 tclk_trail_ns = max(mipi_config->tclk_trail, mipi_config->ths_trail);
664 trail_cnt = DIV_ROUND_UP(tclk_trail_ns * ui_den, 2 * ui_num);
665
666 if (prepare_cnt > PREPARE_CNT_MAX ||
667 exit_zero_cnt > EXIT_ZERO_CNT_MAX ||
668 clk_zero_cnt > CLK_ZERO_CNT_MAX ||
669 trail_cnt > TRAIL_CNT_MAX)
670 DRM_DEBUG_DRIVER("Values crossing maximum limits, restricting to max values\n");
671
672 if (prepare_cnt > PREPARE_CNT_MAX)
673 prepare_cnt = PREPARE_CNT_MAX;
674
675 if (exit_zero_cnt > EXIT_ZERO_CNT_MAX)
676 exit_zero_cnt = EXIT_ZERO_CNT_MAX;
677
678 if (clk_zero_cnt > CLK_ZERO_CNT_MAX)
679 clk_zero_cnt = CLK_ZERO_CNT_MAX;
680
681 if (trail_cnt > TRAIL_CNT_MAX)
682 trail_cnt = TRAIL_CNT_MAX;
683
684 /* B080 */
685 intel_dsi->dphy_reg = exit_zero_cnt << 24 | trail_cnt << 16 |
686 clk_zero_cnt << 8 | prepare_cnt;
687
688 /*
689 * LP to HS switch count = 4TLPX + PREP_COUNT * 2 + EXIT_ZERO_COUNT * 2
690 * + 10UI + Extra Byte Count
691 *
692 * HS to LP switch count = THS-TRAIL + 2TLPX + Extra Byte Count
693 * Extra Byte Count is calculated according to number of lanes.
694 * High Low Switch Count is the Max of LP to HS and
695 * HS to LP switch count
696 *
697 */
698 tlpx_ui = DIV_ROUND_UP(tlpx_ns * ui_den, ui_num);
699
700 /* B044 */
701 /* FIXME:
702 * The comment above does not match with the code */
703 lp_to_hs_switch = DIV_ROUND_UP(4 * tlpx_ui + prepare_cnt * 2 +
704 exit_zero_cnt * 2 + 10, 8);
705
706 hs_to_lp_switch = DIV_ROUND_UP(mipi_config->ths_trail + 2 * tlpx_ui, 8);
707
708 intel_dsi->hs_to_lp_count = max(lp_to_hs_switch, hs_to_lp_switch);
709 intel_dsi->hs_to_lp_count += extra_byte_count;
710
711 /* B088 */
712 /* LP -> HS for clock lanes
713 * LP clk sync + LP11 + LP01 + tclk_prepare + tclk_zero +
714 * extra byte count
715 * 2TPLX + 1TLPX + 1 TPLX(in ns) + prepare_cnt * 2 + clk_zero_cnt *
716 * 2(in UI) + extra byte count
717 * In byteclks = (4TLPX + prepare_cnt * 2 + clk_zero_cnt *2 (in UI)) /
718 * 8 + extra byte count
719 */
720 intel_dsi->clk_lp_to_hs_count =
721 DIV_ROUND_UP(
722 4 * tlpx_ui + prepare_cnt * 2 +
723 clk_zero_cnt * 2,
724 8);
725
726 intel_dsi->clk_lp_to_hs_count += extra_byte_count;
727
728 /* HS->LP for Clock Lanes
729 * Low Power clock synchronisations + 1Tx byteclk + tclk_trail +
730 * Extra byte count
731 * 2TLPX + 8UI + (trail_count*2)(in UI) + Extra byte count
732 * In byteclks = (2*TLpx(in UI) + trail_count*2 +8)(in UI)/8 +
733 * Extra byte count
734 */
735 intel_dsi->clk_hs_to_lp_count =
736 DIV_ROUND_UP(2 * tlpx_ui + trail_cnt * 2 + 8,
737 8);
738 intel_dsi->clk_hs_to_lp_count += extra_byte_count;
739
740 DRM_DEBUG_KMS("Eot %s\n", intel_dsi->eotp_pkt ? "enabled" : "disabled");
741 DRM_DEBUG_KMS("Clockstop %s\n", intel_dsi->clock_stop ?
742 "disabled" : "enabled");
743 DRM_DEBUG_KMS("Mode %s\n", intel_dsi->operation_mode ? "command" : "video");
a9da9bce
GS
744 if (intel_dsi->dual_link == DSI_DUAL_LINK_FRONT_BACK)
745 DRM_DEBUG_KMS("Dual link: DSI_DUAL_LINK_FRONT_BACK\n");
746 else if (intel_dsi->dual_link == DSI_DUAL_LINK_PIXEL_ALT)
747 DRM_DEBUG_KMS("Dual link: DSI_DUAL_LINK_PIXEL_ALT\n");
748 else
749 DRM_DEBUG_KMS("Dual link: NONE\n");
2ab8b458
SK
750 DRM_DEBUG_KMS("Pixel Format %d\n", intel_dsi->pixel_format);
751 DRM_DEBUG_KMS("TLPX %d\n", intel_dsi->escape_clk_div);
752 DRM_DEBUG_KMS("LP RX Timeout 0x%x\n", intel_dsi->lp_rx_timeout);
753 DRM_DEBUG_KMS("Turnaround Timeout 0x%x\n", intel_dsi->turn_arnd_val);
754 DRM_DEBUG_KMS("Init Count 0x%x\n", intel_dsi->init_count);
755 DRM_DEBUG_KMS("HS to LP Count 0x%x\n", intel_dsi->hs_to_lp_count);
756 DRM_DEBUG_KMS("LP Byte Clock %d\n", intel_dsi->lp_byte_clk);
757 DRM_DEBUG_KMS("DBI BW Timer 0x%x\n", intel_dsi->bw_timer);
758 DRM_DEBUG_KMS("LP to HS Clock Count 0x%x\n", intel_dsi->clk_lp_to_hs_count);
759 DRM_DEBUG_KMS("HS to LP Clock Count 0x%x\n", intel_dsi->clk_hs_to_lp_count);
760 DRM_DEBUG_KMS("BTA %s\n",
761 intel_dsi->video_frmt_cfg_bits & DISABLE_VIDEO_BTA ?
762 "disabled" : "enabled");
763
764 /* delays in VBT are in unit of 100us, so need to convert
765 * here in ms
766 * Delay (100us) * 100 /1000 = Delay / 10 (ms) */
767 intel_dsi->backlight_off_delay = pps->bl_disable_delay / 10;
768 intel_dsi->backlight_on_delay = pps->bl_enable_delay / 10;
769 intel_dsi->panel_on_delay = pps->panel_on_delay / 10;
770 intel_dsi->panel_off_delay = pps->panel_off_delay / 10;
771 intel_dsi->panel_pwr_cycle_delay = pps->panel_power_cycle_delay / 10;
772
593e0622
JN
773 /* This is cheating a bit with the cleanup. */
774 vbt_panel = devm_kzalloc(dev->dev, sizeof(*vbt_panel), GFP_KERNEL);
62ab420f
IY
775 if (!vbt_panel)
776 return NULL;
2ab8b458 777
593e0622
JN
778 vbt_panel->intel_dsi = intel_dsi;
779 drm_panel_init(&vbt_panel->panel);
780 vbt_panel->panel.funcs = &vbt_panel_funcs;
781 drm_panel_add(&vbt_panel->panel);
2ab8b458 782
759d10c2
JN
783 /* a regular driver would get the device in probe */
784 for_each_dsi_port(port, intel_dsi->ports) {
785 mipi_dsi_attach(intel_dsi->dsi_hosts[port]->device);
786 }
787
593e0622 788 return &vbt_panel->panel;
2ab8b458 789}