blob: 6675e7668d60b5ca6c5595f15ac3b9d4ac50c3ab [file] [log] [blame]
Inki Dae1c248b72011-10-04 19:19:01 +09001/*
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 *
Inki Daed81aecb2012-12-18 02:30:17 +09008 * 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.
Inki Dae1c248b72011-10-04 19:19:01 +090012 */
13
Sean Paulaf65c802014-01-30 16:19:27 -050014#include <linux/pm_runtime.h>
David Howells760285e2012-10-02 18:01:07 +010015#include <drm/drmP.h>
16#include <drm/drm_crtc_helper.h>
Inki Dae1c248b72011-10-04 19:19:01 +090017
Inki Daef37cd5e2014-05-09 14:25:20 +090018#include <linux/component.h>
Inki Dae96f54212013-12-20 19:16:24 +090019
Inki Dae1c248b72011-10-04 19:19:01 +090020#include <drm/exynos_drm.h>
21
22#include "exynos_drm_drv.h"
23#include "exynos_drm_crtc.h"
24#include "exynos_drm_fbdev.h"
25#include "exynos_drm_fb.h"
26#include "exynos_drm_gem.h"
Joonyoung Shim864ee9e2011-12-08 17:54:07 +090027#include "exynos_drm_plane.h"
Inki Daeb73d1232012-03-21 10:55:26 +090028#include "exynos_drm_vidi.h"
Inki Daeb2df26c2012-04-23 21:01:28 +090029#include "exynos_drm_dmabuf.h"
Joonyoung Shimd7f16422012-05-17 20:06:32 +090030#include "exynos_drm_g2d.h"
Eunchul Kimcb471f142012-12-14 18:10:31 +090031#include "exynos_drm_ipp.h"
Inki Dae0519f9a2012-10-20 07:53:42 -070032#include "exynos_drm_iommu.h"
Inki Dae1c248b72011-10-04 19:19:01 +090033
Inki Dae0edf9932011-12-15 17:31:24 +090034#define DRIVER_NAME "exynos"
Inki Dae1c248b72011-10-04 19:19:01 +090035#define DRIVER_DESC "Samsung SoC DRM"
36#define DRIVER_DATE "20110530"
37#define DRIVER_MAJOR 1
38#define DRIVER_MINOR 0
39
40static int exynos_drm_load(struct drm_device *dev, unsigned long flags)
41{
42 struct exynos_drm_private *private;
Gustavo Padovan6cf27272015-08-06 10:31:47 -030043 struct drm_encoder *encoder;
44 unsigned int clone_mask;
45 int cnt, ret;
Inki Dae1c248b72011-10-04 19:19:01 +090046
Inki Dae1c248b72011-10-04 19:19:01 +090047 private = kzalloc(sizeof(struct exynos_drm_private), GFP_KERNEL);
Sachin Kamat38bb5252013-08-19 19:04:55 +090048 if (!private)
Inki Dae1c248b72011-10-04 19:19:01 +090049 return -ENOMEM;
Inki Dae1c248b72011-10-04 19:19:01 +090050
Sean Paulaf65c802014-01-30 16:19:27 -050051 dev_set_drvdata(dev->dev, dev);
Inki Dae1c248b72011-10-04 19:19:01 +090052 dev->dev_private = (void *)private;
53
Inki Dae0519f9a2012-10-20 07:53:42 -070054 /*
55 * create mapping to manage iommu table and set a pointer to iommu
56 * mapping structure to iommu_mapping of private data.
57 * also this iommu_mapping can be used to check if iommu is supported
58 * or not.
59 */
60 ret = drm_create_iommu_mapping(dev);
61 if (ret < 0) {
62 DRM_ERROR("failed to create iommu mapping.\n");
Inki Daed2ba65f2014-02-28 18:37:02 +090063 goto err_free_private;
Inki Dae0519f9a2012-10-20 07:53:42 -070064 }
65
Inki Dae1c248b72011-10-04 19:19:01 +090066 drm_mode_config_init(dev);
67
68 exynos_drm_mode_config_init(dev);
69
Inki Daed081f562012-02-15 11:25:19 +090070 /* setup possible_clones. */
Gustavo Padovan6cf27272015-08-06 10:31:47 -030071 cnt = 0;
72 clone_mask = 0;
73 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
74 clone_mask |= (1 << (cnt++));
75
76 list_for_each_entry(encoder, &dev->mode_config.encoder_list, head)
77 encoder->possible_clones = clone_mask;
Inki Daed081f562012-02-15 11:25:19 +090078
Daniel Vettera9a346d2013-12-11 11:34:23 +010079 platform_set_drvdata(dev->platformdev, dev);
80
Inki Daef37cd5e2014-05-09 14:25:20 +090081 /* Try to bind all sub drivers. */
82 ret = component_bind_all(dev->dev, dev);
83 if (ret)
Andrzej Hajdac52142e2014-10-07 22:09:14 +090084 goto err_mode_config_cleanup;
85
86 ret = drm_vblank_init(dev, dev->mode_config.num_crtc);
87 if (ret)
88 goto err_unbind_all;
Inki Daef37cd5e2014-05-09 14:25:20 +090089
Inki Daed1afe7d2014-04-14 12:55:55 +090090 /* Probe non kms sub drivers and virtual display driver. */
Inki Daef37cd5e2014-05-09 14:25:20 +090091 ret = exynos_drm_device_subdrv_probe(dev);
92 if (ret)
Andrzej Hajdac52142e2014-10-07 22:09:14 +090093 goto err_cleanup_vblank;
Inki Daef37cd5e2014-05-09 14:25:20 +090094
Gustavo Padovan4ea95262015-06-01 12:04:44 -030095 drm_mode_config_reset(dev);
96
Joonyoung Shim4a3ffed2014-09-18 17:50:35 +090097 /*
98 * enable drm irq mode.
99 * - with irq_enabled = true, we can use the vblank feature.
100 *
101 * P.S. note that we wouldn't use drm irq handler but
102 * just specific driver own one instead because
103 * drm framework supports only one irq handler.
104 */
105 dev->irq_enabled = true;
106
107 /*
108 * with vblank_disable_allowed = true, vblank interrupt will be disabled
109 * by drm timer once a current process gives up ownership of
110 * vblank event.(after drm_vblank_put function is called)
111 */
112 dev->vblank_disable_allowed = true;
113
Andrzej Hajda3cb68302014-10-10 14:31:54 +0200114 /* init kms poll for handling hpd */
115 drm_kms_helper_poll_init(dev);
116
117 /* force connectors detection */
118 drm_helper_hpd_irq_event(dev);
119
Inki Dae1c248b72011-10-04 19:19:01 +0900120 return 0;
121
Inki Daef37cd5e2014-05-09 14:25:20 +0900122err_cleanup_vblank:
Inki Dae1c248b72011-10-04 19:19:01 +0900123 drm_vblank_cleanup(dev);
Andrzej Hajdac52142e2014-10-07 22:09:14 +0900124err_unbind_all:
125 component_unbind_all(dev->dev, dev);
Sean Paul080be03d2014-02-19 21:02:55 +0900126err_mode_config_cleanup:
127 drm_mode_config_cleanup(dev);
Inki Dae0519f9a2012-10-20 07:53:42 -0700128 drm_release_iommu_mapping(dev);
Inki Daed2ba65f2014-02-28 18:37:02 +0900129err_free_private:
Inki Dae1c248b72011-10-04 19:19:01 +0900130 kfree(private);
131
132 return ret;
133}
134
135static int exynos_drm_unload(struct drm_device *dev)
136{
Inki Daef37cd5e2014-05-09 14:25:20 +0900137 exynos_drm_device_subdrv_remove(dev);
138
Inki Dae1c248b72011-10-04 19:19:01 +0900139 exynos_drm_fbdev_fini(dev);
Seung-Woo Kim7db3eba2011-10-18 16:58:05 +0900140 drm_kms_helper_poll_fini(dev);
Inki Dae1c248b72011-10-04 19:19:01 +0900141
Andrzej Hajda9f3dd7d2014-09-09 15:16:06 +0200142 drm_vblank_cleanup(dev);
Andrzej Hajdac52142e2014-10-07 22:09:14 +0900143 component_unbind_all(dev->dev, dev);
Andrzej Hajda9f3dd7d2014-09-09 15:16:06 +0200144 drm_mode_config_cleanup(dev);
145 drm_release_iommu_mapping(dev);
146
147 kfree(dev->dev_private);
Inki Dae1c248b72011-10-04 19:19:01 +0900148 dev->dev_private = NULL;
149
150 return 0;
151}
152
Sean Paulaf65c802014-01-30 16:19:27 -0500153static int exynos_drm_suspend(struct drm_device *dev, pm_message_t state)
154{
155 struct drm_connector *connector;
156
157 drm_modeset_lock_all(dev);
158 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
159 int old_dpms = connector->dpms;
160
161 if (connector->funcs->dpms)
162 connector->funcs->dpms(connector, DRM_MODE_DPMS_OFF);
163
164 /* Set the old mode back to the connector for resume */
165 connector->dpms = old_dpms;
166 }
167 drm_modeset_unlock_all(dev);
168
169 return 0;
170}
171
172static int exynos_drm_resume(struct drm_device *dev)
173{
174 struct drm_connector *connector;
175
176 drm_modeset_lock_all(dev);
177 list_for_each_entry(connector, &dev->mode_config.connector_list, head) {
Andrzej Hajda74cfe072014-10-10 14:31:56 +0200178 if (connector->funcs->dpms) {
179 int dpms = connector->dpms;
180
181 connector->dpms = DRM_MODE_DPMS_OFF;
182 connector->funcs->dpms(connector, dpms);
183 }
Sean Paulaf65c802014-01-30 16:19:27 -0500184 }
Takashi Iwaia16f2232014-05-09 08:14:15 +0200185 drm_modeset_unlock_all(dev);
Sean Paulaf65c802014-01-30 16:19:27 -0500186
Sean Paulaf65c802014-01-30 16:19:27 -0500187 return 0;
188}
189
Joonyoung Shim9084f7b2012-03-16 18:47:09 +0900190static int exynos_drm_open(struct drm_device *dev, struct drm_file *file)
Inki Daeccf4d882011-10-14 13:29:51 +0900191{
Joonyoung Shimd7f16422012-05-17 20:06:32 +0900192 struct drm_exynos_file_private *file_priv;
YoungJun Choba3706c2013-07-01 17:00:47 +0900193 int ret;
Joonyoung Shimd7f16422012-05-17 20:06:32 +0900194
Joonyoung Shimd7f16422012-05-17 20:06:32 +0900195 file_priv = kzalloc(sizeof(*file_priv), GFP_KERNEL);
196 if (!file_priv)
197 return -ENOMEM;
198
Joonyoung Shimd7f16422012-05-17 20:06:32 +0900199 file->driver_priv = file_priv;
Inki Daeb2df26c2012-04-23 21:01:28 +0900200
YoungJun Choba3706c2013-07-01 17:00:47 +0900201 ret = exynos_drm_subdrv_open(dev, file);
Sachin Kamat6ca605f2014-01-16 11:31:26 +0530202 if (ret)
Daniel Kurtz307ceaf2014-03-17 11:28:06 +0800203 goto err_file_priv_free;
YoungJun Choba3706c2013-07-01 17:00:47 +0900204
205 return ret;
Daniel Kurtz307ceaf2014-03-17 11:28:06 +0800206
Daniel Kurtz307ceaf2014-03-17 11:28:06 +0800207err_file_priv_free:
Sachin Kamat6ca605f2014-01-16 11:31:26 +0530208 kfree(file_priv);
209 file->driver_priv = NULL;
210 return ret;
Joonyoung Shim9084f7b2012-03-16 18:47:09 +0900211}
212
Inki Daeccf4d882011-10-14 13:29:51 +0900213static void exynos_drm_preclose(struct drm_device *dev,
214 struct drm_file *file)
215{
Joonyoung Shim9084f7b2012-03-16 18:47:09 +0900216 exynos_drm_subdrv_close(dev, file);
Inki Daeccf4d882011-10-14 13:29:51 +0900217}
218
Inki Dae53ef2992012-02-15 11:25:22 +0900219static void exynos_drm_postclose(struct drm_device *dev, struct drm_file *file)
220{
Inki Dae0cbc3302013-10-01 14:51:37 +0900221 struct drm_pending_event *e, *et;
222 unsigned long flags;
223
Inki Dae53ef2992012-02-15 11:25:22 +0900224 if (!file->driver_priv)
225 return;
226
Inki Dae0cbc3302013-10-01 14:51:37 +0900227 spin_lock_irqsave(&dev->event_lock, flags);
Inki Dae0cbc3302013-10-01 14:51:37 +0900228 /* Release all events handled by page flip handler but not freed. */
229 list_for_each_entry_safe(e, et, &file->event_list, link) {
230 list_del(&e->link);
231 e->destroy(e);
232 }
233 spin_unlock_irqrestore(&dev->event_lock, flags);
234
Inki Dae53ef2992012-02-15 11:25:22 +0900235 kfree(file->driver_priv);
236 file->driver_priv = NULL;
237}
238
Inki Dae1c248b72011-10-04 19:19:01 +0900239static void exynos_drm_lastclose(struct drm_device *dev)
240{
Inki Dae1c248b72011-10-04 19:19:01 +0900241 exynos_drm_fbdev_restore_mode(dev);
242}
243
Laurent Pinchart78b68552012-05-17 13:27:22 +0200244static const struct vm_operations_struct exynos_drm_gem_vm_ops = {
Inki Dae1c248b72011-10-04 19:19:01 +0900245 .fault = exynos_drm_gem_fault,
246 .open = drm_gem_vm_open,
247 .close = drm_gem_vm_close,
248};
249
Rob Clarkbaa70942013-08-02 13:27:49 -0400250static const struct drm_ioctl_desc exynos_ioctls[] = {
Inki Dae1c248b72011-10-04 19:19:01 +0900251 DRM_IOCTL_DEF_DRV(EXYNOS_GEM_CREATE, exynos_drm_gem_create_ioctl,
252 DRM_UNLOCKED | DRM_AUTH),
Inki Dae40cd7e02012-05-04 15:51:17 +0900253 DRM_IOCTL_DEF_DRV(EXYNOS_GEM_GET,
254 exynos_drm_gem_get_ioctl, DRM_UNLOCKED),
Inki Daeb73d1232012-03-21 10:55:26 +0900255 DRM_IOCTL_DEF_DRV(EXYNOS_VIDI_CONNECTION,
256 vidi_connection_ioctl, DRM_UNLOCKED | DRM_AUTH),
Joonyoung Shimd7f16422012-05-17 20:06:32 +0900257 DRM_IOCTL_DEF_DRV(EXYNOS_G2D_GET_VER,
258 exynos_g2d_get_ver_ioctl, DRM_UNLOCKED | DRM_AUTH),
259 DRM_IOCTL_DEF_DRV(EXYNOS_G2D_SET_CMDLIST,
260 exynos_g2d_set_cmdlist_ioctl, DRM_UNLOCKED | DRM_AUTH),
261 DRM_IOCTL_DEF_DRV(EXYNOS_G2D_EXEC,
262 exynos_g2d_exec_ioctl, DRM_UNLOCKED | DRM_AUTH),
Eunchul Kimcb471f142012-12-14 18:10:31 +0900263 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_GET_PROPERTY,
264 exynos_drm_ipp_get_property, DRM_UNLOCKED | DRM_AUTH),
265 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_SET_PROPERTY,
266 exynos_drm_ipp_set_property, DRM_UNLOCKED | DRM_AUTH),
267 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_QUEUE_BUF,
268 exynos_drm_ipp_queue_buf, DRM_UNLOCKED | DRM_AUTH),
269 DRM_IOCTL_DEF_DRV(EXYNOS_IPP_CMD_CTRL,
270 exynos_drm_ipp_cmd_ctrl, DRM_UNLOCKED | DRM_AUTH),
Inki Dae1c248b72011-10-04 19:19:01 +0900271};
272
Joonyoung Shimac2bdf72011-12-08 15:00:20 +0900273static const struct file_operations exynos_drm_driver_fops = {
274 .owner = THIS_MODULE,
275 .open = drm_open,
276 .mmap = exynos_drm_gem_mmap,
277 .poll = drm_poll,
278 .read = drm_read,
279 .unlocked_ioctl = drm_ioctl,
Keith Packard804d74a2012-07-09 15:40:07 -0700280#ifdef CONFIG_COMPAT
281 .compat_ioctl = drm_compat_ioctl,
282#endif
Joonyoung Shimac2bdf72011-12-08 15:00:20 +0900283 .release = drm_release,
284};
285
Inki Dae1c248b72011-10-04 19:19:01 +0900286static struct drm_driver exynos_drm_driver = {
Joonyoung Shimbe9b64a2014-04-12 09:39:52 +0900287 .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME,
Inki Dae1c248b72011-10-04 19:19:01 +0900288 .load = exynos_drm_load,
289 .unload = exynos_drm_unload,
Sean Paulaf65c802014-01-30 16:19:27 -0500290 .suspend = exynos_drm_suspend,
291 .resume = exynos_drm_resume,
Joonyoung Shim9084f7b2012-03-16 18:47:09 +0900292 .open = exynos_drm_open,
Inki Daeccf4d882011-10-14 13:29:51 +0900293 .preclose = exynos_drm_preclose,
Inki Dae1c248b72011-10-04 19:19:01 +0900294 .lastclose = exynos_drm_lastclose,
Inki Dae53ef2992012-02-15 11:25:22 +0900295 .postclose = exynos_drm_postclose,
David Herrmann915b4d12014-08-29 12:12:43 +0200296 .set_busid = drm_platform_set_busid,
Inki Dae1c248b72011-10-04 19:19:01 +0900297 .get_vblank_counter = drm_vblank_count,
298 .enable_vblank = exynos_drm_crtc_enable_vblank,
299 .disable_vblank = exynos_drm_crtc_disable_vblank,
Inki Dae1c248b72011-10-04 19:19:01 +0900300 .gem_free_object = exynos_drm_gem_free_object,
301 .gem_vm_ops = &exynos_drm_gem_vm_ops,
302 .dumb_create = exynos_drm_gem_dumb_create,
303 .dumb_map_offset = exynos_drm_gem_dumb_map_offset,
Daniel Vetter43387b32013-07-16 09:12:04 +0200304 .dumb_destroy = drm_gem_dumb_destroy,
Inki Daeb2df26c2012-04-23 21:01:28 +0900305 .prime_handle_to_fd = drm_gem_prime_handle_to_fd,
306 .prime_fd_to_handle = drm_gem_prime_fd_to_handle,
307 .gem_prime_export = exynos_dmabuf_prime_export,
308 .gem_prime_import = exynos_dmabuf_prime_import,
Inki Dae1c248b72011-10-04 19:19:01 +0900309 .ioctls = exynos_ioctls,
Rob Clarkbaa70942013-08-02 13:27:49 -0400310 .num_ioctls = ARRAY_SIZE(exynos_ioctls),
Joonyoung Shimac2bdf72011-12-08 15:00:20 +0900311 .fops = &exynos_drm_driver_fops,
Inki Dae1c248b72011-10-04 19:19:01 +0900312 .name = DRIVER_NAME,
313 .desc = DRIVER_DESC,
314 .date = DRIVER_DATE,
315 .major = DRIVER_MAJOR,
316 .minor = DRIVER_MINOR,
317};
318
Sean Paulaf65c802014-01-30 16:19:27 -0500319#ifdef CONFIG_PM_SLEEP
320static int exynos_drm_sys_suspend(struct device *dev)
321{
322 struct drm_device *drm_dev = dev_get_drvdata(dev);
323 pm_message_t message;
324
Krzysztof Kozlowskid50a1902014-06-30 15:25:44 +0200325 if (pm_runtime_suspended(dev) || !drm_dev)
Sean Paulaf65c802014-01-30 16:19:27 -0500326 return 0;
327
328 message.event = PM_EVENT_SUSPEND;
329 return exynos_drm_suspend(drm_dev, message);
330}
331
332static int exynos_drm_sys_resume(struct device *dev)
333{
334 struct drm_device *drm_dev = dev_get_drvdata(dev);
335
Krzysztof Kozlowskid50a1902014-06-30 15:25:44 +0200336 if (pm_runtime_suspended(dev) || !drm_dev)
Sean Paulaf65c802014-01-30 16:19:27 -0500337 return 0;
338
339 return exynos_drm_resume(drm_dev);
340}
341#endif
342
Sean Paulaf65c802014-01-30 16:19:27 -0500343static const struct dev_pm_ops exynos_drm_pm_ops = {
344 SET_SYSTEM_SLEEP_PM_OPS(exynos_drm_sys_suspend, exynos_drm_sys_resume)
Sean Paulaf65c802014-01-30 16:19:27 -0500345};
346
Andrzej Hajda86650402015-06-11 23:23:37 +0900347/* forward declaration */
348static struct platform_driver exynos_drm_platform_driver;
Inki Daedf5225b2014-05-29 18:28:02 +0900349
Andrzej Hajda86650402015-06-11 23:23:37 +0900350/*
351 * Connector drivers should not be placed before associated crtc drivers,
352 * because connector requires pipe number of its crtc during initialization.
353 */
354static struct platform_driver *const exynos_drm_kms_drivers[] = {
Andrzej Hajda86650402015-06-11 23:23:37 +0900355#ifdef CONFIG_DRM_EXYNOS_FIMD
356 &fimd_driver,
357#endif
358#ifdef CONFIG_DRM_EXYNOS5433_DECON
359 &exynos5433_decon_driver,
360#endif
361#ifdef CONFIG_DRM_EXYNOS7_DECON
362 &decon_driver,
363#endif
Hyungwon Hwang77bbd892015-06-12 21:59:02 +0900364#ifdef CONFIG_DRM_EXYNOS_MIC
365 &mic_driver,
366#endif
Andrzej Hajda86650402015-06-11 23:23:37 +0900367#ifdef CONFIG_DRM_EXYNOS_DP
368 &dp_driver,
369#endif
370#ifdef CONFIG_DRM_EXYNOS_DSI
371 &dsi_driver,
372#endif
373#ifdef CONFIG_DRM_EXYNOS_HDMI
374 &mixer_driver,
375 &hdmi_driver,
376#endif
Joonyoung Shim735c21c2015-07-15 12:04:39 +0900377#ifdef CONFIG_DRM_EXYNOS_VIDI
378 &vidi_driver,
379#endif
Andrzej Hajda86650402015-06-11 23:23:37 +0900380};
Inki Daedf5225b2014-05-29 18:28:02 +0900381
Andrzej Hajda86650402015-06-11 23:23:37 +0900382static struct platform_driver *const exynos_drm_non_kms_drivers[] = {
Andrzej Hajda86650402015-06-11 23:23:37 +0900383#ifdef CONFIG_DRM_EXYNOS_G2D
384 &g2d_driver,
385#endif
386#ifdef CONFIG_DRM_EXYNOS_FIMC
387 &fimc_driver,
388#endif
389#ifdef CONFIG_DRM_EXYNOS_ROTATOR
390 &rotator_driver,
391#endif
392#ifdef CONFIG_DRM_EXYNOS_GSC
393 &gsc_driver,
394#endif
395#ifdef CONFIG_DRM_EXYNOS_IPP
396 &ipp_driver,
397#endif
398 &exynos_drm_platform_driver,
399};
Inki Daedf5225b2014-05-29 18:28:02 +0900400
Andrzej Hajda86650402015-06-11 23:23:37 +0900401static struct platform_driver *const exynos_drm_drv_with_simple_dev[] = {
402#ifdef CONFIG_DRM_EXYNOS_VIDI
403 &vidi_driver,
404#endif
405#ifdef CONFIG_DRM_EXYNOS_IPP
406 &ipp_driver,
407#endif
408 &exynos_drm_platform_driver,
409};
410#define PDEV_COUNT ARRAY_SIZE(exynos_drm_drv_with_simple_dev)
Inki Daef37cd5e2014-05-09 14:25:20 +0900411
Inki Dae53c55582014-09-11 17:04:03 +0900412static int compare_dev(struct device *dev, void *data)
Inki Daef37cd5e2014-05-09 14:25:20 +0900413{
414 return dev == (struct device *)data;
415}
416
Inki Dae53c55582014-09-11 17:04:03 +0900417static struct component_match *exynos_drm_match_add(struct device *dev)
Inki Daef37cd5e2014-05-09 14:25:20 +0900418{
Inki Dae53c55582014-09-11 17:04:03 +0900419 struct component_match *match = NULL;
Andrzej Hajda86650402015-06-11 23:23:37 +0900420 int i;
Inki Daef37cd5e2014-05-09 14:25:20 +0900421
Andrzej Hajda86650402015-06-11 23:23:37 +0900422 for (i = 0; i < ARRAY_SIZE(exynos_drm_kms_drivers); ++i) {
423 struct device_driver *drv = &exynos_drm_kms_drivers[i]->driver;
424 struct device *p = NULL, *d;
Inki Daef37cd5e2014-05-09 14:25:20 +0900425
Andrzej Hajda86650402015-06-11 23:23:37 +0900426 while ((d = bus_find_device(&platform_bus_type, p, drv,
427 (void *)platform_bus_type.match))) {
428 put_device(p);
429 component_match_add(dev, &match, compare_dev, d);
430 p = d;
Inki Daedf5225b2014-05-29 18:28:02 +0900431 }
Andrzej Hajda86650402015-06-11 23:23:37 +0900432 put_device(p);
Inki Daef37cd5e2014-05-09 14:25:20 +0900433 }
434
Andrzej Hajda86650402015-06-11 23:23:37 +0900435 return match ?: ERR_PTR(-ENODEV);
Inki Daef37cd5e2014-05-09 14:25:20 +0900436}
437
438static int exynos_drm_bind(struct device *dev)
439{
Inki Daef37cd5e2014-05-09 14:25:20 +0900440 return drm_platform_init(&exynos_drm_driver, to_platform_device(dev));
441}
442
443static void exynos_drm_unbind(struct device *dev)
444{
445 drm_put_dev(dev_get_drvdata(dev));
446}
447
448static const struct component_master_ops exynos_drm_ops = {
Inki Daef37cd5e2014-05-09 14:25:20 +0900449 .bind = exynos_drm_bind,
450 .unbind = exynos_drm_unbind,
Inki Dae1c248b72011-10-04 19:19:01 +0900451};
452
Andrzej Hajda417133e2015-06-11 23:20:52 +0900453static int exynos_drm_platform_probe(struct platform_device *pdev)
454{
455 struct component_match *match;
456
457 pdev->dev.coherent_dma_mask = DMA_BIT_MASK(32);
458 exynos_drm_driver.num_ioctls = ARRAY_SIZE(exynos_ioctls);
459
460 match = exynos_drm_match_add(&pdev->dev);
461 if (IS_ERR(match))
462 return PTR_ERR(match);
463
464 return component_master_add_with_match(&pdev->dev, &exynos_drm_ops,
465 match);
466}
467
468static int exynos_drm_platform_remove(struct platform_device *pdev)
469{
470 component_master_del(&pdev->dev, &exynos_drm_ops);
471 return 0;
472}
473
474static struct platform_driver exynos_drm_platform_driver = {
475 .probe = exynos_drm_platform_probe,
476 .remove = exynos_drm_platform_remove,
477 .driver = {
478 .name = "exynos-drm",
479 .pm = &exynos_drm_pm_ops,
480 },
481};
482
Andrzej Hajda417133e2015-06-11 23:20:52 +0900483static struct platform_device *exynos_drm_pdevs[PDEV_COUNT];
484
485static void exynos_drm_unregister_devices(void)
Inki Dae1c248b72011-10-04 19:19:01 +0900486{
Andrzej Hajda417133e2015-06-11 23:20:52 +0900487 int i = PDEV_COUNT;
Joonyoung Shim132a5b92012-03-16 18:47:08 +0900488
Andrzej Hajda417133e2015-06-11 23:20:52 +0900489 while (--i >= 0) {
490 platform_device_unregister(exynos_drm_pdevs[i]);
491 exynos_drm_pdevs[i] = NULL;
Inki Dae7afbfcc2014-11-07 21:32:34 +0900492 }
Inki Dae1c248b72011-10-04 19:19:01 +0900493}
494
Andrzej Hajda417133e2015-06-11 23:20:52 +0900495static int exynos_drm_register_devices(void)
Inki Dae1c248b72011-10-04 19:19:01 +0900496{
Andrzej Hajda417133e2015-06-11 23:20:52 +0900497 int i;
498
499 for (i = 0; i < PDEV_COUNT; ++i) {
500 struct platform_driver *d = exynos_drm_drv_with_simple_dev[i];
501 struct platform_device *pdev =
502 platform_device_register_simple(d->driver.name, -1,
503 NULL, 0);
504
505 if (!IS_ERR(pdev)) {
506 exynos_drm_pdevs[i] = pdev;
507 continue;
508 }
509 while (--i >= 0) {
510 platform_device_unregister(exynos_drm_pdevs[i]);
511 exynos_drm_pdevs[i] = NULL;
512 }
513
514 return PTR_ERR(pdev);
515 }
516
Inki Daef37cd5e2014-05-09 14:25:20 +0900517 return 0;
518}
519
Andrzej Hajda417133e2015-06-11 23:20:52 +0900520static void exynos_drm_unregister_drivers(struct platform_driver * const *drv,
521 int count)
522{
523 while (--count >= 0)
524 platform_driver_unregister(drv[count]);
525}
526
527static int exynos_drm_register_drivers(struct platform_driver * const *drv,
528 int count)
529{
530 int i, ret;
531
532 for (i = 0; i < count; ++i) {
533 ret = platform_driver_register(drv[i]);
534 if (!ret)
535 continue;
536
537 while (--i >= 0)
538 platform_driver_unregister(drv[i]);
539
540 return ret;
541 }
542
543 return 0;
544}
545
546static inline int exynos_drm_register_kms_drivers(void)
547{
548 return exynos_drm_register_drivers(exynos_drm_kms_drivers,
549 ARRAY_SIZE(exynos_drm_kms_drivers));
550}
551
552static inline int exynos_drm_register_non_kms_drivers(void)
553{
554 return exynos_drm_register_drivers(exynos_drm_non_kms_drivers,
555 ARRAY_SIZE(exynos_drm_non_kms_drivers));
556}
557
558static inline void exynos_drm_unregister_kms_drivers(void)
559{
560 exynos_drm_unregister_drivers(exynos_drm_kms_drivers,
561 ARRAY_SIZE(exynos_drm_kms_drivers));
562}
563
564static inline void exynos_drm_unregister_non_kms_drivers(void)
565{
566 exynos_drm_unregister_drivers(exynos_drm_non_kms_drivers,
567 ARRAY_SIZE(exynos_drm_non_kms_drivers));
568}
569
Inki Daef37cd5e2014-05-09 14:25:20 +0900570static int exynos_drm_init(void)
571{
Andrzej Hajdae3b9e462015-06-08 12:15:42 +0200572 int ret;
Inki Daef37cd5e2014-05-09 14:25:20 +0900573
Andrzej Hajda417133e2015-06-11 23:20:52 +0900574 ret = exynos_drm_register_devices();
Inki Daef37cd5e2014-05-09 14:25:20 +0900575 if (ret)
Andrzej Hajda417133e2015-06-11 23:20:52 +0900576 return ret;
577
578 ret = exynos_drm_register_kms_drivers();
579 if (ret)
580 goto err_unregister_pdevs;
581
582 ret = exynos_drm_register_non_kms_drivers();
583 if (ret)
584 goto err_unregister_kms_drivers;
Inki Daef37cd5e2014-05-09 14:25:20 +0900585
586 return 0;
587
Gustavo Padovan820687be2014-11-24 16:37:26 +0900588err_unregister_kms_drivers:
Andrzej Hajda417133e2015-06-11 23:20:52 +0900589 exynos_drm_unregister_kms_drivers();
Gustavo Padovan820687be2014-11-24 16:37:26 +0900590
Andrzej Hajda417133e2015-06-11 23:20:52 +0900591err_unregister_pdevs:
592 exynos_drm_unregister_devices();
Inki Daef37cd5e2014-05-09 14:25:20 +0900593
594 return ret;
595}
596
597static void exynos_drm_exit(void)
598{
Andrzej Hajda417133e2015-06-11 23:20:52 +0900599 exynos_drm_unregister_non_kms_drivers();
600 exynos_drm_unregister_kms_drivers();
601 exynos_drm_unregister_devices();
Inki Dae1c248b72011-10-04 19:19:01 +0900602}
603
604module_init(exynos_drm_init);
605module_exit(exynos_drm_exit);
606
607MODULE_AUTHOR("Inki Dae <inki.dae@samsung.com>");
608MODULE_AUTHOR("Joonyoung Shim <jy0922.shim@samsung.com>");
609MODULE_AUTHOR("Seung-Woo Kim <sw0312.kim@samsung.com>");
610MODULE_DESCRIPTION("Samsung SoC DRM Driver");
611MODULE_LICENSE("GPL");