.. | .. |
---|
9 | 9 | */ |
---|
10 | 10 | |
---|
11 | 11 | #include <linux/component.h> |
---|
| 12 | +#include <linux/dma-mapping.h> |
---|
| 13 | +#include <linux/module.h> |
---|
12 | 14 | #include <linux/of_platform.h> |
---|
| 15 | +#include <linux/pm_runtime.h> |
---|
13 | 16 | |
---|
14 | 17 | #include <drm/drm_atomic.h> |
---|
15 | 18 | #include <drm/drm_atomic_helper.h> |
---|
16 | | -#include <drm/drm_crtc_helper.h> |
---|
17 | | -#include <drm/drm_fb_helper.h> |
---|
| 19 | +#include <drm/drm_drv.h> |
---|
18 | 20 | #include <drm/drm_fb_cma_helper.h> |
---|
| 21 | +#include <drm/drm_fb_helper.h> |
---|
19 | 22 | #include <drm/drm_gem_cma_helper.h> |
---|
20 | 23 | #include <drm/drm_gem_framebuffer_helper.h> |
---|
| 24 | +#include <drm/drm_probe_helper.h> |
---|
| 25 | +#include <drm/drm_vblank.h> |
---|
21 | 26 | |
---|
22 | 27 | #include "ltdc.h" |
---|
23 | 28 | |
---|
.. | .. |
---|
26 | 31 | |
---|
27 | 32 | static const struct drm_mode_config_funcs drv_mode_config_funcs = { |
---|
28 | 33 | .fb_create = drm_gem_fb_create, |
---|
29 | | - .output_poll_changed = drm_fb_helper_output_poll_changed, |
---|
30 | 34 | .atomic_check = drm_atomic_helper_check, |
---|
31 | 35 | .atomic_commit = drm_atomic_helper_commit, |
---|
32 | 36 | }; |
---|
.. | .. |
---|
50 | 54 | DEFINE_DRM_GEM_CMA_FOPS(drv_driver_fops); |
---|
51 | 55 | |
---|
52 | 56 | static struct drm_driver drv_driver = { |
---|
53 | | - .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_PRIME | |
---|
54 | | - DRIVER_ATOMIC, |
---|
55 | | - .lastclose = drm_fb_helper_lastclose, |
---|
| 57 | + .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC, |
---|
56 | 58 | .name = "stm", |
---|
57 | 59 | .desc = "STMicroelectronics SoC DRM", |
---|
58 | 60 | .date = "20170330", |
---|
.. | .. |
---|
60 | 62 | .minor = 0, |
---|
61 | 63 | .patchlevel = 0, |
---|
62 | 64 | .fops = &drv_driver_fops, |
---|
63 | | - .dumb_create = stm_gem_cma_dumb_create, |
---|
64 | | - .prime_handle_to_fd = drm_gem_prime_handle_to_fd, |
---|
65 | | - .prime_fd_to_handle = drm_gem_prime_fd_to_handle, |
---|
66 | | - .gem_free_object_unlocked = drm_gem_cma_free_object, |
---|
67 | | - .gem_vm_ops = &drm_gem_cma_vm_ops, |
---|
68 | | - .gem_prime_export = drm_gem_prime_export, |
---|
69 | | - .gem_prime_import = drm_gem_prime_import, |
---|
70 | | - .gem_prime_get_sg_table = drm_gem_cma_prime_get_sg_table, |
---|
71 | | - .gem_prime_import_sg_table = drm_gem_cma_prime_import_sg_table, |
---|
72 | | - .gem_prime_vmap = drm_gem_cma_prime_vmap, |
---|
73 | | - .gem_prime_vunmap = drm_gem_cma_prime_vunmap, |
---|
74 | | - .gem_prime_mmap = drm_gem_cma_prime_mmap, |
---|
| 65 | + DRM_GEM_CMA_DRIVER_OPS_WITH_DUMB_CREATE(stm_gem_cma_dumb_create), |
---|
75 | 66 | }; |
---|
76 | 67 | |
---|
77 | 68 | static int drv_load(struct drm_device *ddev) |
---|
.. | .. |
---|
88 | 79 | |
---|
89 | 80 | ddev->dev_private = (void *)ldev; |
---|
90 | 81 | |
---|
91 | | - drm_mode_config_init(ddev); |
---|
| 82 | + ret = drmm_mode_config_init(ddev); |
---|
| 83 | + if (ret) |
---|
| 84 | + return ret; |
---|
92 | 85 | |
---|
93 | 86 | /* |
---|
94 | 87 | * set max width and height as default value. |
---|
.. | .. |
---|
103 | 96 | |
---|
104 | 97 | ret = ltdc_load(ddev); |
---|
105 | 98 | if (ret) |
---|
106 | | - goto err; |
---|
| 99 | + return ret; |
---|
107 | 100 | |
---|
108 | 101 | drm_mode_config_reset(ddev); |
---|
109 | 102 | drm_kms_helper_poll_init(ddev); |
---|
110 | 103 | |
---|
111 | | - if (ddev->mode_config.num_connector) { |
---|
112 | | - ret = drm_fb_cma_fbdev_init(ddev, 16, 0); |
---|
113 | | - if (ret) |
---|
114 | | - DRM_DEBUG("Warning: fails to create fbdev\n"); |
---|
115 | | - } |
---|
116 | | - |
---|
117 | 104 | platform_set_drvdata(pdev, ddev); |
---|
118 | 105 | |
---|
119 | 106 | return 0; |
---|
120 | | -err: |
---|
121 | | - drm_mode_config_cleanup(ddev); |
---|
122 | | - return ret; |
---|
123 | 107 | } |
---|
124 | 108 | |
---|
125 | 109 | static void drv_unload(struct drm_device *ddev) |
---|
126 | 110 | { |
---|
127 | 111 | DRM_DEBUG("%s\n", __func__); |
---|
128 | 112 | |
---|
129 | | - drm_fb_cma_fbdev_fini(ddev); |
---|
130 | 113 | drm_kms_helper_poll_fini(ddev); |
---|
131 | 114 | ltdc_unload(ddev); |
---|
132 | | - drm_mode_config_cleanup(ddev); |
---|
133 | 115 | } |
---|
| 116 | + |
---|
| 117 | +static __maybe_unused int drv_suspend(struct device *dev) |
---|
| 118 | +{ |
---|
| 119 | + struct drm_device *ddev = dev_get_drvdata(dev); |
---|
| 120 | + struct ltdc_device *ldev = ddev->dev_private; |
---|
| 121 | + struct drm_atomic_state *state; |
---|
| 122 | + |
---|
| 123 | + WARN_ON(ldev->suspend_state); |
---|
| 124 | + |
---|
| 125 | + state = drm_atomic_helper_suspend(ddev); |
---|
| 126 | + if (IS_ERR(state)) |
---|
| 127 | + return PTR_ERR(state); |
---|
| 128 | + |
---|
| 129 | + ldev->suspend_state = state; |
---|
| 130 | + pm_runtime_force_suspend(dev); |
---|
| 131 | + |
---|
| 132 | + return 0; |
---|
| 133 | +} |
---|
| 134 | + |
---|
| 135 | +static __maybe_unused int drv_resume(struct device *dev) |
---|
| 136 | +{ |
---|
| 137 | + struct drm_device *ddev = dev_get_drvdata(dev); |
---|
| 138 | + struct ltdc_device *ldev = ddev->dev_private; |
---|
| 139 | + int ret; |
---|
| 140 | + |
---|
| 141 | + if (WARN_ON(!ldev->suspend_state)) |
---|
| 142 | + return -ENOENT; |
---|
| 143 | + |
---|
| 144 | + pm_runtime_force_resume(dev); |
---|
| 145 | + ret = drm_atomic_helper_resume(ddev, ldev->suspend_state); |
---|
| 146 | + if (ret) |
---|
| 147 | + pm_runtime_force_suspend(dev); |
---|
| 148 | + |
---|
| 149 | + ldev->suspend_state = NULL; |
---|
| 150 | + |
---|
| 151 | + return ret; |
---|
| 152 | +} |
---|
| 153 | + |
---|
| 154 | +static __maybe_unused int drv_runtime_suspend(struct device *dev) |
---|
| 155 | +{ |
---|
| 156 | + struct drm_device *ddev = dev_get_drvdata(dev); |
---|
| 157 | + |
---|
| 158 | + DRM_DEBUG_DRIVER("\n"); |
---|
| 159 | + ltdc_suspend(ddev); |
---|
| 160 | + |
---|
| 161 | + return 0; |
---|
| 162 | +} |
---|
| 163 | + |
---|
| 164 | +static __maybe_unused int drv_runtime_resume(struct device *dev) |
---|
| 165 | +{ |
---|
| 166 | + struct drm_device *ddev = dev_get_drvdata(dev); |
---|
| 167 | + |
---|
| 168 | + DRM_DEBUG_DRIVER("\n"); |
---|
| 169 | + return ltdc_resume(ddev); |
---|
| 170 | +} |
---|
| 171 | + |
---|
| 172 | +static const struct dev_pm_ops drv_pm_ops = { |
---|
| 173 | + SET_SYSTEM_SLEEP_PM_OPS(drv_suspend, drv_resume) |
---|
| 174 | + SET_RUNTIME_PM_OPS(drv_runtime_suspend, |
---|
| 175 | + drv_runtime_resume, NULL) |
---|
| 176 | +}; |
---|
134 | 177 | |
---|
135 | 178 | static int stm_drm_platform_probe(struct platform_device *pdev) |
---|
136 | 179 | { |
---|
.. | .. |
---|
153 | 196 | ret = drm_dev_register(ddev, 0); |
---|
154 | 197 | if (ret) |
---|
155 | 198 | goto err_put; |
---|
| 199 | + |
---|
| 200 | + drm_fbdev_generic_setup(ddev, 16); |
---|
156 | 201 | |
---|
157 | 202 | return 0; |
---|
158 | 203 | |
---|
.. | .. |
---|
187 | 232 | .driver = { |
---|
188 | 233 | .name = "stm32-display", |
---|
189 | 234 | .of_match_table = drv_dt_ids, |
---|
| 235 | + .pm = &drv_pm_ops, |
---|
190 | 236 | }, |
---|
191 | 237 | }; |
---|
192 | 238 | |
---|