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); 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_UNLOCKED | DRM_AUTH | DRM_RENDER_ALLOW), 409 DRM_IOCTL_DEF_DRV(EXYNOS_GEM_GET, exynos_drm_gem_get_ioctl, 410 DRM_UNLOCKED | DRM_RENDER_ALLOW), 411 DRM_IOCTL_DEF_DRV(EXYNOS_VIDI_CONNECTION, vidi_connection_ioctl, 412 DRM_UNLOCKED | DRM_AUTH), 413 DRM_IOCTL_DEF_DRV(EXYNOS_G2D_GET_VER, exynos_g2d_get_ver_ioctl, 414 DRM_UNLOCKED | DRM_AUTH | DRM_RENDER_ALLOW), 415 DRM_IOCTL_DEF_DRV(EXYNOS_G2D_SET_CMDLIST, exynos_g2d_set_cmdlist_ioctl, 416 DRM_UNLOCKED | DRM_AUTH | DRM_RENDER_ALLOW), 417 DRM_IOCTL_DEF_DRV(EXYNOS_G2D_EXEC, exynos_g2d_exec_ioctl, 418 DRM_UNLOCKED | DRM_AUTH | DRM_RENDER_ALLOW), 419 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_GET_PROPERTY, exynos_drm_ipp_get_property, 420 DRM_UNLOCKED | DRM_AUTH | DRM_RENDER_ALLOW), 421 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_SET_PROPERTY, exynos_drm_ipp_set_property, 422 DRM_UNLOCKED | DRM_AUTH | DRM_RENDER_ALLOW), 423 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_QUEUE_BUF, exynos_drm_ipp_queue_buf, 424 DRM_UNLOCKED | DRM_AUTH | DRM_RENDER_ALLOW), 425 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_CMD_CTRL, exynos_drm_ipp_cmd_ctrl, 426 DRM_UNLOCKED | 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_count, 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_HDMI 533 &mixer_driver, 534 &hdmi_driver, 535 #endif 536 #ifdef CONFIG_DRM_EXYNOS_VIDI 537 &vidi_driver, 538 #endif 539 }; 540 541 static struct platform_driver *const exynos_drm_non_kms_drivers[] = { 542 #ifdef CONFIG_DRM_EXYNOS_G2D 543 &g2d_driver, 544 #endif 545 #ifdef CONFIG_DRM_EXYNOS_FIMC 546 &fimc_driver, 547 #endif 548 #ifdef CONFIG_DRM_EXYNOS_ROTATOR 549 &rotator_driver, 550 #endif 551 #ifdef CONFIG_DRM_EXYNOS_GSC 552 &gsc_driver, 553 #endif 554 #ifdef CONFIG_DRM_EXYNOS_IPP 555 &ipp_driver, 556 #endif 557 &exynos_drm_platform_driver, 558 }; 559 560 static struct platform_driver *const exynos_drm_drv_with_simple_dev[] = { 561 #ifdef CONFIG_DRM_EXYNOS_VIDI 562 &vidi_driver, 563 #endif 564 #ifdef CONFIG_DRM_EXYNOS_IPP 565 &ipp_driver, 566 #endif 567 &exynos_drm_platform_driver, 568 }; 569 #define PDEV_COUNT ARRAY_SIZE(exynos_drm_drv_with_simple_dev) 570 571 static int compare_dev(struct device *dev, void *data) 572 { 573 return dev == (struct device *)data; 574 } 575 576 static struct component_match *exynos_drm_match_add(struct device *dev) 577 { 578 struct component_match *match = NULL; 579 int i; 580 581 for (i = 0; i < ARRAY_SIZE(exynos_drm_kms_drivers); ++i) { 582 struct device_driver *drv = &exynos_drm_kms_drivers[i]->driver; 583 struct device *p = NULL, *d; 584 585 while ((d = bus_find_device(&platform_bus_type, p, drv, 586 (void *)platform_bus_type.match))) { 587 put_device(p); 588 component_match_add(dev, &match, compare_dev, d); 589 p = d; 590 } 591 put_device(p); 592 } 593 594 return match ?: ERR_PTR(-ENODEV); 595 } 596 597 static int exynos_drm_bind(struct device *dev) 598 { 599 return drm_platform_init(&exynos_drm_driver, to_platform_device(dev)); 600 } 601 602 static void exynos_drm_unbind(struct device *dev) 603 { 604 drm_put_dev(dev_get_drvdata(dev)); 605 } 606 607 static const struct component_master_ops exynos_drm_ops = { 608 .bind = exynos_drm_bind, 609 .unbind = exynos_drm_unbind, 610 }; 611 612 static int exynos_drm_platform_probe(struct platform_device *pdev) 613 { 614 struct component_match *match; 615 616 pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32); 617 exynos_drm_driver.num_ioctls = ARRAY_SIZE(exynos_ioctls); 618 619 match = exynos_drm_match_add(&pdev->dev); 620 if (IS_ERR(match)) 621 return PTR_ERR(match); 622 623 return component_master_add_with_match(&pdev->dev, &exynos_drm_ops, 624 match); 625 } 626 627 static int exynos_drm_platform_remove(struct platform_device *pdev) 628 { 629 component_master_del(&pdev->dev, &exynos_drm_ops); 630 return 0; 631 } 632 633 static struct platform_driver exynos_drm_platform_driver = { 634 .probe = exynos_drm_platform_probe, 635 .remove = exynos_drm_platform_remove, 636 .driver = { 637 .name = "exynos-drm", 638 .pm = &exynos_drm_pm_ops, 639 }, 640 }; 641 642 static struct platform_device *exynos_drm_pdevs[PDEV_COUNT]; 643 644 static void exynos_drm_unregister_devices(void) 645 { 646 int i = PDEV_COUNT; 647 648 while (--i >= 0) { 649 platform_device_unregister(exynos_drm_pdevs[i]); 650 exynos_drm_pdevs[i] = NULL; 651 } 652 } 653 654 static int exynos_drm_register_devices(void) 655 { 656 int i; 657 658 for (i = 0; i < PDEV_COUNT; ++i) { 659 struct platform_driver *d = exynos_drm_drv_with_simple_dev[i]; 660 struct platform_device *pdev = 661 platform_device_register_simple(d->driver.name, -1, 662 NULL, 0); 663 664 if (!IS_ERR(pdev)) { 665 exynos_drm_pdevs[i] = pdev; 666 continue; 667 } 668 while (--i >= 0) { 669 platform_device_unregister(exynos_drm_pdevs[i]); 670 exynos_drm_pdevs[i] = NULL; 671 } 672 673 return PTR_ERR(pdev); 674 } 675 676 return 0; 677 } 678 679 static void exynos_drm_unregister_drivers(struct platform_driver * const *drv, 680 int count) 681 { 682 while (--count >= 0) 683 platform_driver_unregister(drv[count]); 684 } 685 686 static int exynos_drm_register_drivers(struct platform_driver * const *drv, 687 int count) 688 { 689 int i, ret; 690 691 for (i = 0; i < count; ++i) { 692 ret = platform_driver_register(drv[i]); 693 if (!ret) 694 continue; 695 696 while (--i >= 0) 697 platform_driver_unregister(drv[i]); 698 699 return ret; 700 } 701 702 return 0; 703 } 704 705 static inline int exynos_drm_register_kms_drivers(void) 706 { 707 return exynos_drm_register_drivers(exynos_drm_kms_drivers, 708 ARRAY_SIZE(exynos_drm_kms_drivers)); 709 } 710 711 static inline int exynos_drm_register_non_kms_drivers(void) 712 { 713 return exynos_drm_register_drivers(exynos_drm_non_kms_drivers, 714 ARRAY_SIZE(exynos_drm_non_kms_drivers)); 715 } 716 717 static inline void exynos_drm_unregister_kms_drivers(void) 718 { 719 exynos_drm_unregister_drivers(exynos_drm_kms_drivers, 720 ARRAY_SIZE(exynos_drm_kms_drivers)); 721 } 722 723 static inline void exynos_drm_unregister_non_kms_drivers(void) 724 { 725 exynos_drm_unregister_drivers(exynos_drm_non_kms_drivers, 726 ARRAY_SIZE(exynos_drm_non_kms_drivers)); 727 } 728 729 static int exynos_drm_init(void) 730 { 731 int ret; 732 733 ret = exynos_drm_register_devices(); 734 if (ret) 735 return ret; 736 737 ret = exynos_drm_register_kms_drivers(); 738 if (ret) 739 goto err_unregister_pdevs; 740 741 ret = exynos_drm_register_non_kms_drivers(); 742 if (ret) 743 goto err_unregister_kms_drivers; 744 745 return 0; 746 747 err_unregister_kms_drivers: 748 exynos_drm_unregister_kms_drivers(); 749 750 err_unregister_pdevs: 751 exynos_drm_unregister_devices(); 752 753 return ret; 754 } 755 756 static void exynos_drm_exit(void) 757 { 758 exynos_drm_unregister_non_kms_drivers(); 759 exynos_drm_unregister_kms_drivers(); 760 exynos_drm_unregister_devices(); 761 } 762 763 module_init(exynos_drm_init); 764 module_exit(exynos_drm_exit); 765 766 MODULE_AUTHOR("Inki Dae <inki.dae@samsung.com>"); 767 MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>"); 768 MODULE_AUTHOR("Seung-Woo Kim <sw0312.kim@samsung.com>"); 769 MODULE_DESCRIPTION("Samsung SoC DRM Driver"); 770 MODULE_LICENSE("GPL"); 771