1 /* SPDX-License-Identifier: GPL-2.0 */
2 /*
3 * Copyright 2012-2019 Red Hat
4 *
5 * This file is subject to the terms and conditions of the GNU General
6 * Public License version 2. See the file COPYING in the main
7 * directory of this archive for more details.
8 *
9 * Authors: Matthew Garrett
10 * Dave Airlie
11 * Gerd Hoffmann
12 *
13 * Portions of this code derived from cirrusfb.c:
14 * drivers/video/cirrusfb.c - driver for Cirrus Logic chipsets
15 *
16 * Copyright 1999-2001 Jeff Garzik <jgarzik@pobox.com>
17 */
18
19 #include <linux/iosys-map.h>
20 #include <linux/module.h>
21 #include <linux/pci.h>
22
23 #include <video/cirrus.h>
24 #include <video/vga.h>
25
26 #include <drm/drm_aperture.h>
27 #include <drm/drm_atomic.h>
28 #include <drm/drm_atomic_helper.h>
29 #include <drm/drm_atomic_state_helper.h>
30 #include <drm/drm_connector.h>
31 #include <drm/drm_damage_helper.h>
32 #include <drm/drm_drv.h>
33 #include <drm/drm_edid.h>
34 #include <drm/drm_fbdev_generic.h>
35 #include <drm/drm_file.h>
36 #include <drm/drm_format_helper.h>
37 #include <drm/drm_fourcc.h>
38 #include <drm/drm_framebuffer.h>
39 #include <drm/drm_gem_atomic_helper.h>
40 #include <drm/drm_gem_framebuffer_helper.h>
41 #include <drm/drm_gem_shmem_helper.h>
42 #include <drm/drm_ioctl.h>
43 #include <drm/drm_managed.h>
44 #include <drm/drm_modeset_helper_vtables.h>
45 #include <drm/drm_module.h>
46 #include <drm/drm_probe_helper.h>
47
48 #define DRIVER_NAME "cirrus"
49 #define DRIVER_DESC "qemu cirrus vga"
50 #define DRIVER_DATE "2019"
51 #define DRIVER_MAJOR 2
52 #define DRIVER_MINOR 0
53
54 #define CIRRUS_MAX_PITCH (0x1FF << 3) /* (4096 - 1) & ~111b bytes */
55 #define CIRRUS_VRAM_SIZE (4 * 1024 * 1024) /* 4 MB */
56
57 struct cirrus_device {
58 struct drm_device dev;
59
60 /* modesetting pipeline */
61 struct drm_plane primary_plane;
62 struct drm_crtc crtc;
63 struct drm_encoder encoder;
64 struct drm_connector connector;
65
66 /* HW resources */
67 void __iomem *vram;
68 void __iomem *mmio;
69 };
70
71 #define to_cirrus(_dev) container_of(_dev, struct cirrus_device, dev)
72
73 struct cirrus_primary_plane_state {
74 struct drm_shadow_plane_state base;
75
76 /* HW scanout buffer */
77 const struct drm_format_info *format;
78 unsigned int pitch;
79 };
80
81 static inline struct cirrus_primary_plane_state *
to_cirrus_primary_plane_state(struct drm_plane_state * plane_state)82 to_cirrus_primary_plane_state(struct drm_plane_state *plane_state)
83 {
84 return container_of(plane_state, struct cirrus_primary_plane_state, base.base);
85 };
86
87 /* ------------------------------------------------------------------ */
88 /*
89 * The meat of this driver. The core passes us a mode and we have to program
90 * it. The modesetting here is the bare minimum required to satisfy the qemu
91 * emulation of this hardware, and running this against a real device is
92 * likely to result in an inadequately programmed mode. We've already had
93 * the opportunity to modify the mode, so whatever we receive here should
94 * be something that can be correctly programmed and displayed
95 */
96
97 #define SEQ_INDEX 4
98 #define SEQ_DATA 5
99
rreg_seq(struct cirrus_device * cirrus,u8 reg)100 static u8 rreg_seq(struct cirrus_device *cirrus, u8 reg)
101 {
102 iowrite8(reg, cirrus->mmio + SEQ_INDEX);
103 return ioread8(cirrus->mmio + SEQ_DATA);
104 }
105
wreg_seq(struct cirrus_device * cirrus,u8 reg,u8 val)106 static void wreg_seq(struct cirrus_device *cirrus, u8 reg, u8 val)
107 {
108 iowrite8(reg, cirrus->mmio + SEQ_INDEX);
109 iowrite8(val, cirrus->mmio + SEQ_DATA);
110 }
111
112 #define CRT_INDEX 0x14
113 #define CRT_DATA 0x15
114
rreg_crt(struct cirrus_device * cirrus,u8 reg)115 static u8 rreg_crt(struct cirrus_device *cirrus, u8 reg)
116 {
117 iowrite8(reg, cirrus->mmio + CRT_INDEX);
118 return ioread8(cirrus->mmio + CRT_DATA);
119 }
120
wreg_crt(struct cirrus_device * cirrus,u8 reg,u8 val)121 static void wreg_crt(struct cirrus_device *cirrus, u8 reg, u8 val)
122 {
123 iowrite8(reg, cirrus->mmio + CRT_INDEX);
124 iowrite8(val, cirrus->mmio + CRT_DATA);
125 }
126
127 #define GFX_INDEX 0xe
128 #define GFX_DATA 0xf
129
wreg_gfx(struct cirrus_device * cirrus,u8 reg,u8 val)130 static void wreg_gfx(struct cirrus_device *cirrus, u8 reg, u8 val)
131 {
132 iowrite8(reg, cirrus->mmio + GFX_INDEX);
133 iowrite8(val, cirrus->mmio + GFX_DATA);
134 }
135
136 #define VGA_DAC_MASK 0x06
137
wreg_hdr(struct cirrus_device * cirrus,u8 val)138 static void wreg_hdr(struct cirrus_device *cirrus, u8 val)
139 {
140 ioread8(cirrus->mmio + VGA_DAC_MASK);
141 ioread8(cirrus->mmio + VGA_DAC_MASK);
142 ioread8(cirrus->mmio + VGA_DAC_MASK);
143 ioread8(cirrus->mmio + VGA_DAC_MASK);
144 iowrite8(val, cirrus->mmio + VGA_DAC_MASK);
145 }
146
cirrus_convert_to(struct drm_framebuffer * fb)147 static const struct drm_format_info *cirrus_convert_to(struct drm_framebuffer *fb)
148 {
149 if (fb->format->format == DRM_FORMAT_XRGB8888 && fb->pitches[0] > CIRRUS_MAX_PITCH) {
150 if (fb->width * 3 <= CIRRUS_MAX_PITCH)
151 /* convert from XR24 to RG24 */
152 return drm_format_info(DRM_FORMAT_RGB888);
153 else
154 /* convert from XR24 to RG16 */
155 return drm_format_info(DRM_FORMAT_RGB565);
156 }
157 return NULL;
158 }
159
cirrus_format(struct drm_framebuffer * fb)160 static const struct drm_format_info *cirrus_format(struct drm_framebuffer *fb)
161 {
162 const struct drm_format_info *format = cirrus_convert_to(fb);
163
164 if (format)
165 return format;
166 return fb->format;
167 }
168
cirrus_pitch(struct drm_framebuffer * fb)169 static int cirrus_pitch(struct drm_framebuffer *fb)
170 {
171 const struct drm_format_info *format = cirrus_convert_to(fb);
172
173 if (format)
174 return drm_format_info_min_pitch(format, 0, fb->width);
175 return fb->pitches[0];
176 }
177
cirrus_set_start_address(struct cirrus_device * cirrus,u32 offset)178 static void cirrus_set_start_address(struct cirrus_device *cirrus, u32 offset)
179 {
180 u32 addr;
181 u8 tmp;
182
183 addr = offset >> 2;
184 wreg_crt(cirrus, 0x0c, (u8)((addr >> 8) & 0xff));
185 wreg_crt(cirrus, 0x0d, (u8)(addr & 0xff));
186
187 tmp = rreg_crt(cirrus, 0x1b);
188 tmp &= 0xf2;
189 tmp |= (addr >> 16) & 0x01;
190 tmp |= (addr >> 15) & 0x0c;
191 wreg_crt(cirrus, 0x1b, tmp);
192
193 tmp = rreg_crt(cirrus, 0x1d);
194 tmp &= 0x7f;
195 tmp |= (addr >> 12) & 0x80;
196 wreg_crt(cirrus, 0x1d, tmp);
197 }
198
cirrus_mode_set(struct cirrus_device * cirrus,struct drm_display_mode * mode)199 static void cirrus_mode_set(struct cirrus_device *cirrus,
200 struct drm_display_mode *mode)
201 {
202 int hsyncstart, hsyncend, htotal, hdispend;
203 int vtotal, vdispend;
204 int tmp;
205
206 htotal = mode->htotal / 8;
207 hsyncend = mode->hsync_end / 8;
208 hsyncstart = mode->hsync_start / 8;
209 hdispend = mode->hdisplay / 8;
210
211 vtotal = mode->vtotal;
212 vdispend = mode->vdisplay;
213
214 vdispend -= 1;
215 vtotal -= 2;
216
217 htotal -= 5;
218 hdispend -= 1;
219 hsyncstart += 1;
220 hsyncend += 1;
221
222 wreg_crt(cirrus, VGA_CRTC_V_SYNC_END, 0x20);
223 wreg_crt(cirrus, VGA_CRTC_H_TOTAL, htotal);
224 wreg_crt(cirrus, VGA_CRTC_H_DISP, hdispend);
225 wreg_crt(cirrus, VGA_CRTC_H_SYNC_START, hsyncstart);
226 wreg_crt(cirrus, VGA_CRTC_H_SYNC_END, hsyncend);
227 wreg_crt(cirrus, VGA_CRTC_V_TOTAL, vtotal & 0xff);
228 wreg_crt(cirrus, VGA_CRTC_V_DISP_END, vdispend & 0xff);
229
230 tmp = 0x40;
231 if ((vdispend + 1) & 512)
232 tmp |= 0x20;
233 wreg_crt(cirrus, VGA_CRTC_MAX_SCAN, tmp);
234
235 /*
236 * Overflow bits for values that don't fit in the standard registers
237 */
238 tmp = 0x10;
239 if (vtotal & 0x100)
240 tmp |= 0x01;
241 if (vdispend & 0x100)
242 tmp |= 0x02;
243 if ((vdispend + 1) & 0x100)
244 tmp |= 0x08;
245 if (vtotal & 0x200)
246 tmp |= 0x20;
247 if (vdispend & 0x200)
248 tmp |= 0x40;
249 wreg_crt(cirrus, VGA_CRTC_OVERFLOW, tmp);
250
251 tmp = 0;
252
253 /* More overflow bits */
254
255 if ((htotal + 5) & 0x40)
256 tmp |= 0x10;
257 if ((htotal + 5) & 0x80)
258 tmp |= 0x20;
259 if (vtotal & 0x100)
260 tmp |= 0x40;
261 if (vtotal & 0x200)
262 tmp |= 0x80;
263
264 wreg_crt(cirrus, CL_CRT1A, tmp);
265
266 /* Disable Hercules/CGA compatibility */
267 wreg_crt(cirrus, VGA_CRTC_MODE, 0x03);
268 }
269
cirrus_format_set(struct cirrus_device * cirrus,const struct drm_format_info * format)270 static void cirrus_format_set(struct cirrus_device *cirrus,
271 const struct drm_format_info *format)
272 {
273 u8 sr07, hdr;
274
275 sr07 = rreg_seq(cirrus, 0x07);
276 sr07 &= 0xe0;
277
278 switch (format->format) {
279 case DRM_FORMAT_C8:
280 sr07 |= 0x11;
281 hdr = 0x00;
282 break;
283 case DRM_FORMAT_RGB565:
284 sr07 |= 0x17;
285 hdr = 0xc1;
286 break;
287 case DRM_FORMAT_RGB888:
288 sr07 |= 0x15;
289 hdr = 0xc5;
290 break;
291 case DRM_FORMAT_XRGB8888:
292 sr07 |= 0x19;
293 hdr = 0xc5;
294 break;
295 default:
296 return;
297 }
298
299 wreg_seq(cirrus, 0x7, sr07);
300
301 /* Enable high-colour modes */
302 wreg_gfx(cirrus, VGA_GFX_MODE, 0x40);
303
304 /* And set graphics mode */
305 wreg_gfx(cirrus, VGA_GFX_MISC, 0x01);
306
307 wreg_hdr(cirrus, hdr);
308 }
309
cirrus_pitch_set(struct cirrus_device * cirrus,unsigned int pitch)310 static void cirrus_pitch_set(struct cirrus_device *cirrus, unsigned int pitch)
311 {
312 u8 cr13, cr1b;
313
314 /* Program the pitch */
315 cr13 = pitch / 8;
316 wreg_crt(cirrus, VGA_CRTC_OFFSET, cr13);
317
318 /* Enable extended blanking and pitch bits, and enable full memory */
319 cr1b = 0x22;
320 cr1b |= (pitch >> 7) & 0x10;
321 wreg_crt(cirrus, 0x1b, cr1b);
322
323 cirrus_set_start_address(cirrus, 0);
324 }
325
326 /* ------------------------------------------------------------------ */
327 /* cirrus display pipe */
328
329 static const uint32_t cirrus_primary_plane_formats[] = {
330 DRM_FORMAT_RGB565,
331 DRM_FORMAT_RGB888,
332 DRM_FORMAT_XRGB8888,
333 };
334
335 static const uint64_t cirrus_primary_plane_format_modifiers[] = {
336 DRM_FORMAT_MOD_LINEAR,
337 DRM_FORMAT_MOD_INVALID
338 };
339
cirrus_primary_plane_helper_atomic_check(struct drm_plane * plane,struct drm_atomic_state * state)340 static int cirrus_primary_plane_helper_atomic_check(struct drm_plane *plane,
341 struct drm_atomic_state *state)
342 {
343 struct drm_plane_state *new_plane_state = drm_atomic_get_new_plane_state(state, plane);
344 struct cirrus_primary_plane_state *new_primary_plane_state =
345 to_cirrus_primary_plane_state(new_plane_state);
346 struct drm_framebuffer *fb = new_plane_state->fb;
347 struct drm_crtc *new_crtc = new_plane_state->crtc;
348 struct drm_crtc_state *new_crtc_state = NULL;
349 int ret;
350 unsigned int pitch;
351
352 if (new_crtc)
353 new_crtc_state = drm_atomic_get_new_crtc_state(state, new_crtc);
354
355 ret = drm_atomic_helper_check_plane_state(new_plane_state, new_crtc_state,
356 DRM_PLANE_NO_SCALING,
357 DRM_PLANE_NO_SCALING,
358 false, false);
359 if (ret)
360 return ret;
361 else if (!new_plane_state->visible)
362 return 0;
363
364 pitch = cirrus_pitch(fb);
365
366 /* validate size constraints */
367 if (pitch > CIRRUS_MAX_PITCH)
368 return -EINVAL;
369 else if (pitch * fb->height > CIRRUS_VRAM_SIZE)
370 return -EINVAL;
371
372 new_primary_plane_state->format = cirrus_format(fb);
373 new_primary_plane_state->pitch = pitch;
374
375 return 0;
376 }
377
cirrus_primary_plane_helper_atomic_update(struct drm_plane * plane,struct drm_atomic_state * state)378 static void cirrus_primary_plane_helper_atomic_update(struct drm_plane *plane,
379 struct drm_atomic_state *state)
380 {
381 struct cirrus_device *cirrus = to_cirrus(plane->dev);
382 struct drm_plane_state *plane_state = drm_atomic_get_new_plane_state(state, plane);
383 struct cirrus_primary_plane_state *primary_plane_state =
384 to_cirrus_primary_plane_state(plane_state);
385 struct drm_shadow_plane_state *shadow_plane_state = to_drm_shadow_plane_state(plane_state);
386 struct drm_framebuffer *fb = plane_state->fb;
387 const struct drm_format_info *format = primary_plane_state->format;
388 unsigned int pitch = primary_plane_state->pitch;
389 struct drm_plane_state *old_plane_state = drm_atomic_get_old_plane_state(state, plane);
390 struct cirrus_primary_plane_state *old_primary_plane_state =
391 to_cirrus_primary_plane_state(old_plane_state);
392 struct iosys_map vaddr = IOSYS_MAP_INIT_VADDR_IOMEM(cirrus->vram);
393 struct drm_atomic_helper_damage_iter iter;
394 struct drm_rect damage;
395 int idx;
396
397 if (!fb)
398 return;
399
400 if (!drm_dev_enter(&cirrus->dev, &idx))
401 return;
402
403 if (old_primary_plane_state->format != format)
404 cirrus_format_set(cirrus, format);
405 if (old_primary_plane_state->pitch != pitch)
406 cirrus_pitch_set(cirrus, pitch);
407
408 drm_atomic_helper_damage_iter_init(&iter, old_plane_state, plane_state);
409 drm_atomic_for_each_plane_damage(&iter, &damage) {
410 unsigned int offset = drm_fb_clip_offset(pitch, format, &damage);
411 struct iosys_map dst = IOSYS_MAP_INIT_OFFSET(&vaddr, offset);
412
413 drm_fb_blit(&dst, &pitch, format->format, shadow_plane_state->data, fb, &damage);
414 }
415
416 drm_dev_exit(idx);
417 }
418
419 static const struct drm_plane_helper_funcs cirrus_primary_plane_helper_funcs = {
420 DRM_GEM_SHADOW_PLANE_HELPER_FUNCS,
421 .atomic_check = cirrus_primary_plane_helper_atomic_check,
422 .atomic_update = cirrus_primary_plane_helper_atomic_update,
423 };
424
425 static struct drm_plane_state *
cirrus_primary_plane_atomic_duplicate_state(struct drm_plane * plane)426 cirrus_primary_plane_atomic_duplicate_state(struct drm_plane *plane)
427 {
428 struct drm_plane_state *plane_state = plane->state;
429 struct cirrus_primary_plane_state *primary_plane_state =
430 to_cirrus_primary_plane_state(plane_state);
431 struct cirrus_primary_plane_state *new_primary_plane_state;
432 struct drm_shadow_plane_state *new_shadow_plane_state;
433
434 if (!plane_state)
435 return NULL;
436
437 new_primary_plane_state = kzalloc(sizeof(*new_primary_plane_state), GFP_KERNEL);
438 if (!new_primary_plane_state)
439 return NULL;
440 new_shadow_plane_state = &new_primary_plane_state->base;
441
442 __drm_gem_duplicate_shadow_plane_state(plane, new_shadow_plane_state);
443 new_primary_plane_state->format = primary_plane_state->format;
444 new_primary_plane_state->pitch = primary_plane_state->pitch;
445
446 return &new_shadow_plane_state->base;
447 }
448
cirrus_primary_plane_atomic_destroy_state(struct drm_plane * plane,struct drm_plane_state * plane_state)449 static void cirrus_primary_plane_atomic_destroy_state(struct drm_plane *plane,
450 struct drm_plane_state *plane_state)
451 {
452 struct cirrus_primary_plane_state *primary_plane_state =
453 to_cirrus_primary_plane_state(plane_state);
454
455 __drm_gem_destroy_shadow_plane_state(&primary_plane_state->base);
456 kfree(primary_plane_state);
457 }
458
cirrus_reset_primary_plane(struct drm_plane * plane)459 static void cirrus_reset_primary_plane(struct drm_plane *plane)
460 {
461 struct cirrus_primary_plane_state *primary_plane_state;
462
463 if (plane->state) {
464 cirrus_primary_plane_atomic_destroy_state(plane, plane->state);
465 plane->state = NULL; /* must be set to NULL here */
466 }
467
468 primary_plane_state = kzalloc(sizeof(*primary_plane_state), GFP_KERNEL);
469 if (!primary_plane_state)
470 return;
471 __drm_gem_reset_shadow_plane(plane, &primary_plane_state->base);
472 }
473
474 static const struct drm_plane_funcs cirrus_primary_plane_funcs = {
475 .update_plane = drm_atomic_helper_update_plane,
476 .disable_plane = drm_atomic_helper_disable_plane,
477 .destroy = drm_plane_cleanup,
478 .reset = cirrus_reset_primary_plane,
479 .atomic_duplicate_state = cirrus_primary_plane_atomic_duplicate_state,
480 .atomic_destroy_state = cirrus_primary_plane_atomic_destroy_state,
481 };
482
cirrus_crtc_helper_atomic_check(struct drm_crtc * crtc,struct drm_atomic_state * state)483 static int cirrus_crtc_helper_atomic_check(struct drm_crtc *crtc, struct drm_atomic_state *state)
484 {
485 struct drm_crtc_state *crtc_state = drm_atomic_get_new_crtc_state(state, crtc);
486 int ret;
487
488 if (!crtc_state->enable)
489 return 0;
490
491 ret = drm_atomic_helper_check_crtc_primary_plane(crtc_state);
492 if (ret)
493 return ret;
494
495 return 0;
496 }
497
cirrus_crtc_helper_atomic_enable(struct drm_crtc * crtc,struct drm_atomic_state * state)498 static void cirrus_crtc_helper_atomic_enable(struct drm_crtc *crtc,
499 struct drm_atomic_state *state)
500 {
501 struct cirrus_device *cirrus = to_cirrus(crtc->dev);
502 struct drm_crtc_state *crtc_state = drm_atomic_get_new_crtc_state(state, crtc);
503 int idx;
504
505 if (!drm_dev_enter(&cirrus->dev, &idx))
506 return;
507
508 cirrus_mode_set(cirrus, &crtc_state->mode);
509
510 /* Unblank (needed on S3 resume, vgabios doesn't do it then) */
511 outb(VGA_AR_ENABLE_DISPLAY, VGA_ATT_W);
512
513 drm_dev_exit(idx);
514 }
515
516 static const struct drm_crtc_helper_funcs cirrus_crtc_helper_funcs = {
517 .atomic_check = cirrus_crtc_helper_atomic_check,
518 .atomic_enable = cirrus_crtc_helper_atomic_enable,
519 };
520
521 static const struct drm_crtc_funcs cirrus_crtc_funcs = {
522 .reset = drm_atomic_helper_crtc_reset,
523 .destroy = drm_crtc_cleanup,
524 .set_config = drm_atomic_helper_set_config,
525 .page_flip = drm_atomic_helper_page_flip,
526 .atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
527 .atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
528 };
529
530 static const struct drm_encoder_funcs cirrus_encoder_funcs = {
531 .destroy = drm_encoder_cleanup,
532 };
533
cirrus_connector_helper_get_modes(struct drm_connector * connector)534 static int cirrus_connector_helper_get_modes(struct drm_connector *connector)
535 {
536 int count;
537
538 count = drm_add_modes_noedid(connector,
539 connector->dev->mode_config.max_width,
540 connector->dev->mode_config.max_height);
541 drm_set_preferred_mode(connector, 1024, 768);
542 return count;
543 }
544
545 static const struct drm_connector_helper_funcs cirrus_connector_helper_funcs = {
546 .get_modes = cirrus_connector_helper_get_modes,
547 };
548
549 static const struct drm_connector_funcs cirrus_connector_funcs = {
550 .fill_modes = drm_helper_probe_single_connector_modes,
551 .destroy = drm_connector_cleanup,
552 .reset = drm_atomic_helper_connector_reset,
553 .atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
554 .atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
555 };
556
cirrus_pipe_init(struct cirrus_device * cirrus)557 static int cirrus_pipe_init(struct cirrus_device *cirrus)
558 {
559 struct drm_device *dev = &cirrus->dev;
560 struct drm_plane *primary_plane;
561 struct drm_crtc *crtc;
562 struct drm_encoder *encoder;
563 struct drm_connector *connector;
564 int ret;
565
566 primary_plane = &cirrus->primary_plane;
567 ret = drm_universal_plane_init(dev, primary_plane, 0,
568 &cirrus_primary_plane_funcs,
569 cirrus_primary_plane_formats,
570 ARRAY_SIZE(cirrus_primary_plane_formats),
571 cirrus_primary_plane_format_modifiers,
572 DRM_PLANE_TYPE_PRIMARY, NULL);
573 if (ret)
574 return ret;
575 drm_plane_helper_add(primary_plane, &cirrus_primary_plane_helper_funcs);
576 drm_plane_enable_fb_damage_clips(primary_plane);
577
578 crtc = &cirrus->crtc;
579 ret = drm_crtc_init_with_planes(dev, crtc, primary_plane, NULL,
580 &cirrus_crtc_funcs, NULL);
581 if (ret)
582 return ret;
583 drm_crtc_helper_add(crtc, &cirrus_crtc_helper_funcs);
584
585 encoder = &cirrus->encoder;
586 ret = drm_encoder_init(dev, encoder, &cirrus_encoder_funcs,
587 DRM_MODE_ENCODER_DAC, NULL);
588 if (ret)
589 return ret;
590 encoder->possible_crtcs = drm_crtc_mask(crtc);
591
592 connector = &cirrus->connector;
593 ret = drm_connector_init(dev, connector, &cirrus_connector_funcs,
594 DRM_MODE_CONNECTOR_VGA);
595 if (ret)
596 return ret;
597 drm_connector_helper_add(connector, &cirrus_connector_helper_funcs);
598
599 ret = drm_connector_attach_encoder(connector, encoder);
600 if (ret)
601 return ret;
602
603 return 0;
604 }
605
606 /* ------------------------------------------------------------------ */
607 /* cirrus framebuffers & mode config */
608
cirrus_mode_config_mode_valid(struct drm_device * dev,const struct drm_display_mode * mode)609 static enum drm_mode_status cirrus_mode_config_mode_valid(struct drm_device *dev,
610 const struct drm_display_mode *mode)
611 {
612 const struct drm_format_info *format = drm_format_info(DRM_FORMAT_XRGB8888);
613 uint64_t pitch = drm_format_info_min_pitch(format, 0, mode->hdisplay);
614
615 if (pitch * mode->vdisplay > CIRRUS_VRAM_SIZE)
616 return MODE_MEM;
617
618 return MODE_OK;
619 }
620
621 static const struct drm_mode_config_funcs cirrus_mode_config_funcs = {
622 .fb_create = drm_gem_fb_create_with_dirty,
623 .mode_valid = cirrus_mode_config_mode_valid,
624 .atomic_check = drm_atomic_helper_check,
625 .atomic_commit = drm_atomic_helper_commit,
626 };
627
cirrus_mode_config_init(struct cirrus_device * cirrus)628 static int cirrus_mode_config_init(struct cirrus_device *cirrus)
629 {
630 struct drm_device *dev = &cirrus->dev;
631 int ret;
632
633 ret = drmm_mode_config_init(dev);
634 if (ret)
635 return ret;
636
637 dev->mode_config.min_width = 0;
638 dev->mode_config.min_height = 0;
639 dev->mode_config.max_width = CIRRUS_MAX_PITCH / 2;
640 dev->mode_config.max_height = 1024;
641 dev->mode_config.preferred_depth = 16;
642 dev->mode_config.prefer_shadow = 0;
643 dev->mode_config.funcs = &cirrus_mode_config_funcs;
644
645 return 0;
646 }
647
648 /* ------------------------------------------------------------------ */
649
650 DEFINE_DRM_GEM_FOPS(cirrus_fops);
651
652 static const struct drm_driver cirrus_driver = {
653 .driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC,
654
655 .name = DRIVER_NAME,
656 .desc = DRIVER_DESC,
657 .date = DRIVER_DATE,
658 .major = DRIVER_MAJOR,
659 .minor = DRIVER_MINOR,
660
661 .fops = &cirrus_fops,
662 DRM_GEM_SHMEM_DRIVER_OPS,
663 };
664
cirrus_pci_probe(struct pci_dev * pdev,const struct pci_device_id * ent)665 static int cirrus_pci_probe(struct pci_dev *pdev,
666 const struct pci_device_id *ent)
667 {
668 struct drm_device *dev;
669 struct cirrus_device *cirrus;
670 int ret;
671
672 ret = drm_aperture_remove_conflicting_pci_framebuffers(pdev, &cirrus_driver);
673 if (ret)
674 return ret;
675
676 ret = pcim_enable_device(pdev);
677 if (ret)
678 return ret;
679
680 ret = pci_request_regions(pdev, DRIVER_NAME);
681 if (ret)
682 return ret;
683
684 ret = -ENOMEM;
685 cirrus = devm_drm_dev_alloc(&pdev->dev, &cirrus_driver,
686 struct cirrus_device, dev);
687 if (IS_ERR(cirrus))
688 return PTR_ERR(cirrus);
689
690 dev = &cirrus->dev;
691
692 cirrus->vram = devm_ioremap(&pdev->dev, pci_resource_start(pdev, 0),
693 pci_resource_len(pdev, 0));
694 if (cirrus->vram == NULL)
695 return -ENOMEM;
696
697 cirrus->mmio = devm_ioremap(&pdev->dev, pci_resource_start(pdev, 1),
698 pci_resource_len(pdev, 1));
699 if (cirrus->mmio == NULL)
700 return -ENOMEM;
701
702 ret = cirrus_mode_config_init(cirrus);
703 if (ret)
704 return ret;
705
706 ret = cirrus_pipe_init(cirrus);
707 if (ret < 0)
708 return ret;
709
710 drm_mode_config_reset(dev);
711
712 pci_set_drvdata(pdev, dev);
713 ret = drm_dev_register(dev, 0);
714 if (ret)
715 return ret;
716
717 drm_fbdev_generic_setup(dev, 16);
718 return 0;
719 }
720
cirrus_pci_remove(struct pci_dev * pdev)721 static void cirrus_pci_remove(struct pci_dev *pdev)
722 {
723 struct drm_device *dev = pci_get_drvdata(pdev);
724
725 drm_dev_unplug(dev);
726 drm_atomic_helper_shutdown(dev);
727 }
728
729 static const struct pci_device_id pciidlist[] = {
730 {
731 .vendor = PCI_VENDOR_ID_CIRRUS,
732 .device = PCI_DEVICE_ID_CIRRUS_5446,
733 /* only bind to the cirrus chip in qemu */
734 .subvendor = PCI_SUBVENDOR_ID_REDHAT_QUMRANET,
735 .subdevice = PCI_SUBDEVICE_ID_QEMU,
736 }, {
737 .vendor = PCI_VENDOR_ID_CIRRUS,
738 .device = PCI_DEVICE_ID_CIRRUS_5446,
739 .subvendor = PCI_VENDOR_ID_XEN,
740 .subdevice = 0x0001,
741 },
742 { /* end if list */ }
743 };
744
745 static struct pci_driver cirrus_pci_driver = {
746 .name = DRIVER_NAME,
747 .id_table = pciidlist,
748 .probe = cirrus_pci_probe,
749 .remove = cirrus_pci_remove,
750 };
751
752 drm_module_pci_driver(cirrus_pci_driver)
753
754 MODULE_DEVICE_TABLE(pci, pciidlist);
755 MODULE_LICENSE("GPL");
756