26ab7723b8bc993ca59aa40e01faba91747784d5
[cascardo/linux.git] / drivers / gpu / drm / exynos / exynos_drm_vidi.c
1 /* exynos_drm_vidi.c
2  *
3  * Copyright (C) 2012 Samsung Electronics Co.Ltd
4  * Authors:
5  *      Inki Dae <inki.dae@samsung.com>
6  *
7  * This program is free software; you can redistribute  it and/or modify it
8  * under  the terms of  the GNU General  Public License as published by the
9  * Free Software Foundation;  either version 2 of the  License, or (at your
10  * option) any later version.
11  *
12  */
13 #include "drmP.h"
14
15 #include <linux/kernel.h>
16 #include <linux/module.h>
17 #include <linux/platform_device.h>
18
19 #include <drm/exynos_drm.h>
20
21 #include "drm_edid.h"
22 #include "drm_crtc_helper.h"
23
24 #include "exynos_drm_drv.h"
25 #include "exynos_drm_crtc.h"
26 #include "exynos_drm_encoder.h"
27
28 /* vidi has totally three virtual windows. */
29 #define WINDOWS_NR              3
30
31 #define get_vidi_context(dev)   platform_get_drvdata(to_platform_device(dev))
32
33 struct vidi_win_data {
34         unsigned int            offset_x;
35         unsigned int            offset_y;
36         unsigned int            ovl_width;
37         unsigned int            ovl_height;
38         unsigned int            fb_width;
39         unsigned int            fb_height;
40         unsigned int            bpp;
41         dma_addr_t              dma_addr;
42         void __iomem            *vaddr;
43         unsigned int            buf_offsize;
44         unsigned int            line_size;      /* bytes */
45         bool                    enabled;
46 };
47
48 struct vidi_context {
49         struct exynos_drm_subdrv        subdrv;
50         struct drm_crtc                 *crtc;
51         struct vidi_win_data            win_data[WINDOWS_NR];
52         struct edid                     *raw_edid;
53         unsigned int                    clkdiv;
54         unsigned int                    default_win;
55         unsigned long                   irq_flags;
56         unsigned int                    connected;
57         bool                            vblank_on;
58         bool                            suspended;
59         struct work_struct              work;
60         struct mutex                    lock;
61 };
62
63 static const char fake_edid_info[] = {
64         0x00, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0x00, 0x4c, 0x2d, 0x05, 0x05,
65         0x00, 0x00, 0x00, 0x00, 0x30, 0x12, 0x01, 0x03, 0x80, 0x10, 0x09, 0x78,
66         0x0a, 0xee, 0x91, 0xa3, 0x54, 0x4c, 0x99, 0x26, 0x0f, 0x50, 0x54, 0xbd,
67         0xee, 0x00, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01,
68         0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x66, 0x21, 0x50, 0xb0, 0x51, 0x00,
69         0x1b, 0x30, 0x40, 0x70, 0x36, 0x00, 0xa0, 0x5a, 0x00, 0x00, 0x00, 0x1e,
70         0x01, 0x1d, 0x00, 0x72, 0x51, 0xd0, 0x1e, 0x20, 0x6e, 0x28, 0x55, 0x00,
71         0xa0, 0x5a, 0x00, 0x00, 0x00, 0x1e, 0x00, 0x00, 0x00, 0xfd, 0x00, 0x18,
72         0x4b, 0x1a, 0x44, 0x17, 0x00, 0x0a, 0x20, 0x20, 0x20, 0x20, 0x20, 0x20,
73         0x00, 0x00, 0x00, 0xfc, 0x00, 0x53, 0x41, 0x4d, 0x53, 0x55, 0x4e, 0x47,
74         0x0a, 0x20, 0x20, 0x20, 0x20, 0x20, 0x01, 0xbc, 0x02, 0x03, 0x1e, 0xf1,
75         0x46, 0x84, 0x05, 0x03, 0x10, 0x20, 0x22, 0x23, 0x09, 0x07, 0x07, 0x83,
76         0x01, 0x00, 0x00, 0xe2, 0x00, 0x0f, 0x67, 0x03, 0x0c, 0x00, 0x10, 0x00,
77         0xb8, 0x2d, 0x01, 0x1d, 0x80, 0x18, 0x71, 0x1c, 0x16, 0x20, 0x58, 0x2c,
78         0x25, 0x00, 0xa0, 0x5a, 0x00, 0x00, 0x00, 0x9e, 0x8c, 0x0a, 0xd0, 0x8a,
79         0x20, 0xe0, 0x2d, 0x10, 0x10, 0x3e, 0x96, 0x00, 0xa0, 0x5a, 0x00, 0x00,
80         0x00, 0x18, 0x02, 0x3a, 0x80, 0x18, 0x71, 0x38, 0x2d, 0x40, 0x58, 0x2c,
81         0x45, 0x00, 0xa0, 0x5a, 0x00, 0x00, 0x00, 0x1e, 0x00, 0x00, 0x00, 0x00,
82         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
83         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
84         0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
85         0x00, 0x00, 0x00, 0x06
86 };
87
88 static void vidi_fake_vblank_handler(struct work_struct *work);
89
90 static bool vidi_display_is_connected(struct device *dev)
91 {
92         struct vidi_context *ctx = get_vidi_context(dev);
93
94         DRM_DEBUG_KMS("%s\n", __FILE__);
95
96         /*
97          * connection request would come from user side
98          * to do hotplug through specific ioctl.
99          */
100         return ctx->connected ? true : false;
101 }
102
103 static int vidi_get_edid(struct device *dev, struct drm_connector *connector,
104                                 u8 *edid, int len)
105 {
106         struct vidi_context *ctx = get_vidi_context(dev);
107         struct edid *raw_edid;
108
109         DRM_DEBUG_KMS("%s\n", __FILE__);
110
111         /*
112          * the edid data comes from user side and it would be set
113          * to ctx->raw_edid through specific ioctl.
114          */
115         if (!ctx->raw_edid) {
116                 DRM_DEBUG_KMS("raw_edid is null.\n");
117                 return -EFAULT;
118         }
119
120         raw_edid = kzalloc(len, GFP_KERNEL);
121         if (!raw_edid) {
122                 DRM_DEBUG_KMS("failed to allocate raw_edid.\n");
123                 return -ENOMEM;
124         }
125
126         memcpy(raw_edid, ctx->raw_edid, min((1 + ctx->raw_edid->extensions)
127                                                 * EDID_LENGTH, len));
128
129         /* attach the edid data to connector. */
130         connector->display_info.raw_edid = (char *)raw_edid;
131
132         memcpy(edid, ctx->raw_edid, min((1 + ctx->raw_edid->extensions)
133                                         * EDID_LENGTH, len));
134
135         return 0;
136 }
137
138 static void *vidi_get_panel(struct device *dev)
139 {
140         DRM_DEBUG_KMS("%s\n", __FILE__);
141
142         /* TODO. */
143
144         return NULL;
145 }
146
147 static int vidi_check_timing(struct device *dev, void *timing)
148 {
149         DRM_DEBUG_KMS("%s\n", __FILE__);
150
151         /* TODO. */
152
153         return 0;
154 }
155
156 static int vidi_display_power_on(struct device *dev, int mode)
157 {
158         DRM_DEBUG_KMS("%s\n", __FILE__);
159
160         /* TODO */
161
162         return 0;
163 }
164
165 static struct exynos_drm_display_ops vidi_display_ops = {
166         .type = EXYNOS_DISPLAY_TYPE_VIDI,
167         .is_connected = vidi_display_is_connected,
168         .get_edid = vidi_get_edid,
169         .get_panel = vidi_get_panel,
170         .check_timing = vidi_check_timing,
171         .power_on = vidi_display_power_on,
172 };
173
174 static void vidi_dpms(struct device *subdrv_dev, int mode)
175 {
176         struct vidi_context *ctx = get_vidi_context(subdrv_dev);
177
178         DRM_DEBUG_KMS("%s, %d\n", __FILE__, mode);
179
180         mutex_lock(&ctx->lock);
181
182         switch (mode) {
183         case DRM_MODE_DPMS_ON:
184                 /* TODO. */
185                 break;
186         case DRM_MODE_DPMS_STANDBY:
187         case DRM_MODE_DPMS_SUSPEND:
188         case DRM_MODE_DPMS_OFF:
189                 /* TODO. */
190                 break;
191         default:
192                 DRM_DEBUG_KMS("unspecified mode %d\n", mode);
193                 break;
194         }
195
196         mutex_unlock(&ctx->lock);
197 }
198
199 static void vidi_apply(struct device *subdrv_dev)
200 {
201         struct vidi_context *ctx = get_vidi_context(subdrv_dev);
202         struct exynos_drm_manager *mgr = ctx->subdrv.manager;
203         struct exynos_drm_manager_ops *mgr_ops = mgr->ops;
204         struct exynos_drm_overlay_ops *ovl_ops = mgr->overlay_ops;
205         struct vidi_win_data *win_data;
206         int i;
207
208         DRM_DEBUG_KMS("%s\n", __FILE__);
209
210         for (i = 0; i < WINDOWS_NR; i++) {
211                 win_data = &ctx->win_data[i];
212                 if (win_data->enabled && (ovl_ops && ovl_ops->commit))
213                         ovl_ops->commit(subdrv_dev, i);
214         }
215
216         if (mgr_ops && mgr_ops->commit)
217                 mgr_ops->commit(subdrv_dev);
218 }
219
220 static void vidi_commit(struct device *dev)
221 {
222         struct vidi_context *ctx = get_vidi_context(dev);
223
224         DRM_DEBUG_KMS("%s\n", __FILE__);
225
226         if (ctx->suspended)
227                 return;
228 }
229
230 static int vidi_enable_vblank(struct device *dev)
231 {
232         struct vidi_context *ctx = get_vidi_context(dev);
233
234         DRM_DEBUG_KMS("%s\n", __FILE__);
235
236         if (ctx->suspended)
237                 return -EPERM;
238
239         if (!test_and_set_bit(0, &ctx->irq_flags))
240                 ctx->vblank_on = true;
241
242         return 0;
243 }
244
245 static void vidi_disable_vblank(struct device *dev)
246 {
247         struct vidi_context *ctx = get_vidi_context(dev);
248
249         DRM_DEBUG_KMS("%s\n", __FILE__);
250
251         if (ctx->suspended)
252                 return;
253
254         if (test_and_clear_bit(0, &ctx->irq_flags))
255                 ctx->vblank_on = false;
256 }
257
258 static struct exynos_drm_manager_ops vidi_manager_ops = {
259         .dpms = vidi_dpms,
260         .apply = vidi_apply,
261         .commit = vidi_commit,
262         .enable_vblank = vidi_enable_vblank,
263         .disable_vblank = vidi_disable_vblank,
264 };
265
266 static void vidi_win_mode_set(struct device *dev,
267                               struct exynos_drm_overlay *overlay)
268 {
269         struct vidi_context *ctx = get_vidi_context(dev);
270         struct vidi_win_data *win_data;
271         int win;
272         unsigned long offset;
273
274         DRM_DEBUG_KMS("%s\n", __FILE__);
275
276         if (!overlay) {
277                 dev_err(dev, "overlay is NULL\n");
278                 return;
279         }
280
281         win = overlay->zpos;
282         if (win == DEFAULT_ZPOS)
283                 win = ctx->default_win;
284
285         if (win < 0 || win > WINDOWS_NR)
286                 return;
287
288         offset = overlay->fb_x * (overlay->bpp >> 3);
289         offset += overlay->fb_y * overlay->fb_pitch;
290
291         DRM_DEBUG_KMS("offset = 0x%lx, fb_pitch = %x\n", offset,
292                         overlay->fb_pitch);
293
294         win_data = &ctx->win_data[win];
295
296         win_data->offset_x = overlay->crtc_x;
297         win_data->offset_y = overlay->crtc_y;
298         win_data->ovl_width = overlay->crtc_width;
299         win_data->ovl_height = overlay->crtc_height;
300         win_data->fb_width = overlay->fb_width;
301         win_data->fb_height = overlay->fb_height;
302         win_data->dma_addr = overlay->dma_addr[0] + offset;
303         win_data->vaddr = overlay->vaddr[0] + offset;
304         win_data->bpp = overlay->bpp;
305         win_data->buf_offsize = (overlay->fb_width - overlay->crtc_width) *
306                                 (overlay->bpp >> 3);
307         win_data->line_size = overlay->crtc_width * (overlay->bpp >> 3);
308
309         /*
310          * some parts of win_data should be transferred to user side
311          * through specific ioctl.
312          */
313
314         DRM_DEBUG_KMS("offset_x = %d, offset_y = %d\n",
315                         win_data->offset_x, win_data->offset_y);
316         DRM_DEBUG_KMS("ovl_width = %d, ovl_height = %d\n",
317                         win_data->ovl_width, win_data->ovl_height);
318         DRM_DEBUG_KMS("paddr = 0x%lx, vaddr = 0x%lx\n",
319                         (unsigned long)win_data->dma_addr,
320                         (unsigned long)win_data->vaddr);
321         DRM_DEBUG_KMS("fb_width = %d, crtc_width = %d\n",
322                         overlay->fb_width, overlay->crtc_width);
323 }
324
325 static void vidi_win_commit(struct device *dev, int zpos)
326 {
327         struct vidi_context *ctx = get_vidi_context(dev);
328         struct vidi_win_data *win_data;
329         int win = zpos;
330
331         DRM_DEBUG_KMS("%s\n", __FILE__);
332
333         if (ctx->suspended)
334                 return;
335
336         if (win == DEFAULT_ZPOS)
337                 win = ctx->default_win;
338
339         if (win < 0 || win > WINDOWS_NR)
340                 return;
341
342         win_data = &ctx->win_data[win];
343
344         win_data->enabled = true;
345
346         DRM_DEBUG_KMS("dma_addr = 0x%x\n", win_data->dma_addr);
347
348         if (ctx->vblank_on)
349                 schedule_work(&ctx->work);
350 }
351
352 static void vidi_win_disable(struct device *dev, int zpos)
353 {
354         struct vidi_context *ctx = get_vidi_context(dev);
355         struct vidi_win_data *win_data;
356         int win = zpos;
357
358         DRM_DEBUG_KMS("%s\n", __FILE__);
359
360         if (win == DEFAULT_ZPOS)
361                 win = ctx->default_win;
362
363         if (win < 0 || win > WINDOWS_NR)
364                 return;
365
366         win_data = &ctx->win_data[win];
367         win_data->enabled = false;
368
369         /* TODO. */
370 }
371
372 static struct exynos_drm_overlay_ops vidi_overlay_ops = {
373         .mode_set = vidi_win_mode_set,
374         .commit = vidi_win_commit,
375         .disable = vidi_win_disable,
376 };
377
378 static struct exynos_drm_manager vidi_manager = {
379         .pipe           = -1,
380         .ops            = &vidi_manager_ops,
381         .overlay_ops    = &vidi_overlay_ops,
382         .display_ops    = &vidi_display_ops,
383 };
384
385 static void vidi_fake_vblank_handler(struct work_struct *work)
386 {
387         struct vidi_context *ctx = container_of(work, struct vidi_context,
388                                         work);
389         struct exynos_drm_subdrv *subdrv = &ctx->subdrv;
390         struct exynos_drm_manager *manager = subdrv->manager;
391
392         if (manager->pipe < 0)
393                 return;
394
395         /* refresh rate is about 50Hz. */
396         usleep_range(16000, 20000);
397
398         drm_handle_vblank(subdrv->drm_dev, manager->pipe);
399         exynos_drm_crtc_finish_pageflip(subdrv->drm_dev, manager->pipe);
400 }
401
402 static int vidi_subdrv_probe(struct drm_device *drm_dev, struct device *dev)
403 {
404         DRM_DEBUG_KMS("%s\n", __FILE__);
405
406         /*
407          * enable drm irq mode.
408          * - with irq_enabled = 1, we can use the vblank feature.
409          *
410          * P.S. note that we wouldn't use drm irq handler but
411          *      just specific driver own one instead because
412          *      drm framework supports only one irq handler.
413          */
414         drm_dev->irq_enabled = 1;
415
416         /*
417          * with vblank_disable_allowed = 1, vblank interrupt will be disabled
418          * by drm timer once a current process gives up ownership of
419          * vblank event.(after drm_vblank_put function is called)
420          */
421         drm_dev->vblank_disable_allowed = 1;
422
423         return 0;
424 }
425
426 static void vidi_subdrv_remove(struct drm_device *drm_dev)
427 {
428         DRM_DEBUG_KMS("%s\n", __FILE__);
429
430         /* TODO. */
431 }
432
433 static int vidi_power_on(struct vidi_context *ctx, bool enable)
434 {
435         struct exynos_drm_subdrv *subdrv = &ctx->subdrv;
436         struct device *dev = subdrv->dev;
437
438         DRM_DEBUG_KMS("%s\n", __FILE__);
439
440         if (enable != false && enable != true)
441                 return -EINVAL;
442
443         if (enable) {
444                 ctx->suspended = false;
445
446                 /* if vblank was enabled status, enable it again. */
447                 if (test_and_clear_bit(0, &ctx->irq_flags))
448                         vidi_enable_vblank(dev);
449
450                 vidi_apply(dev);
451         } else {
452                 ctx->suspended = true;
453         }
454
455         return 0;
456 }
457
458 static int vidi_show_connection(struct device *dev,
459                                 struct device_attribute *attr, char *buf)
460 {
461         int rc;
462         struct vidi_context *ctx = get_vidi_context(dev);
463
464         mutex_lock(&ctx->lock);
465
466         rc = sprintf(buf, "%d\n", ctx->connected);
467
468         mutex_unlock(&ctx->lock);
469
470         return rc;
471 }
472
473 static int vidi_store_connection(struct device *dev,
474                                 struct device_attribute *attr,
475                                 const char *buf, size_t len)
476 {
477         struct vidi_context *ctx = get_vidi_context(dev);
478         int ret;
479
480         DRM_DEBUG_KMS("%s\n", __FILE__);
481
482         ret = kstrtoint(buf, 0, &ctx->connected);
483         if (ret)
484                 return ret;
485
486         if (ctx->connected > 1)
487                 return -EINVAL;
488
489         DRM_DEBUG_KMS("requested connection.\n");
490
491         drm_helper_hpd_irq_event(ctx->subdrv.drm_dev);
492
493         return len;
494 }
495
496 static DEVICE_ATTR(connection, 0644, vidi_show_connection,
497                         vidi_store_connection);
498
499 int vidi_connection_ioctl(struct drm_device *drm_dev, void *data,
500                                 struct drm_file *file_priv)
501 {
502         struct vidi_context *ctx = NULL;
503         struct drm_encoder *encoder;
504         struct exynos_drm_manager *manager;
505         struct exynos_drm_display_ops *display_ops;
506         struct drm_exynos_vidi_connection *vidi = data;
507
508         DRM_DEBUG_KMS("%s\n", __FILE__);
509
510         if (!vidi) {
511                 DRM_DEBUG_KMS("user data for vidi is null.\n");
512                 return -EINVAL;
513         }
514
515         if (!vidi->edid) {
516                 DRM_DEBUG_KMS("edid data is null.\n");
517                 return -EINVAL;
518         }
519
520         if (vidi->connection > 1) {
521                 DRM_DEBUG_KMS("connection should be 0 or 1.\n");
522                 return -EINVAL;
523         }
524
525         list_for_each_entry(encoder, &drm_dev->mode_config.encoder_list,
526                                                                 head) {
527                 manager = exynos_drm_get_manager(encoder);
528                 display_ops = manager->display_ops;
529
530                 if (display_ops->type == EXYNOS_DISPLAY_TYPE_VIDI) {
531                         ctx = get_vidi_context(manager->dev);
532                         break;
533                 }
534         }
535
536         if (!ctx) {
537                 DRM_DEBUG_KMS("not found virtual device type encoder.\n");
538                 return -EINVAL;
539         }
540
541         if (ctx->connected == vidi->connection) {
542                 DRM_DEBUG_KMS("same connection request.\n");
543                 return -EINVAL;
544         }
545
546         if (vidi->connection)
547                 ctx->raw_edid = (struct edid *)vidi->edid;
548
549         ctx->connected = vidi->connection;
550         drm_helper_hpd_irq_event(ctx->subdrv.drm_dev);
551
552         return 0;
553 }
554
555 static int __devinit vidi_probe(struct platform_device *pdev)
556 {
557         struct device *dev = &pdev->dev;
558         struct vidi_context *ctx;
559         struct exynos_drm_subdrv *subdrv;
560         int ret;
561
562         DRM_DEBUG_KMS("%s\n", __FILE__);
563
564         ctx = kzalloc(sizeof(*ctx), GFP_KERNEL);
565         if (!ctx)
566                 return -ENOMEM;
567
568         ctx->default_win = 0;
569
570         INIT_WORK(&ctx->work, vidi_fake_vblank_handler);
571
572         /* for test */
573         ctx->raw_edid = (struct edid *)fake_edid_info;
574
575         subdrv = &ctx->subdrv;
576         subdrv->dev = dev;
577         subdrv->manager = &vidi_manager;
578         subdrv->probe = vidi_subdrv_probe;
579         subdrv->remove = vidi_subdrv_remove;
580
581         mutex_init(&ctx->lock);
582
583         platform_set_drvdata(pdev, ctx);
584
585         ret = device_create_file(&pdev->dev, &dev_attr_connection);
586         if (ret < 0)
587                 DRM_INFO("failed to create connection sysfs.\n");
588
589         exynos_drm_subdrv_register(subdrv);
590
591         return 0;
592 }
593
594 static int __devexit vidi_remove(struct platform_device *pdev)
595 {
596         struct vidi_context *ctx = platform_get_drvdata(pdev);
597
598         DRM_DEBUG_KMS("%s\n", __FILE__);
599
600         exynos_drm_subdrv_unregister(&ctx->subdrv);
601
602         kfree(ctx);
603
604         return 0;
605 }
606
607 #ifdef CONFIG_PM_SLEEP
608 static int vidi_suspend(struct device *dev)
609 {
610         struct vidi_context *ctx = get_vidi_context(dev);
611
612         return vidi_power_on(ctx, false);
613 }
614
615 static int vidi_resume(struct device *dev)
616 {
617         struct vidi_context *ctx = get_vidi_context(dev);
618
619         return vidi_power_on(ctx, true);
620 }
621 #endif
622
623 static const struct dev_pm_ops vidi_pm_ops = {
624         SET_SYSTEM_SLEEP_PM_OPS(vidi_suspend, vidi_resume)
625 };
626
627 struct platform_driver vidi_driver = {
628         .probe          = vidi_probe,
629         .remove         = __devexit_p(vidi_remove),
630         .driver         = {
631                 .name   = "exynos-drm-vidi",
632                 .owner  = THIS_MODULE,
633                 .pm     = &vidi_pm_ops,
634         },
635 };