xref: /openbmc/linux/drivers/gpu/drm/exynos/exynos_drm_drv.c (revision e983940270f10fe8551baf0098be76ea478294a3)
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  *
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.
12  */
13 
14 #include <linux/pm_runtime.h>
15 #include <drm/drmP.h>
16 #include <drm/drm_atomic.h>
17 #include <drm/drm_atomic_helper.h>
18 #include <drm/drm_crtc_helper.h>
19 
20 #include <linux/component.h>
21 
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"
29 #include "exynos_drm_plane.h"
30 #include "exynos_drm_vidi.h"
31 #include "exynos_drm_g2d.h"
32 #include "exynos_drm_ipp.h"
33 #include "exynos_drm_iommu.h"
34 
35 #define DRIVER_NAME	"exynos"
36 #define DRIVER_DESC	"Samsung SoC DRM"
37 #define DRIVER_DATE	"20110530"
38 #define DRIVER_MAJOR	1
39 #define DRIVER_MINOR	0
40 
41 struct exynos_atomic_commit {
42 	struct work_struct	work;
43 	struct drm_device	*dev;
44 	struct drm_atomic_state *state;
45 	u32			crtcs;
46 };
47 
48 static void exynos_atomic_commit_complete(struct exynos_atomic_commit *commit)
49 {
50 	struct drm_device *dev = commit->dev;
51 	struct exynos_drm_private *priv = dev->dev_private;
52 	struct drm_atomic_state *state = commit->state;
53 
54 	drm_atomic_helper_commit_modeset_disables(dev, state);
55 
56 	drm_atomic_helper_commit_modeset_enables(dev, state);
57 
58 	/*
59 	 * Exynos can't update planes with CRTCs and encoders disabled,
60 	 * its updates routines, specially for FIMD, requires the clocks
61 	 * to be enabled. So it is necessary to handle the modeset operations
62 	 * *before* the commit_planes() step, this way it will always
63 	 * have the relevant clocks enabled to perform the update.
64 	 */
65 
66 	drm_atomic_helper_commit_planes(dev, state, 0);
67 
68 	drm_atomic_helper_wait_for_vblanks(dev, state);
69 
70 	drm_atomic_helper_cleanup_planes(dev, state);
71 
72 	drm_atomic_state_free(state);
73 
74 	spin_lock(&priv->lock);
75 	priv->pending &= ~commit->crtcs;
76 	spin_unlock(&priv->lock);
77 
78 	wake_up_all(&priv->wait);
79 
80 	kfree(commit);
81 }
82 
83 static void exynos_drm_atomic_work(struct work_struct *work)
84 {
85 	struct exynos_atomic_commit *commit = container_of(work,
86 				struct exynos_atomic_commit, work);
87 
88 	exynos_atomic_commit_complete(commit);
89 }
90 
91 static struct device *exynos_drm_get_dma_device(void);
92 
93 static int exynos_drm_load(struct drm_device *dev, unsigned long flags)
94 {
95 	struct exynos_drm_private *private;
96 	struct drm_encoder *encoder;
97 	unsigned int clone_mask;
98 	int cnt, ret;
99 
100 	private = kzalloc(sizeof(struct exynos_drm_private), GFP_KERNEL);
101 	if (!private)
102 		return -ENOMEM;
103 
104 	init_waitqueue_head(&private->wait);
105 	spin_lock_init(&private->lock);
106 
107 	dev_set_drvdata(dev->dev, dev);
108 	dev->dev_private = (void *)private;
109 
110 	/* the first real CRTC device is used for all dma mapping operations */
111 	private->dma_dev = exynos_drm_get_dma_device();
112 	if (!private->dma_dev) {
113 		DRM_ERROR("no device found for DMA mapping operations.\n");
114 		ret = -ENODEV;
115 		goto err_free_private;
116 	}
117 	DRM_INFO("Exynos DRM: using %s device for DMA mapping operations\n",
118 		 dev_name(private->dma_dev));
119 
120 	/* create common IOMMU mapping for all devices attached to Exynos DRM */
121 	ret = drm_create_iommu_mapping(dev);
122 	if (ret < 0) {
123 		DRM_ERROR("failed to create iommu mapping.\n");
124 		goto err_free_private;
125 	}
126 
127 	drm_mode_config_init(dev);
128 
129 	exynos_drm_mode_config_init(dev);
130 
131 	/* setup possible_clones. */
132 	cnt = 0;
133 	clone_mask = 0;
134 	list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
135 		clone_mask |= (1 << (cnt++));
136 
137 	list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
138 		encoder->possible_clones = clone_mask;
139 
140 	platform_set_drvdata(dev->platformdev, dev);
141 
142 	/* Try to bind all sub drivers. */
143 	ret = component_bind_all(dev->dev, dev);
144 	if (ret)
145 		goto err_mode_config_cleanup;
146 
147 	ret = drm_vblank_init(dev, dev->mode_config.num_crtc);
148 	if (ret)
149 		goto err_unbind_all;
150 
151 	/* Probe non kms sub drivers and virtual display driver. */
152 	ret = exynos_drm_device_subdrv_probe(dev);
153 	if (ret)
154 		goto err_cleanup_vblank;
155 
156 	drm_mode_config_reset(dev);
157 
158 	/*
159 	 * enable drm irq mode.
160 	 * - with irq_enabled = true, we can use the vblank feature.
161 	 *
162 	 * P.S. note that we wouldn't use drm irq handler but
163 	 *	just specific driver own one instead because
164 	 *	drm framework supports only one irq handler.
165 	 */
166 	dev->irq_enabled = true;
167 
168 	/* init kms poll for handling hpd */
169 	drm_kms_helper_poll_init(dev);
170 
171 	/* force connectors detection */
172 	drm_helper_hpd_irq_event(dev);
173 
174 	return 0;
175 
176 err_cleanup_vblank:
177 	drm_vblank_cleanup(dev);
178 err_unbind_all:
179 	component_unbind_all(dev->dev, dev);
180 err_mode_config_cleanup:
181 	drm_mode_config_cleanup(dev);
182 	drm_release_iommu_mapping(dev);
183 err_free_private:
184 	kfree(private);
185 
186 	return ret;
187 }
188 
189 static int exynos_drm_unload(struct drm_device *dev)
190 {
191 	exynos_drm_device_subdrv_remove(dev);
192 
193 	exynos_drm_fbdev_fini(dev);
194 	drm_kms_helper_poll_fini(dev);
195 
196 	drm_vblank_cleanup(dev);
197 	component_unbind_all(dev->dev, dev);
198 	drm_mode_config_cleanup(dev);
199 	drm_release_iommu_mapping(dev);
200 
201 	kfree(dev->dev_private);
202 	dev->dev_private = NULL;
203 
204 	return 0;
205 }
206 
207 static int commit_is_pending(struct exynos_drm_private *priv, u32 crtcs)
208 {
209 	bool pending;
210 
211 	spin_lock(&priv->lock);
212 	pending = priv->pending & crtcs;
213 	spin_unlock(&priv->lock);
214 
215 	return pending;
216 }
217 
218 int exynos_atomic_commit(struct drm_device *dev, struct drm_atomic_state *state,
219 			 bool nonblock)
220 {
221 	struct exynos_drm_private *priv = dev->dev_private;
222 	struct exynos_atomic_commit *commit;
223 	struct drm_crtc *crtc;
224 	struct drm_crtc_state *crtc_state;
225 	int i, ret;
226 
227 	commit = kzalloc(sizeof(*commit), GFP_KERNEL);
228 	if (!commit)
229 		return -ENOMEM;
230 
231 	ret = drm_atomic_helper_prepare_planes(dev, state);
232 	if (ret) {
233 		kfree(commit);
234 		return ret;
235 	}
236 
237 	/* This is the point of no return */
238 
239 	INIT_WORK(&commit->work, exynos_drm_atomic_work);
240 	commit->dev = dev;
241 	commit->state = state;
242 
243 	/* Wait until all affected CRTCs have completed previous commits and
244 	 * mark them as pending.
245 	 */
246 	for_each_crtc_in_state(state, crtc, crtc_state, i)
247 		commit->crtcs |= drm_crtc_mask(crtc);
248 
249 	wait_event(priv->wait, !commit_is_pending(priv, commit->crtcs));
250 
251 	spin_lock(&priv->lock);
252 	priv->pending |= commit->crtcs;
253 	spin_unlock(&priv->lock);
254 
255 	drm_atomic_helper_swap_state(state, true);
256 
257 	if (nonblock)
258 		schedule_work(&commit->work);
259 	else
260 		exynos_atomic_commit_complete(commit);
261 
262 	return 0;
263 }
264 
265 static int exynos_drm_open(struct drm_device *dev, struct drm_file *file)
266 {
267 	struct drm_exynos_file_private *file_priv;
268 	int ret;
269 
270 	file_priv = kzalloc(sizeof(*file_priv), GFP_KERNEL);
271 	if (!file_priv)
272 		return -ENOMEM;
273 
274 	file->driver_priv = file_priv;
275 
276 	ret = exynos_drm_subdrv_open(dev, file);
277 	if (ret)
278 		goto err_file_priv_free;
279 
280 	return ret;
281 
282 err_file_priv_free:
283 	kfree(file_priv);
284 	file->driver_priv = NULL;
285 	return ret;
286 }
287 
288 static void exynos_drm_preclose(struct drm_device *dev,
289 					struct drm_file *file)
290 {
291 	struct drm_crtc *crtc;
292 
293 	exynos_drm_subdrv_close(dev, file);
294 
295 	list_for_each_entry(crtc, &dev->mode_config.crtc_list, head)
296 		exynos_drm_crtc_cancel_page_flip(crtc, file);
297 }
298 
299 static void exynos_drm_postclose(struct drm_device *dev, struct drm_file *file)
300 {
301 	kfree(file->driver_priv);
302 	file->driver_priv = NULL;
303 }
304 
305 static void exynos_drm_lastclose(struct drm_device *dev)
306 {
307 	exynos_drm_fbdev_restore_mode(dev);
308 }
309 
310 static const struct vm_operations_struct exynos_drm_gem_vm_ops = {
311 	.fault = exynos_drm_gem_fault,
312 	.open = drm_gem_vm_open,
313 	.close = drm_gem_vm_close,
314 };
315 
316 static const struct drm_ioctl_desc exynos_ioctls[] = {
317 	DRM_IOCTL_DEF_DRV(EXYNOS_GEM_CREATE, exynos_drm_gem_create_ioctl,
318 			DRM_AUTH | DRM_RENDER_ALLOW),
319 	DRM_IOCTL_DEF_DRV(EXYNOS_GEM_MAP, exynos_drm_gem_map_ioctl,
320 			DRM_AUTH | DRM_RENDER_ALLOW),
321 	DRM_IOCTL_DEF_DRV(EXYNOS_GEM_GET, exynos_drm_gem_get_ioctl,
322 			DRM_RENDER_ALLOW),
323 	DRM_IOCTL_DEF_DRV(EXYNOS_VIDI_CONNECTION, vidi_connection_ioctl,
324 			DRM_AUTH),
325 	DRM_IOCTL_DEF_DRV(EXYNOS_G2D_GET_VER, exynos_g2d_get_ver_ioctl,
326 			DRM_AUTH | DRM_RENDER_ALLOW),
327 	DRM_IOCTL_DEF_DRV(EXYNOS_G2D_SET_CMDLIST, exynos_g2d_set_cmdlist_ioctl,
328 			DRM_AUTH | DRM_RENDER_ALLOW),
329 	DRM_IOCTL_DEF_DRV(EXYNOS_G2D_EXEC, exynos_g2d_exec_ioctl,
330 			DRM_AUTH | DRM_RENDER_ALLOW),
331 	DRM_IOCTL_DEF_DRV(EXYNOS_IPP_GET_PROPERTY, exynos_drm_ipp_get_property,
332 			DRM_AUTH | DRM_RENDER_ALLOW),
333 	DRM_IOCTL_DEF_DRV(EXYNOS_IPP_SET_PROPERTY, exynos_drm_ipp_set_property,
334 			DRM_AUTH | DRM_RENDER_ALLOW),
335 	DRM_IOCTL_DEF_DRV(EXYNOS_IPP_QUEUE_BUF, exynos_drm_ipp_queue_buf,
336 			DRM_AUTH | DRM_RENDER_ALLOW),
337 	DRM_IOCTL_DEF_DRV(EXYNOS_IPP_CMD_CTRL, exynos_drm_ipp_cmd_ctrl,
338 			DRM_AUTH | DRM_RENDER_ALLOW),
339 };
340 
341 static const struct file_operations exynos_drm_driver_fops = {
342 	.owner		= THIS_MODULE,
343 	.open		= drm_open,
344 	.mmap		= exynos_drm_gem_mmap,
345 	.poll		= drm_poll,
346 	.read		= drm_read,
347 	.unlocked_ioctl	= drm_ioctl,
348 #ifdef CONFIG_COMPAT
349 	.compat_ioctl = drm_compat_ioctl,
350 #endif
351 	.release	= drm_release,
352 };
353 
354 static struct drm_driver exynos_drm_driver = {
355 	.driver_features	= DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME
356 				  | DRIVER_ATOMIC | DRIVER_RENDER,
357 	.load			= exynos_drm_load,
358 	.unload			= exynos_drm_unload,
359 	.open			= exynos_drm_open,
360 	.preclose		= exynos_drm_preclose,
361 	.lastclose		= exynos_drm_lastclose,
362 	.postclose		= exynos_drm_postclose,
363 	.get_vblank_counter	= drm_vblank_no_hw_counter,
364 	.enable_vblank		= exynos_drm_crtc_enable_vblank,
365 	.disable_vblank		= exynos_drm_crtc_disable_vblank,
366 	.gem_free_object_unlocked = exynos_drm_gem_free_object,
367 	.gem_vm_ops		= &exynos_drm_gem_vm_ops,
368 	.dumb_create		= exynos_drm_gem_dumb_create,
369 	.dumb_map_offset	= exynos_drm_gem_dumb_map_offset,
370 	.dumb_destroy		= drm_gem_dumb_destroy,
371 	.prime_handle_to_fd	= drm_gem_prime_handle_to_fd,
372 	.prime_fd_to_handle	= drm_gem_prime_fd_to_handle,
373 	.gem_prime_export	= drm_gem_prime_export,
374 	.gem_prime_import	= drm_gem_prime_import,
375 	.gem_prime_get_sg_table	= exynos_drm_gem_prime_get_sg_table,
376 	.gem_prime_import_sg_table	= exynos_drm_gem_prime_import_sg_table,
377 	.gem_prime_vmap		= exynos_drm_gem_prime_vmap,
378 	.gem_prime_vunmap	= exynos_drm_gem_prime_vunmap,
379 	.gem_prime_mmap		= exynos_drm_gem_prime_mmap,
380 	.ioctls			= exynos_ioctls,
381 	.num_ioctls		= ARRAY_SIZE(exynos_ioctls),
382 	.fops			= &exynos_drm_driver_fops,
383 	.name	= DRIVER_NAME,
384 	.desc	= DRIVER_DESC,
385 	.date	= DRIVER_DATE,
386 	.major	= DRIVER_MAJOR,
387 	.minor	= DRIVER_MINOR,
388 };
389 
390 #ifdef CONFIG_PM_SLEEP
391 static int exynos_drm_suspend(struct device *dev)
392 {
393 	struct drm_device *drm_dev = dev_get_drvdata(dev);
394 	struct drm_connector *connector;
395 
396 	if (pm_runtime_suspended(dev) || !drm_dev)
397 		return 0;
398 
399 	drm_modeset_lock_all(drm_dev);
400 	drm_for_each_connector(connector, drm_dev) {
401 		int old_dpms = connector->dpms;
402 
403 		if (connector->funcs->dpms)
404 			connector->funcs->dpms(connector, DRM_MODE_DPMS_OFF);
405 
406 		/* Set the old mode back to the connector for resume */
407 		connector->dpms = old_dpms;
408 	}
409 	drm_modeset_unlock_all(drm_dev);
410 
411 	return 0;
412 }
413 
414 static int exynos_drm_resume(struct device *dev)
415 {
416 	struct drm_device *drm_dev = dev_get_drvdata(dev);
417 	struct drm_connector *connector;
418 
419 	if (pm_runtime_suspended(dev) || !drm_dev)
420 		return 0;
421 
422 	drm_modeset_lock_all(drm_dev);
423 	drm_for_each_connector(connector, drm_dev) {
424 		if (connector->funcs->dpms) {
425 			int dpms = connector->dpms;
426 
427 			connector->dpms = DRM_MODE_DPMS_OFF;
428 			connector->funcs->dpms(connector, dpms);
429 		}
430 	}
431 	drm_modeset_unlock_all(drm_dev);
432 
433 	return 0;
434 }
435 #endif
436 
437 static const struct dev_pm_ops exynos_drm_pm_ops = {
438 	SET_SYSTEM_SLEEP_PM_OPS(exynos_drm_suspend, exynos_drm_resume)
439 };
440 
441 /* forward declaration */
442 static struct platform_driver exynos_drm_platform_driver;
443 
444 struct exynos_drm_driver_info {
445 	struct platform_driver *driver;
446 	unsigned int flags;
447 };
448 
449 #define DRM_COMPONENT_DRIVER	BIT(0)	/* supports component framework */
450 #define DRM_VIRTUAL_DEVICE	BIT(1)	/* create virtual platform device */
451 #define DRM_DMA_DEVICE		BIT(2)	/* can be used for dma allocations */
452 
453 #define DRV_PTR(drv, cond) (IS_ENABLED(cond) ? &drv : NULL)
454 
455 /*
456  * Connector drivers should not be placed before associated crtc drivers,
457  * because connector requires pipe number of its crtc during initialization.
458  */
459 static struct exynos_drm_driver_info exynos_drm_drivers[] = {
460 	{
461 		DRV_PTR(fimd_driver, CONFIG_DRM_EXYNOS_FIMD),
462 		DRM_COMPONENT_DRIVER | DRM_DMA_DEVICE
463 	}, {
464 		DRV_PTR(exynos5433_decon_driver, CONFIG_DRM_EXYNOS5433_DECON),
465 		DRM_COMPONENT_DRIVER | DRM_DMA_DEVICE
466 	}, {
467 		DRV_PTR(decon_driver, CONFIG_DRM_EXYNOS7_DECON),
468 		DRM_COMPONENT_DRIVER | DRM_DMA_DEVICE
469 	}, {
470 		DRV_PTR(mixer_driver, CONFIG_DRM_EXYNOS_MIXER),
471 		DRM_COMPONENT_DRIVER | DRM_DMA_DEVICE
472 	}, {
473 		DRV_PTR(mic_driver, CONFIG_DRM_EXYNOS_MIC),
474 		DRM_COMPONENT_DRIVER
475 	}, {
476 		DRV_PTR(dp_driver, CONFIG_DRM_EXYNOS_DP),
477 		DRM_COMPONENT_DRIVER
478 	}, {
479 		DRV_PTR(dsi_driver, CONFIG_DRM_EXYNOS_DSI),
480 		DRM_COMPONENT_DRIVER
481 	}, {
482 		DRV_PTR(hdmi_driver, CONFIG_DRM_EXYNOS_HDMI),
483 		DRM_COMPONENT_DRIVER
484 	}, {
485 		DRV_PTR(vidi_driver, CONFIG_DRM_EXYNOS_VIDI),
486 		DRM_COMPONENT_DRIVER | DRM_VIRTUAL_DEVICE
487 	}, {
488 		DRV_PTR(g2d_driver, CONFIG_DRM_EXYNOS_G2D),
489 	}, {
490 		DRV_PTR(fimc_driver, CONFIG_DRM_EXYNOS_FIMC),
491 	}, {
492 		DRV_PTR(rotator_driver, CONFIG_DRM_EXYNOS_ROTATOR),
493 	}, {
494 		DRV_PTR(gsc_driver, CONFIG_DRM_EXYNOS_GSC),
495 	}, {
496 		DRV_PTR(ipp_driver, CONFIG_DRM_EXYNOS_IPP),
497 		DRM_VIRTUAL_DEVICE
498 	}, {
499 		&exynos_drm_platform_driver,
500 		DRM_VIRTUAL_DEVICE
501 	}
502 };
503 
504 static int compare_dev(struct device *dev, void *data)
505 {
506 	return dev == (struct device *)data;
507 }
508 
509 static struct component_match *exynos_drm_match_add(struct device *dev)
510 {
511 	struct component_match *match = NULL;
512 	int i;
513 
514 	for (i = 0; i < ARRAY_SIZE(exynos_drm_drivers); ++i) {
515 		struct exynos_drm_driver_info *info = &exynos_drm_drivers[i];
516 		struct device *p = NULL, *d;
517 
518 		if (!info->driver || !(info->flags & DRM_COMPONENT_DRIVER))
519 			continue;
520 
521 		while ((d = bus_find_device(&platform_bus_type, p,
522 					    &info->driver->driver,
523 					    (void *)platform_bus_type.match))) {
524 			put_device(p);
525 			component_match_add(dev, &match, compare_dev, d);
526 			p = d;
527 		}
528 		put_device(p);
529 	}
530 
531 	return match ?: ERR_PTR(-ENODEV);
532 }
533 
534 static int exynos_drm_bind(struct device *dev)
535 {
536 	return drm_platform_init(&exynos_drm_driver, to_platform_device(dev));
537 }
538 
539 static void exynos_drm_unbind(struct device *dev)
540 {
541 	drm_put_dev(dev_get_drvdata(dev));
542 }
543 
544 static const struct component_master_ops exynos_drm_ops = {
545 	.bind		= exynos_drm_bind,
546 	.unbind		= exynos_drm_unbind,
547 };
548 
549 static int exynos_drm_platform_probe(struct platform_device *pdev)
550 {
551 	struct component_match *match;
552 
553 	pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
554 	exynos_drm_driver.num_ioctls = ARRAY_SIZE(exynos_ioctls);
555 
556 	match = exynos_drm_match_add(&pdev->dev);
557 	if (IS_ERR(match))
558 		return PTR_ERR(match);
559 
560 	return component_master_add_with_match(&pdev->dev, &exynos_drm_ops,
561 					       match);
562 }
563 
564 static int exynos_drm_platform_remove(struct platform_device *pdev)
565 {
566 	component_master_del(&pdev->dev, &exynos_drm_ops);
567 	return 0;
568 }
569 
570 static struct platform_driver exynos_drm_platform_driver = {
571 	.probe	= exynos_drm_platform_probe,
572 	.remove	= exynos_drm_platform_remove,
573 	.driver	= {
574 		.name	= "exynos-drm",
575 		.pm	= &exynos_drm_pm_ops,
576 	},
577 };
578 
579 static struct device *exynos_drm_get_dma_device(void)
580 {
581 	int i;
582 
583 	for (i = 0; i < ARRAY_SIZE(exynos_drm_drivers); ++i) {
584 		struct exynos_drm_driver_info *info = &exynos_drm_drivers[i];
585 		struct device *dev;
586 
587 		if (!info->driver || !(info->flags & DRM_DMA_DEVICE))
588 			continue;
589 
590 		while ((dev = bus_find_device(&platform_bus_type, NULL,
591 					    &info->driver->driver,
592 					    (void *)platform_bus_type.match))) {
593 			put_device(dev);
594 			return dev;
595 		}
596 	}
597 	return NULL;
598 }
599 
600 static void exynos_drm_unregister_devices(void)
601 {
602 	int i;
603 
604 	for (i = ARRAY_SIZE(exynos_drm_drivers) - 1; i >= 0; --i) {
605 		struct exynos_drm_driver_info *info = &exynos_drm_drivers[i];
606 		struct device *dev;
607 
608 		if (!info->driver || !(info->flags & DRM_VIRTUAL_DEVICE))
609 			continue;
610 
611 		while ((dev = bus_find_device(&platform_bus_type, NULL,
612 					    &info->driver->driver,
613 					    (void *)platform_bus_type.match))) {
614 			put_device(dev);
615 			platform_device_unregister(to_platform_device(dev));
616 		}
617 	}
618 }
619 
620 static int exynos_drm_register_devices(void)
621 {
622 	struct platform_device *pdev;
623 	int i;
624 
625 	for (i = 0; i < ARRAY_SIZE(exynos_drm_drivers); ++i) {
626 		struct exynos_drm_driver_info *info = &exynos_drm_drivers[i];
627 
628 		if (!info->driver || !(info->flags & DRM_VIRTUAL_DEVICE))
629 			continue;
630 
631 		pdev = platform_device_register_simple(
632 					info->driver->driver.name, -1, NULL, 0);
633 		if (IS_ERR(pdev))
634 			goto fail;
635 	}
636 
637 	return 0;
638 fail:
639 	exynos_drm_unregister_devices();
640 	return PTR_ERR(pdev);
641 }
642 
643 static void exynos_drm_unregister_drivers(void)
644 {
645 	int i;
646 
647 	for (i = ARRAY_SIZE(exynos_drm_drivers) - 1; i >= 0; --i) {
648 		struct exynos_drm_driver_info *info = &exynos_drm_drivers[i];
649 
650 		if (!info->driver)
651 			continue;
652 
653 		platform_driver_unregister(info->driver);
654 	}
655 }
656 
657 static int exynos_drm_register_drivers(void)
658 {
659 	int i, ret;
660 
661 	for (i = 0; i < ARRAY_SIZE(exynos_drm_drivers); ++i) {
662 		struct exynos_drm_driver_info *info = &exynos_drm_drivers[i];
663 
664 		if (!info->driver)
665 			continue;
666 
667 		ret = platform_driver_register(info->driver);
668 		if (ret)
669 			goto fail;
670 	}
671 	return 0;
672 fail:
673 	exynos_drm_unregister_drivers();
674 	return ret;
675 }
676 
677 static int exynos_drm_init(void)
678 {
679 	int ret;
680 
681 	ret = exynos_drm_register_devices();
682 	if (ret)
683 		return ret;
684 
685 	ret = exynos_drm_register_drivers();
686 	if (ret)
687 		goto err_unregister_pdevs;
688 
689 	return 0;
690 
691 err_unregister_pdevs:
692 	exynos_drm_unregister_devices();
693 
694 	return ret;
695 }
696 
697 static void exynos_drm_exit(void)
698 {
699 	exynos_drm_unregister_drivers();
700 	exynos_drm_unregister_devices();
701 }
702 
703 module_init(exynos_drm_init);
704 module_exit(exynos_drm_exit);
705 
706 MODULE_AUTHOR("Inki Dae <inki.dae@samsung.com>");
707 MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
708 MODULE_AUTHOR("Seung-Woo Kim <sw0312.kim@samsung.com>");
709 MODULE_DESCRIPTION("Samsung SoC DRM Driver");
710 MODULE_LICENSE("GPL");
711