]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/gpu/drm/exynos/exynos_drm_drv.c
Merge branches 'for-4.4/upstream-fixes', 'for-4.5/async-suspend', 'for-4.5/container...
[mirror_ubuntu-artful-kernel.git] / drivers / gpu / drm / exynos / exynos_drm_drv.c
CommitLineData
1c248b7d
ID
1/*
2 * Copyright (c) 2011 Samsung Electronics Co., Ltd.
3 * Authors:
4 * Inki Dae <inki.dae@samsung.com>
5 * Joonyoung Shim <jy0922.shim@samsung.com>
6 * Seung-Woo Kim <sw0312.kim@samsung.com>
7 *
d81aecb5
ID
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
1c248b7d
ID
12 */
13
af65c804 14#include <linux/pm_runtime.h>
760285e7 15#include <drm/drmP.h>
a379df19
GP
16#include <drm/drm_atomic.h>
17#include <drm/drm_atomic_helper.h>
760285e7 18#include <drm/drm_crtc_helper.h>
1c248b7d 19
f37cd5e8 20#include <linux/component.h>
96f54215 21
1c248b7d
ID
22#include <drm/exynos_drm.h>
23
24#include "exynos_drm_drv.h"
25#include "exynos_drm_crtc.h"
26#include "exynos_drm_fbdev.h"
27#include "exynos_drm_fb.h"
28#include "exynos_drm_gem.h"
864ee9e6 29#include "exynos_drm_plane.h"
b73d1230 30#include "exynos_drm_vidi.h"
d7f1642c 31#include "exynos_drm_g2d.h"
cb471f14 32#include "exynos_drm_ipp.h"
0519f9a1 33#include "exynos_drm_iommu.h"
1c248b7d 34
0edf9936 35#define DRIVER_NAME "exynos"
1c248b7d
ID
36#define DRIVER_DESC "Samsung SoC DRM"
37#define DRIVER_DATE "20110530"
38#define DRIVER_MAJOR 1
39#define DRIVER_MINOR 0
40
a379df19
GP
41struct exynos_atomic_commit {
42 struct work_struct work;
43 struct drm_device *dev;
44 struct drm_atomic_state *state;
45 u32 crtcs;
46};
47
c4533665
GP
48static void exynos_atomic_wait_for_commit(struct drm_atomic_state *state)
49{
50 struct drm_crtc_state *crtc_state;
51 struct drm_crtc *crtc;
52 int i, ret;
53
54 for_each_crtc_in_state(state, crtc, crtc_state, i) {
55 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
56
57 if (!crtc->state->enable)
58 continue;
59
60 ret = drm_crtc_vblank_get(crtc);
61 if (ret)
62 continue;
63
64 exynos_drm_crtc_wait_pending_update(exynos_crtc);
65 drm_crtc_vblank_put(crtc);
66 }
67}
68
a379df19
GP
69static void exynos_atomic_commit_complete(struct exynos_atomic_commit *commit)
70{
71 struct drm_device *dev = commit->dev;
72 struct exynos_drm_private *priv = dev->dev_private;
73 struct drm_atomic_state *state = commit->state;
c4533665
GP
74 struct drm_plane *plane;
75 struct drm_crtc *crtc;
76 struct drm_plane_state *plane_state;
77 struct drm_crtc_state *crtc_state;
78 int i;
a379df19
GP
79
80 drm_atomic_helper_commit_modeset_disables(dev, state);
81
82 drm_atomic_helper_commit_modeset_enables(dev, state);
83
84 /*
85 * Exynos can't update planes with CRTCs and encoders disabled,
86 * its updates routines, specially for FIMD, requires the clocks
87 * to be enabled. So it is necessary to handle the modeset operations
88 * *before* the commit_planes() step, this way it will always
89 * have the relevant clocks enabled to perform the update.
90 */
91
c4533665
GP
92 for_each_crtc_in_state(state, crtc, crtc_state, i) {
93 struct exynos_drm_crtc *exynos_crtc = to_exynos_crtc(crtc);
94
95 atomic_set(&exynos_crtc->pending_update, 0);
96 }
97
98 for_each_plane_in_state(state, plane, plane_state, i) {
99 struct exynos_drm_crtc *exynos_crtc =
100 to_exynos_crtc(plane->crtc);
101
102 if (!plane->crtc)
103 continue;
104
105 atomic_inc(&exynos_crtc->pending_update);
106 }
107
aef9dbb8 108 drm_atomic_helper_commit_planes(dev, state, false);
a379df19 109
c4533665 110 exynos_atomic_wait_for_commit(state);
a379df19
GP
111
112 drm_atomic_helper_cleanup_planes(dev, state);
113
114 drm_atomic_state_free(state);
115
116 spin_lock(&priv->lock);
117 priv->pending &= ~commit->crtcs;
118 spin_unlock(&priv->lock);
119
120 wake_up_all(&priv->wait);
121
122 kfree(commit);
123}
124
125static void exynos_drm_atomic_work(struct work_struct *work)
126{
127 struct exynos_atomic_commit *commit = container_of(work,
128 struct exynos_atomic_commit, work);
129
130 exynos_atomic_commit_complete(commit);
131}
132
1c248b7d
ID
133static int exynos_drm_load(struct drm_device *dev, unsigned long flags)
134{
135 struct exynos_drm_private *private;
6cf27275
GP
136 struct drm_encoder *encoder;
137 unsigned int clone_mask;
138 int cnt, ret;
1c248b7d 139
1c248b7d 140 private = kzalloc(sizeof(struct exynos_drm_private), GFP_KERNEL);
38bb5253 141 if (!private)
1c248b7d 142 return -ENOMEM;
1c248b7d 143
a379df19
GP
144 init_waitqueue_head(&private->wait);
145 spin_lock_init(&private->lock);
146
af65c804 147 dev_set_drvdata(dev->dev, dev);
1c248b7d
ID
148 dev->dev_private = (void *)private;
149
0519f9a1
ID
150 /*
151 * create mapping to manage iommu table and set a pointer to iommu
152 * mapping structure to iommu_mapping of private data.
153 * also this iommu_mapping can be used to check if iommu is supported
154 * or not.
155 */
156 ret = drm_create_iommu_mapping(dev);
157 if (ret < 0) {
158 DRM_ERROR("failed to create iommu mapping.\n");
d2ba65f6 159 goto err_free_private;
0519f9a1
ID
160 }
161
1c248b7d
ID
162 drm_mode_config_init(dev);
163
164 exynos_drm_mode_config_init(dev);
165
d081f566 166 /* setup possible_clones. */
6cf27275
GP
167 cnt = 0;
168 clone_mask = 0;
169 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
170 clone_mask |= (1 << (cnt++));
171
172 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
173 encoder->possible_clones = clone_mask;
d081f566 174
a9a346d6
DV
175 platform_set_drvdata(dev->platformdev, dev);
176
f37cd5e8
ID
177 /* Try to bind all sub drivers. */
178 ret = component_bind_all(dev->dev, dev);
179 if (ret)
c52142e6
AH
180 goto err_mode_config_cleanup;
181
182 ret = drm_vblank_init(dev, dev->mode_config.num_crtc);
183 if (ret)
184 goto err_unbind_all;
f37cd5e8 185
d1afe7d4 186 /* Probe non kms sub drivers and virtual display driver. */
f37cd5e8
ID
187 ret = exynos_drm_device_subdrv_probe(dev);
188 if (ret)
c52142e6 189 goto err_cleanup_vblank;
f37cd5e8 190
4ea9526b
GP
191 drm_mode_config_reset(dev);
192
4a3ffedd
JS
193 /*
194 * enable drm irq mode.
195 * - with irq_enabled = true, we can use the vblank feature.
196 *
197 * P.S. note that we wouldn't use drm irq handler but
198 * just specific driver own one instead because
199 * drm framework supports only one irq handler.
200 */
201 dev->irq_enabled = true;
202
203 /*
204 * with vblank_disable_allowed = true, vblank interrupt will be disabled
205 * by drm timer once a current process gives up ownership of
206 * vblank event.(after drm_vblank_put function is called)
207 */
208 dev->vblank_disable_allowed = true;
209
3cb6830a
AH
210 /* init kms poll for handling hpd */
211 drm_kms_helper_poll_init(dev);
212
213 /* force connectors detection */
214 drm_helper_hpd_irq_event(dev);
215
1c248b7d
ID
216 return 0;
217
f37cd5e8 218err_cleanup_vblank:
1c248b7d 219 drm_vblank_cleanup(dev);
c52142e6
AH
220err_unbind_all:
221 component_unbind_all(dev->dev, dev);
080be03d
SP
222err_mode_config_cleanup:
223 drm_mode_config_cleanup(dev);
0519f9a1 224 drm_release_iommu_mapping(dev);
d2ba65f6 225err_free_private:
1c248b7d
ID
226 kfree(private);
227
228 return ret;
229}
230
231static int exynos_drm_unload(struct drm_device *dev)
232{
f37cd5e8
ID
233 exynos_drm_device_subdrv_remove(dev);
234
1c248b7d 235 exynos_drm_fbdev_fini(dev);
7db3eba6 236 drm_kms_helper_poll_fini(dev);
0519f9a1 237
9f3dd7db 238 drm_vblank_cleanup(dev);
c52142e6 239 component_unbind_all(dev->dev, dev);
9f3dd7db 240 drm_mode_config_cleanup(dev);
0519f9a1 241 drm_release_iommu_mapping(dev);
1c248b7d 242
9f3dd7db 243 kfree(dev->dev_private);
1c248b7d
ID
244 dev->dev_private = NULL;
245
246 return 0;
247}
248
a379df19
GP
249static int commit_is_pending(struct exynos_drm_private *priv, u32 crtcs)
250{
251 bool pending;
252
253 spin_lock(&priv->lock);
254 pending = priv->pending & crtcs;
255 spin_unlock(&priv->lock);
256
257 return pending;
258}
259
260int exynos_atomic_commit(struct drm_device *dev, struct drm_atomic_state *state,
261 bool async)
262{
263 struct exynos_drm_private *priv = dev->dev_private;
264 struct exynos_atomic_commit *commit;
265 int i, ret;
266
267 commit = kzalloc(sizeof(*commit), GFP_KERNEL);
268 if (!commit)
269 return -ENOMEM;
270
271 ret = drm_atomic_helper_prepare_planes(dev, state);
272 if (ret) {
273 kfree(commit);
274 return ret;
275 }
276
277 /* This is the point of no return */
278
279 INIT_WORK(&commit->work, exynos_drm_atomic_work);
280 commit->dev = dev;
281 commit->state = state;
282
283 /* Wait until all affected CRTCs have completed previous commits and
284 * mark them as pending.
285 */
286 for (i = 0; i < dev->mode_config.num_crtc; ++i) {
287 if (state->crtcs[i])
288 commit->crtcs |= 1 << drm_crtc_index(state->crtcs[i]);
289 }
290
291 wait_event(priv->wait, !commit_is_pending(priv, commit->crtcs));
292
293 spin_lock(&priv->lock);
294 priv->pending |= commit->crtcs;
295 spin_unlock(&priv->lock);
296
297 drm_atomic_helper_swap_state(dev, state);
298
299 if (async)
300 schedule_work(&commit->work);
301 else
302 exynos_atomic_commit_complete(commit);
303
304 return 0;
305}
306
7082947e 307#ifdef CONFIG_PM_SLEEP
af65c804
SP
308static int exynos_drm_suspend(struct drm_device *dev, pm_message_t state)
309{
310 struct drm_connector *connector;
311
312 drm_modeset_lock_all(dev);
313 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
314 int old_dpms = connector->dpms;
315
316 if (connector->funcs->dpms)
317 connector->funcs->dpms(connector, DRM_MODE_DPMS_OFF);
318
319 /* Set the old mode back to the connector for resume */
320 connector->dpms = old_dpms;
321 }
322 drm_modeset_unlock_all(dev);
323
324 return 0;
325}
326
327static int exynos_drm_resume(struct drm_device *dev)
328{
329 struct drm_connector *connector;
330
331 drm_modeset_lock_all(dev);
332 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
74cfe07a
AH
333 if (connector->funcs->dpms) {
334 int dpms = connector->dpms;
335
336 connector->dpms = DRM_MODE_DPMS_OFF;
337 connector->funcs->dpms(connector, dpms);
338 }
af65c804 339 }
a16f223e 340 drm_modeset_unlock_all(dev);
af65c804 341
af65c804
SP
342 return 0;
343}
7082947e 344#endif
af65c804 345
9084f7b8
JS
346static int exynos_drm_open(struct drm_device *dev, struct drm_file *file)
347{
d7f1642c 348 struct drm_exynos_file_private *file_priv;
ba3706c0 349 int ret;
d7f1642c 350
d7f1642c
JS
351 file_priv = kzalloc(sizeof(*file_priv), GFP_KERNEL);
352 if (!file_priv)
353 return -ENOMEM;
354
d7f1642c 355 file->driver_priv = file_priv;
b2df26c1 356
ba3706c0 357 ret = exynos_drm_subdrv_open(dev, file);
6ca605f7 358 if (ret)
307ceaff 359 goto err_file_priv_free;
ba3706c0 360
6ca605f7 361 return ret;
307ceaff 362
307ceaff 363err_file_priv_free:
6ca605f7
SK
364 kfree(file_priv);
365 file->driver_priv = NULL;
ba3706c0 366 return ret;
9084f7b8
JS
367}
368
ccf4d883 369static void exynos_drm_preclose(struct drm_device *dev,
6f811502 370 struct drm_file *file)
0cbc330e
ID
371{
372 exynos_drm_subdrv_close(dev, file);
373}
374
375static void exynos_drm_postclose(struct drm_device *dev, struct drm_file *file)
ccf4d883 376{
0cbc330e 377 struct drm_pending_event *e, *et;
3ab09435
JS
378 unsigned long flags;
379
0cbc330e
ID
380 if (!file->driver_priv)
381 return;
382
3ab09435 383 spin_lock_irqsave(&dev->event_lock, flags);
0cbc330e
ID
384 /* Release all events handled by page flip handler but not freed. */
385 list_for_each_entry_safe(e, et, &file->event_list, link) {
386 list_del(&e->link);
387 e->destroy(e);
388 }
389 spin_unlock_irqrestore(&dev->event_lock, flags);
ccf4d883 390
53ef299f
ID
391 kfree(file->driver_priv);
392 file->driver_priv = NULL;
393}
394
1c248b7d
ID
395static void exynos_drm_lastclose(struct drm_device *dev)
396{
1c248b7d
ID
397 exynos_drm_fbdev_restore_mode(dev);
398}
399
78b68556 400static const struct vm_operations_struct exynos_drm_gem_vm_ops = {
1c248b7d
ID
401 .fault = exynos_drm_gem_fault,
402 .open = drm_gem_vm_open,
403 .close = drm_gem_vm_close,
404};
405
baa70943 406static const struct drm_ioctl_desc exynos_ioctls[] = {
1c248b7d 407 DRM_IOCTL_DEF_DRV(EXYNOS_GEM_CREATE, exynos_drm_gem_create_ioctl,
f8c47144 408 DRM_AUTH | DRM_RENDER_ALLOW),
74f230d2 409 DRM_IOCTL_DEF_DRV(EXYNOS_GEM_GET, exynos_drm_gem_get_ioctl,
f8c47144 410 DRM_RENDER_ALLOW),
74f230d2 411 DRM_IOCTL_DEF_DRV(EXYNOS_VIDI_CONNECTION, vidi_connection_ioctl,
f8c47144 412 DRM_AUTH),
74f230d2 413 DRM_IOCTL_DEF_DRV(EXYNOS_G2D_GET_VER, exynos_g2d_get_ver_ioctl,
f8c47144 414 DRM_AUTH | DRM_RENDER_ALLOW),
74f230d2 415 DRM_IOCTL_DEF_DRV(EXYNOS_G2D_SET_CMDLIST, exynos_g2d_set_cmdlist_ioctl,
f8c47144 416 DRM_AUTH | DRM_RENDER_ALLOW),
74f230d2 417 DRM_IOCTL_DEF_DRV(EXYNOS_G2D_EXEC, exynos_g2d_exec_ioctl,
f8c47144 418 DRM_AUTH | DRM_RENDER_ALLOW),
74f230d2 419 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_GET_PROPERTY, exynos_drm_ipp_get_property,
f8c47144 420 DRM_AUTH | DRM_RENDER_ALLOW),
74f230d2 421 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_SET_PROPERTY, exynos_drm_ipp_set_property,
f8c47144 422 DRM_AUTH | DRM_RENDER_ALLOW),
74f230d2 423 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_QUEUE_BUF, exynos_drm_ipp_queue_buf,
f8c47144 424 DRM_AUTH | DRM_RENDER_ALLOW),
74f230d2 425 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_CMD_CTRL, exynos_drm_ipp_cmd_ctrl,
f8c47144 426 DRM_AUTH | DRM_RENDER_ALLOW),
1c248b7d
ID
427};
428
ac2bdf73
JS
429static const struct file_operations exynos_drm_driver_fops = {
430 .owner = THIS_MODULE,
431 .open = drm_open,
432 .mmap = exynos_drm_gem_mmap,
433 .poll = drm_poll,
434 .read = drm_read,
435 .unlocked_ioctl = drm_ioctl,
804d74ab
KP
436#ifdef CONFIG_COMPAT
437 .compat_ioctl = drm_compat_ioctl,
438#endif
ac2bdf73
JS
439 .release = drm_release,
440};
441
1c248b7d 442static struct drm_driver exynos_drm_driver = {
c8c38ccf 443 .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME
74f230d2 444 | DRIVER_ATOMIC | DRIVER_RENDER,
1c248b7d
ID
445 .load = exynos_drm_load,
446 .unload = exynos_drm_unload,
9084f7b8 447 .open = exynos_drm_open,
ccf4d883 448 .preclose = exynos_drm_preclose,
1c248b7d 449 .lastclose = exynos_drm_lastclose,
53ef299f 450 .postclose = exynos_drm_postclose,
915b4d11 451 .set_busid = drm_platform_set_busid,
b44f8408 452 .get_vblank_counter = drm_vblank_no_hw_counter,
1c248b7d
ID
453 .enable_vblank = exynos_drm_crtc_enable_vblank,
454 .disable_vblank = exynos_drm_crtc_disable_vblank,
1c248b7d
ID
455 .gem_free_object = exynos_drm_gem_free_object,
456 .gem_vm_ops = &exynos_drm_gem_vm_ops,
457 .dumb_create = exynos_drm_gem_dumb_create,
458 .dumb_map_offset = exynos_drm_gem_dumb_map_offset,
43387b37 459 .dumb_destroy = drm_gem_dumb_destroy,
b2df26c1
ID
460 .prime_handle_to_fd = drm_gem_prime_handle_to_fd,
461 .prime_fd_to_handle = drm_gem_prime_fd_to_handle,
01ed50dd
JS
462 .gem_prime_export = drm_gem_prime_export,
463 .gem_prime_import = drm_gem_prime_import,
464 .gem_prime_get_sg_table = exynos_drm_gem_prime_get_sg_table,
465 .gem_prime_import_sg_table = exynos_drm_gem_prime_import_sg_table,
466 .gem_prime_vmap = exynos_drm_gem_prime_vmap,
467 .gem_prime_vunmap = exynos_drm_gem_prime_vunmap,
1c248b7d 468 .ioctls = exynos_ioctls,
baa70943 469 .num_ioctls = ARRAY_SIZE(exynos_ioctls),
ac2bdf73 470 .fops = &exynos_drm_driver_fops,
1c248b7d
ID
471 .name = DRIVER_NAME,
472 .desc = DRIVER_DESC,
473 .date = DRIVER_DATE,
474 .major = DRIVER_MAJOR,
475 .minor = DRIVER_MINOR,
476};
477
af65c804
SP
478#ifdef CONFIG_PM_SLEEP
479static int exynos_drm_sys_suspend(struct device *dev)
480{
481 struct drm_device *drm_dev = dev_get_drvdata(dev);
482 pm_message_t message;
483
d50a1907 484 if (pm_runtime_suspended(dev) || !drm_dev)
af65c804
SP
485 return 0;
486
487 message.event = PM_EVENT_SUSPEND;
488 return exynos_drm_suspend(drm_dev, message);
489}
490
491static int exynos_drm_sys_resume(struct device *dev)
492{
493 struct drm_device *drm_dev = dev_get_drvdata(dev);
494
d50a1907 495 if (pm_runtime_suspended(dev) || !drm_dev)
af65c804
SP
496 return 0;
497
498 return exynos_drm_resume(drm_dev);
499}
500#endif
501
af65c804
SP
502static const struct dev_pm_ops exynos_drm_pm_ops = {
503 SET_SYSTEM_SLEEP_PM_OPS(exynos_drm_sys_suspend, exynos_drm_sys_resume)
af65c804
SP
504};
505
86650408
AH
506/* forward declaration */
507static struct platform_driver exynos_drm_platform_driver;
f37cd5e8 508
86650408
AH
509/*
510 * Connector drivers should not be placed before associated crtc drivers,
511 * because connector requires pipe number of its crtc during initialization.
512 */
513static struct platform_driver *const exynos_drm_kms_drivers[] = {
86650408
AH
514#ifdef CONFIG_DRM_EXYNOS_FIMD
515 &fimd_driver,
516#endif
517#ifdef CONFIG_DRM_EXYNOS5433_DECON
518 &exynos5433_decon_driver,
519#endif
520#ifdef CONFIG_DRM_EXYNOS7_DECON
521 &decon_driver,
522#endif
77bbd891
HH
523#ifdef CONFIG_DRM_EXYNOS_MIC
524 &mic_driver,
525#endif
86650408
AH
526#ifdef CONFIG_DRM_EXYNOS_DP
527 &dp_driver,
528#endif
529#ifdef CONFIG_DRM_EXYNOS_DSI
530 &dsi_driver,
531#endif
3cb02b4a 532#ifdef CONFIG_DRM_EXYNOS_MIXER
86650408 533 &mixer_driver,
3cb02b4a
AH
534#endif
535#ifdef CONFIG_DRM_EXYNOS_HDMI
86650408
AH
536 &hdmi_driver,
537#endif
735c21c3
JS
538#ifdef CONFIG_DRM_EXYNOS_VIDI
539 &vidi_driver,
540#endif
86650408 541};
df5225bc 542
86650408 543static struct platform_driver *const exynos_drm_non_kms_drivers[] = {
86650408
AH
544#ifdef CONFIG_DRM_EXYNOS_G2D
545 &g2d_driver,
546#endif
547#ifdef CONFIG_DRM_EXYNOS_FIMC
548 &fimc_driver,
549#endif
550#ifdef CONFIG_DRM_EXYNOS_ROTATOR
551 &rotator_driver,
552#endif
553#ifdef CONFIG_DRM_EXYNOS_GSC
554 &gsc_driver,
555#endif
556#ifdef CONFIG_DRM_EXYNOS_IPP
557 &ipp_driver,
558#endif
559 &exynos_drm_platform_driver,
560};
f37cd5e8 561
86650408
AH
562static struct platform_driver *const exynos_drm_drv_with_simple_dev[] = {
563#ifdef CONFIG_DRM_EXYNOS_VIDI
564 &vidi_driver,
565#endif
566#ifdef CONFIG_DRM_EXYNOS_IPP
567 &ipp_driver,
568#endif
569 &exynos_drm_platform_driver,
570};
571#define PDEV_COUNT ARRAY_SIZE(exynos_drm_drv_with_simple_dev)
f37cd5e8 572
53c5558d 573static int compare_dev(struct device *dev, void *data)
f37cd5e8
ID
574{
575 return dev == (struct device *)data;
576}
577
53c5558d 578static struct component_match *exynos_drm_match_add(struct device *dev)
f37cd5e8 579{
53c5558d 580 struct component_match *match = NULL;
86650408 581 int i;
f37cd5e8 582
86650408
AH
583 for (i = 0; i < ARRAY_SIZE(exynos_drm_kms_drivers); ++i) {
584 struct device_driver *drv = &exynos_drm_kms_drivers[i]->driver;
585 struct device *p = NULL, *d;
f7c2f36f 586
86650408
AH
587 while ((d = bus_find_device(&platform_bus_type, p, drv,
588 (void *)platform_bus_type.match))) {
589 put_device(p);
590 component_match_add(dev, &match, compare_dev, d);
591 p = d;
df5225bc 592 }
86650408 593 put_device(p);
f37cd5e8
ID
594 }
595
86650408 596 return match ?: ERR_PTR(-ENODEV);
f37cd5e8
ID
597}
598
599static int exynos_drm_bind(struct device *dev)
600{
f37cd5e8
ID
601 return drm_platform_init(&exynos_drm_driver, to_platform_device(dev));
602}
603
604static void exynos_drm_unbind(struct device *dev)
605{
606 drm_put_dev(dev_get_drvdata(dev));
607}
608
609static const struct component_master_ops exynos_drm_ops = {
f37cd5e8
ID
610 .bind = exynos_drm_bind,
611 .unbind = exynos_drm_unbind,
1c248b7d
ID
612};
613
417133e4
AH
614static int exynos_drm_platform_probe(struct platform_device *pdev)
615{
616 struct component_match *match;
617
618 pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
619 exynos_drm_driver.num_ioctls = ARRAY_SIZE(exynos_ioctls);
620
621 match = exynos_drm_match_add(&pdev->dev);
622 if (IS_ERR(match))
623 return PTR_ERR(match);
624
625 return component_master_add_with_match(&pdev->dev, &exynos_drm_ops,
626 match);
627}
628
629static int exynos_drm_platform_remove(struct platform_device *pdev)
630{
631 component_master_del(&pdev->dev, &exynos_drm_ops);
632 return 0;
633}
634
635static struct platform_driver exynos_drm_platform_driver = {
636 .probe = exynos_drm_platform_probe,
637 .remove = exynos_drm_platform_remove,
638 .driver = {
639 .name = "exynos-drm",
640 .pm = &exynos_drm_pm_ops,
641 },
642};
643
417133e4
AH
644static struct platform_device *exynos_drm_pdevs[PDEV_COUNT];
645
646static void exynos_drm_unregister_devices(void)
72390677 647{
417133e4 648 int i = PDEV_COUNT;
25928a39 649
417133e4
AH
650 while (--i >= 0) {
651 platform_device_unregister(exynos_drm_pdevs[i]);
652 exynos_drm_pdevs[i] = NULL;
653 }
654}
7eb8f069 655
417133e4
AH
656static int exynos_drm_register_devices(void)
657{
658 int i;
659
660 for (i = 0; i < PDEV_COUNT; ++i) {
661 struct platform_driver *d = exynos_drm_drv_with_simple_dev[i];
662 struct platform_device *pdev =
663 platform_device_register_simple(d->driver.name, -1,
664 NULL, 0);
665
666 if (!IS_ERR(pdev)) {
667 exynos_drm_pdevs[i] = pdev;
668 continue;
669 }
670 while (--i >= 0) {
671 platform_device_unregister(exynos_drm_pdevs[i]);
672 exynos_drm_pdevs[i] = NULL;
673 }
674
675 return PTR_ERR(pdev);
72390677 676 }
f37cd5e8 677
417133e4 678 return 0;
1c248b7d
ID
679}
680
417133e4
AH
681static void exynos_drm_unregister_drivers(struct platform_driver * const *drv,
682 int count)
1c248b7d 683{
417133e4
AH
684 while (--count >= 0)
685 platform_driver_unregister(drv[count]);
686}
687
688static int exynos_drm_register_drivers(struct platform_driver * const *drv,
689 int count)
690{
691 int i, ret;
692
693 for (i = 0; i < count; ++i) {
694 ret = platform_driver_register(drv[i]);
695 if (!ret)
696 continue;
697
698 while (--i >= 0)
699 platform_driver_unregister(drv[i]);
700
701 return ret;
702 }
703
f37cd5e8
ID
704 return 0;
705}
706
417133e4
AH
707static inline int exynos_drm_register_kms_drivers(void)
708{
709 return exynos_drm_register_drivers(exynos_drm_kms_drivers,
710 ARRAY_SIZE(exynos_drm_kms_drivers));
711}
712
713static inline int exynos_drm_register_non_kms_drivers(void)
714{
715 return exynos_drm_register_drivers(exynos_drm_non_kms_drivers,
716 ARRAY_SIZE(exynos_drm_non_kms_drivers));
717}
718
719static inline void exynos_drm_unregister_kms_drivers(void)
720{
721 exynos_drm_unregister_drivers(exynos_drm_kms_drivers,
722 ARRAY_SIZE(exynos_drm_kms_drivers));
723}
724
725static inline void exynos_drm_unregister_non_kms_drivers(void)
726{
727 exynos_drm_unregister_drivers(exynos_drm_non_kms_drivers,
728 ARRAY_SIZE(exynos_drm_non_kms_drivers));
729}
730
f37cd5e8
ID
731static int exynos_drm_init(void)
732{
e3b9e460 733 int ret;
f37cd5e8 734
417133e4
AH
735 ret = exynos_drm_register_devices();
736 if (ret)
737 return ret;
820687be 738
417133e4
AH
739 ret = exynos_drm_register_kms_drivers();
740 if (ret)
741 goto err_unregister_pdevs;
f37cd5e8 742
417133e4 743 ret = exynos_drm_register_non_kms_drivers();
f37cd5e8 744 if (ret)
417133e4 745 goto err_unregister_kms_drivers;
f37cd5e8
ID
746
747 return 0;
748
820687be 749err_unregister_kms_drivers:
417133e4 750 exynos_drm_unregister_kms_drivers();
820687be 751
417133e4
AH
752err_unregister_pdevs:
753 exynos_drm_unregister_devices();
f37cd5e8
ID
754
755 return ret;
756}
757
758static void exynos_drm_exit(void)
759{
417133e4
AH
760 exynos_drm_unregister_non_kms_drivers();
761 exynos_drm_unregister_kms_drivers();
762 exynos_drm_unregister_devices();
1c248b7d
ID
763}
764
765module_init(exynos_drm_init);
766module_exit(exynos_drm_exit);
767
768MODULE_AUTHOR("Inki Dae <inki.dae@samsung.com>");
769MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
770MODULE_AUTHOR("Seung-Woo Kim <sw0312.kim@samsung.com>");
771MODULE_DESCRIPTION("Samsung SoC DRM Driver");
772MODULE_LICENSE("GPL");