1
2
3
4
5
6#include <linux/hyperv.h>
7
8#include <drm/drm_damage_helper.h>
9#include <drm/drm_drv.h>
10#include <drm/drm_fb_helper.h>
11#include <drm/drm_format_helper.h>
12#include <drm/drm_fourcc.h>
13#include <drm/drm_gem_atomic_helper.h>
14#include <drm/drm_gem_framebuffer_helper.h>
15#include <drm/drm_gem_shmem_helper.h>
16#include <drm/drm_probe_helper.h>
17#include <drm/drm_simple_kms_helper.h>
18
19#include "hyperv_drm.h"
20
21static int hyperv_blit_to_vram_rect(struct drm_framebuffer *fb,
22 const struct dma_buf_map *map,
23 struct drm_rect *rect)
24{
25 struct hyperv_drm_device *hv = to_hv(fb->dev);
26 void *vmap = map->vaddr;
27 int idx;
28
29 if (!drm_dev_enter(&hv->dev, &idx))
30 return -ENODEV;
31
32 drm_fb_memcpy_dstclip(hv->vram, fb->pitches[0], vmap, fb, rect);
33 drm_dev_exit(idx);
34
35 return 0;
36}
37
38static int hyperv_blit_to_vram_fullscreen(struct drm_framebuffer *fb, const struct dma_buf_map *map)
39{
40 struct drm_rect fullscreen = {
41 .x1 = 0,
42 .x2 = fb->width,
43 .y1 = 0,
44 .y2 = fb->height,
45 };
46 return hyperv_blit_to_vram_rect(fb, map, &fullscreen);
47}
48
49static int hyperv_connector_get_modes(struct drm_connector *connector)
50{
51 struct hyperv_drm_device *hv = to_hv(connector->dev);
52 int count;
53
54 count = drm_add_modes_noedid(connector,
55 connector->dev->mode_config.max_width,
56 connector->dev->mode_config.max_height);
57 drm_set_preferred_mode(connector, hv->preferred_width,
58 hv->preferred_height);
59
60 return count;
61}
62
63static const struct drm_connector_helper_funcs hyperv_connector_helper_funcs = {
64 .get_modes = hyperv_connector_get_modes,
65};
66
67static const struct drm_connector_funcs hyperv_connector_funcs = {
68 .fill_modes = drm_helper_probe_single_connector_modes,
69 .destroy = drm_connector_cleanup,
70 .reset = drm_atomic_helper_connector_reset,
71 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
72 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
73};
74
75static inline int hyperv_conn_init(struct hyperv_drm_device *hv)
76{
77 drm_connector_helper_add(&hv->connector, &hyperv_connector_helper_funcs);
78 return drm_connector_init(&hv->dev, &hv->connector,
79 &hyperv_connector_funcs,
80 DRM_MODE_CONNECTOR_VIRTUAL);
81}
82
83static int hyperv_check_size(struct hyperv_drm_device *hv, int w, int h,
84 struct drm_framebuffer *fb)
85{
86 u32 pitch = w * (hv->screen_depth / 8);
87
88 if (fb)
89 pitch = fb->pitches[0];
90
91 if (pitch * h > hv->fb_size)
92 return -EINVAL;
93
94 return 0;
95}
96
97static void hyperv_pipe_enable(struct drm_simple_display_pipe *pipe,
98 struct drm_crtc_state *crtc_state,
99 struct drm_plane_state *plane_state)
100{
101 struct hyperv_drm_device *hv = to_hv(pipe->crtc.dev);
102 struct drm_shadow_plane_state *shadow_plane_state = to_drm_shadow_plane_state(plane_state);
103
104 hyperv_hide_hw_ptr(hv->hdev);
105 hyperv_update_situation(hv->hdev, 1, hv->screen_depth,
106 crtc_state->mode.hdisplay,
107 crtc_state->mode.vdisplay,
108 plane_state->fb->pitches[0]);
109 hyperv_blit_to_vram_fullscreen(plane_state->fb, &shadow_plane_state->data[0]);
110}
111
112static int hyperv_pipe_check(struct drm_simple_display_pipe *pipe,
113 struct drm_plane_state *plane_state,
114 struct drm_crtc_state *crtc_state)
115{
116 struct hyperv_drm_device *hv = to_hv(pipe->crtc.dev);
117 struct drm_framebuffer *fb = plane_state->fb;
118
119 if (fb->format->format != DRM_FORMAT_XRGB8888)
120 return -EINVAL;
121
122 if (fb->pitches[0] * fb->height > hv->fb_size)
123 return -EINVAL;
124
125 return 0;
126}
127
128static void hyperv_pipe_update(struct drm_simple_display_pipe *pipe,
129 struct drm_plane_state *old_state)
130{
131 struct hyperv_drm_device *hv = to_hv(pipe->crtc.dev);
132 struct drm_plane_state *state = pipe->plane.state;
133 struct drm_shadow_plane_state *shadow_plane_state = to_drm_shadow_plane_state(state);
134 struct drm_rect rect;
135
136 if (drm_atomic_helper_damage_merged(old_state, state, &rect)) {
137 hyperv_blit_to_vram_rect(state->fb, &shadow_plane_state->data[0], &rect);
138 hyperv_update_dirt(hv->hdev, &rect);
139 }
140}
141
142static const struct drm_simple_display_pipe_funcs hyperv_pipe_funcs = {
143 .enable = hyperv_pipe_enable,
144 .check = hyperv_pipe_check,
145 .update = hyperv_pipe_update,
146 DRM_GEM_SIMPLE_DISPLAY_PIPE_SHADOW_PLANE_FUNCS,
147};
148
149static const uint32_t hyperv_formats[] = {
150 DRM_FORMAT_XRGB8888,
151};
152
153static const uint64_t hyperv_modifiers[] = {
154 DRM_FORMAT_MOD_LINEAR,
155 DRM_FORMAT_MOD_INVALID
156};
157
158static inline int hyperv_pipe_init(struct hyperv_drm_device *hv)
159{
160 int ret;
161
162 ret = drm_simple_display_pipe_init(&hv->dev,
163 &hv->pipe,
164 &hyperv_pipe_funcs,
165 hyperv_formats,
166 ARRAY_SIZE(hyperv_formats),
167 hyperv_modifiers,
168 &hv->connector);
169 if (ret)
170 return ret;
171
172 drm_plane_enable_fb_damage_clips(&hv->pipe.plane);
173
174 return 0;
175}
176
177static enum drm_mode_status
178hyperv_mode_valid(struct drm_device *dev,
179 const struct drm_display_mode *mode)
180{
181 struct hyperv_drm_device *hv = to_hv(dev);
182
183 if (hyperv_check_size(hv, mode->hdisplay, mode->vdisplay, NULL))
184 return MODE_BAD;
185
186 return MODE_OK;
187}
188
189static const struct drm_mode_config_funcs hyperv_mode_config_funcs = {
190 .fb_create = drm_gem_fb_create_with_dirty,
191 .mode_valid = hyperv_mode_valid,
192 .atomic_check = drm_atomic_helper_check,
193 .atomic_commit = drm_atomic_helper_commit,
194};
195
196int hyperv_mode_config_init(struct hyperv_drm_device *hv)
197{
198 struct drm_device *dev = &hv->dev;
199 int ret;
200
201 ret = drmm_mode_config_init(dev);
202 if (ret) {
203 drm_err(dev, "Failed to initialized mode setting.\n");
204 return ret;
205 }
206
207 dev->mode_config.min_width = 0;
208 dev->mode_config.min_height = 0;
209 dev->mode_config.max_width = hv->screen_width_max;
210 dev->mode_config.max_height = hv->screen_height_max;
211
212 dev->mode_config.preferred_depth = hv->screen_depth;
213 dev->mode_config.prefer_shadow = 0;
214
215 dev->mode_config.funcs = &hyperv_mode_config_funcs;
216
217 ret = hyperv_conn_init(hv);
218 if (ret) {
219 drm_err(dev, "Failed to initialized connector.\n");
220 return ret;
221 }
222
223 ret = hyperv_pipe_init(hv);
224 if (ret) {
225 drm_err(dev, "Failed to initialized pipe.\n");
226 return ret;
227 }
228
229 drm_mode_config_reset(dev);
230
231 return 0;
232}
233