]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blob - drivers/gpu/drm/exynos/exynos_hdmi.c
projects / mirror_ubuntu-zesty-kernel.git / blob
? search:
summary | shortlog | log | commit | commitdiff | tree
blame | history | raw | HEAD
drm/exynos/hdmi: unregister connector on removal
[mirror_ubuntu-zesty-kernel.git] / drivers / gpu / drm / exynos / exynos_hdmi.c
1 /*
2 * Copyright (C) 2011 Samsung Electronics Co.Ltd
3 * Authors:
4 * Seung-Woo Kim <sw0312.kim@samsung.com>
5 * Inki Dae <inki.dae@samsung.com>
6 * Joonyoung Shim <jy0922.shim@samsung.com>
7 *
8 * Based on drivers/media/video/s5p-tv/hdmi_drv.c
9 *
10 * This program is free software; you can redistribute it and/or modify it
11 * under the terms of the GNU General Public License as published by the
12 * Free Software Foundation; either version 2 of the License, or (at your
13 * option) any later version.
14 *
15 */
16
17 #include <drm/drmP.h>
18 #include <drm/drm_edid.h>
19 #include <drm/drm_crtc_helper.h>
20
21 #include "regs-hdmi.h"
22
23 #include <linux/kernel.h>
24 #include <linux/spinlock.h>
25 #include <linux/wait.h>
26 #include <linux/i2c.h>
27 #include <linux/platform_device.h>
28 #include <linux/interrupt.h>
29 #include <linux/irq.h>
30 #include <linux/delay.h>
31 #include <linux/pm_runtime.h>
32 #include <linux/clk.h>
33 #include <linux/regulator/consumer.h>
34 #include <linux/io.h>
35 #include <linux/of.h>
36 #include <linux/of_address.h>
37 #include <linux/of_gpio.h>
38 #include <linux/hdmi.h>
39 #include <linux/component.h>
40 #include <linux/mfd/syscon.h>
41 #include <linux/regmap.h>
42
43 #include <drm/exynos_drm.h>
44
45 #include "exynos_drm_drv.h"
46 #include "exynos_drm_crtc.h"
47 #include "exynos_mixer.h"
48
49 #include <linux/gpio.h>
50 #include <media/s5p_hdmi.h>
51
52 #define get_hdmi_display(dev) platform_get_drvdata(to_platform_device(dev))
53 #define ctx_from_connector(c) container_of(c, struct hdmi_context, connector)
54
55 #define HOTPLUG_DEBOUNCE_MS 1100
56
57 /* AVI header and aspect ratio */
58 #define HDMI_AVI_VERSION 0x02
59 #define HDMI_AVI_LENGTH 0x0D
60
61 /* AUI header info */
62 #define HDMI_AUI_VERSION 0x01
63 #define HDMI_AUI_LENGTH 0x0A
64 #define AVI_SAME_AS_PIC_ASPECT_RATIO 0x8
65 #define AVI_4_3_CENTER_RATIO 0x9
66 #define AVI_16_9_CENTER_RATIO 0xa
67
68 enum hdmi_type {
69 HDMI_TYPE13,
70 HDMI_TYPE14,
71 };
72
73 struct hdmi_driver_data {
74 unsigned int type;
75 const struct hdmiphy_config *phy_confs;
76 unsigned int phy_conf_count;
77 unsigned int is_apb_phy:1;
78 };
79
80 struct hdmi_resources {
81 struct clk *hdmi;
82 struct clk *sclk_hdmi;
83 struct clk *sclk_pixel;
84 struct clk *sclk_hdmiphy;
85 struct clk *mout_hdmi;
86 struct regulator_bulk_data *regul_bulk;
87 struct regulator *reg_hdmi_en;
88 int regul_count;
89 };
90
91 struct hdmi_tg_regs {
92 u8 cmd[1];
93 u8 h_fsz[2];
94 u8 hact_st[2];
95 u8 hact_sz[2];
96 u8 v_fsz[2];
97 u8 vsync[2];
98 u8 vsync2[2];
99 u8 vact_st[2];
100 u8 vact_sz[2];
101 u8 field_chg[2];
102 u8 vact_st2[2];
103 u8 vact_st3[2];
104 u8 vact_st4[2];
105 u8 vsync_top_hdmi[2];
106 u8 vsync_bot_hdmi[2];
107 u8 field_top_hdmi[2];
108 u8 field_bot_hdmi[2];
109 u8 tg_3d[1];
110 };
111
112 struct hdmi_v13_core_regs {
113 u8 h_blank[2];
114 u8 v_blank[3];
115 u8 h_v_line[3];
116 u8 vsync_pol[1];
117 u8 int_pro_mode[1];
118 u8 v_blank_f[3];
119 u8 h_sync_gen[3];
120 u8 v_sync_gen1[3];
121 u8 v_sync_gen2[3];
122 u8 v_sync_gen3[3];
123 };
124
125 struct hdmi_v14_core_regs {
126 u8 h_blank[2];
127 u8 v2_blank[2];
128 u8 v1_blank[2];
129 u8 v_line[2];
130 u8 h_line[2];
131 u8 hsync_pol[1];
132 u8 vsync_pol[1];
133 u8 int_pro_mode[1];
134 u8 v_blank_f0[2];
135 u8 v_blank_f1[2];
136 u8 h_sync_start[2];
137 u8 h_sync_end[2];
138 u8 v_sync_line_bef_2[2];
139 u8 v_sync_line_bef_1[2];
140 u8 v_sync_line_aft_2[2];
141 u8 v_sync_line_aft_1[2];
142 u8 v_sync_line_aft_pxl_2[2];
143 u8 v_sync_line_aft_pxl_1[2];
144 u8 v_blank_f2[2]; /* for 3D mode */
145 u8 v_blank_f3[2]; /* for 3D mode */
146 u8 v_blank_f4[2]; /* for 3D mode */
147 u8 v_blank_f5[2]; /* for 3D mode */
148 u8 v_sync_line_aft_3[2];
149 u8 v_sync_line_aft_4[2];
150 u8 v_sync_line_aft_5[2];
151 u8 v_sync_line_aft_6[2];
152 u8 v_sync_line_aft_pxl_3[2];
153 u8 v_sync_line_aft_pxl_4[2];
154 u8 v_sync_line_aft_pxl_5[2];
155 u8 v_sync_line_aft_pxl_6[2];
156 u8 vact_space_1[2];
157 u8 vact_space_2[2];
158 u8 vact_space_3[2];
159 u8 vact_space_4[2];
160 u8 vact_space_5[2];
161 u8 vact_space_6[2];
162 };
163
164 struct hdmi_v13_conf {
165 struct hdmi_v13_core_regs core;
166 struct hdmi_tg_regs tg;
167 };
168
169 struct hdmi_v14_conf {
170 struct hdmi_v14_core_regs core;
171 struct hdmi_tg_regs tg;
172 };
173
174 struct hdmi_conf_regs {
175 int pixel_clock;
176 int cea_video_id;
177 enum hdmi_picture_aspect aspect_ratio;
178 union {
179 struct hdmi_v13_conf v13_conf;
180 struct hdmi_v14_conf v14_conf;
181 } conf;
182 };
183
184 struct hdmi_context {
185 struct device *dev;
186 struct drm_device *drm_dev;
187 struct drm_connector connector;
188 struct drm_encoder *encoder;
189 bool hpd;
190 bool powered;
191 bool dvi_mode;
192 struct mutex hdmi_mutex;
193
194 void __iomem *regs;
195 int irq;
196 struct delayed_work hotplug_work;
197
198 struct i2c_adapter *ddc_adpt;
199 struct i2c_client *hdmiphy_port;
200
201 /* current hdmiphy conf regs */
202 struct drm_display_mode current_mode;
203 struct hdmi_conf_regs mode_conf;
204
205 struct hdmi_resources res;
206
207 int hpd_gpio;
208 void __iomem *regs_hdmiphy;
209 const struct hdmiphy_config *phy_confs;
210 unsigned int phy_conf_count;
211
212 struct regmap *pmureg;
213 enum hdmi_type type;
214 };
215
216 struct hdmiphy_config {
217 int pixel_clock;
218 u8 conf[32];
219 };
220
221 /* list of phy config settings */
222 static const struct hdmiphy_config hdmiphy_v13_configs[] = {
223 {
224 .pixel_clock = 27000000,
225 .conf = {
226 0x01, 0x05, 0x00, 0xD8, 0x10, 0x1C, 0x30, 0x40,
227 0x6B, 0x10, 0x02, 0x51, 0xDF, 0xF2, 0x54, 0x87,
228 0x84, 0x00, 0x30, 0x38, 0x00, 0x08, 0x10, 0xE0,
229 0x22, 0x40, 0xE3, 0x26, 0x00, 0x00, 0x00, 0x00,
230 },
231 },
232 {
233 .pixel_clock = 27027000,
234 .conf = {
235 0x01, 0x05, 0x00, 0xD4, 0x10, 0x9C, 0x09, 0x64,
236 0x6B, 0x10, 0x02, 0x51, 0xDF, 0xF2, 0x54, 0x87,
237 0x84, 0x00, 0x30, 0x38, 0x00, 0x08, 0x10, 0xE0,
238 0x22, 0x40, 0xE3, 0x26, 0x00, 0x00, 0x00, 0x00,
239 },
240 },
241 {
242 .pixel_clock = 74176000,
243 .conf = {
244 0x01, 0x05, 0x00, 0xD8, 0x10, 0x9C, 0xef, 0x5B,
245 0x6D, 0x10, 0x01, 0x51, 0xef, 0xF3, 0x54, 0xb9,
246 0x84, 0x00, 0x30, 0x38, 0x00, 0x08, 0x10, 0xE0,
247 0x22, 0x40, 0xa5, 0x26, 0x01, 0x00, 0x00, 0x00,
248 },
249 },
250 {
251 .pixel_clock = 74250000,
252 .conf = {
253 0x01, 0x05, 0x00, 0xd8, 0x10, 0x9c, 0xf8, 0x40,
254 0x6a, 0x10, 0x01, 0x51, 0xff, 0xf1, 0x54, 0xba,
255 0x84, 0x00, 0x10, 0x38, 0x00, 0x08, 0x10, 0xe0,
256 0x22, 0x40, 0xa4, 0x26, 0x01, 0x00, 0x00, 0x00,
257 },
258 },
259 {
260 .pixel_clock = 148500000,
261 .conf = {
262 0x01, 0x05, 0x00, 0xD8, 0x10, 0x9C, 0xf8, 0x40,
263 0x6A, 0x18, 0x00, 0x51, 0xff, 0xF1, 0x54, 0xba,
264 0x84, 0x00, 0x10, 0x38, 0x00, 0x08, 0x10, 0xE0,
265 0x22, 0x40, 0xa4, 0x26, 0x02, 0x00, 0x00, 0x00,
266 },
267 },
268 };
269
270 static const struct hdmiphy_config hdmiphy_v14_configs[] = {
271 {
272 .pixel_clock = 25200000,
273 .conf = {
274 0x01, 0x51, 0x2A, 0x75, 0x40, 0x01, 0x00, 0x08,
275 0x82, 0x80, 0xfc, 0xd8, 0x45, 0xa0, 0xac, 0x80,
276 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
277 0x54, 0xf4, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
278 },
279 },
280 {
281 .pixel_clock = 27000000,
282 .conf = {
283 0x01, 0xd1, 0x22, 0x51, 0x40, 0x08, 0xfc, 0x20,
284 0x98, 0xa0, 0xcb, 0xd8, 0x45, 0xa0, 0xac, 0x80,
285 0x06, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
286 0x54, 0xe4, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
287 },
288 },
289 {
290 .pixel_clock = 27027000,
291 .conf = {
292 0x01, 0xd1, 0x2d, 0x72, 0x40, 0x64, 0x12, 0x08,
293 0x43, 0xa0, 0x0e, 0xd9, 0x45, 0xa0, 0xac, 0x80,
294 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
295 0x54, 0xe3, 0x24, 0x00, 0x00, 0x00, 0x01, 0x00,
296 },
297 },
298 {
299 .pixel_clock = 36000000,
300 .conf = {
301 0x01, 0x51, 0x2d, 0x55, 0x40, 0x01, 0x00, 0x08,
302 0x82, 0x80, 0x0e, 0xd9, 0x45, 0xa0, 0xac, 0x80,
303 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
304 0x54, 0xab, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
305 },
306 },
307 {
308 .pixel_clock = 40000000,
309 .conf = {
310 0x01, 0x51, 0x32, 0x55, 0x40, 0x01, 0x00, 0x08,
311 0x82, 0x80, 0x2c, 0xd9, 0x45, 0xa0, 0xac, 0x80,
312 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
313 0x54, 0x9a, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
314 },
315 },
316 {
317 .pixel_clock = 65000000,
318 .conf = {
319 0x01, 0xd1, 0x36, 0x34, 0x40, 0x1e, 0x0a, 0x08,
320 0x82, 0xa0, 0x45, 0xd9, 0x45, 0xa0, 0xac, 0x80,
321 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
322 0x54, 0xbd, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
323 },
324 },
325 {
326 .pixel_clock = 71000000,
327 .conf = {
328 0x01, 0xd1, 0x3b, 0x35, 0x40, 0x0c, 0x04, 0x08,
329 0x85, 0xa0, 0x63, 0xd9, 0x45, 0xa0, 0xac, 0x80,
330 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
331 0x54, 0xad, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
332 },
333 },
334 {
335 .pixel_clock = 73250000,
336 .conf = {
337 0x01, 0xd1, 0x3d, 0x35, 0x40, 0x18, 0x02, 0x08,
338 0x83, 0xa0, 0x6e, 0xd9, 0x45, 0xa0, 0xac, 0x80,
339 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
340 0x54, 0xa8, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
341 },
342 },
343 {
344 .pixel_clock = 74176000,
345 .conf = {
346 0x01, 0xd1, 0x3e, 0x35, 0x40, 0x5b, 0xde, 0x08,
347 0x82, 0xa0, 0x73, 0xd9, 0x45, 0xa0, 0xac, 0x80,
348 0x56, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
349 0x54, 0xa6, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
350 },
351 },
352 {
353 .pixel_clock = 74250000,
354 .conf = {
355 0x01, 0xd1, 0x1f, 0x10, 0x40, 0x40, 0xf8, 0x08,
356 0x81, 0xa0, 0xba, 0xd8, 0x45, 0xa0, 0xac, 0x80,
357 0x3c, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
358 0x54, 0xa5, 0x24, 0x01, 0x00, 0x00, 0x01, 0x00,
359 },
360 },
361 {
362 .pixel_clock = 83500000,
363 .conf = {
364 0x01, 0xd1, 0x23, 0x11, 0x40, 0x0c, 0xfb, 0x08,
365 0x85, 0xa0, 0xd1, 0xd8, 0x45, 0xa0, 0xac, 0x80,
366 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
367 0x54, 0x93, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
368 },
369 },
370 {
371 .pixel_clock = 106500000,
372 .conf = {
373 0x01, 0xd1, 0x2c, 0x12, 0x40, 0x0c, 0x09, 0x08,
374 0x84, 0xa0, 0x0a, 0xd9, 0x45, 0xa0, 0xac, 0x80,
375 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
376 0x54, 0x73, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
377 },
378 },
379 {
380 .pixel_clock = 108000000,
381 .conf = {
382 0x01, 0x51, 0x2d, 0x15, 0x40, 0x01, 0x00, 0x08,
383 0x82, 0x80, 0x0e, 0xd9, 0x45, 0xa0, 0xac, 0x80,
384 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
385 0x54, 0xc7, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
386 },
387 },
388 {
389 .pixel_clock = 115500000,
390 .conf = {
391 0x01, 0xd1, 0x30, 0x12, 0x40, 0x40, 0x10, 0x08,
392 0x80, 0x80, 0x21, 0xd9, 0x45, 0xa0, 0xac, 0x80,
393 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
394 0x54, 0xaa, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
395 },
396 },
397 {
398 .pixel_clock = 119000000,
399 .conf = {
400 0x01, 0xd1, 0x32, 0x1a, 0x40, 0x30, 0xd8, 0x08,
401 0x04, 0xa0, 0x2a, 0xd9, 0x45, 0xa0, 0xac, 0x80,
402 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
403 0x54, 0x9d, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
404 },
405 },
406 {
407 .pixel_clock = 146250000,
408 .conf = {
409 0x01, 0xd1, 0x3d, 0x15, 0x40, 0x18, 0xfd, 0x08,
410 0x83, 0xa0, 0x6e, 0xd9, 0x45, 0xa0, 0xac, 0x80,
411 0x08, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
412 0x54, 0x50, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
413 },
414 },
415 {
416 .pixel_clock = 148500000,
417 .conf = {
418 0x01, 0xd1, 0x1f, 0x00, 0x40, 0x40, 0xf8, 0x08,
419 0x81, 0xa0, 0xba, 0xd8, 0x45, 0xa0, 0xac, 0x80,
420 0x3c, 0x80, 0x11, 0x04, 0x02, 0x22, 0x44, 0x86,
421 0x54, 0x4b, 0x25, 0x03, 0x00, 0x00, 0x01, 0x00,
422 },
423 },
424 };
425
426 static const struct hdmiphy_config hdmiphy_5420_configs[] = {
427 {
428 .pixel_clock = 25200000,
429 .conf = {
430 0x01, 0x52, 0x3F, 0x55, 0x40, 0x01, 0x00, 0xC8,
431 0x82, 0xC8, 0xBD, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
432 0x06, 0x80, 0x01, 0x84, 0x05, 0x02, 0x24, 0x66,
433 0x54, 0xF4, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
434 },
435 },
436 {
437 .pixel_clock = 27000000,
438 .conf = {
439 0x01, 0xD1, 0x22, 0x51, 0x40, 0x08, 0xFC, 0xE0,
440 0x98, 0xE8, 0xCB, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
441 0x06, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
442 0x54, 0xE4, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
443 },
444 },
445 {
446 .pixel_clock = 27027000,
447 .conf = {
448 0x01, 0xD1, 0x2D, 0x72, 0x40, 0x64, 0x12, 0xC8,
449 0x43, 0xE8, 0x0E, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
450 0x26, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
451 0x54, 0xE3, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
452 },
453 },
454 {
455 .pixel_clock = 36000000,
456 .conf = {
457 0x01, 0x51, 0x2D, 0x55, 0x40, 0x40, 0x00, 0xC8,
458 0x02, 0xC8, 0x0E, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
459 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
460 0x54, 0xAB, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
461 },
462 },
463 {
464 .pixel_clock = 40000000,
465 .conf = {
466 0x01, 0xD1, 0x21, 0x31, 0x40, 0x3C, 0x28, 0xC8,
467 0x87, 0xE8, 0xC8, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
468 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
469 0x54, 0x9A, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
470 },
471 },
472 {
473 .pixel_clock = 65000000,
474 .conf = {
475 0x01, 0xD1, 0x36, 0x34, 0x40, 0x0C, 0x04, 0xC8,
476 0x82, 0xE8, 0x45, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
477 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
478 0x54, 0xBD, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
479 },
480 },
481 {
482 .pixel_clock = 71000000,
483 .conf = {
484 0x01, 0xD1, 0x3B, 0x35, 0x40, 0x0C, 0x04, 0xC8,
485 0x85, 0xE8, 0x63, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
486 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
487 0x54, 0x57, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
488 },
489 },
490 {
491 .pixel_clock = 73250000,
492 .conf = {
493 0x01, 0xD1, 0x1F, 0x10, 0x40, 0x78, 0x8D, 0xC8,
494 0x81, 0xE8, 0xB7, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
495 0x56, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
496 0x54, 0xA8, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
497 },
498 },
499 {
500 .pixel_clock = 74176000,
501 .conf = {
502 0x01, 0xD1, 0x1F, 0x10, 0x40, 0x5B, 0xEF, 0xC8,
503 0x81, 0xE8, 0xB9, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
504 0x56, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
505 0x54, 0xA6, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
506 },
507 },
508 {
509 .pixel_clock = 74250000,
510 .conf = {
511 0x01, 0xD1, 0x1F, 0x10, 0x40, 0x40, 0xF8, 0x08,
512 0x81, 0xE8, 0xBA, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
513 0x26, 0x80, 0x09, 0x84, 0x05, 0x22, 0x24, 0x66,
514 0x54, 0xA5, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
515 },
516 },
517 {
518 .pixel_clock = 83500000,
519 .conf = {
520 0x01, 0xD1, 0x23, 0x11, 0x40, 0x0C, 0xFB, 0xC8,
521 0x85, 0xE8, 0xD1, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
522 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
523 0x54, 0x4A, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
524 },
525 },
526 {
527 .pixel_clock = 88750000,
528 .conf = {
529 0x01, 0xD1, 0x25, 0x11, 0x40, 0x18, 0xFF, 0xC8,
530 0x83, 0xE8, 0xDE, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
531 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
532 0x54, 0x45, 0x24, 0x00, 0x00, 0x00, 0x01, 0x80,
533 },
534 },
535 {
536 .pixel_clock = 106500000,
537 .conf = {
538 0x01, 0xD1, 0x2C, 0x12, 0x40, 0x0C, 0x09, 0xC8,
539 0x84, 0xE8, 0x0A, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
540 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
541 0x54, 0x73, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
542 },
543 },
544 {
545 .pixel_clock = 108000000,
546 .conf = {
547 0x01, 0x51, 0x2D, 0x15, 0x40, 0x01, 0x00, 0xC8,
548 0x82, 0xC8, 0x0E, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
549 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
550 0x54, 0xC7, 0x25, 0x03, 0x00, 0x00, 0x01, 0x80,
551 },
552 },
553 {
554 .pixel_clock = 115500000,
555 .conf = {
556 0x01, 0xD1, 0x30, 0x14, 0x40, 0x0C, 0x03, 0xC8,
557 0x88, 0xE8, 0x21, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
558 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
559 0x54, 0x6A, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
560 },
561 },
562 {
563 .pixel_clock = 146250000,
564 .conf = {
565 0x01, 0xD1, 0x3D, 0x15, 0x40, 0x18, 0xFD, 0xC8,
566 0x83, 0xE8, 0x6E, 0xD9, 0x45, 0xA0, 0xAC, 0x80,
567 0x08, 0x80, 0x09, 0x84, 0x05, 0x02, 0x24, 0x66,
568 0x54, 0x54, 0x24, 0x01, 0x00, 0x00, 0x01, 0x80,
569 },
570 },
571 {
572 .pixel_clock = 148500000,
573 .conf = {
574 0x01, 0xD1, 0x1F, 0x00, 0x40, 0x40, 0xF8, 0x08,
575 0x81, 0xE8, 0xBA, 0xD8, 0x45, 0xA0, 0xAC, 0x80,
576 0x26, 0x80, 0x09, 0x84, 0x05, 0x22, 0x24, 0x66,
577 0x54, 0x4B, 0x25, 0x03, 0x00, 0x80, 0x01, 0x80,
578 },
579 },
580 };
581
582 static struct hdmi_driver_data exynos5420_hdmi_driver_data = {
583 .type = HDMI_TYPE14,
584 .phy_confs = hdmiphy_5420_configs,
585 .phy_conf_count = ARRAY_SIZE(hdmiphy_5420_configs),
586 .is_apb_phy = 1,
587 };
588
589 static struct hdmi_driver_data exynos4212_hdmi_driver_data = {
590 .type = HDMI_TYPE14,
591 .phy_confs = hdmiphy_v14_configs,
592 .phy_conf_count = ARRAY_SIZE(hdmiphy_v14_configs),
593 .is_apb_phy = 0,
594 };
595
596 static struct hdmi_driver_data exynos4210_hdmi_driver_data = {
597 .type = HDMI_TYPE13,
598 .phy_confs = hdmiphy_v13_configs,
599 .phy_conf_count = ARRAY_SIZE(hdmiphy_v13_configs),
600 .is_apb_phy = 0,
601 };
602
603 static struct hdmi_driver_data exynos5_hdmi_driver_data = {
604 .type = HDMI_TYPE14,
605 .phy_confs = hdmiphy_v13_configs,
606 .phy_conf_count = ARRAY_SIZE(hdmiphy_v13_configs),
607 .is_apb_phy = 0,
608 };
609
610 static inline u32 hdmi_reg_read(struct hdmi_context *hdata, u32 reg_id)
611 {
612 return readl(hdata->regs + reg_id);
613 }
614
615 static inline void hdmi_reg_writeb(struct hdmi_context *hdata,
616 u32 reg_id, u8 value)
617 {
618 writeb(value, hdata->regs + reg_id);
619 }
620
621 static inline void hdmi_reg_writemask(struct hdmi_context *hdata,
622 u32 reg_id, u32 value, u32 mask)
623 {
624 u32 old = readl(hdata->regs + reg_id);
625 value = (value & mask) | (old & ~mask);
626 writel(value, hdata->regs + reg_id);
627 }
628
629 static int hdmiphy_reg_writeb(struct hdmi_context *hdata,
630 u32 reg_offset, u8 value)
631 {
632 if (hdata->hdmiphy_port) {
633 u8 buffer[2];
634 int ret;
635
636 buffer[0] = reg_offset;
637 buffer[1] = value;
638
639 ret = i2c_master_send(hdata->hdmiphy_port, buffer, 2);
640 if (ret == 2)
641 return 0;
642 return ret;
643 } else {
644 writeb(value, hdata->regs_hdmiphy + (reg_offset<<2));
645 return 0;
646 }
647 }
648
649 static int hdmiphy_reg_write_buf(struct hdmi_context *hdata,
650 u32 reg_offset, const u8 *buf, u32 len)
651 {
652 if ((reg_offset + len) > 32)
653 return -EINVAL;
654
655 if (hdata->hdmiphy_port) {
656 int ret;
657
658 ret = i2c_master_send(hdata->hdmiphy_port, buf, len);
659 if (ret == len)
660 return 0;
661 return ret;
662 } else {
663 int i;
664 for (i = 0; i < len; i++)
665 writeb(buf[i], hdata->regs_hdmiphy +
666 ((reg_offset + i)<<2));
667 return 0;
668 }
669 }
670
671 static void hdmi_v13_regs_dump(struct hdmi_context *hdata, char *prefix)
672 {
673 #define DUMPREG(reg_id) \
674 DRM_DEBUG_KMS("%s:" #reg_id " = %08x\n", prefix, \
675 readl(hdata->regs + reg_id))
676 DRM_DEBUG_KMS("%s: ---- CONTROL REGISTERS ----\n", prefix);
677 DUMPREG(HDMI_INTC_FLAG);
678 DUMPREG(HDMI_INTC_CON);
679 DUMPREG(HDMI_HPD_STATUS);
680 DUMPREG(HDMI_V13_PHY_RSTOUT);
681 DUMPREG(HDMI_V13_PHY_VPLL);
682 DUMPREG(HDMI_V13_PHY_CMU);
683 DUMPREG(HDMI_V13_CORE_RSTOUT);
684
685 DRM_DEBUG_KMS("%s: ---- CORE REGISTERS ----\n", prefix);
686 DUMPREG(HDMI_CON_0);
687 DUMPREG(HDMI_CON_1);
688 DUMPREG(HDMI_CON_2);
689 DUMPREG(HDMI_SYS_STATUS);
690 DUMPREG(HDMI_V13_PHY_STATUS);
691 DUMPREG(HDMI_STATUS_EN);
692 DUMPREG(HDMI_HPD);
693 DUMPREG(HDMI_MODE_SEL);
694 DUMPREG(HDMI_V13_HPD_GEN);
695 DUMPREG(HDMI_V13_DC_CONTROL);
696 DUMPREG(HDMI_V13_VIDEO_PATTERN_GEN);
697
698 DRM_DEBUG_KMS("%s: ---- CORE SYNC REGISTERS ----\n", prefix);
699 DUMPREG(HDMI_H_BLANK_0);
700 DUMPREG(HDMI_H_BLANK_1);
701 DUMPREG(HDMI_V13_V_BLANK_0);
702 DUMPREG(HDMI_V13_V_BLANK_1);
703 DUMPREG(HDMI_V13_V_BLANK_2);
704 DUMPREG(HDMI_V13_H_V_LINE_0);
705 DUMPREG(HDMI_V13_H_V_LINE_1);
706 DUMPREG(HDMI_V13_H_V_LINE_2);
707 DUMPREG(HDMI_VSYNC_POL);
708 DUMPREG(HDMI_INT_PRO_MODE);
709 DUMPREG(HDMI_V13_V_BLANK_F_0);
710 DUMPREG(HDMI_V13_V_BLANK_F_1);
711 DUMPREG(HDMI_V13_V_BLANK_F_2);
712 DUMPREG(HDMI_V13_H_SYNC_GEN_0);
713 DUMPREG(HDMI_V13_H_SYNC_GEN_1);
714 DUMPREG(HDMI_V13_H_SYNC_GEN_2);
715 DUMPREG(HDMI_V13_V_SYNC_GEN_1_0);
716 DUMPREG(HDMI_V13_V_SYNC_GEN_1_1);
717 DUMPREG(HDMI_V13_V_SYNC_GEN_1_2);
718 DUMPREG(HDMI_V13_V_SYNC_GEN_2_0);
719 DUMPREG(HDMI_V13_V_SYNC_GEN_2_1);
720 DUMPREG(HDMI_V13_V_SYNC_GEN_2_2);
721 DUMPREG(HDMI_V13_V_SYNC_GEN_3_0);
722 DUMPREG(HDMI_V13_V_SYNC_GEN_3_1);
723 DUMPREG(HDMI_V13_V_SYNC_GEN_3_2);
724
725 DRM_DEBUG_KMS("%s: ---- TG REGISTERS ----\n", prefix);
726 DUMPREG(HDMI_TG_CMD);
727 DUMPREG(HDMI_TG_H_FSZ_L);
728 DUMPREG(HDMI_TG_H_FSZ_H);
729 DUMPREG(HDMI_TG_HACT_ST_L);
730 DUMPREG(HDMI_TG_HACT_ST_H);
731 DUMPREG(HDMI_TG_HACT_SZ_L);
732 DUMPREG(HDMI_TG_HACT_SZ_H);
733 DUMPREG(HDMI_TG_V_FSZ_L);
734 DUMPREG(HDMI_TG_V_FSZ_H);
735 DUMPREG(HDMI_TG_VSYNC_L);
736 DUMPREG(HDMI_TG_VSYNC_H);
737 DUMPREG(HDMI_TG_VSYNC2_L);
738 DUMPREG(HDMI_TG_VSYNC2_H);
739 DUMPREG(HDMI_TG_VACT_ST_L);
740 DUMPREG(HDMI_TG_VACT_ST_H);
741 DUMPREG(HDMI_TG_VACT_SZ_L);
742 DUMPREG(HDMI_TG_VACT_SZ_H);
743 DUMPREG(HDMI_TG_FIELD_CHG_L);
744 DUMPREG(HDMI_TG_FIELD_CHG_H);
745 DUMPREG(HDMI_TG_VACT_ST2_L);
746 DUMPREG(HDMI_TG_VACT_ST2_H);
747 DUMPREG(HDMI_TG_VSYNC_TOP_HDMI_L);
748 DUMPREG(HDMI_TG_VSYNC_TOP_HDMI_H);
749 DUMPREG(HDMI_TG_VSYNC_BOT_HDMI_L);
750 DUMPREG(HDMI_TG_VSYNC_BOT_HDMI_H);
751 DUMPREG(HDMI_TG_FIELD_TOP_HDMI_L);
752 DUMPREG(HDMI_TG_FIELD_TOP_HDMI_H);
753 DUMPREG(HDMI_TG_FIELD_BOT_HDMI_L);
754 DUMPREG(HDMI_TG_FIELD_BOT_HDMI_H);
755 #undef DUMPREG
756 }
757
758 static void hdmi_v14_regs_dump(struct hdmi_context *hdata, char *prefix)
759 {
760 int i;
761
762 #define DUMPREG(reg_id) \
763 DRM_DEBUG_KMS("%s:" #reg_id " = %08x\n", prefix, \
764 readl(hdata->regs + reg_id))
765
766 DRM_DEBUG_KMS("%s: ---- CONTROL REGISTERS ----\n", prefix);
767 DUMPREG(HDMI_INTC_CON);
768 DUMPREG(HDMI_INTC_FLAG);
769 DUMPREG(HDMI_HPD_STATUS);
770 DUMPREG(HDMI_INTC_CON_1);
771 DUMPREG(HDMI_INTC_FLAG_1);
772 DUMPREG(HDMI_PHY_STATUS_0);
773 DUMPREG(HDMI_PHY_STATUS_PLL);
774 DUMPREG(HDMI_PHY_CON_0);
775 DUMPREG(HDMI_PHY_RSTOUT);
776 DUMPREG(HDMI_PHY_VPLL);
777 DUMPREG(HDMI_PHY_CMU);
778 DUMPREG(HDMI_CORE_RSTOUT);
779
780 DRM_DEBUG_KMS("%s: ---- CORE REGISTERS ----\n", prefix);
781 DUMPREG(HDMI_CON_0);
782 DUMPREG(HDMI_CON_1);
783 DUMPREG(HDMI_CON_2);
784 DUMPREG(HDMI_SYS_STATUS);
785 DUMPREG(HDMI_PHY_STATUS_0);
786 DUMPREG(HDMI_STATUS_EN);
787 DUMPREG(HDMI_HPD);
788 DUMPREG(HDMI_MODE_SEL);
789 DUMPREG(HDMI_ENC_EN);
790 DUMPREG(HDMI_DC_CONTROL);
791 DUMPREG(HDMI_VIDEO_PATTERN_GEN);
792
793 DRM_DEBUG_KMS("%s: ---- CORE SYNC REGISTERS ----\n", prefix);
794 DUMPREG(HDMI_H_BLANK_0);
795 DUMPREG(HDMI_H_BLANK_1);
796 DUMPREG(HDMI_V2_BLANK_0);
797 DUMPREG(HDMI_V2_BLANK_1);
798 DUMPREG(HDMI_V1_BLANK_0);
799 DUMPREG(HDMI_V1_BLANK_1);
800 DUMPREG(HDMI_V_LINE_0);
801 DUMPREG(HDMI_V_LINE_1);
802 DUMPREG(HDMI_H_LINE_0);
803 DUMPREG(HDMI_H_LINE_1);
804 DUMPREG(HDMI_HSYNC_POL);
805
806 DUMPREG(HDMI_VSYNC_POL);
807 DUMPREG(HDMI_INT_PRO_MODE);
808 DUMPREG(HDMI_V_BLANK_F0_0);
809 DUMPREG(HDMI_V_BLANK_F0_1);
810 DUMPREG(HDMI_V_BLANK_F1_0);
811 DUMPREG(HDMI_V_BLANK_F1_1);
812
813 DUMPREG(HDMI_H_SYNC_START_0);
814 DUMPREG(HDMI_H_SYNC_START_1);
815 DUMPREG(HDMI_H_SYNC_END_0);
816 DUMPREG(HDMI_H_SYNC_END_1);
817
818 DUMPREG(HDMI_V_SYNC_LINE_BEF_2_0);
819 DUMPREG(HDMI_V_SYNC_LINE_BEF_2_1);
820 DUMPREG(HDMI_V_SYNC_LINE_BEF_1_0);
821 DUMPREG(HDMI_V_SYNC_LINE_BEF_1_1);
822
823 DUMPREG(HDMI_V_SYNC_LINE_AFT_2_0);
824 DUMPREG(HDMI_V_SYNC_LINE_AFT_2_1);
825 DUMPREG(HDMI_V_SYNC_LINE_AFT_1_0);
826 DUMPREG(HDMI_V_SYNC_LINE_AFT_1_1);
827
828 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_2_0);
829 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_2_1);
830 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_1_0);
831 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_1_1);
832
833 DUMPREG(HDMI_V_BLANK_F2_0);
834 DUMPREG(HDMI_V_BLANK_F2_1);
835 DUMPREG(HDMI_V_BLANK_F3_0);
836 DUMPREG(HDMI_V_BLANK_F3_1);
837 DUMPREG(HDMI_V_BLANK_F4_0);
838 DUMPREG(HDMI_V_BLANK_F4_1);
839 DUMPREG(HDMI_V_BLANK_F5_0);
840 DUMPREG(HDMI_V_BLANK_F5_1);
841
842 DUMPREG(HDMI_V_SYNC_LINE_AFT_3_0);
843 DUMPREG(HDMI_V_SYNC_LINE_AFT_3_1);
844 DUMPREG(HDMI_V_SYNC_LINE_AFT_4_0);
845 DUMPREG(HDMI_V_SYNC_LINE_AFT_4_1);
846 DUMPREG(HDMI_V_SYNC_LINE_AFT_5_0);
847 DUMPREG(HDMI_V_SYNC_LINE_AFT_5_1);
848 DUMPREG(HDMI_V_SYNC_LINE_AFT_6_0);
849 DUMPREG(HDMI_V_SYNC_LINE_AFT_6_1);
850
851 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_3_0);
852 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_3_1);
853 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_4_0);
854 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_4_1);
855 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_5_0);
856 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_5_1);
857 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_6_0);
858 DUMPREG(HDMI_V_SYNC_LINE_AFT_PXL_6_1);
859
860 DUMPREG(HDMI_VACT_SPACE_1_0);
861 DUMPREG(HDMI_VACT_SPACE_1_1);
862 DUMPREG(HDMI_VACT_SPACE_2_0);
863 DUMPREG(HDMI_VACT_SPACE_2_1);
864 DUMPREG(HDMI_VACT_SPACE_3_0);
865 DUMPREG(HDMI_VACT_SPACE_3_1);
866 DUMPREG(HDMI_VACT_SPACE_4_0);
867 DUMPREG(HDMI_VACT_SPACE_4_1);
868 DUMPREG(HDMI_VACT_SPACE_5_0);
869 DUMPREG(HDMI_VACT_SPACE_5_1);
870 DUMPREG(HDMI_VACT_SPACE_6_0);
871 DUMPREG(HDMI_VACT_SPACE_6_1);
872
873 DRM_DEBUG_KMS("%s: ---- TG REGISTERS ----\n", prefix);
874 DUMPREG(HDMI_TG_CMD);
875 DUMPREG(HDMI_TG_H_FSZ_L);
876 DUMPREG(HDMI_TG_H_FSZ_H);
877 DUMPREG(HDMI_TG_HACT_ST_L);
878 DUMPREG(HDMI_TG_HACT_ST_H);
879 DUMPREG(HDMI_TG_HACT_SZ_L);
880 DUMPREG(HDMI_TG_HACT_SZ_H);
881 DUMPREG(HDMI_TG_V_FSZ_L);
882 DUMPREG(HDMI_TG_V_FSZ_H);
883 DUMPREG(HDMI_TG_VSYNC_L);
884 DUMPREG(HDMI_TG_VSYNC_H);
885 DUMPREG(HDMI_TG_VSYNC2_L);
886 DUMPREG(HDMI_TG_VSYNC2_H);
887 DUMPREG(HDMI_TG_VACT_ST_L);
888 DUMPREG(HDMI_TG_VACT_ST_H);
889 DUMPREG(HDMI_TG_VACT_SZ_L);
890 DUMPREG(HDMI_TG_VACT_SZ_H);
891 DUMPREG(HDMI_TG_FIELD_CHG_L);
892 DUMPREG(HDMI_TG_FIELD_CHG_H);
893 DUMPREG(HDMI_TG_VACT_ST2_L);
894 DUMPREG(HDMI_TG_VACT_ST2_H);
895 DUMPREG(HDMI_TG_VACT_ST3_L);
896 DUMPREG(HDMI_TG_VACT_ST3_H);
897 DUMPREG(HDMI_TG_VACT_ST4_L);
898 DUMPREG(HDMI_TG_VACT_ST4_H);
899 DUMPREG(HDMI_TG_VSYNC_TOP_HDMI_L);
900 DUMPREG(HDMI_TG_VSYNC_TOP_HDMI_H);
901 DUMPREG(HDMI_TG_VSYNC_BOT_HDMI_L);
902 DUMPREG(HDMI_TG_VSYNC_BOT_HDMI_H);
903 DUMPREG(HDMI_TG_FIELD_TOP_HDMI_L);
904 DUMPREG(HDMI_TG_FIELD_TOP_HDMI_H);
905 DUMPREG(HDMI_TG_FIELD_BOT_HDMI_L);
906 DUMPREG(HDMI_TG_FIELD_BOT_HDMI_H);
907 DUMPREG(HDMI_TG_3D);
908
909 DRM_DEBUG_KMS("%s: ---- PACKET REGISTERS ----\n", prefix);
910 DUMPREG(HDMI_AVI_CON);
911 DUMPREG(HDMI_AVI_HEADER0);
912 DUMPREG(HDMI_AVI_HEADER1);
913 DUMPREG(HDMI_AVI_HEADER2);
914 DUMPREG(HDMI_AVI_CHECK_SUM);
915 DUMPREG(HDMI_VSI_CON);
916 DUMPREG(HDMI_VSI_HEADER0);
917 DUMPREG(HDMI_VSI_HEADER1);
918 DUMPREG(HDMI_VSI_HEADER2);
919 for (i = 0; i < 7; ++i)
920 DUMPREG(HDMI_VSI_DATA(i));
921
922 #undef DUMPREG
923 }
924
925 static void hdmi_regs_dump(struct hdmi_context *hdata, char *prefix)
926 {
927 if (hdata->type == HDMI_TYPE13)
928 hdmi_v13_regs_dump(hdata, prefix);
929 else
930 hdmi_v14_regs_dump(hdata, prefix);
931 }
932
933 static u8 hdmi_chksum(struct hdmi_context *hdata,
934 u32 start, u8 len, u32 hdr_sum)
935 {
936 int i;
937
938 /* hdr_sum : header0 + header1 + header2
939 * start : start address of packet byte1
940 * len : packet bytes - 1 */
941 for (i = 0; i < len; ++i)
942 hdr_sum += 0xff & hdmi_reg_read(hdata, start + i * 4);
943
944 /* return 2's complement of 8 bit hdr_sum */
945 return (u8)(~(hdr_sum & 0xff) + 1);
946 }
947
948 static void hdmi_reg_infoframe(struct hdmi_context *hdata,
949 union hdmi_infoframe *infoframe)
950 {
951 u32 hdr_sum;
952 u8 chksum;
953 u32 mod;
954 u32 vic;
955
956 mod = hdmi_reg_read(hdata, HDMI_MODE_SEL);
957 if (hdata->dvi_mode) {
958 hdmi_reg_writeb(hdata, HDMI_VSI_CON,
959 HDMI_VSI_CON_DO_NOT_TRANSMIT);
960 hdmi_reg_writeb(hdata, HDMI_AVI_CON,
961 HDMI_AVI_CON_DO_NOT_TRANSMIT);
962 hdmi_reg_writeb(hdata, HDMI_AUI_CON, HDMI_AUI_CON_NO_TRAN);
963 return;
964 }
965
966 switch (infoframe->any.type) {
967 case HDMI_INFOFRAME_TYPE_AVI:
968 hdmi_reg_writeb(hdata, HDMI_AVI_CON, HDMI_AVI_CON_EVERY_VSYNC);
969 hdmi_reg_writeb(hdata, HDMI_AVI_HEADER0, infoframe->any.type);
970 hdmi_reg_writeb(hdata, HDMI_AVI_HEADER1,
971 infoframe->any.version);
972 hdmi_reg_writeb(hdata, HDMI_AVI_HEADER2, infoframe->any.length);
973 hdr_sum = infoframe->any.type + infoframe->any.version +
974 infoframe->any.length;
975
976 /* Output format zero hardcoded ,RGB YBCR selection */
977 hdmi_reg_writeb(hdata, HDMI_AVI_BYTE(1), 0 << 5 |
978 AVI_ACTIVE_FORMAT_VALID |
979 AVI_UNDERSCANNED_DISPLAY_VALID);
980
981 /*
982 * Set the aspect ratio as per the mode, mentioned in
983 * Table 9 AVI InfoFrame Data Byte 2 of CEA-861-D Standard
984 */
985 switch (hdata->mode_conf.aspect_ratio) {
986 case HDMI_PICTURE_ASPECT_4_3:
987 hdmi_reg_writeb(hdata, HDMI_AVI_BYTE(2),
988 hdata->mode_conf.aspect_ratio |
989 AVI_4_3_CENTER_RATIO);
990 break;
991 case HDMI_PICTURE_ASPECT_16_9:
992 hdmi_reg_writeb(hdata, HDMI_AVI_BYTE(2),
993 hdata->mode_conf.aspect_ratio |
994 AVI_16_9_CENTER_RATIO);
995 break;
996 case HDMI_PICTURE_ASPECT_NONE:
997 default:
998 hdmi_reg_writeb(hdata, HDMI_AVI_BYTE(2),
999 hdata->mode_conf.aspect_ratio |
1000 AVI_SAME_AS_PIC_ASPECT_RATIO);
1001 break;
1002 }
1003
1004 vic = hdata->mode_conf.cea_video_id;
1005 hdmi_reg_writeb(hdata, HDMI_AVI_BYTE(4), vic);
1006
1007 chksum = hdmi_chksum(hdata, HDMI_AVI_BYTE(1),
1008 infoframe->any.length, hdr_sum);
1009 DRM_DEBUG_KMS("AVI checksum = 0x%x\n", chksum);
1010 hdmi_reg_writeb(hdata, HDMI_AVI_CHECK_SUM, chksum);
1011 break;
1012 case HDMI_INFOFRAME_TYPE_AUDIO:
1013 hdmi_reg_writeb(hdata, HDMI_AUI_CON, 0x02);
1014 hdmi_reg_writeb(hdata, HDMI_AUI_HEADER0, infoframe->any.type);
1015 hdmi_reg_writeb(hdata, HDMI_AUI_HEADER1,
1016 infoframe->any.version);
1017 hdmi_reg_writeb(hdata, HDMI_AUI_HEADER2, infoframe->any.length);
1018 hdr_sum = infoframe->any.type + infoframe->any.version +
1019 infoframe->any.length;
1020 chksum = hdmi_chksum(hdata, HDMI_AUI_BYTE(1),
1021 infoframe->any.length, hdr_sum);
1022 DRM_DEBUG_KMS("AUI checksum = 0x%x\n", chksum);
1023 hdmi_reg_writeb(hdata, HDMI_AUI_CHECK_SUM, chksum);
1024 break;
1025 default:
1026 break;
1027 }
1028 }
1029
1030 static enum drm_connector_status hdmi_detect(struct drm_connector *connector,
1031 bool force)
1032 {
1033 struct hdmi_context *hdata = ctx_from_connector(connector);
1034
1035 hdata->hpd = gpio_get_value(hdata->hpd_gpio);
1036
1037 return hdata->hpd ? connector_status_connected :
1038 connector_status_disconnected;
1039 }
1040
1041 static void hdmi_connector_destroy(struct drm_connector *connector)
1042 {
1043 drm_connector_unregister(connector);
1044 drm_connector_cleanup(connector);
1045 }
1046
1047 static struct drm_connector_funcs hdmi_connector_funcs = {
1048 .dpms = drm_helper_connector_dpms,
1049 .fill_modes = drm_helper_probe_single_connector_modes,
1050 .detect = hdmi_detect,
1051 .destroy = hdmi_connector_destroy,
1052 };
1053
1054 static int hdmi_get_modes(struct drm_connector *connector)
1055 {
1056 struct hdmi_context *hdata = ctx_from_connector(connector);
1057 struct edid *edid;
1058
1059 if (!hdata->ddc_adpt)
1060 return -ENODEV;
1061
1062 edid = drm_get_edid(connector, hdata->ddc_adpt);
1063 if (!edid)
1064 return -ENODEV;
1065
1066 hdata->dvi_mode = !drm_detect_hdmi_monitor(edid);
1067 DRM_DEBUG_KMS("%s : width[%d] x height[%d]\n",
1068 (hdata->dvi_mode ? "dvi monitor" : "hdmi monitor"),
1069 edid->width_cm, edid->height_cm);
1070
1071 drm_mode_connector_update_edid_property(connector, edid);
1072
1073 return drm_add_edid_modes(connector, edid);
1074 }
1075
1076 static int hdmi_find_phy_conf(struct hdmi_context *hdata, u32 pixel_clock)
1077 {
1078 int i;
1079
1080 for (i = 0; i < hdata->phy_conf_count; i++)
1081 if (hdata->phy_confs[i].pixel_clock == pixel_clock)
1082 return i;
1083
1084 DRM_DEBUG_KMS("Could not find phy config for %d\n", pixel_clock);
1085 return -EINVAL;
1086 }
1087
1088 static int hdmi_mode_valid(struct drm_connector *connector,
1089 struct drm_display_mode *mode)
1090 {
1091 struct hdmi_context *hdata = ctx_from_connector(connector);
1092 int ret;
1093
1094 DRM_DEBUG_KMS("xres=%d, yres=%d, refresh=%d, intl=%d clock=%d\n",
1095 mode->hdisplay, mode->vdisplay, mode->vrefresh,
1096 (mode->flags & DRM_MODE_FLAG_INTERLACE) ? true :
1097 false, mode->clock * 1000);
1098
1099 ret = mixer_check_mode(mode);
1100 if (ret)
1101 return MODE_BAD;
1102
1103 ret = hdmi_find_phy_conf(hdata, mode->clock * 1000);
1104 if (ret < 0)
1105 return MODE_BAD;
1106
1107 return MODE_OK;
1108 }
1109
1110 static struct drm_encoder *hdmi_best_encoder(struct drm_connector *connector)
1111 {
1112 struct hdmi_context *hdata = ctx_from_connector(connector);
1113
1114 return hdata->encoder;
1115 }
1116
1117 static struct drm_connector_helper_funcs hdmi_connector_helper_funcs = {
1118 .get_modes = hdmi_get_modes,
1119 .mode_valid = hdmi_mode_valid,
1120 .best_encoder = hdmi_best_encoder,
1121 };
1122
1123 static int hdmi_create_connector(struct exynos_drm_display *display,
1124 struct drm_encoder *encoder)
1125 {
1126 struct hdmi_context *hdata = display->ctx;
1127 struct drm_connector *connector = &hdata->connector;
1128 int ret;
1129
1130 hdata->encoder = encoder;
1131 connector->interlace_allowed = true;
1132 connector->polled = DRM_CONNECTOR_POLL_HPD;
1133
1134 ret = drm_connector_init(hdata->drm_dev, connector,
1135 &hdmi_connector_funcs, DRM_MODE_CONNECTOR_HDMIA);
1136 if (ret) {
1137 DRM_ERROR("Failed to initialize connector with drm\n");
1138 return ret;
1139 }
1140
1141 drm_connector_helper_add(connector, &hdmi_connector_helper_funcs);
1142 drm_connector_register(connector);
1143 drm_mode_connector_attach_encoder(connector, encoder);
1144
1145 return 0;
1146 }
1147
1148 static void hdmi_mode_fixup(struct exynos_drm_display *display,
1149 struct drm_connector *connector,
1150 const struct drm_display_mode *mode,
1151 struct drm_display_mode *adjusted_mode)
1152 {
1153 struct drm_display_mode *m;
1154 int mode_ok;
1155
1156 DRM_DEBUG_KMS("%s\n", __FILE__);
1157
1158 drm_mode_set_crtcinfo(adjusted_mode, 0);
1159
1160 mode_ok = hdmi_mode_valid(connector, adjusted_mode);
1161
1162 /* just return if user desired mode exists. */
1163 if (mode_ok == MODE_OK)
1164 return;
1165
1166 /*
1167 * otherwise, find the most suitable mode among modes and change it
1168 * to adjusted_mode.
1169 */
1170 list_for_each_entry(m, &connector->modes, head) {
1171 mode_ok = hdmi_mode_valid(connector, m);
1172
1173 if (mode_ok == MODE_OK) {
1174 DRM_INFO("desired mode doesn't exist so\n");
1175 DRM_INFO("use the most suitable mode among modes.\n");
1176
1177 DRM_DEBUG_KMS("Adjusted Mode: [%d]x[%d] [%d]Hz\n",
1178 m->hdisplay, m->vdisplay, m->vrefresh);
1179
1180 drm_mode_copy(adjusted_mode, m);
1181 break;
1182 }
1183 }
1184 }
1185
1186 static void hdmi_set_acr(u32 freq, u8 *acr)
1187 {
1188 u32 n, cts;
1189
1190 switch (freq) {
1191 case 32000:
1192 n = 4096;
1193 cts = 27000;
1194 break;
1195 case 44100:
1196 n = 6272;
1197 cts = 30000;
1198 break;
1199 case 88200:
1200 n = 12544;
1201 cts = 30000;
1202 break;
1203 case 176400:
1204 n = 25088;
1205 cts = 30000;
1206 break;
1207 case 48000:
1208 n = 6144;
1209 cts = 27000;
1210 break;
1211 case 96000:
1212 n = 12288;
1213 cts = 27000;
1214 break;
1215 case 192000:
1216 n = 24576;
1217 cts = 27000;
1218 break;
1219 default:
1220 n = 0;
1221 cts = 0;
1222 break;
1223 }
1224
1225 acr[1] = cts >> 16;
1226 acr[2] = cts >> 8 & 0xff;
1227 acr[3] = cts & 0xff;
1228
1229 acr[4] = n >> 16;
1230 acr[5] = n >> 8 & 0xff;
1231 acr[6] = n & 0xff;
1232 }
1233
1234 static void hdmi_reg_acr(struct hdmi_context *hdata, u8 *acr)
1235 {
1236 hdmi_reg_writeb(hdata, HDMI_ACR_N0, acr[6]);
1237 hdmi_reg_writeb(hdata, HDMI_ACR_N1, acr[5]);
1238 hdmi_reg_writeb(hdata, HDMI_ACR_N2, acr[4]);
1239 hdmi_reg_writeb(hdata, HDMI_ACR_MCTS0, acr[3]);
1240 hdmi_reg_writeb(hdata, HDMI_ACR_MCTS1, acr[2]);
1241 hdmi_reg_writeb(hdata, HDMI_ACR_MCTS2, acr[1]);
1242 hdmi_reg_writeb(hdata, HDMI_ACR_CTS0, acr[3]);
1243 hdmi_reg_writeb(hdata, HDMI_ACR_CTS1, acr[2]);
1244 hdmi_reg_writeb(hdata, HDMI_ACR_CTS2, acr[1]);
1245
1246 if (hdata->type == HDMI_TYPE13)
1247 hdmi_reg_writeb(hdata, HDMI_V13_ACR_CON, 4);
1248 else
1249 hdmi_reg_writeb(hdata, HDMI_ACR_CON, 4);
1250 }
1251
1252 static void hdmi_audio_init(struct hdmi_context *hdata)
1253 {
1254 u32 sample_rate, bits_per_sample;
1255 u32 data_num, bit_ch, sample_frq;
1256 u32 val;
1257 u8 acr[7];
1258
1259 sample_rate = 44100;
1260 bits_per_sample = 16;
1261
1262 switch (bits_per_sample) {
1263 case 20:
1264 data_num = 2;
1265 bit_ch = 1;
1266 break;
1267 case 24:
1268 data_num = 3;
1269 bit_ch = 1;
1270 break;
1271 default:
1272 data_num = 1;
1273 bit_ch = 0;
1274 break;
1275 }
1276
1277 hdmi_set_acr(sample_rate, acr);
1278 hdmi_reg_acr(hdata, acr);
1279
1280 hdmi_reg_writeb(hdata, HDMI_I2S_MUX_CON, HDMI_I2S_IN_DISABLE
1281 | HDMI_I2S_AUD_I2S | HDMI_I2S_CUV_I2S_ENABLE
1282 | HDMI_I2S_MUX_ENABLE);
1283
1284 hdmi_reg_writeb(hdata, HDMI_I2S_MUX_CH, HDMI_I2S_CH0_EN
1285 | HDMI_I2S_CH1_EN | HDMI_I2S_CH2_EN);
1286
1287 hdmi_reg_writeb(hdata, HDMI_I2S_MUX_CUV, HDMI_I2S_CUV_RL_EN);
1288
1289 sample_frq = (sample_rate == 44100) ? 0 :
1290 (sample_rate == 48000) ? 2 :
1291 (sample_rate == 32000) ? 3 :
1292 (sample_rate == 96000) ? 0xa : 0x0;
1293
1294 hdmi_reg_writeb(hdata, HDMI_I2S_CLK_CON, HDMI_I2S_CLK_DIS);
1295 hdmi_reg_writeb(hdata, HDMI_I2S_CLK_CON, HDMI_I2S_CLK_EN);
1296
1297 val = hdmi_reg_read(hdata, HDMI_I2S_DSD_CON) | 0x01;
1298 hdmi_reg_writeb(hdata, HDMI_I2S_DSD_CON, val);
1299
1300 /* Configuration I2S input ports. Configure I2S_PIN_SEL_0~4 */
1301 hdmi_reg_writeb(hdata, HDMI_I2S_PIN_SEL_0, HDMI_I2S_SEL_SCLK(5)
1302 | HDMI_I2S_SEL_LRCK(6));
1303 hdmi_reg_writeb(hdata, HDMI_I2S_PIN_SEL_1, HDMI_I2S_SEL_SDATA1(1)
1304 | HDMI_I2S_SEL_SDATA2(4));
1305 hdmi_reg_writeb(hdata, HDMI_I2S_PIN_SEL_2, HDMI_I2S_SEL_SDATA3(1)
1306 | HDMI_I2S_SEL_SDATA2(2));
1307 hdmi_reg_writeb(hdata, HDMI_I2S_PIN_SEL_3, HDMI_I2S_SEL_DSD(0));
1308
1309 /* I2S_CON_1 & 2 */
1310 hdmi_reg_writeb(hdata, HDMI_I2S_CON_1, HDMI_I2S_SCLK_FALLING_EDGE
1311 | HDMI_I2S_L_CH_LOW_POL);
1312 hdmi_reg_writeb(hdata, HDMI_I2S_CON_2, HDMI_I2S_MSB_FIRST_MODE
1313 | HDMI_I2S_SET_BIT_CH(bit_ch)
1314 | HDMI_I2S_SET_SDATA_BIT(data_num)
1315 | HDMI_I2S_BASIC_FORMAT);
1316
1317 /* Configure register related to CUV information */
1318 hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_0, HDMI_I2S_CH_STATUS_MODE_0
1319 | HDMI_I2S_2AUD_CH_WITHOUT_PREEMPH
1320 | HDMI_I2S_COPYRIGHT
1321 | HDMI_I2S_LINEAR_PCM
1322 | HDMI_I2S_CONSUMER_FORMAT);
1323 hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_1, HDMI_I2S_CD_PLAYER);
1324 hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_2, HDMI_I2S_SET_SOURCE_NUM(0));
1325 hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_3, HDMI_I2S_CLK_ACCUR_LEVEL_2
1326 | HDMI_I2S_SET_SMP_FREQ(sample_frq));
1327 hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_4,
1328 HDMI_I2S_ORG_SMP_FREQ_44_1
1329 | HDMI_I2S_WORD_LEN_MAX24_24BITS
1330 | HDMI_I2S_WORD_LEN_MAX_24BITS);
1331
1332 hdmi_reg_writeb(hdata, HDMI_I2S_CH_ST_CON, HDMI_I2S_CH_STATUS_RELOAD);
1333 }
1334
1335 static void hdmi_audio_control(struct hdmi_context *hdata, bool onoff)
1336 {
1337 if (hdata->dvi_mode)
1338 return;
1339
1340 hdmi_reg_writeb(hdata, HDMI_AUI_CON, onoff ? 2 : 0);
1341 hdmi_reg_writemask(hdata, HDMI_CON_0, onoff ?
1342 HDMI_ASP_EN : HDMI_ASP_DIS, HDMI_ASP_MASK);
1343 }
1344
1345 static void hdmi_start(struct hdmi_context *hdata, bool start)
1346 {
1347 u32 val = start ? HDMI_TG_EN : 0;
1348
1349 if (hdata->current_mode.flags & DRM_MODE_FLAG_INTERLACE)
1350 val |= HDMI_FIELD_EN;
1351
1352 hdmi_reg_writemask(hdata, HDMI_CON_0, val, HDMI_EN);
1353 hdmi_reg_writemask(hdata, HDMI_TG_CMD, val, HDMI_TG_EN | HDMI_FIELD_EN);
1354 }
1355
1356 static void hdmi_conf_init(struct hdmi_context *hdata)
1357 {
1358 union hdmi_infoframe infoframe;
1359
1360 /* disable HPD interrupts from HDMI IP block, use GPIO instead */
1361 hdmi_reg_writemask(hdata, HDMI_INTC_CON, 0, HDMI_INTC_EN_GLOBAL |
1362 HDMI_INTC_EN_HPD_PLUG | HDMI_INTC_EN_HPD_UNPLUG);
1363
1364 /* choose HDMI mode */
1365 hdmi_reg_writemask(hdata, HDMI_MODE_SEL,
1366 HDMI_MODE_HDMI_EN, HDMI_MODE_MASK);
1367 /* Apply Video preable and Guard band in HDMI mode only */
1368 hdmi_reg_writeb(hdata, HDMI_CON_2, 0);
1369 /* disable bluescreen */
1370 hdmi_reg_writemask(hdata, HDMI_CON_0, 0, HDMI_BLUE_SCR_EN);
1371
1372 if (hdata->dvi_mode) {
1373 /* choose DVI mode */
1374 hdmi_reg_writemask(hdata, HDMI_MODE_SEL,
1375 HDMI_MODE_DVI_EN, HDMI_MODE_MASK);
1376 hdmi_reg_writeb(hdata, HDMI_CON_2,
1377 HDMI_VID_PREAMBLE_DIS | HDMI_GUARD_BAND_DIS);
1378 }
1379
1380 if (hdata->type == HDMI_TYPE13) {
1381 /* choose bluescreen (fecal) color */
1382 hdmi_reg_writeb(hdata, HDMI_V13_BLUE_SCREEN_0, 0x12);
1383 hdmi_reg_writeb(hdata, HDMI_V13_BLUE_SCREEN_1, 0x34);
1384 hdmi_reg_writeb(hdata, HDMI_V13_BLUE_SCREEN_2, 0x56);
1385
1386 /* enable AVI packet every vsync, fixes purple line problem */
1387 hdmi_reg_writeb(hdata, HDMI_V13_AVI_CON, 0x02);
1388 /* force RGB, look to CEA-861-D, table 7 for more detail */
1389 hdmi_reg_writeb(hdata, HDMI_V13_AVI_BYTE(0), 0 << 5);
1390 hdmi_reg_writemask(hdata, HDMI_CON_1, 0x10 << 5, 0x11 << 5);
1391
1392 hdmi_reg_writeb(hdata, HDMI_V13_SPD_CON, 0x02);
1393 hdmi_reg_writeb(hdata, HDMI_V13_AUI_CON, 0x02);
1394 hdmi_reg_writeb(hdata, HDMI_V13_ACR_CON, 0x04);
1395 } else {
1396 infoframe.any.type = HDMI_INFOFRAME_TYPE_AVI;
1397 infoframe.any.version = HDMI_AVI_VERSION;
1398 infoframe.any.length = HDMI_AVI_LENGTH;
1399 hdmi_reg_infoframe(hdata, &infoframe);
1400
1401 infoframe.any.type = HDMI_INFOFRAME_TYPE_AUDIO;
1402 infoframe.any.version = HDMI_AUI_VERSION;
1403 infoframe.any.length = HDMI_AUI_LENGTH;
1404 hdmi_reg_infoframe(hdata, &infoframe);
1405
1406 /* enable AVI packet every vsync, fixes purple line problem */
1407 hdmi_reg_writemask(hdata, HDMI_CON_1, 2, 3 << 5);
1408 }
1409 }
1410
1411 static void hdmi_v13_mode_apply(struct hdmi_context *hdata)
1412 {
1413 const struct hdmi_tg_regs *tg = &hdata->mode_conf.conf.v13_conf.tg;
1414 const struct hdmi_v13_core_regs *core =
1415 &hdata->mode_conf.conf.v13_conf.core;
1416 int tries;
1417
1418 /* setting core registers */
1419 hdmi_reg_writeb(hdata, HDMI_H_BLANK_0, core->h_blank[0]);
1420 hdmi_reg_writeb(hdata, HDMI_H_BLANK_1, core->h_blank[1]);
1421 hdmi_reg_writeb(hdata, HDMI_V13_V_BLANK_0, core->v_blank[0]);
1422 hdmi_reg_writeb(hdata, HDMI_V13_V_BLANK_1, core->v_blank[1]);
1423 hdmi_reg_writeb(hdata, HDMI_V13_V_BLANK_2, core->v_blank[2]);
1424 hdmi_reg_writeb(hdata, HDMI_V13_H_V_LINE_0, core->h_v_line[0]);
1425 hdmi_reg_writeb(hdata, HDMI_V13_H_V_LINE_1, core->h_v_line[1]);
1426 hdmi_reg_writeb(hdata, HDMI_V13_H_V_LINE_2, core->h_v_line[2]);
1427 hdmi_reg_writeb(hdata, HDMI_VSYNC_POL, core->vsync_pol[0]);
1428 hdmi_reg_writeb(hdata, HDMI_INT_PRO_MODE, core->int_pro_mode[0]);
1429 hdmi_reg_writeb(hdata, HDMI_V13_V_BLANK_F_0, core->v_blank_f[0]);
1430 hdmi_reg_writeb(hdata, HDMI_V13_V_BLANK_F_1, core->v_blank_f[1]);
1431 hdmi_reg_writeb(hdata, HDMI_V13_V_BLANK_F_2, core->v_blank_f[2]);
1432 hdmi_reg_writeb(hdata, HDMI_V13_H_SYNC_GEN_0, core->h_sync_gen[0]);
1433 hdmi_reg_writeb(hdata, HDMI_V13_H_SYNC_GEN_1, core->h_sync_gen[1]);
1434 hdmi_reg_writeb(hdata, HDMI_V13_H_SYNC_GEN_2, core->h_sync_gen[2]);
1435 hdmi_reg_writeb(hdata, HDMI_V13_V_SYNC_GEN_1_0, core->v_sync_gen1[0]);
1436 hdmi_reg_writeb(hdata, HDMI_V13_V_SYNC_GEN_1_1, core->v_sync_gen1[1]);
1437 hdmi_reg_writeb(hdata, HDMI_V13_V_SYNC_GEN_1_2, core->v_sync_gen1[2]);
1438 hdmi_reg_writeb(hdata, HDMI_V13_V_SYNC_GEN_2_0, core->v_sync_gen2[0]);
1439 hdmi_reg_writeb(hdata, HDMI_V13_V_SYNC_GEN_2_1, core->v_sync_gen2[1]);
1440 hdmi_reg_writeb(hdata, HDMI_V13_V_SYNC_GEN_2_2, core->v_sync_gen2[2]);
1441 hdmi_reg_writeb(hdata, HDMI_V13_V_SYNC_GEN_3_0, core->v_sync_gen3[0]);
1442 hdmi_reg_writeb(hdata, HDMI_V13_V_SYNC_GEN_3_1, core->v_sync_gen3[1]);
1443 hdmi_reg_writeb(hdata, HDMI_V13_V_SYNC_GEN_3_2, core->v_sync_gen3[2]);
1444 /* Timing generator registers */
1445 hdmi_reg_writeb(hdata, HDMI_TG_H_FSZ_L, tg->h_fsz[0]);
1446 hdmi_reg_writeb(hdata, HDMI_TG_H_FSZ_H, tg->h_fsz[1]);
1447 hdmi_reg_writeb(hdata, HDMI_TG_HACT_ST_L, tg->hact_st[0]);
1448 hdmi_reg_writeb(hdata, HDMI_TG_HACT_ST_H, tg->hact_st[1]);
1449 hdmi_reg_writeb(hdata, HDMI_TG_HACT_SZ_L, tg->hact_sz[0]);
1450 hdmi_reg_writeb(hdata, HDMI_TG_HACT_SZ_H, tg->hact_sz[1]);
1451 hdmi_reg_writeb(hdata, HDMI_TG_V_FSZ_L, tg->v_fsz[0]);
1452 hdmi_reg_writeb(hdata, HDMI_TG_V_FSZ_H, tg->v_fsz[1]);
1453 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_L, tg->vsync[0]);
1454 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_H, tg->vsync[1]);
1455 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC2_L, tg->vsync2[0]);
1456 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC2_H, tg->vsync2[1]);
1457 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST_L, tg->vact_st[0]);
1458 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST_H, tg->vact_st[1]);
1459 hdmi_reg_writeb(hdata, HDMI_TG_VACT_SZ_L, tg->vact_sz[0]);
1460 hdmi_reg_writeb(hdata, HDMI_TG_VACT_SZ_H, tg->vact_sz[1]);
1461 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_CHG_L, tg->field_chg[0]);
1462 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_CHG_H, tg->field_chg[1]);
1463 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST2_L, tg->vact_st2[0]);
1464 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST2_H, tg->vact_st2[1]);
1465 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_TOP_HDMI_L, tg->vsync_top_hdmi[0]);
1466 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_TOP_HDMI_H, tg->vsync_top_hdmi[1]);
1467 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_BOT_HDMI_L, tg->vsync_bot_hdmi[0]);
1468 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_BOT_HDMI_H, tg->vsync_bot_hdmi[1]);
1469 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_TOP_HDMI_L, tg->field_top_hdmi[0]);
1470 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_TOP_HDMI_H, tg->field_top_hdmi[1]);
1471 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_BOT_HDMI_L, tg->field_bot_hdmi[0]);
1472 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_BOT_HDMI_H, tg->field_bot_hdmi[1]);
1473
1474 /* waiting for HDMIPHY's PLL to get to steady state */
1475 for (tries = 100; tries; --tries) {
1476 u32 val = hdmi_reg_read(hdata, HDMI_V13_PHY_STATUS);
1477 if (val & HDMI_PHY_STATUS_READY)
1478 break;
1479 usleep_range(1000, 2000);
1480 }
1481 /* steady state not achieved */
1482 if (tries == 0) {
1483 DRM_ERROR("hdmiphy's pll could not reach steady state.\n");
1484 hdmi_regs_dump(hdata, "timing apply");
1485 }
1486
1487 clk_disable_unprepare(hdata->res.sclk_hdmi);
1488 clk_set_parent(hdata->res.mout_hdmi, hdata->res.sclk_hdmiphy);
1489 clk_prepare_enable(hdata->res.sclk_hdmi);
1490
1491 /* enable HDMI and timing generator */
1492 hdmi_start(hdata, true);
1493 }
1494
1495 static void hdmi_v14_mode_apply(struct hdmi_context *hdata)
1496 {
1497 const struct hdmi_tg_regs *tg = &hdata->mode_conf.conf.v14_conf.tg;
1498 const struct hdmi_v14_core_regs *core =
1499 &hdata->mode_conf.conf.v14_conf.core;
1500 int tries;
1501
1502 /* setting core registers */
1503 hdmi_reg_writeb(hdata, HDMI_H_BLANK_0, core->h_blank[0]);
1504 hdmi_reg_writeb(hdata, HDMI_H_BLANK_1, core->h_blank[1]);
1505 hdmi_reg_writeb(hdata, HDMI_V2_BLANK_0, core->v2_blank[0]);
1506 hdmi_reg_writeb(hdata, HDMI_V2_BLANK_1, core->v2_blank[1]);
1507 hdmi_reg_writeb(hdata, HDMI_V1_BLANK_0, core->v1_blank[0]);
1508 hdmi_reg_writeb(hdata, HDMI_V1_BLANK_1, core->v1_blank[1]);
1509 hdmi_reg_writeb(hdata, HDMI_V_LINE_0, core->v_line[0]);
1510 hdmi_reg_writeb(hdata, HDMI_V_LINE_1, core->v_line[1]);
1511 hdmi_reg_writeb(hdata, HDMI_H_LINE_0, core->h_line[0]);
1512 hdmi_reg_writeb(hdata, HDMI_H_LINE_1, core->h_line[1]);
1513 hdmi_reg_writeb(hdata, HDMI_HSYNC_POL, core->hsync_pol[0]);
1514 hdmi_reg_writeb(hdata, HDMI_VSYNC_POL, core->vsync_pol[0]);
1515 hdmi_reg_writeb(hdata, HDMI_INT_PRO_MODE, core->int_pro_mode[0]);
1516 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F0_0, core->v_blank_f0[0]);
1517 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F0_1, core->v_blank_f0[1]);
1518 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F1_0, core->v_blank_f1[0]);
1519 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F1_1, core->v_blank_f1[1]);
1520 hdmi_reg_writeb(hdata, HDMI_H_SYNC_START_0, core->h_sync_start[0]);
1521 hdmi_reg_writeb(hdata, HDMI_H_SYNC_START_1, core->h_sync_start[1]);
1522 hdmi_reg_writeb(hdata, HDMI_H_SYNC_END_0, core->h_sync_end[0]);
1523 hdmi_reg_writeb(hdata, HDMI_H_SYNC_END_1, core->h_sync_end[1]);
1524 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_BEF_2_0,
1525 core->v_sync_line_bef_2[0]);
1526 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_BEF_2_1,
1527 core->v_sync_line_bef_2[1]);
1528 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_BEF_1_0,
1529 core->v_sync_line_bef_1[0]);
1530 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_BEF_1_1,
1531 core->v_sync_line_bef_1[1]);
1532 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_2_0,
1533 core->v_sync_line_aft_2[0]);
1534 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_2_1,
1535 core->v_sync_line_aft_2[1]);
1536 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_1_0,
1537 core->v_sync_line_aft_1[0]);
1538 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_1_1,
1539 core->v_sync_line_aft_1[1]);
1540 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_2_0,
1541 core->v_sync_line_aft_pxl_2[0]);
1542 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_2_1,
1543 core->v_sync_line_aft_pxl_2[1]);
1544 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_1_0,
1545 core->v_sync_line_aft_pxl_1[0]);
1546 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_1_1,
1547 core->v_sync_line_aft_pxl_1[1]);
1548 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F2_0, core->v_blank_f2[0]);
1549 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F2_1, core->v_blank_f2[1]);
1550 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F3_0, core->v_blank_f3[0]);
1551 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F3_1, core->v_blank_f3[1]);
1552 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F4_0, core->v_blank_f4[0]);
1553 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F4_1, core->v_blank_f4[1]);
1554 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F5_0, core->v_blank_f5[0]);
1555 hdmi_reg_writeb(hdata, HDMI_V_BLANK_F5_1, core->v_blank_f5[1]);
1556 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_3_0,
1557 core->v_sync_line_aft_3[0]);
1558 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_3_1,
1559 core->v_sync_line_aft_3[1]);
1560 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_4_0,
1561 core->v_sync_line_aft_4[0]);
1562 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_4_1,
1563 core->v_sync_line_aft_4[1]);
1564 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_5_0,
1565 core->v_sync_line_aft_5[0]);
1566 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_5_1,
1567 core->v_sync_line_aft_5[1]);
1568 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_6_0,
1569 core->v_sync_line_aft_6[0]);
1570 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_6_1,
1571 core->v_sync_line_aft_6[1]);
1572 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_3_0,
1573 core->v_sync_line_aft_pxl_3[0]);
1574 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_3_1,
1575 core->v_sync_line_aft_pxl_3[1]);
1576 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_4_0,
1577 core->v_sync_line_aft_pxl_4[0]);
1578 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_4_1,
1579 core->v_sync_line_aft_pxl_4[1]);
1580 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_5_0,
1581 core->v_sync_line_aft_pxl_5[0]);
1582 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_5_1,
1583 core->v_sync_line_aft_pxl_5[1]);
1584 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_6_0,
1585 core->v_sync_line_aft_pxl_6[0]);
1586 hdmi_reg_writeb(hdata, HDMI_V_SYNC_LINE_AFT_PXL_6_1,
1587 core->v_sync_line_aft_pxl_6[1]);
1588 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_1_0, core->vact_space_1[0]);
1589 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_1_1, core->vact_space_1[1]);
1590 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_2_0, core->vact_space_2[0]);
1591 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_2_1, core->vact_space_2[1]);
1592 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_3_0, core->vact_space_3[0]);
1593 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_3_1, core->vact_space_3[1]);
1594 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_4_0, core->vact_space_4[0]);
1595 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_4_1, core->vact_space_4[1]);
1596 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_5_0, core->vact_space_5[0]);
1597 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_5_1, core->vact_space_5[1]);
1598 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_6_0, core->vact_space_6[0]);
1599 hdmi_reg_writeb(hdata, HDMI_VACT_SPACE_6_1, core->vact_space_6[1]);
1600
1601 /* Timing generator registers */
1602 hdmi_reg_writeb(hdata, HDMI_TG_H_FSZ_L, tg->h_fsz[0]);
1603 hdmi_reg_writeb(hdata, HDMI_TG_H_FSZ_H, tg->h_fsz[1]);
1604 hdmi_reg_writeb(hdata, HDMI_TG_HACT_ST_L, tg->hact_st[0]);
1605 hdmi_reg_writeb(hdata, HDMI_TG_HACT_ST_H, tg->hact_st[1]);
1606 hdmi_reg_writeb(hdata, HDMI_TG_HACT_SZ_L, tg->hact_sz[0]);
1607 hdmi_reg_writeb(hdata, HDMI_TG_HACT_SZ_H, tg->hact_sz[1]);
1608 hdmi_reg_writeb(hdata, HDMI_TG_V_FSZ_L, tg->v_fsz[0]);
1609 hdmi_reg_writeb(hdata, HDMI_TG_V_FSZ_H, tg->v_fsz[1]);
1610 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_L, tg->vsync[0]);
1611 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_H, tg->vsync[1]);
1612 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC2_L, tg->vsync2[0]);
1613 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC2_H, tg->vsync2[1]);
1614 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST_L, tg->vact_st[0]);
1615 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST_H, tg->vact_st[1]);
1616 hdmi_reg_writeb(hdata, HDMI_TG_VACT_SZ_L, tg->vact_sz[0]);
1617 hdmi_reg_writeb(hdata, HDMI_TG_VACT_SZ_H, tg->vact_sz[1]);
1618 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_CHG_L, tg->field_chg[0]);
1619 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_CHG_H, tg->field_chg[1]);
1620 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST2_L, tg->vact_st2[0]);
1621 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST2_H, tg->vact_st2[1]);
1622 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST3_L, tg->vact_st3[0]);
1623 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST3_H, tg->vact_st3[1]);
1624 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST4_L, tg->vact_st4[0]);
1625 hdmi_reg_writeb(hdata, HDMI_TG_VACT_ST4_H, tg->vact_st4[1]);
1626 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_TOP_HDMI_L, tg->vsync_top_hdmi[0]);
1627 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_TOP_HDMI_H, tg->vsync_top_hdmi[1]);
1628 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_BOT_HDMI_L, tg->vsync_bot_hdmi[0]);
1629 hdmi_reg_writeb(hdata, HDMI_TG_VSYNC_BOT_HDMI_H, tg->vsync_bot_hdmi[1]);
1630 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_TOP_HDMI_L, tg->field_top_hdmi[0]);
1631 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_TOP_HDMI_H, tg->field_top_hdmi[1]);
1632 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_BOT_HDMI_L, tg->field_bot_hdmi[0]);
1633 hdmi_reg_writeb(hdata, HDMI_TG_FIELD_BOT_HDMI_H, tg->field_bot_hdmi[1]);
1634 hdmi_reg_writeb(hdata, HDMI_TG_3D, tg->tg_3d[0]);
1635
1636 /* waiting for HDMIPHY's PLL to get to steady state */
1637 for (tries = 100; tries; --tries) {
1638 u32 val = hdmi_reg_read(hdata, HDMI_PHY_STATUS_0);
1639 if (val & HDMI_PHY_STATUS_READY)
1640 break;
1641 usleep_range(1000, 2000);
1642 }
1643 /* steady state not achieved */
1644 if (tries == 0) {
1645 DRM_ERROR("hdmiphy's pll could not reach steady state.\n");
1646 hdmi_regs_dump(hdata, "timing apply");
1647 }
1648
1649 clk_disable_unprepare(hdata->res.sclk_hdmi);
1650 clk_set_parent(hdata->res.mout_hdmi, hdata->res.sclk_hdmiphy);
1651 clk_prepare_enable(hdata->res.sclk_hdmi);
1652
1653 /* enable HDMI and timing generator */
1654 hdmi_start(hdata, true);
1655 }
1656
1657 static void hdmi_mode_apply(struct hdmi_context *hdata)
1658 {
1659 if (hdata->type == HDMI_TYPE13)
1660 hdmi_v13_mode_apply(hdata);
1661 else
1662 hdmi_v14_mode_apply(hdata);
1663 }
1664
1665 static void hdmiphy_conf_reset(struct hdmi_context *hdata)
1666 {
1667 u8 buffer[2];
1668 u32 reg;
1669
1670 clk_disable_unprepare(hdata->res.sclk_hdmi);
1671 clk_set_parent(hdata->res.mout_hdmi, hdata->res.sclk_pixel);
1672 clk_prepare_enable(hdata->res.sclk_hdmi);
1673
1674 /* operation mode */
1675 buffer[0] = 0x1f;
1676 buffer[1] = 0x00;
1677
1678 if (hdata->hdmiphy_port)
1679 i2c_master_send(hdata->hdmiphy_port, buffer, 2);
1680
1681 if (hdata->type == HDMI_TYPE13)
1682 reg = HDMI_V13_PHY_RSTOUT;
1683 else
1684 reg = HDMI_PHY_RSTOUT;
1685
1686 /* reset hdmiphy */
1687 hdmi_reg_writemask(hdata, reg, ~0, HDMI_PHY_SW_RSTOUT);
1688 usleep_range(10000, 12000);
1689 hdmi_reg_writemask(hdata, reg, 0, HDMI_PHY_SW_RSTOUT);
1690 usleep_range(10000, 12000);
1691 }
1692
1693 static void hdmiphy_poweron(struct hdmi_context *hdata)
1694 {
1695 if (hdata->type != HDMI_TYPE14)
1696 return;
1697
1698 DRM_DEBUG_KMS("\n");
1699
1700 /* For PHY Mode Setting */
1701 hdmiphy_reg_writeb(hdata, HDMIPHY_MODE_SET_DONE,
1702 HDMI_PHY_ENABLE_MODE_SET);
1703 /* Phy Power On */
1704 hdmiphy_reg_writeb(hdata, HDMIPHY_POWER,
1705 HDMI_PHY_POWER_ON);
1706 /* For PHY Mode Setting */
1707 hdmiphy_reg_writeb(hdata, HDMIPHY_MODE_SET_DONE,
1708 HDMI_PHY_DISABLE_MODE_SET);
1709 /* PHY SW Reset */
1710 hdmiphy_conf_reset(hdata);
1711 }
1712
1713 static void hdmiphy_poweroff(struct hdmi_context *hdata)
1714 {
1715 if (hdata->type != HDMI_TYPE14)
1716 return;
1717
1718 DRM_DEBUG_KMS("\n");
1719
1720 /* PHY SW Reset */
1721 hdmiphy_conf_reset(hdata);
1722 /* For PHY Mode Setting */
1723 hdmiphy_reg_writeb(hdata, HDMIPHY_MODE_SET_DONE,
1724 HDMI_PHY_ENABLE_MODE_SET);
1725
1726 /* PHY Power Off */
1727 hdmiphy_reg_writeb(hdata, HDMIPHY_POWER,
1728 HDMI_PHY_POWER_OFF);
1729
1730 /* For PHY Mode Setting */
1731 hdmiphy_reg_writeb(hdata, HDMIPHY_MODE_SET_DONE,
1732 HDMI_PHY_DISABLE_MODE_SET);
1733 }
1734
1735 static void hdmiphy_conf_apply(struct hdmi_context *hdata)
1736 {
1737 int ret;
1738 int i;
1739
1740 /* pixel clock */
1741 i = hdmi_find_phy_conf(hdata, hdata->mode_conf.pixel_clock);
1742 if (i < 0) {
1743 DRM_ERROR("failed to find hdmiphy conf\n");
1744 return;
1745 }
1746
1747 ret = hdmiphy_reg_write_buf(hdata, 0, hdata->phy_confs[i].conf, 32);
1748 if (ret) {
1749 DRM_ERROR("failed to configure hdmiphy\n");
1750 return;
1751 }
1752
1753 usleep_range(10000, 12000);
1754
1755 ret = hdmiphy_reg_writeb(hdata, HDMIPHY_MODE_SET_DONE,
1756 HDMI_PHY_DISABLE_MODE_SET);
1757 if (ret) {
1758 DRM_ERROR("failed to enable hdmiphy\n");
1759 return;
1760 }
1761
1762 }
1763
1764 static void hdmi_conf_apply(struct hdmi_context *hdata)
1765 {
1766 hdmiphy_conf_reset(hdata);
1767 hdmiphy_conf_apply(hdata);
1768
1769 mutex_lock(&hdata->hdmi_mutex);
1770 hdmi_start(hdata, false);
1771 hdmi_conf_init(hdata);
1772 mutex_unlock(&hdata->hdmi_mutex);
1773
1774 hdmi_audio_init(hdata);
1775
1776 /* setting core registers */
1777 hdmi_mode_apply(hdata);
1778 hdmi_audio_control(hdata, true);
1779
1780 hdmi_regs_dump(hdata, "start");
1781 }
1782
1783 static void hdmi_set_reg(u8 *reg_pair, int num_bytes, u32 value)
1784 {
1785 int i;
1786 BUG_ON(num_bytes > 4);
1787 for (i = 0; i < num_bytes; i++)
1788 reg_pair[i] = (value >> (8 * i)) & 0xff;
1789 }
1790
1791 static void hdmi_v13_mode_set(struct hdmi_context *hdata,
1792 struct drm_display_mode *m)
1793 {
1794 struct hdmi_v13_core_regs *core = &hdata->mode_conf.conf.v13_conf.core;
1795 struct hdmi_tg_regs *tg = &hdata->mode_conf.conf.v13_conf.tg;
1796 unsigned int val;
1797
1798 hdata->mode_conf.cea_video_id =
1799 drm_match_cea_mode((struct drm_display_mode *)m);
1800 hdata->mode_conf.pixel_clock = m->clock * 1000;
1801 hdata->mode_conf.aspect_ratio = m->picture_aspect_ratio;
1802
1803 hdmi_set_reg(core->h_blank, 2, m->htotal - m->hdisplay);
1804 hdmi_set_reg(core->h_v_line, 3, (m->htotal << 12) | m->vtotal);
1805
1806 val = (m->flags & DRM_MODE_FLAG_NVSYNC) ? 1 : 0;
1807 hdmi_set_reg(core->vsync_pol, 1, val);
1808
1809 val = (m->flags & DRM_MODE_FLAG_INTERLACE) ? 1 : 0;
1810 hdmi_set_reg(core->int_pro_mode, 1, val);
1811
1812 val = (m->hsync_start - m->hdisplay - 2);
1813 val |= ((m->hsync_end - m->hdisplay - 2) << 10);
1814 val |= ((m->flags & DRM_MODE_FLAG_NHSYNC) ? 1 : 0)<<20;
1815 hdmi_set_reg(core->h_sync_gen, 3, val);
1816
1817 /*
1818 * Quirk requirement for exynos HDMI IP design,
1819 * 2 pixels less than the actual calculation for hsync_start
1820 * and end.
1821 */
1822
1823 /* Following values & calculations differ for different type of modes */
1824 if (m->flags & DRM_MODE_FLAG_INTERLACE) {
1825 /* Interlaced Mode */
1826 val = ((m->vsync_end - m->vdisplay) / 2);
1827 val |= ((m->vsync_start - m->vdisplay) / 2) << 12;
1828 hdmi_set_reg(core->v_sync_gen1, 3, val);
1829
1830 val = m->vtotal / 2;
1831 val |= ((m->vtotal - m->vdisplay) / 2) << 11;
1832 hdmi_set_reg(core->v_blank, 3, val);
1833
1834 val = (m->vtotal +
1835 ((m->vsync_end - m->vsync_start) * 4) + 5) / 2;
1836 val |= m->vtotal << 11;
1837 hdmi_set_reg(core->v_blank_f, 3, val);
1838
1839 val = ((m->vtotal / 2) + 7);
1840 val |= ((m->vtotal / 2) + 2) << 12;
1841 hdmi_set_reg(core->v_sync_gen2, 3, val);
1842
1843 val = ((m->htotal / 2) + (m->hsync_start - m->hdisplay));
1844 val |= ((m->htotal / 2) +
1845 (m->hsync_start - m->hdisplay)) << 12;
1846 hdmi_set_reg(core->v_sync_gen3, 3, val);
1847
1848 hdmi_set_reg(tg->vact_st, 2, (m->vtotal - m->vdisplay) / 2);
1849 hdmi_set_reg(tg->vact_sz, 2, m->vdisplay / 2);
1850
1851 hdmi_set_reg(tg->vact_st2, 2, 0x249);/* Reset value + 1*/
1852 } else {
1853 /* Progressive Mode */
1854
1855 val = m->vtotal;
1856 val |= (m->vtotal - m->vdisplay) << 11;
1857 hdmi_set_reg(core->v_blank, 3, val);
1858
1859 hdmi_set_reg(core->v_blank_f, 3, 0);
1860
1861 val = (m->vsync_end - m->vdisplay);
1862 val |= ((m->vsync_start - m->vdisplay) << 12);
1863 hdmi_set_reg(core->v_sync_gen1, 3, val);
1864
1865 hdmi_set_reg(core->v_sync_gen2, 3, 0x1001);/* Reset value */
1866 hdmi_set_reg(core->v_sync_gen3, 3, 0x1001);/* Reset value */
1867 hdmi_set_reg(tg->vact_st, 2, m->vtotal - m->vdisplay);
1868 hdmi_set_reg(tg->vact_sz, 2, m->vdisplay);
1869 hdmi_set_reg(tg->vact_st2, 2, 0x248); /* Reset value */
1870 }
1871
1872 /* Timing generator registers */
1873 hdmi_set_reg(tg->cmd, 1, 0x0);
1874 hdmi_set_reg(tg->h_fsz, 2, m->htotal);
1875 hdmi_set_reg(tg->hact_st, 2, m->htotal - m->hdisplay);
1876 hdmi_set_reg(tg->hact_sz, 2, m->hdisplay);
1877 hdmi_set_reg(tg->v_fsz, 2, m->vtotal);
1878 hdmi_set_reg(tg->vsync, 2, 0x1);
1879 hdmi_set_reg(tg->vsync2, 2, 0x233); /* Reset value */
1880 hdmi_set_reg(tg->field_chg, 2, 0x233); /* Reset value */
1881 hdmi_set_reg(tg->vsync_top_hdmi, 2, 0x1); /* Reset value */
1882 hdmi_set_reg(tg->vsync_bot_hdmi, 2, 0x233); /* Reset value */
1883 hdmi_set_reg(tg->field_top_hdmi, 2, 0x1); /* Reset value */
1884 hdmi_set_reg(tg->field_bot_hdmi, 2, 0x233); /* Reset value */
1885 hdmi_set_reg(tg->tg_3d, 1, 0x0); /* Not used */
1886 }
1887
1888 static void hdmi_v14_mode_set(struct hdmi_context *hdata,
1889 struct drm_display_mode *m)
1890 {
1891 struct hdmi_tg_regs *tg = &hdata->mode_conf.conf.v14_conf.tg;
1892 struct hdmi_v14_core_regs *core =
1893 &hdata->mode_conf.conf.v14_conf.core;
1894
1895 hdata->mode_conf.cea_video_id =
1896 drm_match_cea_mode((struct drm_display_mode *)m);
1897 hdata->mode_conf.pixel_clock = m->clock * 1000;
1898 hdata->mode_conf.aspect_ratio = m->picture_aspect_ratio;
1899
1900 hdmi_set_reg(core->h_blank, 2, m->htotal - m->hdisplay);
1901 hdmi_set_reg(core->v_line, 2, m->vtotal);
1902 hdmi_set_reg(core->h_line, 2, m->htotal);
1903 hdmi_set_reg(core->hsync_pol, 1,
1904 (m->flags & DRM_MODE_FLAG_NHSYNC) ? 1 : 0);
1905 hdmi_set_reg(core->vsync_pol, 1,
1906 (m->flags & DRM_MODE_FLAG_NVSYNC) ? 1 : 0);
1907 hdmi_set_reg(core->int_pro_mode, 1,
1908 (m->flags & DRM_MODE_FLAG_INTERLACE) ? 1 : 0);
1909
1910 /*
1911 * Quirk requirement for exynos 5 HDMI IP design,
1912 * 2 pixels less than the actual calculation for hsync_start
1913 * and end.
1914 */
1915
1916 /* Following values & calculations differ for different type of modes */
1917 if (m->flags & DRM_MODE_FLAG_INTERLACE) {
1918 /* Interlaced Mode */
1919 hdmi_set_reg(core->v_sync_line_bef_2, 2,
1920 (m->vsync_end - m->vdisplay) / 2);
1921 hdmi_set_reg(core->v_sync_line_bef_1, 2,
1922 (m->vsync_start - m->vdisplay) / 2);
1923 hdmi_set_reg(core->v2_blank, 2, m->vtotal / 2);
1924 hdmi_set_reg(core->v1_blank, 2, (m->vtotal - m->vdisplay) / 2);
1925 hdmi_set_reg(core->v_blank_f0, 2, m->vtotal - m->vdisplay / 2);
1926 hdmi_set_reg(core->v_blank_f1, 2, m->vtotal);
1927 hdmi_set_reg(core->v_sync_line_aft_2, 2, (m->vtotal / 2) + 7);
1928 hdmi_set_reg(core->v_sync_line_aft_1, 2, (m->vtotal / 2) + 2);
1929 hdmi_set_reg(core->v_sync_line_aft_pxl_2, 2,
1930 (m->htotal / 2) + (m->hsync_start - m->hdisplay));
1931 hdmi_set_reg(core->v_sync_line_aft_pxl_1, 2,
1932 (m->htotal / 2) + (m->hsync_start - m->hdisplay));
1933 hdmi_set_reg(tg->vact_st, 2, (m->vtotal - m->vdisplay) / 2);
1934 hdmi_set_reg(tg->vact_sz, 2, m->vdisplay / 2);
1935 hdmi_set_reg(tg->vact_st2, 2, m->vtotal - m->vdisplay / 2);
1936 hdmi_set_reg(tg->vsync2, 2, (m->vtotal / 2) + 1);
1937 hdmi_set_reg(tg->vsync_bot_hdmi, 2, (m->vtotal / 2) + 1);
1938 hdmi_set_reg(tg->field_bot_hdmi, 2, (m->vtotal / 2) + 1);
1939 hdmi_set_reg(tg->vact_st3, 2, 0x0);
1940 hdmi_set_reg(tg->vact_st4, 2, 0x0);
1941 } else {
1942 /* Progressive Mode */
1943 hdmi_set_reg(core->v_sync_line_bef_2, 2,
1944 m->vsync_end - m->vdisplay);
1945 hdmi_set_reg(core->v_sync_line_bef_1, 2,
1946 m->vsync_start - m->vdisplay);
1947 hdmi_set_reg(core->v2_blank, 2, m->vtotal);
1948 hdmi_set_reg(core->v1_blank, 2, m->vtotal - m->vdisplay);
1949 hdmi_set_reg(core->v_blank_f0, 2, 0xffff);
1950 hdmi_set_reg(core->v_blank_f1, 2, 0xffff);
1951 hdmi_set_reg(core->v_sync_line_aft_2, 2, 0xffff);
1952 hdmi_set_reg(core->v_sync_line_aft_1, 2, 0xffff);
1953 hdmi_set_reg(core->v_sync_line_aft_pxl_2, 2, 0xffff);
1954 hdmi_set_reg(core->v_sync_line_aft_pxl_1, 2, 0xffff);
1955 hdmi_set_reg(tg->vact_st, 2, m->vtotal - m->vdisplay);
1956 hdmi_set_reg(tg->vact_sz, 2, m->vdisplay);
1957 hdmi_set_reg(tg->vact_st2, 2, 0x248); /* Reset value */
1958 hdmi_set_reg(tg->vact_st3, 2, 0x47b); /* Reset value */
1959 hdmi_set_reg(tg->vact_st4, 2, 0x6ae); /* Reset value */
1960 hdmi_set_reg(tg->vsync2, 2, 0x233); /* Reset value */
1961 hdmi_set_reg(tg->vsync_bot_hdmi, 2, 0x233); /* Reset value */
1962 hdmi_set_reg(tg->field_bot_hdmi, 2, 0x233); /* Reset value */
1963 }
1964
1965 /* Following values & calculations are same irrespective of mode type */
1966 hdmi_set_reg(core->h_sync_start, 2, m->hsync_start - m->hdisplay - 2);
1967 hdmi_set_reg(core->h_sync_end, 2, m->hsync_end - m->hdisplay - 2);
1968 hdmi_set_reg(core->vact_space_1, 2, 0xffff);
1969 hdmi_set_reg(core->vact_space_2, 2, 0xffff);
1970 hdmi_set_reg(core->vact_space_3, 2, 0xffff);
1971 hdmi_set_reg(core->vact_space_4, 2, 0xffff);
1972 hdmi_set_reg(core->vact_space_5, 2, 0xffff);
1973 hdmi_set_reg(core->vact_space_6, 2, 0xffff);
1974 hdmi_set_reg(core->v_blank_f2, 2, 0xffff);
1975 hdmi_set_reg(core->v_blank_f3, 2, 0xffff);
1976 hdmi_set_reg(core->v_blank_f4, 2, 0xffff);
1977 hdmi_set_reg(core->v_blank_f5, 2, 0xffff);
1978 hdmi_set_reg(core->v_sync_line_aft_3, 2, 0xffff);
1979 hdmi_set_reg(core->v_sync_line_aft_4, 2, 0xffff);
1980 hdmi_set_reg(core->v_sync_line_aft_5, 2, 0xffff);
1981 hdmi_set_reg(core->v_sync_line_aft_6, 2, 0xffff);
1982 hdmi_set_reg(core->v_sync_line_aft_pxl_3, 2, 0xffff);
1983 hdmi_set_reg(core->v_sync_line_aft_pxl_4, 2, 0xffff);
1984 hdmi_set_reg(core->v_sync_line_aft_pxl_5, 2, 0xffff);
1985 hdmi_set_reg(core->v_sync_line_aft_pxl_6, 2, 0xffff);
1986
1987 /* Timing generator registers */
1988 hdmi_set_reg(tg->cmd, 1, 0x0);
1989 hdmi_set_reg(tg->h_fsz, 2, m->htotal);
1990 hdmi_set_reg(tg->hact_st, 2, m->htotal - m->hdisplay);
1991 hdmi_set_reg(tg->hact_sz, 2, m->hdisplay);
1992 hdmi_set_reg(tg->v_fsz, 2, m->vtotal);
1993 hdmi_set_reg(tg->vsync, 2, 0x1);
1994 hdmi_set_reg(tg->field_chg, 2, 0x233); /* Reset value */
1995 hdmi_set_reg(tg->vsync_top_hdmi, 2, 0x1); /* Reset value */
1996 hdmi_set_reg(tg->field_top_hdmi, 2, 0x1); /* Reset value */
1997 hdmi_set_reg(tg->tg_3d, 1, 0x0);
1998 }
1999
2000 static void hdmi_mode_set(struct exynos_drm_display *display,
2001 struct drm_display_mode *mode)
2002 {
2003 struct hdmi_context *hdata = display->ctx;
2004 struct drm_display_mode *m = mode;
2005
2006 DRM_DEBUG_KMS("xres=%d, yres=%d, refresh=%d, intl=%s\n",
2007 m->hdisplay, m->vdisplay,
2008 m->vrefresh, (m->flags & DRM_MODE_FLAG_INTERLACE) ?
2009 "INTERLACED" : "PROGERESSIVE");
2010
2011 /* preserve mode information for later use. */
2012 drm_mode_copy(&hdata->current_mode, mode);
2013
2014 if (hdata->type == HDMI_TYPE13)
2015 hdmi_v13_mode_set(hdata, mode);
2016 else
2017 hdmi_v14_mode_set(hdata, mode);
2018 }
2019
2020 static void hdmi_commit(struct exynos_drm_display *display)
2021 {
2022 struct hdmi_context *hdata = display->ctx;
2023
2024 mutex_lock(&hdata->hdmi_mutex);
2025 if (!hdata->powered) {
2026 mutex_unlock(&hdata->hdmi_mutex);
2027 return;
2028 }
2029 mutex_unlock(&hdata->hdmi_mutex);
2030
2031 hdmi_conf_apply(hdata);
2032 }
2033
2034 static void hdmi_poweron(struct exynos_drm_display *display)
2035 {
2036 struct hdmi_context *hdata = display->ctx;
2037 struct hdmi_resources *res = &hdata->res;
2038
2039 mutex_lock(&hdata->hdmi_mutex);
2040 if (hdata->powered) {
2041 mutex_unlock(&hdata->hdmi_mutex);
2042 return;
2043 }
2044
2045 hdata->powered = true;
2046
2047 mutex_unlock(&hdata->hdmi_mutex);
2048
2049 pm_runtime_get_sync(hdata->dev);
2050
2051 if (regulator_bulk_enable(res->regul_count, res->regul_bulk))
2052 DRM_DEBUG_KMS("failed to enable regulator bulk\n");
2053
2054 /* set pmu hdmiphy control bit to enable hdmiphy */
2055 regmap_update_bits(hdata->pmureg, PMU_HDMI_PHY_CONTROL,
2056 PMU_HDMI_PHY_ENABLE_BIT, 1);
2057
2058 clk_prepare_enable(res->hdmi);
2059 clk_prepare_enable(res->sclk_hdmi);
2060
2061 hdmiphy_poweron(hdata);
2062 hdmi_commit(display);
2063 }
2064
2065 static void hdmi_poweroff(struct exynos_drm_display *display)
2066 {
2067 struct hdmi_context *hdata = display->ctx;
2068 struct hdmi_resources *res = &hdata->res;
2069
2070 mutex_lock(&hdata->hdmi_mutex);
2071 if (!hdata->powered)
2072 goto out;
2073 mutex_unlock(&hdata->hdmi_mutex);
2074
2075 /* HDMI System Disable */
2076 hdmi_reg_writemask(hdata, HDMI_CON_0, 0, HDMI_EN);
2077
2078 hdmiphy_poweroff(hdata);
2079
2080 cancel_delayed_work(&hdata->hotplug_work);
2081
2082 clk_disable_unprepare(res->sclk_hdmi);
2083 clk_disable_unprepare(res->hdmi);
2084
2085 /* reset pmu hdmiphy control bit to disable hdmiphy */
2086 regmap_update_bits(hdata->pmureg, PMU_HDMI_PHY_CONTROL,
2087 PMU_HDMI_PHY_ENABLE_BIT, 0);
2088
2089 regulator_bulk_disable(res->regul_count, res->regul_bulk);
2090
2091 pm_runtime_put_sync(hdata->dev);
2092
2093 mutex_lock(&hdata->hdmi_mutex);
2094 hdata->powered = false;
2095
2096 out:
2097 mutex_unlock(&hdata->hdmi_mutex);
2098 }
2099
2100 static void hdmi_dpms(struct exynos_drm_display *display, int mode)
2101 {
2102 struct hdmi_context *hdata = display->ctx;
2103 struct drm_encoder *encoder = hdata->encoder;
2104 struct drm_crtc *crtc = encoder->crtc;
2105 struct drm_crtc_helper_funcs *funcs = NULL;
2106
2107 DRM_DEBUG_KMS("mode %d\n", mode);
2108
2109 switch (mode) {
2110 case DRM_MODE_DPMS_ON:
2111 hdmi_poweron(display);
2112 break;
2113 case DRM_MODE_DPMS_STANDBY:
2114 case DRM_MODE_DPMS_SUSPEND:
2115 case DRM_MODE_DPMS_OFF:
2116 /*
2117 * The SFRs of VP and Mixer are updated by Vertical Sync of
2118 * Timing generator which is a part of HDMI so the sequence
2119 * to disable TV Subsystem should be as following,
2120 * VP -> Mixer -> HDMI
2121 *
2122 * Below codes will try to disable Mixer and VP(if used)
2123 * prior to disabling HDMI.
2124 */
2125 if (crtc)
2126 funcs = crtc->helper_private;
2127 if (funcs && funcs->dpms)
2128 (*funcs->dpms)(crtc, mode);
2129
2130 hdmi_poweroff(display);
2131 break;
2132 default:
2133 DRM_DEBUG_KMS("unknown dpms mode: %d\n", mode);
2134 break;
2135 }
2136 }
2137
2138 static struct exynos_drm_display_ops hdmi_display_ops = {
2139 .create_connector = hdmi_create_connector,
2140 .mode_fixup = hdmi_mode_fixup,
2141 .mode_set = hdmi_mode_set,
2142 .dpms = hdmi_dpms,
2143 .commit = hdmi_commit,
2144 };
2145
2146 static struct exynos_drm_display hdmi_display = {
2147 .type = EXYNOS_DISPLAY_TYPE_HDMI,
2148 .ops = &hdmi_display_ops,
2149 };
2150
2151 static void hdmi_hotplug_work_func(struct work_struct *work)
2152 {
2153 struct hdmi_context *hdata;
2154
2155 hdata = container_of(work, struct hdmi_context, hotplug_work.work);
2156
2157 mutex_lock(&hdata->hdmi_mutex);
2158 hdata->hpd = gpio_get_value(hdata->hpd_gpio);
2159 mutex_unlock(&hdata->hdmi_mutex);
2160
2161 if (hdata->drm_dev)
2162 drm_helper_hpd_irq_event(hdata->drm_dev);
2163 }
2164
2165 static irqreturn_t hdmi_irq_thread(int irq, void *arg)
2166 {
2167 struct hdmi_context *hdata = arg;
2168
2169 mod_delayed_work(system_wq, &hdata->hotplug_work,
2170 msecs_to_jiffies(HOTPLUG_DEBOUNCE_MS));
2171
2172 return IRQ_HANDLED;
2173 }
2174
2175 static int hdmi_resources_init(struct hdmi_context *hdata)
2176 {
2177 struct device *dev = hdata->dev;
2178 struct hdmi_resources *res = &hdata->res;
2179 static char *supply[] = {
2180 "vdd",
2181 "vdd_osc",
2182 "vdd_pll",
2183 };
2184 int i, ret;
2185
2186 DRM_DEBUG_KMS("HDMI resource init\n");
2187
2188 /* get clocks, power */
2189 res->hdmi = devm_clk_get(dev, "hdmi");
2190 if (IS_ERR(res->hdmi)) {
2191 DRM_ERROR("failed to get clock 'hdmi'\n");
2192 ret = PTR_ERR(res->hdmi);
2193 goto fail;
2194 }
2195 res->sclk_hdmi = devm_clk_get(dev, "sclk_hdmi");
2196 if (IS_ERR(res->sclk_hdmi)) {
2197 DRM_ERROR("failed to get clock 'sclk_hdmi'\n");
2198 ret = PTR_ERR(res->sclk_hdmi);
2199 goto fail;
2200 }
2201 res->sclk_pixel = devm_clk_get(dev, "sclk_pixel");
2202 if (IS_ERR(res->sclk_pixel)) {
2203 DRM_ERROR("failed to get clock 'sclk_pixel'\n");
2204 ret = PTR_ERR(res->sclk_pixel);
2205 goto fail;
2206 }
2207 res->sclk_hdmiphy = devm_clk_get(dev, "sclk_hdmiphy");
2208 if (IS_ERR(res->sclk_hdmiphy)) {
2209 DRM_ERROR("failed to get clock 'sclk_hdmiphy'\n");
2210 ret = PTR_ERR(res->sclk_hdmiphy);
2211 goto fail;
2212 }
2213 res->mout_hdmi = devm_clk_get(dev, "mout_hdmi");
2214 if (IS_ERR(res->mout_hdmi)) {
2215 DRM_ERROR("failed to get clock 'mout_hdmi'\n");
2216 ret = PTR_ERR(res->mout_hdmi);
2217 goto fail;
2218 }
2219
2220 clk_set_parent(res->mout_hdmi, res->sclk_pixel);
2221
2222 res->regul_bulk = devm_kzalloc(dev, ARRAY_SIZE(supply) *
2223 sizeof(res->regul_bulk[0]), GFP_KERNEL);
2224 if (!res->regul_bulk) {
2225 ret = -ENOMEM;
2226 goto fail;
2227 }
2228 for (i = 0; i < ARRAY_SIZE(supply); ++i) {
2229 res->regul_bulk[i].supply = supply[i];
2230 res->regul_bulk[i].consumer = NULL;
2231 }
2232 ret = devm_regulator_bulk_get(dev, ARRAY_SIZE(supply), res->regul_bulk);
2233 if (ret) {
2234 DRM_ERROR("failed to get regulators\n");
2235 return ret;
2236 }
2237 res->regul_count = ARRAY_SIZE(supply);
2238
2239 res->reg_hdmi_en = devm_regulator_get(dev, "hdmi-en");
2240 if (IS_ERR(res->reg_hdmi_en) && PTR_ERR(res->reg_hdmi_en) != -ENOENT) {
2241 DRM_ERROR("failed to get hdmi-en regulator\n");
2242 return PTR_ERR(res->reg_hdmi_en);
2243 }
2244 if (!IS_ERR(res->reg_hdmi_en)) {
2245 ret = regulator_enable(res->reg_hdmi_en);
2246 if (ret) {
2247 DRM_ERROR("failed to enable hdmi-en regulator\n");
2248 return ret;
2249 }
2250 } else
2251 res->reg_hdmi_en = NULL;
2252
2253 return ret;
2254 fail:
2255 DRM_ERROR("HDMI resource init - failed\n");
2256 return ret;
2257 }
2258
2259 static struct s5p_hdmi_platform_data *drm_hdmi_dt_parse_pdata
2260 (struct device *dev)
2261 {
2262 struct device_node *np = dev->of_node;
2263 struct s5p_hdmi_platform_data *pd;
2264 u32 value;
2265
2266 pd = devm_kzalloc(dev, sizeof(*pd), GFP_KERNEL);
2267 if (!pd)
2268 goto err_data;
2269
2270 if (!of_find_property(np, "hpd-gpio", &value)) {
2271 DRM_ERROR("no hpd gpio property found\n");
2272 goto err_data;
2273 }
2274
2275 pd->hpd_gpio = of_get_named_gpio(np, "hpd-gpio", 0);
2276
2277 return pd;
2278
2279 err_data:
2280 return NULL;
2281 }
2282
2283 static struct of_device_id hdmi_match_types[] = {
2284 {
2285 .compatible = "samsung,exynos5-hdmi",
2286 .data = &exynos5_hdmi_driver_data,
2287 }, {
2288 .compatible = "samsung,exynos4210-hdmi",
2289 .data = &exynos4210_hdmi_driver_data,
2290 }, {
2291 .compatible = "samsung,exynos4212-hdmi",
2292 .data = &exynos4212_hdmi_driver_data,
2293 }, {
2294 .compatible = "samsung,exynos5420-hdmi",
2295 .data = &exynos5420_hdmi_driver_data,
2296 }, {
2297 /* end node */
2298 }
2299 };
2300 MODULE_DEVICE_TABLE (of, hdmi_match_types);
2301
2302 static int hdmi_bind(struct device *dev, struct device *master, void *data)
2303 {
2304 struct drm_device *drm_dev = data;
2305 struct hdmi_context *hdata;
2306
2307 hdata = hdmi_display.ctx;
2308 hdata->drm_dev = drm_dev;
2309
2310 return exynos_drm_create_enc_conn(drm_dev, &hdmi_display);
2311 }
2312
2313 static void hdmi_unbind(struct device *dev, struct device *master, void *data)
2314 {
2315 struct exynos_drm_display *display = get_hdmi_display(dev);
2316 struct drm_encoder *encoder = display->encoder;
2317 struct hdmi_context *hdata = display->ctx;
2318
2319 hdmi_connector_destroy(&hdata->connector);
2320 encoder->funcs->destroy(encoder);
2321 }
2322
2323 static const struct component_ops hdmi_component_ops = {
2324 .bind = hdmi_bind,
2325 .unbind = hdmi_unbind,
2326 };
2327
2328 static struct device_node *hdmi_legacy_ddc_dt_binding(struct device *dev)
2329 {
2330 const char *compatible_str = "samsung,exynos4210-hdmiddc";
2331 struct device_node *np;
2332
2333 np = of_find_compatible_node(NULL, NULL, compatible_str);
2334 if (np)
2335 return of_get_next_parent(np);
2336
2337 return NULL;
2338 }
2339
2340 static struct device_node *hdmi_legacy_phy_dt_binding(struct device *dev)
2341 {
2342 const char *compatible_str = "samsung,exynos4212-hdmiphy";
2343
2344 return of_find_compatible_node(NULL, NULL, compatible_str);
2345 }
2346
2347 static int hdmi_probe(struct platform_device *pdev)
2348 {
2349 struct device_node *ddc_node, *phy_node;
2350 struct s5p_hdmi_platform_data *pdata;
2351 struct hdmi_driver_data *drv_data;
2352 const struct of_device_id *match;
2353 struct device *dev = &pdev->dev;
2354 struct hdmi_context *hdata;
2355 struct resource *res;
2356 int ret;
2357
2358 ret = exynos_drm_component_add(&pdev->dev, EXYNOS_DEVICE_TYPE_CONNECTOR,
2359 hdmi_display.type);
2360 if (ret)
2361 return ret;
2362
2363 if (!dev->of_node) {
2364 ret = -ENODEV;
2365 goto err_del_component;
2366 }
2367
2368 pdata = drm_hdmi_dt_parse_pdata(dev);
2369 if (!pdata) {
2370 ret = -EINVAL;
2371 goto err_del_component;
2372 }
2373
2374 hdata = devm_kzalloc(dev, sizeof(struct hdmi_context), GFP_KERNEL);
2375 if (!hdata) {
2376 ret = -ENOMEM;
2377 goto err_del_component;
2378 }
2379
2380 mutex_init(&hdata->hdmi_mutex);
2381
2382 platform_set_drvdata(pdev, &hdmi_display);
2383
2384 match = of_match_node(hdmi_match_types, dev->of_node);
2385 if (!match) {
2386 ret = -ENODEV;
2387 goto err_del_component;
2388 }
2389
2390 drv_data = (struct hdmi_driver_data *)match->data;
2391 hdata->type = drv_data->type;
2392 hdata->phy_confs = drv_data->phy_confs;
2393 hdata->phy_conf_count = drv_data->phy_conf_count;
2394
2395 hdata->hpd_gpio = pdata->hpd_gpio;
2396 hdata->dev = dev;
2397
2398 ret = hdmi_resources_init(hdata);
2399 if (ret) {
2400 DRM_ERROR("hdmi_resources_init failed\n");
2401 return ret;
2402 }
2403
2404 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2405 hdata->regs = devm_ioremap_resource(dev, res);
2406 if (IS_ERR(hdata->regs)) {
2407 ret = PTR_ERR(hdata->regs);
2408 goto err_del_component;
2409 }
2410
2411 ret = devm_gpio_request(dev, hdata->hpd_gpio, "HPD");
2412 if (ret) {
2413 DRM_ERROR("failed to request HPD gpio\n");
2414 goto err_del_component;
2415 }
2416
2417 ddc_node = hdmi_legacy_ddc_dt_binding(dev);
2418 if (ddc_node)
2419 goto out_get_ddc_adpt;
2420
2421 /* DDC i2c driver */
2422 ddc_node = of_parse_phandle(dev->of_node, "ddc", 0);
2423 if (!ddc_node) {
2424 DRM_ERROR("Failed to find ddc node in device tree\n");
2425 ret = -ENODEV;
2426 goto err_del_component;
2427 }
2428
2429 out_get_ddc_adpt:
2430 hdata->ddc_adpt = of_find_i2c_adapter_by_node(ddc_node);
2431 if (!hdata->ddc_adpt) {
2432 DRM_ERROR("Failed to get ddc i2c adapter by node\n");
2433 return -EPROBE_DEFER;
2434 }
2435
2436 phy_node = hdmi_legacy_phy_dt_binding(dev);
2437 if (phy_node)
2438 goto out_get_phy_port;
2439
2440 /* hdmiphy i2c driver */
2441 phy_node = of_parse_phandle(dev->of_node, "phy", 0);
2442 if (!phy_node) {
2443 DRM_ERROR("Failed to find hdmiphy node in device tree\n");
2444 ret = -ENODEV;
2445 goto err_ddc;
2446 }
2447
2448 out_get_phy_port:
2449 if (drv_data->is_apb_phy) {
2450 hdata->regs_hdmiphy = of_iomap(phy_node, 0);
2451 if (!hdata->regs_hdmiphy) {
2452 DRM_ERROR("failed to ioremap hdmi phy\n");
2453 ret = -ENOMEM;
2454 goto err_ddc;
2455 }
2456 } else {
2457 hdata->hdmiphy_port = of_find_i2c_device_by_node(phy_node);
2458 if (!hdata->hdmiphy_port) {
2459 DRM_ERROR("Failed to get hdmi phy i2c client\n");
2460 ret = -EPROBE_DEFER;
2461 goto err_ddc;
2462 }
2463 }
2464
2465 hdata->irq = gpio_to_irq(hdata->hpd_gpio);
2466 if (hdata->irq < 0) {
2467 DRM_ERROR("failed to get GPIO irq\n");
2468 ret = hdata->irq;
2469 goto err_hdmiphy;
2470 }
2471
2472 hdata->hpd = gpio_get_value(hdata->hpd_gpio);
2473
2474 INIT_DELAYED_WORK(&hdata->hotplug_work, hdmi_hotplug_work_func);
2475
2476 ret = devm_request_threaded_irq(dev, hdata->irq, NULL,
2477 hdmi_irq_thread, IRQF_TRIGGER_RISING |
2478 IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
2479 "hdmi", hdata);
2480 if (ret) {
2481 DRM_ERROR("failed to register hdmi interrupt\n");
2482 goto err_hdmiphy;
2483 }
2484
2485 hdata->pmureg = syscon_regmap_lookup_by_phandle(dev->of_node,
2486 "samsung,syscon-phandle");
2487 if (IS_ERR(hdata->pmureg)) {
2488 DRM_ERROR("syscon regmap lookup failed.\n");
2489 ret = -EPROBE_DEFER;
2490 goto err_hdmiphy;
2491 }
2492
2493 pm_runtime_enable(dev);
2494 hdmi_display.ctx = hdata;
2495
2496 ret = component_add(&pdev->dev, &hdmi_component_ops);
2497 if (ret)
2498 goto err_disable_pm_runtime;
2499
2500 return ret;
2501
2502 err_disable_pm_runtime:
2503 pm_runtime_disable(dev);
2504
2505 err_hdmiphy:
2506 if (hdata->hdmiphy_port)
2507 put_device(&hdata->hdmiphy_port->dev);
2508 err_ddc:
2509 put_device(&hdata->ddc_adpt->dev);
2510
2511 err_del_component:
2512 exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CONNECTOR);
2513
2514 return ret;
2515 }
2516
2517 static int hdmi_remove(struct platform_device *pdev)
2518 {
2519 struct hdmi_context *hdata = hdmi_display.ctx;
2520
2521 cancel_delayed_work_sync(&hdata->hotplug_work);
2522
2523 if (hdata->res.reg_hdmi_en)
2524 regulator_disable(hdata->res.reg_hdmi_en);
2525
2526 if (hdata->hdmiphy_port)
2527 put_device(&hdata->hdmiphy_port->dev);
2528 put_device(&hdata->ddc_adpt->dev);
2529
2530 pm_runtime_disable(&pdev->dev);
2531 component_del(&pdev->dev, &hdmi_component_ops);
2532
2533 exynos_drm_component_del(&pdev->dev, EXYNOS_DEVICE_TYPE_CONNECTOR);
2534 return 0;
2535 }
2536
2537 struct platform_driver hdmi_driver = {
2538 .probe = hdmi_probe,
2539 .remove = hdmi_remove,
2540 .driver = {
2541 .name = "exynos-hdmi",
2542 .owner = THIS_MODULE,
2543 .of_match_table = hdmi_match_types,
2544 },
2545 };
ubuntu-zesty-kernel mirror