98fdeaee7b613cc0d639141e78f5ef38caacc1c2
[firefly-linux-kernel-4.4.55.git] / drivers / video / rockchip / hdmi / rockchip-hdmi-core.c
1 #include <linux/delay.h>
2 #include "rockchip-hdmi.h"
3 #include "rockchip-hdmi-cec.h"
4
5 struct hdmi_delayed_work {
6         struct delayed_work work;
7         struct hdmi *hdmi;
8         int event;
9         void *data;
10 };
11
12 struct hdmi_id_ref_info {
13         struct hdmi *hdmi;
14         int id;
15         int ref;
16 } ref_info[HDMI_MAX_ID];
17
18 static int uboot_vic;
19 static void hdmi_work_queue(struct work_struct *work);
20
21 struct delayed_work *hdmi_submit_work(struct hdmi *hdmi,
22                                       int event, int delay, void *data)
23 {
24         struct hdmi_delayed_work *work;
25
26         DBG("%s event %04x delay %d", __func__, event, delay);
27
28         work = kmalloc(sizeof(*work), GFP_ATOMIC);
29
30         if (work) {
31                 INIT_DELAYED_WORK(&work->work, hdmi_work_queue);
32                 work->hdmi = hdmi;
33                 work->event = event;
34                 work->data = data;
35                 queue_delayed_work(hdmi->workqueue,
36                                    &work->work,
37                                    msecs_to_jiffies(delay));
38         } else {
39                 pr_warn("HDMI: Cannot allocate memory to create work\n");
40                 return 0;
41         }
42
43         return &work->work;
44 }
45
46 static void hdmi_send_uevent(struct hdmi *hdmi, int uevent)
47 {
48         char *envp[3];
49
50         envp[0] = "INTERFACE=HDMI";
51         envp[1] = kmalloc(32, GFP_KERNEL);
52         if (envp[1] == NULL)
53                 return;
54         sprintf(envp[1], "SCREEN=%d", hdmi->ddev->property);
55         envp[2] = NULL;
56         kobject_uevent_env(&hdmi->ddev->dev->kobj, uevent, envp);
57         kfree(envp[1]);
58 }
59
60 static inline void hdmi_wq_set_output(struct hdmi *hdmi, int mute)
61 {
62         DBG("%s mute %d", __func__, mute);
63         if (hdmi->ops->setmute)
64                 hdmi->ops->setmute(hdmi, mute);
65 }
66
67 static inline void hdmi_wq_set_audio(struct hdmi *hdmi)
68 {
69         DBG("%s", __func__);
70         if (hdmi->ops->setaudio)
71                 hdmi->ops->setaudio(hdmi, &hdmi->audio);
72 }
73
74 static void hdmi_wq_set_video(struct hdmi *hdmi)
75 {
76         struct hdmi_video       video;
77
78         DBG("%s", __func__);
79
80         video.vic = hdmi->vic & HDMI_VIC_MASK;
81         video.sink_hdmi = hdmi->edid.sink_hdmi;
82         video.format_3d = hdmi->mode_3d;
83         /* For DVI, output RGB */
84         if (hdmi->edid.sink_hdmi == 0) {
85                 video.color_output = HDMI_COLOR_RGB_0_255;
86         } else {
87                 if (hdmi->colormode == HDMI_COLOR_AUTO) {
88                         if (hdmi->edid.ycbcr444)
89                                 video.color_output = HDMI_COLOR_YCBCR444;
90                         else if (hdmi->edid.ycbcr422)
91                                 video.color_output = HDMI_COLOR_YCBCR422;
92                         else
93                                 video.color_output = HDMI_COLOR_RGB_16_235;
94                 } else {
95                         video.color_output = hdmi->colormode;
96                 }
97         }
98         if ((hdmi->property->feature & SUPPORT_DEEP_10BIT) &&
99             (hdmi->edid.deepcolor & HDMI_DEEP_COLOR_30BITS)) {
100                 if (hdmi->colordepth == HDMI_DEPP_COLOR_AUTO ||
101                     hdmi->colordepth == 10)
102                         video.color_output_depth = 10;
103         } else {
104                 video.color_output_depth = 8;
105         }
106         if (hdmi->vic & HDMI_VIDEO_YUV420)
107                 video.color_output = HDMI_COLOR_YCBCR420;
108         pr_info("hdmi output corlor mode is %d\n", video.color_output);
109         video.color_input = HDMI_COLOR_RGB_0_255;
110         if (hdmi->property->feature & SUPPORT_YCBCR_INPUT) {
111                 if (video.color_output == HDMI_COLOR_YCBCR444 ||
112                     video.color_output == HDMI_COLOR_YCBCR422)
113                         video.color_input = HDMI_COLOR_YCBCR444;
114                 else if (video.color_output == HDMI_COLOR_YCBCR420)
115                         video.color_input = HDMI_COLOR_YCBCR420;
116         }
117         hdmi->colormode_input = video.color_input;
118         hdmi_set_lcdc(hdmi);
119         if (hdmi->ops->setvideo)
120                 hdmi->ops->setvideo(hdmi, &video);
121 }
122
123 static void hdmi_wq_parse_edid(struct hdmi *hdmi)
124 {
125         struct hdmi_edid *pedid;
126         unsigned char *buff = NULL;
127         int rc = HDMI_ERROR_SUCESS, extendblock = 0, i, trytimes;
128
129         if (hdmi == NULL)
130                 return;
131
132         DBG("%s", __func__);
133
134         pedid = &(hdmi->edid);
135         fb_destroy_modelist(&pedid->modelist);
136         memset(pedid, 0, sizeof(struct hdmi_edid));
137         INIT_LIST_HEAD(&pedid->modelist);
138
139         buff = kmalloc(HDMI_EDID_BLOCK_SIZE, GFP_KERNEL);
140         if (buff == NULL) {
141                 dev_err(hdmi->dev,
142                         "[%s] can not allocate memory for edid buff.\n",
143                         __func__);
144                 rc = HDMI_ERROR_FALSE;
145                 goto out;
146         }
147
148         if (hdmi->ops->getedid == NULL) {
149                 rc = HDMI_ERROR_FALSE;
150                 goto out;
151         }
152
153         /* Read base block edid.*/
154         for (trytimes = 0; trytimes < 3; trytimes++) {
155                 if (trytimes)
156                         msleep(50);
157                 memset(buff, 0 , HDMI_EDID_BLOCK_SIZE);
158                 rc = hdmi->ops->getedid(hdmi, 0, buff);
159                 if (rc) {
160                         dev_err(hdmi->dev,
161                                 "[HDMI] read edid base block error\n");
162                         continue;
163                 }
164
165                 rc = hdmi_edid_parse_base(buff, &extendblock, pedid);
166                 if (rc) {
167                         dev_err(hdmi->dev,
168                                 "[HDMI] parse edid base block error\n");
169                         continue;
170                 }
171                 if (!rc)
172                         break;
173         }
174         if (rc)
175                 goto out;
176
177         for (i = 1; i < extendblock + 1; i++) {
178                 for (trytimes = 0; trytimes < 3; trytimes++) {
179                         if (trytimes)
180                                 msleep(20);
181                         memset(buff, 0 , HDMI_EDID_BLOCK_SIZE);
182                         rc = hdmi->ops->getedid(hdmi, i, buff);
183                         if (rc) {
184                                 dev_err(hdmi->dev,
185                                         "[HDMI] read edid block %d error\n",
186                                         i);
187                                 continue;
188                         }
189
190                         rc = hdmi_edid_parse_extensions(buff, pedid);
191                         if (rc) {
192                                 dev_err(hdmi->dev,
193                                         "[HDMI] parse edid block %d error\n",
194                                         i);
195                                 continue;
196                         }
197
198                         if (!rc)
199                                 break;
200                 }
201         }
202 out:
203         kfree(buff);
204         rc = hdmi_ouputmode_select(hdmi, rc);
205 }
206
207 static void hdmi_wq_insert(struct hdmi *hdmi)
208 {
209         DBG("%s", __func__);
210         if (hdmi->ops->insert)
211                 hdmi->ops->insert(hdmi);
212         hdmi_wq_parse_edid(hdmi);
213         if (hdmi->property->feature & SUPPORT_CEC)
214                 rockchip_hdmi_cec_set_pa(hdmi->edid.cecaddress);
215         hdmi_send_uevent(hdmi, KOBJ_ADD);
216         if (hdmi->enable) {
217                 /*hdmi->autoset = 0;*/
218                 hdmi_wq_set_video(hdmi);
219                 #ifdef CONFIG_SWITCH
220                 switch_set_state(&(hdmi->switchdev), 1);
221                 #endif
222                 hdmi_wq_set_audio(hdmi);
223                 hdmi_wq_set_output(hdmi, hdmi->mute);
224                 if (hdmi->ops->hdcp_cb)
225                         hdmi->ops->hdcp_cb(hdmi);
226                 if (hdmi->ops->setcec)
227                         hdmi->ops->setcec(hdmi);
228         }
229         if (hdmi->uboot)
230                 hdmi->uboot = 0;
231 }
232
233 static void hdmi_wq_remove(struct hdmi *hdmi)
234 {
235         struct list_head *pos, *n;
236         struct rk_screen screen;
237
238         DBG("%s", __func__);
239         if (hdmi->ops->remove)
240                 hdmi->ops->remove(hdmi);
241         if (hdmi->hotplug == HDMI_HPD_ACTIVED) {
242                 screen.type = SCREEN_HDMI;
243                 rk_fb_switch_screen(&screen, 0, hdmi->lcdc->id);
244         }
245         #ifdef CONFIG_SWITCH
246         switch_set_state(&(hdmi->switchdev), 0);
247         #endif
248         list_for_each_safe(pos, n, &hdmi->edid.modelist) {
249                 list_del(pos);
250                 kfree(pos);
251         }
252         kfree(hdmi->edid.audio);
253         if (hdmi->edid.specs) {
254                 kfree(hdmi->edid.specs->modedb);
255                 kfree(hdmi->edid.specs);
256         }
257         memset(&hdmi->edid, 0, sizeof(struct hdmi_edid));
258         hdmi_init_modelist(hdmi);
259         hdmi->mute      = HDMI_AV_UNMUTE;
260         hdmi->mode_3d = HDMI_3D_NONE;
261         hdmi->uboot = 0;
262         hdmi->hotplug = HDMI_HPD_REMOVED;
263         hdmi_send_uevent(hdmi, KOBJ_REMOVE);
264 }
265
266 static void hdmi_work_queue(struct work_struct *work)
267 {
268         struct hdmi_delayed_work *hdmi_w =
269                 container_of(work, struct hdmi_delayed_work, work.work);
270         struct hdmi *hdmi = hdmi_w->hdmi;
271         int event = hdmi_w->event;
272         int hpd = HDMI_HPD_REMOVED;
273
274         mutex_lock(&hdmi->lock);
275
276         DBG("\nhdmi_work_queue() - evt= %x %d\n",
277             (event & 0xFF00) >> 8,
278             event & 0xFF);
279
280         switch (event) {
281         case HDMI_ENABLE_CTL:
282                 if (!hdmi->enable) {
283                         hdmi->enable = 1;
284                         if (!hdmi->sleep) {
285                                 if (hdmi->ops->enable)
286                                         hdmi->ops->enable(hdmi);
287                                 if (hdmi->hotplug == HDMI_HPD_ACTIVED)
288                                         hdmi_wq_insert(hdmi);
289                         }
290                 }
291                 break;
292         case HDMI_RESUME_CTL:
293                 if (hdmi->sleep) {
294                         if (hdmi->ops->enable)
295                                 hdmi->ops->enable(hdmi);
296                         hdmi->sleep = 0;
297                 }
298                 break;
299         case HDMI_DISABLE_CTL:
300                 if (hdmi->enable) {
301                         if (!hdmi->sleep) {
302                                 if (hdmi->ops->disable)
303                                         hdmi->ops->disable(hdmi);
304                                 hdmi_wq_remove(hdmi);
305                         }
306                         hdmi->enable = 0;
307                 }
308                 break;
309         case HDMI_SUSPEND_CTL:
310                 if (!hdmi->sleep) {
311                         hdmi_wq_set_output(hdmi,
312                                            HDMI_VIDEO_MUTE | HDMI_AUDIO_MUTE);
313                         if (hdmi->ops->disable)
314                                 hdmi->ops->disable(hdmi);
315                         if (hdmi->enable)
316                                 hdmi_wq_remove(hdmi);
317                         hdmi->sleep = 1;
318                 }
319                 break;
320         case HDMI_HPD_CHANGE:
321                 if (hdmi->ops->getstatus)
322                         hpd = hdmi->ops->getstatus(hdmi);
323                 DBG("hdmi_work_queue() - hpd is %d hotplug is %d",
324                     hpd, hdmi->hotplug);
325                 if (hpd != hdmi->hotplug) {
326                         if (hpd == HDMI_HPD_ACTIVED) {
327                                 hdmi->hotplug = hpd;
328                                 hdmi_wq_insert(hdmi);
329                         } else if (hdmi->hotplug == HDMI_HPD_ACTIVED) {
330                                 hdmi_wq_remove(hdmi);
331                         }
332                         hdmi->hotplug = hpd;
333                 }
334                 break;
335         case HDMI_SET_VIDEO:
336                 if (hdmi->enable && !hdmi->sleep) {
337                         hdmi_wq_set_output(hdmi,
338                                            HDMI_VIDEO_MUTE | HDMI_AUDIO_MUTE);
339                         if (rk_fb_get_display_policy() == DISPLAY_POLICY_BOX)
340                                 msleep(2000);
341                         else
342                                 msleep(1000);
343                         hdmi_wq_set_video(hdmi);
344                         hdmi_send_uevent(hdmi, KOBJ_CHANGE);
345                         hdmi_wq_set_audio(hdmi);
346                         hdmi_wq_set_output(hdmi, hdmi->mute);
347                         if (hdmi->ops->hdcp_cb)
348                                 hdmi->ops->hdcp_cb(hdmi);
349                 }
350                 break;
351         case HDMI_SET_AUDIO:
352                 if ((hdmi->mute & HDMI_AUDIO_MUTE) == 0 &&
353                     hdmi->enable && !hdmi->sleep) {
354                         hdmi_wq_set_output(hdmi, HDMI_AUDIO_MUTE);
355                         hdmi_wq_set_audio(hdmi);
356                         hdmi_wq_set_output(hdmi, hdmi->mute);
357                 }
358                 break;
359         case HDMI_MUTE_AUDIO:
360         case HDMI_UNMUTE_AUDIO:
361                 if (hdmi->mute & HDMI_AUDIO_MUTE ||
362                     !hdmi->enable || hdmi->sleep ||
363                     hdmi->hotplug != HDMI_HPD_ACTIVED)
364                         break;
365                 if (event == HDMI_MUTE_AUDIO)
366                         hdmi_wq_set_output(hdmi, hdmi->mute |
367                                            HDMI_AUDIO_MUTE);
368                 else
369                         hdmi_wq_set_output(hdmi,
370                                            hdmi->mute & (~HDMI_AUDIO_MUTE));
371                 break;
372         case HDMI_SET_3D:
373                 if (hdmi->ops->setvsi) {
374                         if (hdmi->mode_3d != HDMI_3D_NONE)
375                                 hdmi->ops->setvsi(hdmi, hdmi->mode_3d,
376                                                   HDMI_VIDEO_FORMAT_3D);
377                         else if ((hdmi->vic & HDMI_TYPE_MASK) == 0)
378                                 hdmi->ops->setvsi(hdmi, hdmi->vic,
379                                                   HDMI_VIDEO_FORMAT_NORMAL);
380                 }
381                 break;
382         case HDMI_SET_COLOR:
383                 hdmi_wq_set_output(hdmi,
384                                    HDMI_VIDEO_MUTE | HDMI_AUDIO_MUTE);
385                 msleep(100);
386                 hdmi_wq_set_video(hdmi);
387                 hdmi_wq_set_output(hdmi, hdmi->mute);
388                 break;
389         case HDMI_ENABLE_HDCP:
390                 if (hdmi->hotplug == HDMI_HPD_ACTIVED && hdmi->ops->hdcp_cb)
391                         hdmi->ops->hdcp_cb(hdmi);
392                 break;
393         default:
394                 pr_err("HDMI: hdmi_work_queue() unkown event\n");
395                 break;
396         }
397
398         kfree(hdmi_w->data);
399         kfree(hdmi_w);
400
401         DBG("\nhdmi_work_queue() - exit evt= %x %d\n",
402             (event & 0xFF00) >> 8,
403             event & 0xFF);
404         mutex_unlock(&hdmi->lock);
405 }
406
407 struct hdmi *rockchip_hdmi_register(struct hdmi_property *property,
408                                     struct hdmi_ops *ops)
409 {
410         struct hdmi *hdmi;
411         char name[32];
412         int i;
413
414         if (property == NULL || ops == NULL) {
415                 pr_err("HDMI: %s invalid parameter\n", __func__);
416                 return NULL;
417         }
418
419         for (i = 0; i < HDMI_MAX_ID; i++) {
420                 if (ref_info[i].ref == 0)
421                         break;
422         }
423         if (i == HDMI_MAX_ID)
424                 return NULL;
425
426         DBG("hdmi_register() - video source %d display %d",
427             property->videosrc,  property->display);
428
429         hdmi = kmalloc(sizeof(*hdmi), GFP_KERNEL);
430         if (!hdmi) {
431                 pr_err("HDMI: no memory to allocate hdmi device.\n");
432                 return NULL;
433         }
434         memset(hdmi, 0, sizeof(struct hdmi));
435         mutex_init(&hdmi->lock);
436
437         hdmi->property = property;
438         hdmi->ops = ops;
439         hdmi->enable = false;
440         hdmi->mute = HDMI_AV_UNMUTE;
441         hdmi->hotplug = HDMI_HPD_REMOVED;
442         hdmi->autoset = HDMI_AUTO_CONFIG;
443         if (uboot_vic > 0) {
444                 hdmi->vic = uboot_vic;
445                 hdmi->uboot = 1;
446                 hdmi->autoset = 0;
447         } else if (hdmi->autoset) {
448                 hdmi->vic = 0;
449         } else {
450                 hdmi->vic = hdmi->property->defaultmode;
451         }
452         hdmi->colormode = HDMI_VIDEO_DEFAULT_COLORMODE;
453         hdmi->colordepth = HDMI_DEPP_COLOR_AUTO;
454         hdmi->mode_3d = HDMI_3D_NONE;
455         hdmi->audio.type = HDMI_AUDIO_DEFAULT_TYPE;
456         hdmi->audio.channel = HDMI_AUDIO_DEFAULT_CHANNEL;
457         hdmi->audio.rate = HDMI_AUDIO_DEFAULT_RATE;
458         hdmi->audio.word_length = HDMI_AUDIO_DEFAULT_WORDLENGTH;
459         hdmi->xscale = 100;
460         hdmi->yscale = 100;
461         hdmi_init_modelist(hdmi);
462
463 #ifndef CONFIG_ARCH_RK29
464         if (hdmi->property->videosrc == DISPLAY_SOURCE_LCDC0)
465                 hdmi->lcdc = rk_get_lcdc_drv("lcdc0");
466         else
467                 hdmi->lcdc = rk_get_lcdc_drv("lcdc1");
468 #endif
469         memset(name, 0, 32);
470         sprintf(name, "hdmi-%s", hdmi->property->name);
471         hdmi->workqueue = create_singlethread_workqueue(name);
472         if (hdmi->workqueue == NULL) {
473                 pr_err("HDMI,: create workqueue failed.\n");
474                 goto err_create_wq;
475         }
476         hdmi->ddev = hdmi_register_display_sysfs(hdmi, NULL);
477         if (hdmi->ddev == NULL) {
478                 pr_err("HDMI : register display sysfs failed.\n");
479                 goto err_register_display;
480         }
481         hdmi->id = i;
482         #ifdef CONFIG_SWITCH
483         if (hdmi->id == 0) {
484                 hdmi->switchdev.name = "hdmi";
485         } else {
486                 hdmi->switchdev.name = kzalloc(32, GFP_KERNEL);
487                 memset((char *)hdmi->switchdev.name, 0, 32);
488                 sprintf((char *)hdmi->switchdev.name, "hdmi%d", hdmi->id);
489         }
490         switch_dev_register(&(hdmi->switchdev));
491         #endif
492
493         ref_info[i].hdmi = hdmi;
494         ref_info[i].ref = 1;
495         return hdmi;
496
497 err_register_display:
498         destroy_workqueue(hdmi->workqueue);
499 err_create_wq:
500         kfree(hdmi);
501         return NULL;
502 }
503
504 void rockchip_hdmi_unregister(struct hdmi *hdmi)
505 {
506         if (hdmi) {
507                 flush_workqueue(hdmi->workqueue);
508                 destroy_workqueue(hdmi->workqueue);
509                 #ifdef CONFIG_SWITCH
510                 switch_dev_unregister(&(hdmi->switchdev));
511                 #endif
512                 hdmi_unregister_display_sysfs(hdmi);
513                 fb_destroy_modelist(&hdmi->edid.modelist);
514                 kfree(hdmi->edid.audio);
515                 if (hdmi->edid.specs) {
516                         kfree(hdmi->edid.specs->modedb);
517                         kfree(hdmi->edid.specs);
518                 }
519                 kfree(hdmi);
520
521                 ref_info[hdmi->id].ref = 0;
522                 ref_info[hdmi->id].hdmi = NULL;
523
524                 hdmi = NULL;
525         }
526 }
527
528 int hdmi_get_hotplug(void)
529 {
530         if (ref_info[0].hdmi)
531                 return ref_info[0].hdmi->hotplug;
532         else
533                 return HDMI_HPD_REMOVED;
534 }
535
536 int hdmi_config_audio(struct hdmi_audio *audio)
537 {
538         int i;
539         struct hdmi *hdmi;
540
541         if (audio == NULL)
542                 return HDMI_ERROR_FALSE;
543
544         for (i = 0; i < HDMI_MAX_ID; i++) {
545                 if (ref_info[i].ref == 0)
546                         continue;
547                 hdmi = ref_info[i].hdmi;
548
549                 /*
550                 if (memcmp(audio, &hdmi->audio, sizeof(struct hdmi_audio)) == 0)
551                         continue;
552                 */
553                 /*for (j = 0; j < hdmi->edid.audio_num; j++) {
554                         if (audio->type == hdmi->edid.audio_num)
555                                 break;
556                 }*/
557
558                 /*if ( (j == hdmi->edid.audio_num) ||
559                         (audio->channel > hdmi->edid.audio[j].channel) ||
560                         ((audio->rate & hdmi->edid.audio[j].rate) == 0)||
561                         ((audio->type == HDMI_AUDIO_LPCM) &&
562                         ((audio->word_length &
563                           hdmi->edid.audio[j].word_length) == 0)) ) {
564                         pr_warn("[%s] warning : input audio type
565                                 not supported in hdmi sink\n", __func__);
566                         continue;
567                 }*/
568                 memcpy(&hdmi->audio, audio, sizeof(struct hdmi_audio));
569                 hdmi_submit_work(hdmi, HDMI_SET_AUDIO, 0, NULL);
570         }
571         return 0;
572 }
573
574 void hdmi_audio_mute(int mute)
575 {
576         int i;
577         struct hdmi *hdmi;
578
579         for (i = 0; i < HDMI_MAX_ID; i++) {
580                 if (ref_info[i].ref == 0)
581                         continue;
582                 hdmi = ref_info[i].hdmi;
583
584                 if (mute)
585                         hdmi_submit_work(hdmi, HDMI_MUTE_AUDIO, 0, NULL);
586                 else
587                         hdmi_submit_work(hdmi, HDMI_UNMUTE_AUDIO, 0, NULL);
588         }
589 }
590
591 static int __init bootloader_setup(char *str)
592 {
593         if (str) {
594                 pr_info("hdmi init vic is %s\n", str);
595                 if (kstrtoint(str, 0, &uboot_vic) < 0)
596                         uboot_vic = 0;
597         }
598         return 0;
599 }
600
601 early_param("hdmi.vic", bootloader_setup);
602
603 static int __init hdmi_class_init(void)
604 {
605         int i;
606
607         for (i = 0; i < HDMI_MAX_ID; i++) {
608                 ref_info[i].id = i;
609                 ref_info[i].ref = 0;
610                 ref_info[i].hdmi = NULL;
611         }
612         pr_info("Rockchip hdmi driver version 2.0\n.");
613         return 0;
614 }
615
616 subsys_initcall(hdmi_class_init);