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_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 
69 static 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;
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;
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 
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 
108 	drm_atomic_helper_commit_planes(dev, state, false);
109 
110 	exynos_atomic_wait_for_commit(state);
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 
125 static 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 
133 static int exynos_drm_load(struct drm_device *dev, unsigned long flags)
134 {
135 	struct exynos_drm_private *private;
136 	struct drm_encoder *encoder;
137 	unsigned int clone_mask;
138 	int cnt, ret;
139 
140 	private = kzalloc(sizeof(struct exynos_drm_private), GFP_KERNEL);
141 	if (!private)
142 		return -ENOMEM;
143 
144 	init_waitqueue_head(&private->wait);
145 	spin_lock_init(&private->lock);
146 
147 	dev_set_drvdata(dev->dev, dev);
148 	dev->dev_private = (void *)private;
149 
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");
159 		goto err_free_private;
160 	}
161 
162 	drm_mode_config_init(dev);
163 
164 	exynos_drm_mode_config_init(dev);
165 
166 	/* setup possible_clones. */
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;
174 
175 	platform_set_drvdata(dev->platformdev, dev);
176 
177 	/* Try to bind all sub drivers. */
178 	ret = component_bind_all(dev->dev, dev);
179 	if (ret)
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;
185 
186 	/* Probe non kms sub drivers and virtual display driver. */
187 	ret = exynos_drm_device_subdrv_probe(dev);
188 	if (ret)
189 		goto err_cleanup_vblank;
190 
191 	drm_mode_config_reset(dev);
192 
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 
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 
216 	return 0;
217 
218 err_cleanup_vblank:
219 	drm_vblank_cleanup(dev);
220 err_unbind_all:
221 	component_unbind_all(dev->dev, dev);
222 err_mode_config_cleanup:
223 	drm_mode_config_cleanup(dev);
224 	drm_release_iommu_mapping(dev);
225 err_free_private:
226 	kfree(private);
227 
228 	return ret;
229 }
230 
231 static int exynos_drm_unload(struct drm_device *dev)
232 {
233 	exynos_drm_device_subdrv_remove(dev);
234 
235 	exynos_drm_fbdev_fini(dev);
236 	drm_kms_helper_poll_fini(dev);
237 
238 	drm_vblank_cleanup(dev);
239 	component_unbind_all(dev->dev, dev);
240 	drm_mode_config_cleanup(dev);
241 	drm_release_iommu_mapping(dev);
242 
243 	kfree(dev->dev_private);
244 	dev->dev_private = NULL;
245 
246 	return 0;
247 }
248 
249 static 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 
260 int 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 
307 #ifdef CONFIG_PM_SLEEP
308 static 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 
327 static 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) {
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 		}
339 	}
340 	drm_modeset_unlock_all(dev);
341 
342 	return 0;
343 }
344 #endif
345 
346 static int exynos_drm_open(struct drm_device *dev, struct drm_file *file)
347 {
348 	struct drm_exynos_file_private *file_priv;
349 	int ret;
350 
351 	file_priv = kzalloc(sizeof(*file_priv), GFP_KERNEL);
352 	if (!file_priv)
353 		return -ENOMEM;
354 
355 	file->driver_priv = file_priv;
356 
357 	ret = exynos_drm_subdrv_open(dev, file);
358 	if (ret)
359 		goto err_file_priv_free;
360 
361 	return ret;
362 
363 err_file_priv_free:
364 	kfree(file_priv);
365 	file->driver_priv = NULL;
366 	return ret;
367 }
368 
369 static void exynos_drm_preclose(struct drm_device *dev,
370 					struct drm_file *file)
371 {
372 	exynos_drm_subdrv_close(dev, file);
373 }
374 
375 static void exynos_drm_postclose(struct drm_device *dev, struct drm_file *file)
376 {
377 	struct drm_pending_event *e, *et;
378 	unsigned long flags;
379 
380 	if (!file->driver_priv)
381 		return;
382 
383 	spin_lock_irqsave(&dev->event_lock, flags);
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);
390 
391 	kfree(file->driver_priv);
392 	file->driver_priv = NULL;
393 }
394 
395 static void exynos_drm_lastclose(struct drm_device *dev)
396 {
397 	exynos_drm_fbdev_restore_mode(dev);
398 }
399 
400 static const struct vm_operations_struct exynos_drm_gem_vm_ops = {
401 	.fault = exynos_drm_gem_fault,
402 	.open = drm_gem_vm_open,
403 	.close = drm_gem_vm_close,
404 };
405 
406 static const struct drm_ioctl_desc exynos_ioctls[] = {
407 	DRM_IOCTL_DEF_DRV(EXYNOS_GEM_CREATE, exynos_drm_gem_create_ioctl,
408 			DRM_AUTH | DRM_RENDER_ALLOW),
409 	DRM_IOCTL_DEF_DRV(EXYNOS_GEM_GET, exynos_drm_gem_get_ioctl,
410 			DRM_RENDER_ALLOW),
411 	DRM_IOCTL_DEF_DRV(EXYNOS_VIDI_CONNECTION, vidi_connection_ioctl,
412 			DRM_AUTH),
413 	DRM_IOCTL_DEF_DRV(EXYNOS_G2D_GET_VER, exynos_g2d_get_ver_ioctl,
414 			DRM_AUTH | DRM_RENDER_ALLOW),
415 	DRM_IOCTL_DEF_DRV(EXYNOS_G2D_SET_CMDLIST, exynos_g2d_set_cmdlist_ioctl,
416 			DRM_AUTH | DRM_RENDER_ALLOW),
417 	DRM_IOCTL_DEF_DRV(EXYNOS_G2D_EXEC, exynos_g2d_exec_ioctl,
418 			DRM_AUTH | DRM_RENDER_ALLOW),
419 	DRM_IOCTL_DEF_DRV(EXYNOS_IPP_GET_PROPERTY, exynos_drm_ipp_get_property,
420 			DRM_AUTH | DRM_RENDER_ALLOW),
421 	DRM_IOCTL_DEF_DRV(EXYNOS_IPP_SET_PROPERTY, exynos_drm_ipp_set_property,
422 			DRM_AUTH | DRM_RENDER_ALLOW),
423 	DRM_IOCTL_DEF_DRV(EXYNOS_IPP_QUEUE_BUF, exynos_drm_ipp_queue_buf,
424 			DRM_AUTH | DRM_RENDER_ALLOW),
425 	DRM_IOCTL_DEF_DRV(EXYNOS_IPP_CMD_CTRL, exynos_drm_ipp_cmd_ctrl,
426 			DRM_AUTH | DRM_RENDER_ALLOW),
427 };
428 
429 static 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,
436 #ifdef CONFIG_COMPAT
437 	.compat_ioctl = drm_compat_ioctl,
438 #endif
439 	.release	= drm_release,
440 };
441 
442 static struct drm_driver exynos_drm_driver = {
443 	.driver_features	= DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME
444 				  | DRIVER_ATOMIC | DRIVER_RENDER,
445 	.load			= exynos_drm_load,
446 	.unload			= exynos_drm_unload,
447 	.open			= exynos_drm_open,
448 	.preclose		= exynos_drm_preclose,
449 	.lastclose		= exynos_drm_lastclose,
450 	.postclose		= exynos_drm_postclose,
451 	.set_busid		= drm_platform_set_busid,
452 	.get_vblank_counter	= drm_vblank_no_hw_counter,
453 	.enable_vblank		= exynos_drm_crtc_enable_vblank,
454 	.disable_vblank		= exynos_drm_crtc_disable_vblank,
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,
459 	.dumb_destroy		= drm_gem_dumb_destroy,
460 	.prime_handle_to_fd	= drm_gem_prime_handle_to_fd,
461 	.prime_fd_to_handle	= drm_gem_prime_fd_to_handle,
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,
468 	.ioctls			= exynos_ioctls,
469 	.num_ioctls		= ARRAY_SIZE(exynos_ioctls),
470 	.fops			= &exynos_drm_driver_fops,
471 	.name	= DRIVER_NAME,
472 	.desc	= DRIVER_DESC,
473 	.date	= DRIVER_DATE,
474 	.major	= DRIVER_MAJOR,
475 	.minor	= DRIVER_MINOR,
476 };
477 
478 #ifdef CONFIG_PM_SLEEP
479 static 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 
484 	if (pm_runtime_suspended(dev) || !drm_dev)
485 		return 0;
486 
487 	message.event = PM_EVENT_SUSPEND;
488 	return exynos_drm_suspend(drm_dev, message);
489 }
490 
491 static int exynos_drm_sys_resume(struct device *dev)
492 {
493 	struct drm_device *drm_dev = dev_get_drvdata(dev);
494 
495 	if (pm_runtime_suspended(dev) || !drm_dev)
496 		return 0;
497 
498 	return exynos_drm_resume(drm_dev);
499 }
500 #endif
501 
502 static const struct dev_pm_ops exynos_drm_pm_ops = {
503 	SET_SYSTEM_SLEEP_PM_OPS(exynos_drm_sys_suspend, exynos_drm_sys_resume)
504 };
505 
506 /* forward declaration */
507 static struct platform_driver exynos_drm_platform_driver;
508 
509 /*
510  * Connector drivers should not be placed before associated crtc drivers,
511  * because connector requires pipe number of its crtc during initialization.
512  */
513 static struct platform_driver *const exynos_drm_kms_drivers[] = {
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
523 #ifdef CONFIG_DRM_EXYNOS_MIC
524 	&mic_driver,
525 #endif
526 #ifdef CONFIG_DRM_EXYNOS_DP
527 	&dp_driver,
528 #endif
529 #ifdef CONFIG_DRM_EXYNOS_DSI
530 	&dsi_driver,
531 #endif
532 #ifdef CONFIG_DRM_EXYNOS_MIXER
533 	&mixer_driver,
534 #endif
535 #ifdef CONFIG_DRM_EXYNOS_HDMI
536 	&hdmi_driver,
537 #endif
538 #ifdef CONFIG_DRM_EXYNOS_VIDI
539 	&vidi_driver,
540 #endif
541 };
542 
543 static struct platform_driver *const exynos_drm_non_kms_drivers[] = {
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 };
561 
562 static 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)
572 
573 static int compare_dev(struct device *dev, void *data)
574 {
575 	return dev == (struct device *)data;
576 }
577 
578 static struct component_match *exynos_drm_match_add(struct device *dev)
579 {
580 	struct component_match *match = NULL;
581 	int i;
582 
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;
586 
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;
592 		}
593 		put_device(p);
594 	}
595 
596 	return match ?: ERR_PTR(-ENODEV);
597 }
598 
599 static int exynos_drm_bind(struct device *dev)
600 {
601 	return drm_platform_init(&exynos_drm_driver, to_platform_device(dev));
602 }
603 
604 static void exynos_drm_unbind(struct device *dev)
605 {
606 	drm_put_dev(dev_get_drvdata(dev));
607 }
608 
609 static const struct component_master_ops exynos_drm_ops = {
610 	.bind		= exynos_drm_bind,
611 	.unbind		= exynos_drm_unbind,
612 };
613 
614 static 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 
629 static int exynos_drm_platform_remove(struct platform_device *pdev)
630 {
631 	component_master_del(&pdev->dev, &exynos_drm_ops);
632 	return 0;
633 }
634 
635 static 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 
644 static struct platform_device *exynos_drm_pdevs[PDEV_COUNT];
645 
646 static void exynos_drm_unregister_devices(void)
647 {
648 	int i = PDEV_COUNT;
649 
650 	while (--i >= 0) {
651 		platform_device_unregister(exynos_drm_pdevs[i]);
652 		exynos_drm_pdevs[i] = NULL;
653 	}
654 }
655 
656 static 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);
676 	}
677 
678 	return 0;
679 }
680 
681 static void exynos_drm_unregister_drivers(struct platform_driver * const *drv,
682 					  int count)
683 {
684 	while (--count >= 0)
685 		platform_driver_unregister(drv[count]);
686 }
687 
688 static 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 
704 	return 0;
705 }
706 
707 static 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 
713 static 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 
719 static 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 
725 static 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 
731 static int exynos_drm_init(void)
732 {
733 	int ret;
734 
735 	ret = exynos_drm_register_devices();
736 	if (ret)
737 		return ret;
738 
739 	ret = exynos_drm_register_kms_drivers();
740 	if (ret)
741 		goto err_unregister_pdevs;
742 
743 	ret = exynos_drm_register_non_kms_drivers();
744 	if (ret)
745 		goto err_unregister_kms_drivers;
746 
747 	return 0;
748 
749 err_unregister_kms_drivers:
750 	exynos_drm_unregister_kms_drivers();
751 
752 err_unregister_pdevs:
753 	exynos_drm_unregister_devices();
754 
755 	return ret;
756 }
757 
758 static void exynos_drm_exit(void)
759 {
760 	exynos_drm_unregister_non_kms_drivers();
761 	exynos_drm_unregister_kms_drivers();
762 	exynos_drm_unregister_devices();
763 }
764 
765 module_init(exynos_drm_init);
766 module_exit(exynos_drm_exit);
767 
768 MODULE_AUTHOR("Inki Dae <inki.dae@samsung.com>");
769 MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
770 MODULE_AUTHOR("Seung-Woo Kim <sw0312.kim@samsung.com>");
771 MODULE_DESCRIPTION("Samsung SoC DRM Driver");
772 MODULE_LICENSE("GPL");
773