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

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 #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 

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