Version:  2.0.40 2.2.26 2.4.37 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16 3.17 3.18 3.19 4.0 4.1 4.2 4.3 4.4 4.5

Linux/drivers/gpu/drm/exynos/exynos_drm_drv.c

  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 static int exynos_drm_open(struct drm_device *dev, struct drm_file *file)
308 {
309         struct drm_exynos_file_private *file_priv;
310         int ret;
311 
312         file_priv = kzalloc(sizeof(*file_priv), GFP_KERNEL);
313         if (!file_priv)
314                 return -ENOMEM;
315 
316         file->driver_priv = file_priv;
317 
318         ret = exynos_drm_subdrv_open(dev, file);
319         if (ret)
320                 goto err_file_priv_free;
321 
322         return ret;
323 
324 err_file_priv_free:
325         kfree(file_priv);
326         file->driver_priv = NULL;
327         return ret;
328 }
329 
330 static void exynos_drm_preclose(struct drm_device *dev,
331                                         struct drm_file *file)
332 {
333         struct drm_crtc *crtc;
334 
335         exynos_drm_subdrv_close(dev, file);
336 
337         list_for_each_entry(crtc, &dev->mode_config.crtc_list, head)
338                 exynos_drm_crtc_cancel_page_flip(crtc, file);
339 }
340 
341 static void exynos_drm_postclose(struct drm_device *dev, struct drm_file *file)
342 {
343         struct drm_pending_event *e, *et;
344         unsigned long flags;
345 
346         if (!file->driver_priv)
347                 return;
348 
349         spin_lock_irqsave(&dev->event_lock, flags);
350         /* Release all events handled by page flip handler but not freed. */
351         list_for_each_entry_safe(e, et, &file->event_list, link) {
352                 list_del(&e->link);
353                 e->destroy(e);
354         }
355         spin_unlock_irqrestore(&dev->event_lock, flags);
356 
357         kfree(file->driver_priv);
358         file->driver_priv = NULL;
359 }
360 
361 static void exynos_drm_lastclose(struct drm_device *dev)
362 {
363         exynos_drm_fbdev_restore_mode(dev);
364 }
365 
366 static const struct vm_operations_struct exynos_drm_gem_vm_ops = {
367         .fault = exynos_drm_gem_fault,
368         .open = drm_gem_vm_open,
369         .close = drm_gem_vm_close,
370 };
371 
372 static const struct drm_ioctl_desc exynos_ioctls[] = {
373         DRM_IOCTL_DEF_DRV(EXYNOS_GEM_CREATE, exynos_drm_gem_create_ioctl,
374                         DRM_AUTH | DRM_RENDER_ALLOW),
375         DRM_IOCTL_DEF_DRV(EXYNOS_GEM_GET, exynos_drm_gem_get_ioctl,
376                         DRM_RENDER_ALLOW),
377         DRM_IOCTL_DEF_DRV(EXYNOS_VIDI_CONNECTION, vidi_connection_ioctl,
378                         DRM_AUTH),
379         DRM_IOCTL_DEF_DRV(EXYNOS_G2D_GET_VER, exynos_g2d_get_ver_ioctl,
380                         DRM_AUTH | DRM_RENDER_ALLOW),
381         DRM_IOCTL_DEF_DRV(EXYNOS_G2D_SET_CMDLIST, exynos_g2d_set_cmdlist_ioctl,
382                         DRM_AUTH | DRM_RENDER_ALLOW),
383         DRM_IOCTL_DEF_DRV(EXYNOS_G2D_EXEC, exynos_g2d_exec_ioctl,
384                         DRM_AUTH | DRM_RENDER_ALLOW),
385         DRM_IOCTL_DEF_DRV(EXYNOS_IPP_GET_PROPERTY, exynos_drm_ipp_get_property,
386                         DRM_AUTH | DRM_RENDER_ALLOW),
387         DRM_IOCTL_DEF_DRV(EXYNOS_IPP_SET_PROPERTY, exynos_drm_ipp_set_property,
388                         DRM_AUTH | DRM_RENDER_ALLOW),
389         DRM_IOCTL_DEF_DRV(EXYNOS_IPP_QUEUE_BUF, exynos_drm_ipp_queue_buf,
390                         DRM_AUTH | DRM_RENDER_ALLOW),
391         DRM_IOCTL_DEF_DRV(EXYNOS_IPP_CMD_CTRL, exynos_drm_ipp_cmd_ctrl,
392                         DRM_AUTH | DRM_RENDER_ALLOW),
393 };
394 
395 static const struct file_operations exynos_drm_driver_fops = {
396         .owner          = THIS_MODULE,
397         .open           = drm_open,
398         .mmap           = exynos_drm_gem_mmap,
399         .poll           = drm_poll,
400         .read           = drm_read,
401         .unlocked_ioctl = drm_ioctl,
402 #ifdef CONFIG_COMPAT
403         .compat_ioctl = drm_compat_ioctl,
404 #endif
405         .release        = drm_release,
406 };
407 
408 static struct drm_driver exynos_drm_driver = {
409         .driver_features        = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME
410                                   | DRIVER_ATOMIC | DRIVER_RENDER,
411         .load                   = exynos_drm_load,
412         .unload                 = exynos_drm_unload,
413         .open                   = exynos_drm_open,
414         .preclose               = exynos_drm_preclose,
415         .lastclose              = exynos_drm_lastclose,
416         .postclose              = exynos_drm_postclose,
417         .set_busid              = drm_platform_set_busid,
418         .get_vblank_counter     = drm_vblank_no_hw_counter,
419         .enable_vblank          = exynos_drm_crtc_enable_vblank,
420         .disable_vblank         = exynos_drm_crtc_disable_vblank,
421         .gem_free_object        = exynos_drm_gem_free_object,
422         .gem_vm_ops             = &exynos_drm_gem_vm_ops,
423         .dumb_create            = exynos_drm_gem_dumb_create,
424         .dumb_map_offset        = exynos_drm_gem_dumb_map_offset,
425         .dumb_destroy           = drm_gem_dumb_destroy,
426         .prime_handle_to_fd     = drm_gem_prime_handle_to_fd,
427         .prime_fd_to_handle     = drm_gem_prime_fd_to_handle,
428         .gem_prime_export       = drm_gem_prime_export,
429         .gem_prime_import       = drm_gem_prime_import,
430         .gem_prime_get_sg_table = exynos_drm_gem_prime_get_sg_table,
431         .gem_prime_import_sg_table      = exynos_drm_gem_prime_import_sg_table,
432         .gem_prime_vmap         = exynos_drm_gem_prime_vmap,
433         .gem_prime_vunmap       = exynos_drm_gem_prime_vunmap,
434         .ioctls                 = exynos_ioctls,
435         .num_ioctls             = ARRAY_SIZE(exynos_ioctls),
436         .fops                   = &exynos_drm_driver_fops,
437         .name   = DRIVER_NAME,
438         .desc   = DRIVER_DESC,
439         .date   = DRIVER_DATE,
440         .major  = DRIVER_MAJOR,
441         .minor  = DRIVER_MINOR,
442 };
443 
444 #ifdef CONFIG_PM_SLEEP
445 static int exynos_drm_suspend(struct device *dev)
446 {
447         struct drm_device *drm_dev = dev_get_drvdata(dev);
448         struct drm_connector *connector;
449 
450         if (pm_runtime_suspended(dev) || !drm_dev)
451                 return 0;
452 
453         drm_modeset_lock_all(drm_dev);
454         drm_for_each_connector(connector, drm_dev) {
455                 int old_dpms = connector->dpms;
456 
457                 if (connector->funcs->dpms)
458                         connector->funcs->dpms(connector, DRM_MODE_DPMS_OFF);
459 
460                 /* Set the old mode back to the connector for resume */
461                 connector->dpms = old_dpms;
462         }
463         drm_modeset_unlock_all(drm_dev);
464 
465         return 0;
466 }
467 
468 static int exynos_drm_resume(struct device *dev)
469 {
470         struct drm_device *drm_dev = dev_get_drvdata(dev);
471         struct drm_connector *connector;
472 
473         if (pm_runtime_suspended(dev) || !drm_dev)
474                 return 0;
475 
476         drm_modeset_lock_all(drm_dev);
477         drm_for_each_connector(connector, drm_dev) {
478                 if (connector->funcs->dpms) {
479                         int dpms = connector->dpms;
480 
481                         connector->dpms = DRM_MODE_DPMS_OFF;
482                         connector->funcs->dpms(connector, dpms);
483                 }
484         }
485         drm_modeset_unlock_all(drm_dev);
486 
487         return 0;
488 }
489 #endif
490 
491 static const struct dev_pm_ops exynos_drm_pm_ops = {
492         SET_SYSTEM_SLEEP_PM_OPS(exynos_drm_suspend, exynos_drm_resume)
493 };
494 
495 /* forward declaration */
496 static struct platform_driver exynos_drm_platform_driver;
497 
498 /*
499  * Connector drivers should not be placed before associated crtc drivers,
500  * because connector requires pipe number of its crtc during initialization.
501  */
502 static struct platform_driver *const exynos_drm_kms_drivers[] = {
503 #ifdef CONFIG_DRM_EXYNOS_FIMD
504         &fimd_driver,
505 #endif
506 #ifdef CONFIG_DRM_EXYNOS5433_DECON
507         &exynos5433_decon_driver,
508 #endif
509 #ifdef CONFIG_DRM_EXYNOS7_DECON
510         &decon_driver,
511 #endif
512 #ifdef CONFIG_DRM_EXYNOS_MIC
513         &mic_driver,
514 #endif
515 #ifdef CONFIG_DRM_EXYNOS_DP
516         &dp_driver,
517 #endif
518 #ifdef CONFIG_DRM_EXYNOS_DSI
519         &dsi_driver,
520 #endif
521 #ifdef CONFIG_DRM_EXYNOS_MIXER
522         &mixer_driver,
523 #endif
524 #ifdef CONFIG_DRM_EXYNOS_HDMI
525         &hdmi_driver,
526 #endif
527 #ifdef CONFIG_DRM_EXYNOS_VIDI
528         &vidi_driver,
529 #endif
530 };
531 
532 static struct platform_driver *const exynos_drm_non_kms_drivers[] = {
533 #ifdef CONFIG_DRM_EXYNOS_G2D
534         &g2d_driver,
535 #endif
536 #ifdef CONFIG_DRM_EXYNOS_FIMC
537         &fimc_driver,
538 #endif
539 #ifdef CONFIG_DRM_EXYNOS_ROTATOR
540         &rotator_driver,
541 #endif
542 #ifdef CONFIG_DRM_EXYNOS_GSC
543         &gsc_driver,
544 #endif
545 #ifdef CONFIG_DRM_EXYNOS_IPP
546         &ipp_driver,
547 #endif
548         &exynos_drm_platform_driver,
549 };
550 
551 static struct platform_driver *const exynos_drm_drv_with_simple_dev[] = {
552 #ifdef CONFIG_DRM_EXYNOS_VIDI
553         &vidi_driver,
554 #endif
555 #ifdef CONFIG_DRM_EXYNOS_IPP
556         &ipp_driver,
557 #endif
558         &exynos_drm_platform_driver,
559 };
560 #define PDEV_COUNT ARRAY_SIZE(exynos_drm_drv_with_simple_dev)
561 
562 static int compare_dev(struct device *dev, void *data)
563 {
564         return dev == (struct device *)data;
565 }
566 
567 static struct component_match *exynos_drm_match_add(struct device *dev)
568 {
569         struct component_match *match = NULL;
570         int i;
571 
572         for (i = 0; i < ARRAY_SIZE(exynos_drm_kms_drivers); ++i) {
573                 struct device_driver *drv = &exynos_drm_kms_drivers[i]->driver;
574                 struct device *p = NULL, *d;
575 
576                 while ((d = bus_find_device(&platform_bus_type, p, drv,
577                                             (void *)platform_bus_type.match))) {
578                         put_device(p);
579                         component_match_add(dev, &match, compare_dev, d);
580                         p = d;
581                 }
582                 put_device(p);
583         }
584 
585         return match ?: ERR_PTR(-ENODEV);
586 }
587 
588 static int exynos_drm_bind(struct device *dev)
589 {
590         return drm_platform_init(&exynos_drm_driver, to_platform_device(dev));
591 }
592 
593 static void exynos_drm_unbind(struct device *dev)
594 {
595         drm_put_dev(dev_get_drvdata(dev));
596 }
597 
598 static const struct component_master_ops exynos_drm_ops = {
599         .bind           = exynos_drm_bind,
600         .unbind         = exynos_drm_unbind,
601 };
602 
603 static int exynos_drm_platform_probe(struct platform_device *pdev)
604 {
605         struct component_match *match;
606 
607         pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
608         exynos_drm_driver.num_ioctls = ARRAY_SIZE(exynos_ioctls);
609 
610         match = exynos_drm_match_add(&pdev->dev);
611         if (IS_ERR(match))
612                 return PTR_ERR(match);
613 
614         return component_master_add_with_match(&pdev->dev, &exynos_drm_ops,
615                                                match);
616 }
617 
618 static int exynos_drm_platform_remove(struct platform_device *pdev)
619 {
620         component_master_del(&pdev->dev, &exynos_drm_ops);
621         return 0;
622 }
623 
624 static struct platform_driver exynos_drm_platform_driver = {
625         .probe  = exynos_drm_platform_probe,
626         .remove = exynos_drm_platform_remove,
627         .driver = {
628                 .name   = "exynos-drm",
629                 .pm     = &exynos_drm_pm_ops,
630         },
631 };
632 
633 static struct platform_device *exynos_drm_pdevs[PDEV_COUNT];
634 
635 static void exynos_drm_unregister_devices(void)
636 {
637         int i = PDEV_COUNT;
638 
639         while (--i >= 0) {
640                 platform_device_unregister(exynos_drm_pdevs[i]);
641                 exynos_drm_pdevs[i] = NULL;
642         }
643 }
644 
645 static int exynos_drm_register_devices(void)
646 {
647         int i;
648 
649         for (i = 0; i < PDEV_COUNT; ++i) {
650                 struct platform_driver *d = exynos_drm_drv_with_simple_dev[i];
651                 struct platform_device *pdev =
652                         platform_device_register_simple(d->driver.name, -1,
653                                                         NULL, 0);
654 
655                 if (!IS_ERR(pdev)) {
656                         exynos_drm_pdevs[i] = pdev;
657                         continue;
658                 }
659                 while (--i >= 0) {
660                         platform_device_unregister(exynos_drm_pdevs[i]);
661                         exynos_drm_pdevs[i] = NULL;
662                 }
663 
664                 return PTR_ERR(pdev);
665         }
666 
667         return 0;
668 }
669 
670 static void exynos_drm_unregister_drivers(struct platform_driver * const *drv,
671                                           int count)
672 {
673         while (--count >= 0)
674                 platform_driver_unregister(drv[count]);
675 }
676 
677 static int exynos_drm_register_drivers(struct platform_driver * const *drv,
678                                        int count)
679 {
680         int i, ret;
681 
682         for (i = 0; i < count; ++i) {
683                 ret = platform_driver_register(drv[i]);
684                 if (!ret)
685                         continue;
686 
687                 while (--i >= 0)
688                         platform_driver_unregister(drv[i]);
689 
690                 return ret;
691         }
692 
693         return 0;
694 }
695 
696 static inline int exynos_drm_register_kms_drivers(void)
697 {
698         return exynos_drm_register_drivers(exynos_drm_kms_drivers,
699                                         ARRAY_SIZE(exynos_drm_kms_drivers));
700 }
701 
702 static inline int exynos_drm_register_non_kms_drivers(void)
703 {
704         return exynos_drm_register_drivers(exynos_drm_non_kms_drivers,
705                                         ARRAY_SIZE(exynos_drm_non_kms_drivers));
706 }
707 
708 static inline void exynos_drm_unregister_kms_drivers(void)
709 {
710         exynos_drm_unregister_drivers(exynos_drm_kms_drivers,
711                                         ARRAY_SIZE(exynos_drm_kms_drivers));
712 }
713 
714 static inline void exynos_drm_unregister_non_kms_drivers(void)
715 {
716         exynos_drm_unregister_drivers(exynos_drm_non_kms_drivers,
717                                         ARRAY_SIZE(exynos_drm_non_kms_drivers));
718 }
719 
720 static int exynos_drm_init(void)
721 {
722         int ret;
723 
724         ret = exynos_drm_register_devices();
725         if (ret)
726                 return ret;
727 
728         ret = exynos_drm_register_kms_drivers();
729         if (ret)
730                 goto err_unregister_pdevs;
731 
732         ret = exynos_drm_register_non_kms_drivers();
733         if (ret)
734                 goto err_unregister_kms_drivers;
735 
736         return 0;
737 
738 err_unregister_kms_drivers:
739         exynos_drm_unregister_kms_drivers();
740 
741 err_unregister_pdevs:
742         exynos_drm_unregister_devices();
743 
744         return ret;
745 }
746 
747 static void exynos_drm_exit(void)
748 {
749         exynos_drm_unregister_non_kms_drivers();
750         exynos_drm_unregister_kms_drivers();
751         exynos_drm_unregister_devices();
752 }
753 
754 module_init(exynos_drm_init);
755 module_exit(exynos_drm_exit);
756 
757 MODULE_AUTHOR("Inki Dae <inki.dae@samsung.com>");
758 MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
759 MODULE_AUTHOR("Seung-Woo Kim <sw0312.kim@samsung.com>");
760 MODULE_DESCRIPTION("Samsung SoC DRM Driver");
761 MODULE_LICENSE("GPL");
762 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us