1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright (C) 2020 BayLibre, SAS
4  * Author: Neil Armstrong <narmstrong@baylibre.com>
5  */
6 
7 #include <linux/delay.h>
8 #include <linux/gpio/consumer.h>
9 #include <linux/module.h>
10 #include <linux/of.h>
11 #include <linux/regulator/consumer.h>
12 
13 #include <video/mipi_display.h>
14 
15 #include <drm/drm_crtc.h>
16 #include <drm/drm_device.h>
17 #include <drm/drm_mipi_dsi.h>
18 #include <drm/drm_modes.h>
19 #include <drm/drm_panel.h>
20 
21 struct khadas_ts050_panel {
22 	struct drm_panel base;
23 	struct mipi_dsi_device *link;
24 
25 	struct regulator *supply;
26 	struct gpio_desc *reset_gpio;
27 	struct gpio_desc *enable_gpio;
28 
29 	bool prepared;
30 	bool enabled;
31 };
32 
33 struct khadas_ts050_panel_cmd {
34 	u8 cmd;
35 	u8 data;
36 };
37 
38 /* Only the CMD1 User Command set is documented */
39 static const struct khadas_ts050_panel_cmd init_code[] = {
40 	/* Select Unknown CMD Page (Undocumented) */
41 	{0xff, 0xee},
42 	/* Reload CMD1: Don't reload default value to register */
43 	{0xfb, 0x01},
44 	{0x1f, 0x45},
45 	{0x24, 0x4f},
46 	{0x38, 0xc8},
47 	{0x39, 0x27},
48 	{0x1e, 0x77},
49 	{0x1d, 0x0f},
50 	{0x7e, 0x71},
51 	{0x7c, 0x03},
52 	{0xff, 0x00},
53 	{0xfb, 0x01},
54 	{0x35, 0x01},
55 	/* Select CMD2 Page0 (Undocumented) */
56 	{0xff, 0x01},
57 	/* Reload CMD1: Don't reload default value to register */
58 	{0xfb, 0x01},
59 	{0x00, 0x01},
60 	{0x01, 0x55},
61 	{0x02, 0x40},
62 	{0x05, 0x40},
63 	{0x06, 0x4a},
64 	{0x07, 0x24},
65 	{0x08, 0x0c},
66 	{0x0b, 0x7d},
67 	{0x0c, 0x7d},
68 	{0x0e, 0xb0},
69 	{0x0f, 0xae},
70 	{0x11, 0x10},
71 	{0x12, 0x10},
72 	{0x13, 0x03},
73 	{0x14, 0x4a},
74 	{0x15, 0x12},
75 	{0x16, 0x12},
76 	{0x18, 0x00},
77 	{0x19, 0x77},
78 	{0x1a, 0x55},
79 	{0x1b, 0x13},
80 	{0x1c, 0x00},
81 	{0x1d, 0x00},
82 	{0x1e, 0x13},
83 	{0x1f, 0x00},
84 	{0x23, 0x00},
85 	{0x24, 0x00},
86 	{0x25, 0x00},
87 	{0x26, 0x00},
88 	{0x27, 0x00},
89 	{0x28, 0x00},
90 	{0x35, 0x00},
91 	{0x66, 0x00},
92 	{0x58, 0x82},
93 	{0x59, 0x02},
94 	{0x5a, 0x02},
95 	{0x5b, 0x02},
96 	{0x5c, 0x82},
97 	{0x5d, 0x82},
98 	{0x5e, 0x02},
99 	{0x5f, 0x02},
100 	{0x72, 0x31},
101 	/* Select CMD2 Page4 (Undocumented) */
102 	{0xff, 0x05},
103 	/* Reload CMD1: Don't reload default value to register */
104 	{0xfb, 0x01},
105 	{0x00, 0x01},
106 	{0x01, 0x0b},
107 	{0x02, 0x0c},
108 	{0x03, 0x09},
109 	{0x04, 0x0a},
110 	{0x05, 0x00},
111 	{0x06, 0x0f},
112 	{0x07, 0x10},
113 	{0x08, 0x00},
114 	{0x09, 0x00},
115 	{0x0a, 0x00},
116 	{0x0b, 0x00},
117 	{0x0c, 0x00},
118 	{0x0d, 0x13},
119 	{0x0e, 0x15},
120 	{0x0f, 0x17},
121 	{0x10, 0x01},
122 	{0x11, 0x0b},
123 	{0x12, 0x0c},
124 	{0x13, 0x09},
125 	{0x14, 0x0a},
126 	{0x15, 0x00},
127 	{0x16, 0x0f},
128 	{0x17, 0x10},
129 	{0x18, 0x00},
130 	{0x19, 0x00},
131 	{0x1a, 0x00},
132 	{0x1b, 0x00},
133 	{0x1c, 0x00},
134 	{0x1d, 0x13},
135 	{0x1e, 0x15},
136 	{0x1f, 0x17},
137 	{0x20, 0x00},
138 	{0x21, 0x03},
139 	{0x22, 0x01},
140 	{0x23, 0x40},
141 	{0x24, 0x40},
142 	{0x25, 0xed},
143 	{0x29, 0x58},
144 	{0x2a, 0x12},
145 	{0x2b, 0x01},
146 	{0x4b, 0x06},
147 	{0x4c, 0x11},
148 	{0x4d, 0x20},
149 	{0x4e, 0x02},
150 	{0x4f, 0x02},
151 	{0x50, 0x20},
152 	{0x51, 0x61},
153 	{0x52, 0x01},
154 	{0x53, 0x63},
155 	{0x54, 0x77},
156 	{0x55, 0xed},
157 	{0x5b, 0x00},
158 	{0x5c, 0x00},
159 	{0x5d, 0x00},
160 	{0x5e, 0x00},
161 	{0x5f, 0x15},
162 	{0x60, 0x75},
163 	{0x61, 0x00},
164 	{0x62, 0x00},
165 	{0x63, 0x00},
166 	{0x64, 0x00},
167 	{0x65, 0x00},
168 	{0x66, 0x00},
169 	{0x67, 0x00},
170 	{0x68, 0x04},
171 	{0x69, 0x00},
172 	{0x6a, 0x00},
173 	{0x6c, 0x40},
174 	{0x75, 0x01},
175 	{0x76, 0x01},
176 	{0x7a, 0x80},
177 	{0x7b, 0xa3},
178 	{0x7c, 0xd8},
179 	{0x7d, 0x60},
180 	{0x7f, 0x15},
181 	{0x80, 0x81},
182 	{0x83, 0x05},
183 	{0x93, 0x08},
184 	{0x94, 0x10},
185 	{0x8a, 0x00},
186 	{0x9b, 0x0f},
187 	{0xea, 0xff},
188 	{0xec, 0x00},
189 	/* Select CMD2 Page0 (Undocumented) */
190 	{0xff, 0x01},
191 	/* Reload CMD1: Don't reload default value to register */
192 	{0xfb, 0x01},
193 	{0x75, 0x00},
194 	{0x76, 0xdf},
195 	{0x77, 0x00},
196 	{0x78, 0xe4},
197 	{0x79, 0x00},
198 	{0x7a, 0xed},
199 	{0x7b, 0x00},
200 	{0x7c, 0xf6},
201 	{0x7d, 0x00},
202 	{0x7e, 0xff},
203 	{0x7f, 0x01},
204 	{0x80, 0x07},
205 	{0x81, 0x01},
206 	{0x82, 0x10},
207 	{0x83, 0x01},
208 	{0x84, 0x18},
209 	{0x85, 0x01},
210 	{0x86, 0x20},
211 	{0x87, 0x01},
212 	{0x88, 0x3d},
213 	{0x89, 0x01},
214 	{0x8a, 0x56},
215 	{0x8b, 0x01},
216 	{0x8c, 0x84},
217 	{0x8d, 0x01},
218 	{0x8e, 0xab},
219 	{0x8f, 0x01},
220 	{0x90, 0xec},
221 	{0x91, 0x02},
222 	{0x92, 0x22},
223 	{0x93, 0x02},
224 	{0x94, 0x23},
225 	{0x95, 0x02},
226 	{0x96, 0x55},
227 	{0x97, 0x02},
228 	{0x98, 0x8b},
229 	{0x99, 0x02},
230 	{0x9a, 0xaf},
231 	{0x9b, 0x02},
232 	{0x9c, 0xdf},
233 	{0x9d, 0x03},
234 	{0x9e, 0x01},
235 	{0x9f, 0x03},
236 	{0xa0, 0x2c},
237 	{0xa2, 0x03},
238 	{0xa3, 0x39},
239 	{0xa4, 0x03},
240 	{0xa5, 0x47},
241 	{0xa6, 0x03},
242 	{0xa7, 0x56},
243 	{0xa9, 0x03},
244 	{0xaa, 0x66},
245 	{0xab, 0x03},
246 	{0xac, 0x76},
247 	{0xad, 0x03},
248 	{0xae, 0x85},
249 	{0xaf, 0x03},
250 	{0xb0, 0x90},
251 	{0xb1, 0x03},
252 	{0xb2, 0xcb},
253 	{0xb3, 0x00},
254 	{0xb4, 0xdf},
255 	{0xb5, 0x00},
256 	{0xb6, 0xe4},
257 	{0xb7, 0x00},
258 	{0xb8, 0xed},
259 	{0xb9, 0x00},
260 	{0xba, 0xf6},
261 	{0xbb, 0x00},
262 	{0xbc, 0xff},
263 	{0xbd, 0x01},
264 	{0xbe, 0x07},
265 	{0xbf, 0x01},
266 	{0xc0, 0x10},
267 	{0xc1, 0x01},
268 	{0xc2, 0x18},
269 	{0xc3, 0x01},
270 	{0xc4, 0x20},
271 	{0xc5, 0x01},
272 	{0xc6, 0x3d},
273 	{0xc7, 0x01},
274 	{0xc8, 0x56},
275 	{0xc9, 0x01},
276 	{0xca, 0x84},
277 	{0xcb, 0x01},
278 	{0xcc, 0xab},
279 	{0xcd, 0x01},
280 	{0xce, 0xec},
281 	{0xcf, 0x02},
282 	{0xd0, 0x22},
283 	{0xd1, 0x02},
284 	{0xd2, 0x23},
285 	{0xd3, 0x02},
286 	{0xd4, 0x55},
287 	{0xd5, 0x02},
288 	{0xd6, 0x8b},
289 	{0xd7, 0x02},
290 	{0xd8, 0xaf},
291 	{0xd9, 0x02},
292 	{0xda, 0xdf},
293 	{0xdb, 0x03},
294 	{0xdc, 0x01},
295 	{0xdd, 0x03},
296 	{0xde, 0x2c},
297 	{0xdf, 0x03},
298 	{0xe0, 0x39},
299 	{0xe1, 0x03},
300 	{0xe2, 0x47},
301 	{0xe3, 0x03},
302 	{0xe4, 0x56},
303 	{0xe5, 0x03},
304 	{0xe6, 0x66},
305 	{0xe7, 0x03},
306 	{0xe8, 0x76},
307 	{0xe9, 0x03},
308 	{0xea, 0x85},
309 	{0xeb, 0x03},
310 	{0xec, 0x90},
311 	{0xed, 0x03},
312 	{0xee, 0xcb},
313 	{0xef, 0x00},
314 	{0xf0, 0xbb},
315 	{0xf1, 0x00},
316 	{0xf2, 0xc0},
317 	{0xf3, 0x00},
318 	{0xf4, 0xcc},
319 	{0xf5, 0x00},
320 	{0xf6, 0xd6},
321 	{0xf7, 0x00},
322 	{0xf8, 0xe1},
323 	{0xf9, 0x00},
324 	{0xfa, 0xea},
325 	/* Select CMD2 Page2 (Undocumented) */
326 	{0xff, 0x02},
327 	/* Reload CMD1: Don't reload default value to register */
328 	{0xfb, 0x01},
329 	{0x00, 0x00},
330 	{0x01, 0xf4},
331 	{0x02, 0x00},
332 	{0x03, 0xef},
333 	{0x04, 0x01},
334 	{0x05, 0x07},
335 	{0x06, 0x01},
336 	{0x07, 0x28},
337 	{0x08, 0x01},
338 	{0x09, 0x44},
339 	{0x0a, 0x01},
340 	{0x0b, 0x76},
341 	{0x0c, 0x01},
342 	{0x0d, 0xa0},
343 	{0x0e, 0x01},
344 	{0x0f, 0xe7},
345 	{0x10, 0x02},
346 	{0x11, 0x1f},
347 	{0x12, 0x02},
348 	{0x13, 0x22},
349 	{0x14, 0x02},
350 	{0x15, 0x54},
351 	{0x16, 0x02},
352 	{0x17, 0x8b},
353 	{0x18, 0x02},
354 	{0x19, 0xaf},
355 	{0x1a, 0x02},
356 	{0x1b, 0xe0},
357 	{0x1c, 0x03},
358 	{0x1d, 0x01},
359 	{0x1e, 0x03},
360 	{0x1f, 0x2d},
361 	{0x20, 0x03},
362 	{0x21, 0x39},
363 	{0x22, 0x03},
364 	{0x23, 0x47},
365 	{0x24, 0x03},
366 	{0x25, 0x57},
367 	{0x26, 0x03},
368 	{0x27, 0x65},
369 	{0x28, 0x03},
370 	{0x29, 0x77},
371 	{0x2a, 0x03},
372 	{0x2b, 0x85},
373 	{0x2d, 0x03},
374 	{0x2f, 0x8f},
375 	{0x30, 0x03},
376 	{0x31, 0xcb},
377 	{0x32, 0x00},
378 	{0x33, 0xbb},
379 	{0x34, 0x00},
380 	{0x35, 0xc0},
381 	{0x36, 0x00},
382 	{0x37, 0xcc},
383 	{0x38, 0x00},
384 	{0x39, 0xd6},
385 	{0x3a, 0x00},
386 	{0x3b, 0xe1},
387 	{0x3d, 0x00},
388 	{0x3f, 0xea},
389 	{0x40, 0x00},
390 	{0x41, 0xf4},
391 	{0x42, 0x00},
392 	{0x43, 0xfe},
393 	{0x44, 0x01},
394 	{0x45, 0x07},
395 	{0x46, 0x01},
396 	{0x47, 0x28},
397 	{0x48, 0x01},
398 	{0x49, 0x44},
399 	{0x4a, 0x01},
400 	{0x4b, 0x76},
401 	{0x4c, 0x01},
402 	{0x4d, 0xa0},
403 	{0x4e, 0x01},
404 	{0x4f, 0xe7},
405 	{0x50, 0x02},
406 	{0x51, 0x1f},
407 	{0x52, 0x02},
408 	{0x53, 0x22},
409 	{0x54, 0x02},
410 	{0x55, 0x54},
411 	{0x56, 0x02},
412 	{0x58, 0x8b},
413 	{0x59, 0x02},
414 	{0x5a, 0xaf},
415 	{0x5b, 0x02},
416 	{0x5c, 0xe0},
417 	{0x5d, 0x03},
418 	{0x5e, 0x01},
419 	{0x5f, 0x03},
420 	{0x60, 0x2d},
421 	{0x61, 0x03},
422 	{0x62, 0x39},
423 	{0x63, 0x03},
424 	{0x64, 0x47},
425 	{0x65, 0x03},
426 	{0x66, 0x57},
427 	{0x67, 0x03},
428 	{0x68, 0x65},
429 	{0x69, 0x03},
430 	{0x6a, 0x77},
431 	{0x6b, 0x03},
432 	{0x6c, 0x85},
433 	{0x6d, 0x03},
434 	{0x6e, 0x8f},
435 	{0x6f, 0x03},
436 	{0x70, 0xcb},
437 	{0x71, 0x00},
438 	{0x72, 0x00},
439 	{0x73, 0x00},
440 	{0x74, 0x21},
441 	{0x75, 0x00},
442 	{0x76, 0x4c},
443 	{0x77, 0x00},
444 	{0x78, 0x6b},
445 	{0x79, 0x00},
446 	{0x7a, 0x85},
447 	{0x7b, 0x00},
448 	{0x7c, 0x9a},
449 	{0x7d, 0x00},
450 	{0x7e, 0xad},
451 	{0x7f, 0x00},
452 	{0x80, 0xbe},
453 	{0x81, 0x00},
454 	{0x82, 0xcd},
455 	{0x83, 0x01},
456 	{0x84, 0x01},
457 	{0x85, 0x01},
458 	{0x86, 0x29},
459 	{0x87, 0x01},
460 	{0x88, 0x68},
461 	{0x89, 0x01},
462 	{0x8a, 0x98},
463 	{0x8b, 0x01},
464 	{0x8c, 0xe5},
465 	{0x8d, 0x02},
466 	{0x8e, 0x1e},
467 	{0x8f, 0x02},
468 	{0x90, 0x30},
469 	{0x91, 0x02},
470 	{0x92, 0x52},
471 	{0x93, 0x02},
472 	{0x94, 0x88},
473 	{0x95, 0x02},
474 	{0x96, 0xaa},
475 	{0x97, 0x02},
476 	{0x98, 0xd7},
477 	{0x99, 0x02},
478 	{0x9a, 0xf7},
479 	{0x9b, 0x03},
480 	{0x9c, 0x21},
481 	{0x9d, 0x03},
482 	{0x9e, 0x2e},
483 	{0x9f, 0x03},
484 	{0xa0, 0x3d},
485 	{0xa2, 0x03},
486 	{0xa3, 0x4c},
487 	{0xa4, 0x03},
488 	{0xa5, 0x5e},
489 	{0xa6, 0x03},
490 	{0xa7, 0x71},
491 	{0xa9, 0x03},
492 	{0xaa, 0x86},
493 	{0xab, 0x03},
494 	{0xac, 0x94},
495 	{0xad, 0x03},
496 	{0xae, 0xfa},
497 	{0xaf, 0x00},
498 	{0xb0, 0x00},
499 	{0xb1, 0x00},
500 	{0xb2, 0x21},
501 	{0xb3, 0x00},
502 	{0xb4, 0x4c},
503 	{0xb5, 0x00},
504 	{0xb6, 0x6b},
505 	{0xb7, 0x00},
506 	{0xb8, 0x85},
507 	{0xb9, 0x00},
508 	{0xba, 0x9a},
509 	{0xbb, 0x00},
510 	{0xbc, 0xad},
511 	{0xbd, 0x00},
512 	{0xbe, 0xbe},
513 	{0xbf, 0x00},
514 	{0xc0, 0xcd},
515 	{0xc1, 0x01},
516 	{0xc2, 0x01},
517 	{0xc3, 0x01},
518 	{0xc4, 0x29},
519 	{0xc5, 0x01},
520 	{0xc6, 0x68},
521 	{0xc7, 0x01},
522 	{0xc8, 0x98},
523 	{0xc9, 0x01},
524 	{0xca, 0xe5},
525 	{0xcb, 0x02},
526 	{0xcc, 0x1e},
527 	{0xcd, 0x02},
528 	{0xce, 0x20},
529 	{0xcf, 0x02},
530 	{0xd0, 0x52},
531 	{0xd1, 0x02},
532 	{0xd2, 0x88},
533 	{0xd3, 0x02},
534 	{0xd4, 0xaa},
535 	{0xd5, 0x02},
536 	{0xd6, 0xd7},
537 	{0xd7, 0x02},
538 	{0xd8, 0xf7},
539 	{0xd9, 0x03},
540 	{0xda, 0x21},
541 	{0xdb, 0x03},
542 	{0xdc, 0x2e},
543 	{0xdd, 0x03},
544 	{0xde, 0x3d},
545 	{0xdf, 0x03},
546 	{0xe0, 0x4c},
547 	{0xe1, 0x03},
548 	{0xe2, 0x5e},
549 	{0xe3, 0x03},
550 	{0xe4, 0x71},
551 	{0xe5, 0x03},
552 	{0xe6, 0x86},
553 	{0xe7, 0x03},
554 	{0xe8, 0x94},
555 	{0xe9, 0x03},
556 	{0xea, 0xfa},
557 	/* Select CMD2 Page0 (Undocumented) */
558 	{0xff, 0x01},
559 	/* Reload CMD1: Don't reload default value to register */
560 	{0xfb, 0x01},
561 	/* Select CMD2 Page1 (Undocumented) */
562 	{0xff, 0x02},
563 	/* Reload CMD1: Don't reload default value to register */
564 	{0xfb, 0x01},
565 	/* Select CMD2 Page3 (Undocumented) */
566 	{0xff, 0x04},
567 	/* Reload CMD1: Don't reload default value to register */
568 	{0xfb, 0x01},
569 	/* Select CMD1 */
570 	{0xff, 0x00},
571 	{0xd3, 0x05}, /* RGBMIPICTRL: VSYNC back porch = 5 */
572 	{0xd4, 0x04}, /* RGBMIPICTRL: VSYNC front porch = 4 */
573 };
574 
575 static inline
576 struct khadas_ts050_panel *to_khadas_ts050_panel(struct drm_panel *panel)
577 {
578 	return container_of(panel, struct khadas_ts050_panel, base);
579 }
580 
581 static int khadas_ts050_panel_prepare(struct drm_panel *panel)
582 {
583 	struct khadas_ts050_panel *khadas_ts050 = to_khadas_ts050_panel(panel);
584 	unsigned int i;
585 	int err;
586 
587 	if (khadas_ts050->prepared)
588 		return 0;
589 
590 	gpiod_set_value_cansleep(khadas_ts050->enable_gpio, 0);
591 
592 	err = regulator_enable(khadas_ts050->supply);
593 	if (err < 0)
594 		return err;
595 
596 	gpiod_set_value_cansleep(khadas_ts050->enable_gpio, 1);
597 
598 	msleep(60);
599 
600 	gpiod_set_value_cansleep(khadas_ts050->reset_gpio, 1);
601 
602 	usleep_range(10000, 11000);
603 
604 	gpiod_set_value_cansleep(khadas_ts050->reset_gpio, 0);
605 
606 	/* Select CMD2 page 4 (Undocumented) */
607 	mipi_dsi_dcs_write(khadas_ts050->link, 0xff, (u8[]){ 0x05 }, 1);
608 
609 	/* Reload CMD1: Don't reload default value to register */
610 	mipi_dsi_dcs_write(khadas_ts050->link, 0xfb, (u8[]){ 0x01 }, 1);
611 
612 	mipi_dsi_dcs_write(khadas_ts050->link, 0xc5, (u8[]){ 0x01 }, 1);
613 
614 	msleep(100);
615 
616 	for (i = 0; i < ARRAY_SIZE(init_code); i++) {
617 		err = mipi_dsi_dcs_write(khadas_ts050->link,
618 					 init_code[i].cmd,
619 					 &init_code[i].data, 1);
620 		if (err < 0) {
621 			dev_err(panel->dev, "failed write cmds: %d\n", err);
622 			goto poweroff;
623 		}
624 	}
625 
626 	err = mipi_dsi_dcs_exit_sleep_mode(khadas_ts050->link);
627 	if (err < 0) {
628 		dev_err(panel->dev, "failed to exit sleep mode: %d\n", err);
629 		goto poweroff;
630 	}
631 
632 	msleep(120);
633 
634 	/* Select CMD1 */
635 	mipi_dsi_dcs_write(khadas_ts050->link, 0xff, (u8[]){ 0x00 }, 1);
636 
637 	err = mipi_dsi_dcs_set_tear_on(khadas_ts050->link,
638 				       MIPI_DSI_DCS_TEAR_MODE_VBLANK);
639 	if (err < 0) {
640 		dev_err(panel->dev, "failed to set tear on: %d\n", err);
641 		goto poweroff;
642 	}
643 
644 	err = mipi_dsi_dcs_set_display_on(khadas_ts050->link);
645 	if (err < 0) {
646 		dev_err(panel->dev, "failed to set display on: %d\n", err);
647 		goto poweroff;
648 	}
649 
650 	usleep_range(10000, 11000);
651 
652 	khadas_ts050->prepared = true;
653 
654 	return 0;
655 
656 poweroff:
657 	gpiod_set_value_cansleep(khadas_ts050->enable_gpio, 0);
658 	gpiod_set_value_cansleep(khadas_ts050->reset_gpio, 1);
659 
660 	regulator_disable(khadas_ts050->supply);
661 
662 	return err;
663 }
664 
665 static int khadas_ts050_panel_unprepare(struct drm_panel *panel)
666 {
667 	struct khadas_ts050_panel *khadas_ts050 = to_khadas_ts050_panel(panel);
668 	int err;
669 
670 	if (!khadas_ts050->prepared)
671 		return 0;
672 
673 	khadas_ts050->prepared = false;
674 
675 	err = mipi_dsi_dcs_enter_sleep_mode(khadas_ts050->link);
676 	if (err < 0)
677 		dev_err(panel->dev, "failed to enter sleep mode: %d\n", err);
678 
679 	msleep(150);
680 
681 	gpiod_set_value_cansleep(khadas_ts050->enable_gpio, 0);
682 	gpiod_set_value_cansleep(khadas_ts050->reset_gpio, 1);
683 
684 	err = regulator_disable(khadas_ts050->supply);
685 	if (err < 0)
686 		return err;
687 
688 	return 0;
689 }
690 
691 static int khadas_ts050_panel_enable(struct drm_panel *panel)
692 {
693 	struct khadas_ts050_panel *khadas_ts050 = to_khadas_ts050_panel(panel);
694 
695 	khadas_ts050->enabled = true;
696 
697 	return 0;
698 }
699 
700 static int khadas_ts050_panel_disable(struct drm_panel *panel)
701 {
702 	struct khadas_ts050_panel *khadas_ts050 = to_khadas_ts050_panel(panel);
703 	int err;
704 
705 	if (!khadas_ts050->enabled)
706 		return 0;
707 
708 	err = mipi_dsi_dcs_set_display_off(khadas_ts050->link);
709 	if (err < 0)
710 		dev_err(panel->dev, "failed to set display off: %d\n", err);
711 
712 	usleep_range(10000, 11000);
713 
714 	khadas_ts050->enabled = false;
715 
716 	return 0;
717 }
718 
719 static const struct drm_display_mode default_mode = {
720 	.clock = 120000,
721 	.hdisplay = 1088,
722 	.hsync_start = 1088 + 104,
723 	.hsync_end = 1088 + 104 + 4,
724 	.htotal = 1088 + 104 + 4 + 127,
725 	.vdisplay = 1920,
726 	.vsync_start = 1920 + 4,
727 	.vsync_end = 1920 + 4 + 2,
728 	.vtotal = 1920 + 4 + 2 + 3,
729 	.flags = DRM_MODE_FLAG_NHSYNC | DRM_MODE_FLAG_NVSYNC,
730 };
731 
732 static int khadas_ts050_panel_get_modes(struct drm_panel *panel,
733 					struct drm_connector *connector)
734 {
735 	struct drm_display_mode *mode;
736 
737 	mode = drm_mode_duplicate(connector->dev, &default_mode);
738 	if (!mode) {
739 		dev_err(panel->dev, "failed to add mode %ux%u@%u\n",
740 			default_mode.hdisplay, default_mode.vdisplay,
741 			drm_mode_vrefresh(&default_mode));
742 		return -ENOMEM;
743 	}
744 
745 	drm_mode_set_name(mode);
746 
747 	drm_mode_probed_add(connector, mode);
748 
749 	connector->display_info.width_mm = 64;
750 	connector->display_info.height_mm = 118;
751 	connector->display_info.bpc = 8;
752 
753 	return 1;
754 }
755 
756 static const struct drm_panel_funcs khadas_ts050_panel_funcs = {
757 	.prepare = khadas_ts050_panel_prepare,
758 	.unprepare = khadas_ts050_panel_unprepare,
759 	.enable = khadas_ts050_panel_enable,
760 	.disable = khadas_ts050_panel_disable,
761 	.get_modes = khadas_ts050_panel_get_modes,
762 };
763 
764 static const struct of_device_id khadas_ts050_of_match[] = {
765 	{ .compatible = "khadas,ts050", },
766 	{ /* sentinel */ }
767 };
768 MODULE_DEVICE_TABLE(of, khadas_ts050_of_match);
769 
770 static int khadas_ts050_panel_add(struct khadas_ts050_panel *khadas_ts050)
771 {
772 	struct device *dev = &khadas_ts050->link->dev;
773 	int err;
774 
775 	khadas_ts050->supply = devm_regulator_get(dev, "power");
776 	if (IS_ERR(khadas_ts050->supply))
777 		return dev_err_probe(dev, PTR_ERR(khadas_ts050->supply),
778 				     "failed to get power supply");
779 
780 	khadas_ts050->reset_gpio = devm_gpiod_get(dev, "reset",
781 						  GPIOD_OUT_LOW);
782 	if (IS_ERR(khadas_ts050->reset_gpio))
783 		return dev_err_probe(dev, PTR_ERR(khadas_ts050->reset_gpio),
784 				     "failed to get reset gpio");
785 
786 	khadas_ts050->enable_gpio = devm_gpiod_get(dev, "enable",
787 						   GPIOD_OUT_HIGH);
788 	if (IS_ERR(khadas_ts050->enable_gpio))
789 		return dev_err_probe(dev, PTR_ERR(khadas_ts050->enable_gpio),
790 				     "failed to get enable gpio");
791 
792 	drm_panel_init(&khadas_ts050->base, &khadas_ts050->link->dev,
793 		       &khadas_ts050_panel_funcs, DRM_MODE_CONNECTOR_DSI);
794 
795 	err = drm_panel_of_backlight(&khadas_ts050->base);
796 	if (err)
797 		return err;
798 
799 	drm_panel_add(&khadas_ts050->base);
800 
801 	return 0;
802 }
803 
804 static int khadas_ts050_panel_probe(struct mipi_dsi_device *dsi)
805 {
806 	struct khadas_ts050_panel *khadas_ts050;
807 	int err;
808 
809 	dsi->lanes = 4;
810 	dsi->format = MIPI_DSI_FMT_RGB888;
811 	dsi->mode_flags = MIPI_DSI_MODE_VIDEO | MIPI_DSI_MODE_VIDEO_BURST |
812 			  MIPI_DSI_MODE_LPM | MIPI_DSI_MODE_EOT_PACKET;
813 
814 	khadas_ts050 = devm_kzalloc(&dsi->dev, sizeof(*khadas_ts050),
815 				    GFP_KERNEL);
816 	if (!khadas_ts050)
817 		return -ENOMEM;
818 
819 	mipi_dsi_set_drvdata(dsi, khadas_ts050);
820 	khadas_ts050->link = dsi;
821 
822 	err = khadas_ts050_panel_add(khadas_ts050);
823 	if (err < 0)
824 		return err;
825 
826 	err = mipi_dsi_attach(dsi);
827 	if (err)
828 		drm_panel_remove(&khadas_ts050->base);
829 
830 	return err;
831 }
832 
833 static int khadas_ts050_panel_remove(struct mipi_dsi_device *dsi)
834 {
835 	struct khadas_ts050_panel *khadas_ts050 = mipi_dsi_get_drvdata(dsi);
836 	int err;
837 
838 	err = mipi_dsi_detach(dsi);
839 	if (err < 0)
840 		dev_err(&dsi->dev, "failed to detach from DSI host: %d\n", err);
841 
842 	drm_panel_remove(&khadas_ts050->base);
843 	drm_panel_disable(&khadas_ts050->base);
844 	drm_panel_unprepare(&khadas_ts050->base);
845 
846 	return 0;
847 }
848 
849 static void khadas_ts050_panel_shutdown(struct mipi_dsi_device *dsi)
850 {
851 	struct khadas_ts050_panel *khadas_ts050 = mipi_dsi_get_drvdata(dsi);
852 
853 	drm_panel_disable(&khadas_ts050->base);
854 	drm_panel_unprepare(&khadas_ts050->base);
855 }
856 
857 static struct mipi_dsi_driver khadas_ts050_panel_driver = {
858 	.driver = {
859 		.name = "panel-khadas-ts050",
860 		.of_match_table = khadas_ts050_of_match,
861 	},
862 	.probe = khadas_ts050_panel_probe,
863 	.remove = khadas_ts050_panel_remove,
864 	.shutdown = khadas_ts050_panel_shutdown,
865 };
866 module_mipi_dsi_driver(khadas_ts050_panel_driver);
867 
868 MODULE_AUTHOR("Neil Armstrong <narmstrong@baylibre.com>");
869 MODULE_DESCRIPTION("Khadas TS050 panel driver");
870 MODULE_LICENSE("GPL v2");
871