2023-08-30 17:31:07 +02:00
|
|
|
/* SPDX-License-Identifier: GPL-2.0 */
|
|
|
|
/*
|
|
|
|
* Copyright 2012-2019 Red Hat
|
|
|
|
*
|
|
|
|
* This file is subject to the terms and conditions of the GNU General
|
|
|
|
* Public License version 2. See the file COPYING in the main
|
|
|
|
* directory of this archive for more details.
|
|
|
|
*
|
|
|
|
* Authors: Matthew Garrett
|
|
|
|
* Dave Airlie
|
|
|
|
* Gerd Hoffmann
|
|
|
|
*
|
|
|
|
* Portions of this code derived from cirrusfb.c:
|
|
|
|
* drivers/video/cirrusfb.c - driver for Cirrus Logic chipsets
|
|
|
|
*
|
|
|
|
* Copyright 1999-2001 Jeff Garzik <jgarzik@pobox.com>
|
|
|
|
*/
|
|
|
|
|
|
|
|
#include <linux/iosys-map.h>
|
|
|
|
#include <linux/module.h>
|
|
|
|
#include <linux/pci.h>
|
|
|
|
|
|
|
|
#include <video/cirrus.h>
|
|
|
|
#include <video/vga.h>
|
|
|
|
|
|
|
|
#include <drm/drm_aperture.h>
|
2023-10-24 12:59:35 +02:00
|
|
|
#include <drm/drm_atomic.h>
|
2023-08-30 17:31:07 +02:00
|
|
|
#include <drm/drm_atomic_helper.h>
|
|
|
|
#include <drm/drm_atomic_state_helper.h>
|
|
|
|
#include <drm/drm_connector.h>
|
|
|
|
#include <drm/drm_damage_helper.h>
|
|
|
|
#include <drm/drm_drv.h>
|
|
|
|
#include <drm/drm_edid.h>
|
|
|
|
#include <drm/drm_fbdev_generic.h>
|
|
|
|
#include <drm/drm_file.h>
|
|
|
|
#include <drm/drm_format_helper.h>
|
|
|
|
#include <drm/drm_fourcc.h>
|
|
|
|
#include <drm/drm_framebuffer.h>
|
|
|
|
#include <drm/drm_gem_atomic_helper.h>
|
|
|
|
#include <drm/drm_gem_framebuffer_helper.h>
|
|
|
|
#include <drm/drm_gem_shmem_helper.h>
|
|
|
|
#include <drm/drm_ioctl.h>
|
|
|
|
#include <drm/drm_managed.h>
|
|
|
|
#include <drm/drm_modeset_helper_vtables.h>
|
|
|
|
#include <drm/drm_module.h>
|
|
|
|
#include <drm/drm_probe_helper.h>
|
|
|
|
|
|
|
|
#define DRIVER_NAME "cirrus"
|
|
|
|
#define DRIVER_DESC "qemu cirrus vga"
|
|
|
|
#define DRIVER_DATE "2019"
|
|
|
|
#define DRIVER_MAJOR 2
|
|
|
|
#define DRIVER_MINOR 0
|
|
|
|
|
|
|
|
#define CIRRUS_MAX_PITCH (0x1FF << 3) /* (4096 - 1) & ~111b bytes */
|
|
|
|
#define CIRRUS_VRAM_SIZE (4 * 1024 * 1024) /* 4 MB */
|
|
|
|
|
|
|
|
struct cirrus_device {
|
|
|
|
struct drm_device dev;
|
2023-10-24 12:59:35 +02:00
|
|
|
|
|
|
|
/* modesetting pipeline */
|
|
|
|
struct drm_plane primary_plane;
|
|
|
|
struct drm_crtc crtc;
|
|
|
|
struct drm_encoder encoder;
|
|
|
|
struct drm_connector connector;
|
|
|
|
|
|
|
|
/* HW resources */
|
2023-08-30 17:31:07 +02:00
|
|
|
void __iomem *vram;
|
|
|
|
void __iomem *mmio;
|
|
|
|
};
|
|
|
|
|
|
|
|
#define to_cirrus(_dev) container_of(_dev, struct cirrus_device, dev)
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
struct cirrus_primary_plane_state {
|
|
|
|
struct drm_shadow_plane_state base;
|
|
|
|
|
|
|
|
/* HW scanout buffer */
|
|
|
|
const struct drm_format_info *format;
|
|
|
|
unsigned int pitch;
|
|
|
|
};
|
|
|
|
|
|
|
|
static inline struct cirrus_primary_plane_state *
|
|
|
|
to_cirrus_primary_plane_state(struct drm_plane_state *plane_state)
|
|
|
|
{
|
|
|
|
return container_of(plane_state, struct cirrus_primary_plane_state, base.base);
|
|
|
|
};
|
|
|
|
|
2023-08-30 17:31:07 +02:00
|
|
|
/* ------------------------------------------------------------------ */
|
|
|
|
/*
|
|
|
|
* The meat of this driver. The core passes us a mode and we have to program
|
|
|
|
* it. The modesetting here is the bare minimum required to satisfy the qemu
|
|
|
|
* emulation of this hardware, and running this against a real device is
|
|
|
|
* likely to result in an inadequately programmed mode. We've already had
|
|
|
|
* the opportunity to modify the mode, so whatever we receive here should
|
|
|
|
* be something that can be correctly programmed and displayed
|
|
|
|
*/
|
|
|
|
|
|
|
|
#define SEQ_INDEX 4
|
|
|
|
#define SEQ_DATA 5
|
|
|
|
|
|
|
|
static u8 rreg_seq(struct cirrus_device *cirrus, u8 reg)
|
|
|
|
{
|
|
|
|
iowrite8(reg, cirrus->mmio + SEQ_INDEX);
|
|
|
|
return ioread8(cirrus->mmio + SEQ_DATA);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void wreg_seq(struct cirrus_device *cirrus, u8 reg, u8 val)
|
|
|
|
{
|
|
|
|
iowrite8(reg, cirrus->mmio + SEQ_INDEX);
|
|
|
|
iowrite8(val, cirrus->mmio + SEQ_DATA);
|
|
|
|
}
|
|
|
|
|
|
|
|
#define CRT_INDEX 0x14
|
|
|
|
#define CRT_DATA 0x15
|
|
|
|
|
|
|
|
static u8 rreg_crt(struct cirrus_device *cirrus, u8 reg)
|
|
|
|
{
|
|
|
|
iowrite8(reg, cirrus->mmio + CRT_INDEX);
|
|
|
|
return ioread8(cirrus->mmio + CRT_DATA);
|
|
|
|
}
|
|
|
|
|
|
|
|
static void wreg_crt(struct cirrus_device *cirrus, u8 reg, u8 val)
|
|
|
|
{
|
|
|
|
iowrite8(reg, cirrus->mmio + CRT_INDEX);
|
|
|
|
iowrite8(val, cirrus->mmio + CRT_DATA);
|
|
|
|
}
|
|
|
|
|
|
|
|
#define GFX_INDEX 0xe
|
|
|
|
#define GFX_DATA 0xf
|
|
|
|
|
|
|
|
static void wreg_gfx(struct cirrus_device *cirrus, u8 reg, u8 val)
|
|
|
|
{
|
|
|
|
iowrite8(reg, cirrus->mmio + GFX_INDEX);
|
|
|
|
iowrite8(val, cirrus->mmio + GFX_DATA);
|
|
|
|
}
|
|
|
|
|
|
|
|
#define VGA_DAC_MASK 0x06
|
|
|
|
|
|
|
|
static void wreg_hdr(struct cirrus_device *cirrus, u8 val)
|
|
|
|
{
|
|
|
|
ioread8(cirrus->mmio + VGA_DAC_MASK);
|
|
|
|
ioread8(cirrus->mmio + VGA_DAC_MASK);
|
|
|
|
ioread8(cirrus->mmio + VGA_DAC_MASK);
|
|
|
|
ioread8(cirrus->mmio + VGA_DAC_MASK);
|
|
|
|
iowrite8(val, cirrus->mmio + VGA_DAC_MASK);
|
|
|
|
}
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static const struct drm_format_info *cirrus_convert_to(struct drm_framebuffer *fb)
|
2023-08-30 17:31:07 +02:00
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
if (fb->format->format == DRM_FORMAT_XRGB8888 && fb->pitches[0] > CIRRUS_MAX_PITCH) {
|
2023-08-30 17:31:07 +02:00
|
|
|
if (fb->width * 3 <= CIRRUS_MAX_PITCH)
|
|
|
|
/* convert from XR24 to RG24 */
|
2023-10-24 12:59:35 +02:00
|
|
|
return drm_format_info(DRM_FORMAT_RGB888);
|
2023-08-30 17:31:07 +02:00
|
|
|
else
|
|
|
|
/* convert from XR24 to RG16 */
|
2023-10-24 12:59:35 +02:00
|
|
|
return drm_format_info(DRM_FORMAT_RGB565);
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
2023-10-24 12:59:35 +02:00
|
|
|
return NULL;
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static const struct drm_format_info *cirrus_format(struct drm_framebuffer *fb)
|
2023-08-30 17:31:07 +02:00
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
const struct drm_format_info *format = cirrus_convert_to(fb);
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
if (format)
|
|
|
|
return format;
|
|
|
|
return fb->format;
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
static int cirrus_pitch(struct drm_framebuffer *fb)
|
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
const struct drm_format_info *format = cirrus_convert_to(fb);
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
if (format)
|
|
|
|
return drm_format_info_min_pitch(format, 0, fb->width);
|
2023-08-30 17:31:07 +02:00
|
|
|
return fb->pitches[0];
|
|
|
|
}
|
|
|
|
|
|
|
|
static void cirrus_set_start_address(struct cirrus_device *cirrus, u32 offset)
|
|
|
|
{
|
|
|
|
u32 addr;
|
|
|
|
u8 tmp;
|
|
|
|
|
|
|
|
addr = offset >> 2;
|
|
|
|
wreg_crt(cirrus, 0x0c, (u8)((addr >> 8) & 0xff));
|
|
|
|
wreg_crt(cirrus, 0x0d, (u8)(addr & 0xff));
|
|
|
|
|
|
|
|
tmp = rreg_crt(cirrus, 0x1b);
|
|
|
|
tmp &= 0xf2;
|
|
|
|
tmp |= (addr >> 16) & 0x01;
|
|
|
|
tmp |= (addr >> 15) & 0x0c;
|
|
|
|
wreg_crt(cirrus, 0x1b, tmp);
|
|
|
|
|
|
|
|
tmp = rreg_crt(cirrus, 0x1d);
|
|
|
|
tmp &= 0x7f;
|
|
|
|
tmp |= (addr >> 12) & 0x80;
|
|
|
|
wreg_crt(cirrus, 0x1d, tmp);
|
|
|
|
}
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static void cirrus_mode_set(struct cirrus_device *cirrus,
|
|
|
|
struct drm_display_mode *mode)
|
2023-08-30 17:31:07 +02:00
|
|
|
{
|
|
|
|
int hsyncstart, hsyncend, htotal, hdispend;
|
|
|
|
int vtotal, vdispend;
|
2023-10-24 12:59:35 +02:00
|
|
|
int tmp;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
|
|
|
htotal = mode->htotal / 8;
|
|
|
|
hsyncend = mode->hsync_end / 8;
|
|
|
|
hsyncstart = mode->hsync_start / 8;
|
|
|
|
hdispend = mode->hdisplay / 8;
|
|
|
|
|
|
|
|
vtotal = mode->vtotal;
|
|
|
|
vdispend = mode->vdisplay;
|
|
|
|
|
|
|
|
vdispend -= 1;
|
|
|
|
vtotal -= 2;
|
|
|
|
|
|
|
|
htotal -= 5;
|
|
|
|
hdispend -= 1;
|
|
|
|
hsyncstart += 1;
|
|
|
|
hsyncend += 1;
|
|
|
|
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_V_SYNC_END, 0x20);
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_H_TOTAL, htotal);
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_H_DISP, hdispend);
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_H_SYNC_START, hsyncstart);
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_H_SYNC_END, hsyncend);
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_V_TOTAL, vtotal & 0xff);
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_V_DISP_END, vdispend & 0xff);
|
|
|
|
|
|
|
|
tmp = 0x40;
|
|
|
|
if ((vdispend + 1) & 512)
|
|
|
|
tmp |= 0x20;
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_MAX_SCAN, tmp);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Overflow bits for values that don't fit in the standard registers
|
|
|
|
*/
|
|
|
|
tmp = 0x10;
|
|
|
|
if (vtotal & 0x100)
|
|
|
|
tmp |= 0x01;
|
|
|
|
if (vdispend & 0x100)
|
|
|
|
tmp |= 0x02;
|
|
|
|
if ((vdispend + 1) & 0x100)
|
|
|
|
tmp |= 0x08;
|
|
|
|
if (vtotal & 0x200)
|
|
|
|
tmp |= 0x20;
|
|
|
|
if (vdispend & 0x200)
|
|
|
|
tmp |= 0x40;
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_OVERFLOW, tmp);
|
|
|
|
|
|
|
|
tmp = 0;
|
|
|
|
|
|
|
|
/* More overflow bits */
|
|
|
|
|
|
|
|
if ((htotal + 5) & 0x40)
|
|
|
|
tmp |= 0x10;
|
|
|
|
if ((htotal + 5) & 0x80)
|
|
|
|
tmp |= 0x20;
|
|
|
|
if (vtotal & 0x100)
|
|
|
|
tmp |= 0x40;
|
|
|
|
if (vtotal & 0x200)
|
|
|
|
tmp |= 0x80;
|
|
|
|
|
|
|
|
wreg_crt(cirrus, CL_CRT1A, tmp);
|
|
|
|
|
|
|
|
/* Disable Hercules/CGA compatibility */
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_MODE, 0x03);
|
2023-10-24 12:59:35 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
static void cirrus_format_set(struct cirrus_device *cirrus,
|
|
|
|
const struct drm_format_info *format)
|
|
|
|
{
|
|
|
|
u8 sr07, hdr;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
|
|
|
sr07 = rreg_seq(cirrus, 0x07);
|
|
|
|
sr07 &= 0xe0;
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
switch (format->format) {
|
|
|
|
case DRM_FORMAT_C8:
|
2023-08-30 17:31:07 +02:00
|
|
|
sr07 |= 0x11;
|
2023-10-24 12:59:35 +02:00
|
|
|
hdr = 0x00;
|
2023-08-30 17:31:07 +02:00
|
|
|
break;
|
2023-10-24 12:59:35 +02:00
|
|
|
case DRM_FORMAT_RGB565:
|
2023-08-30 17:31:07 +02:00
|
|
|
sr07 |= 0x17;
|
|
|
|
hdr = 0xc1;
|
|
|
|
break;
|
2023-10-24 12:59:35 +02:00
|
|
|
case DRM_FORMAT_RGB888:
|
2023-08-30 17:31:07 +02:00
|
|
|
sr07 |= 0x15;
|
|
|
|
hdr = 0xc5;
|
|
|
|
break;
|
2023-10-24 12:59:35 +02:00
|
|
|
case DRM_FORMAT_XRGB8888:
|
2023-08-30 17:31:07 +02:00
|
|
|
sr07 |= 0x19;
|
|
|
|
hdr = 0xc5;
|
|
|
|
break;
|
|
|
|
default:
|
2023-10-24 12:59:35 +02:00
|
|
|
return;
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
wreg_seq(cirrus, 0x7, sr07);
|
|
|
|
|
|
|
|
/* Enable high-colour modes */
|
|
|
|
wreg_gfx(cirrus, VGA_GFX_MODE, 0x40);
|
|
|
|
|
|
|
|
/* And set graphics mode */
|
|
|
|
wreg_gfx(cirrus, VGA_GFX_MISC, 0x01);
|
|
|
|
|
|
|
|
wreg_hdr(cirrus, hdr);
|
2023-10-24 12:59:35 +02:00
|
|
|
}
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static void cirrus_pitch_set(struct cirrus_device *cirrus, unsigned int pitch)
|
|
|
|
{
|
|
|
|
u8 cr13, cr1b;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
/* Program the pitch */
|
|
|
|
cr13 = pitch / 8;
|
|
|
|
wreg_crt(cirrus, VGA_CRTC_OFFSET, cr13);
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
/* Enable extended blanking and pitch bits, and enable full memory */
|
|
|
|
cr1b = 0x22;
|
|
|
|
cr1b |= (pitch >> 7) & 0x10;
|
|
|
|
cr1b |= (pitch >> 6) & 0x40;
|
|
|
|
wreg_crt(cirrus, 0x1b, cr1b);
|
|
|
|
|
|
|
|
cirrus_set_start_address(cirrus, 0);
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
/* ------------------------------------------------------------------ */
|
|
|
|
/* cirrus display pipe */
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static const uint32_t cirrus_primary_plane_formats[] = {
|
|
|
|
DRM_FORMAT_RGB565,
|
|
|
|
DRM_FORMAT_RGB888,
|
|
|
|
DRM_FORMAT_XRGB8888,
|
|
|
|
};
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static const uint64_t cirrus_primary_plane_format_modifiers[] = {
|
|
|
|
DRM_FORMAT_MOD_LINEAR,
|
|
|
|
DRM_FORMAT_MOD_INVALID
|
|
|
|
};
|
|
|
|
|
|
|
|
static int cirrus_primary_plane_helper_atomic_check(struct drm_plane *plane,
|
|
|
|
struct drm_atomic_state *state)
|
|
|
|
{
|
|
|
|
struct drm_plane_state *new_plane_state = drm_atomic_get_new_plane_state(state, plane);
|
|
|
|
struct cirrus_primary_plane_state *new_primary_plane_state =
|
|
|
|
to_cirrus_primary_plane_state(new_plane_state);
|
|
|
|
struct drm_framebuffer *fb = new_plane_state->fb;
|
|
|
|
struct drm_crtc *new_crtc = new_plane_state->crtc;
|
|
|
|
struct drm_crtc_state *new_crtc_state = NULL;
|
|
|
|
int ret;
|
|
|
|
unsigned int pitch;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
if (new_crtc)
|
|
|
|
new_crtc_state = drm_atomic_get_new_crtc_state(state, new_crtc);
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
ret = drm_atomic_helper_check_plane_state(new_plane_state, new_crtc_state,
|
|
|
|
DRM_PLANE_NO_SCALING,
|
|
|
|
DRM_PLANE_NO_SCALING,
|
|
|
|
false, false);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
else if (!new_plane_state->visible)
|
|
|
|
return 0;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
pitch = cirrus_pitch(fb);
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
/* validate size constraints */
|
|
|
|
if (pitch > CIRRUS_MAX_PITCH)
|
|
|
|
return -EINVAL;
|
|
|
|
else if (pitch * fb->height > CIRRUS_VRAM_SIZE)
|
|
|
|
return -EINVAL;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
new_primary_plane_state->format = cirrus_format(fb);
|
|
|
|
new_primary_plane_state->pitch = pitch;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static void cirrus_primary_plane_helper_atomic_update(struct drm_plane *plane,
|
|
|
|
struct drm_atomic_state *state)
|
2023-08-30 17:31:07 +02:00
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
struct cirrus_device *cirrus = to_cirrus(plane->dev);
|
|
|
|
struct drm_plane_state *plane_state = drm_atomic_get_new_plane_state(state, plane);
|
|
|
|
struct cirrus_primary_plane_state *primary_plane_state =
|
|
|
|
to_cirrus_primary_plane_state(plane_state);
|
|
|
|
struct drm_shadow_plane_state *shadow_plane_state = to_drm_shadow_plane_state(plane_state);
|
|
|
|
struct drm_framebuffer *fb = plane_state->fb;
|
|
|
|
const struct drm_format_info *format = primary_plane_state->format;
|
|
|
|
unsigned int pitch = primary_plane_state->pitch;
|
|
|
|
struct drm_plane_state *old_plane_state = drm_atomic_get_old_plane_state(state, plane);
|
|
|
|
struct cirrus_primary_plane_state *old_primary_plane_state =
|
|
|
|
to_cirrus_primary_plane_state(old_plane_state);
|
|
|
|
struct iosys_map vaddr = IOSYS_MAP_INIT_VADDR_IOMEM(cirrus->vram);
|
|
|
|
struct drm_atomic_helper_damage_iter iter;
|
|
|
|
struct drm_rect damage;
|
|
|
|
int idx;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
if (!fb)
|
|
|
|
return;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
if (!drm_dev_enter(&cirrus->dev, &idx))
|
|
|
|
return;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
if (old_primary_plane_state->format != format)
|
|
|
|
cirrus_format_set(cirrus, format);
|
|
|
|
if (old_primary_plane_state->pitch != pitch)
|
|
|
|
cirrus_pitch_set(cirrus, pitch);
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
drm_atomic_helper_damage_iter_init(&iter, old_plane_state, plane_state);
|
|
|
|
drm_atomic_for_each_plane_damage(&iter, &damage) {
|
|
|
|
unsigned int offset = drm_fb_clip_offset(pitch, format, &damage);
|
|
|
|
struct iosys_map dst = IOSYS_MAP_INIT_OFFSET(&vaddr, offset);
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
drm_fb_blit(&dst, &pitch, format->format, shadow_plane_state->data, fb, &damage);
|
|
|
|
}
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
drm_dev_exit(idx);
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static const struct drm_plane_helper_funcs cirrus_primary_plane_helper_funcs = {
|
|
|
|
DRM_GEM_SHADOW_PLANE_HELPER_FUNCS,
|
|
|
|
.atomic_check = cirrus_primary_plane_helper_atomic_check,
|
|
|
|
.atomic_update = cirrus_primary_plane_helper_atomic_update,
|
2023-08-30 17:31:07 +02:00
|
|
|
};
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static struct drm_plane_state *
|
|
|
|
cirrus_primary_plane_atomic_duplicate_state(struct drm_plane *plane)
|
2023-08-30 17:31:07 +02:00
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
struct drm_plane_state *plane_state = plane->state;
|
|
|
|
struct cirrus_primary_plane_state *primary_plane_state =
|
|
|
|
to_cirrus_primary_plane_state(plane_state);
|
|
|
|
struct cirrus_primary_plane_state *new_primary_plane_state;
|
|
|
|
struct drm_shadow_plane_state *new_shadow_plane_state;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
if (!plane_state)
|
|
|
|
return NULL;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
new_primary_plane_state = kzalloc(sizeof(*new_primary_plane_state), GFP_KERNEL);
|
|
|
|
if (!new_primary_plane_state)
|
|
|
|
return NULL;
|
|
|
|
new_shadow_plane_state = &new_primary_plane_state->base;
|
|
|
|
|
|
|
|
__drm_gem_duplicate_shadow_plane_state(plane, new_shadow_plane_state);
|
|
|
|
new_primary_plane_state->format = primary_plane_state->format;
|
|
|
|
new_primary_plane_state->pitch = primary_plane_state->pitch;
|
|
|
|
|
|
|
|
return &new_shadow_plane_state->base;
|
|
|
|
}
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static void cirrus_primary_plane_atomic_destroy_state(struct drm_plane *plane,
|
|
|
|
struct drm_plane_state *plane_state)
|
2023-08-30 17:31:07 +02:00
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
struct cirrus_primary_plane_state *primary_plane_state =
|
|
|
|
to_cirrus_primary_plane_state(plane_state);
|
|
|
|
|
|
|
|
__drm_gem_destroy_shadow_plane_state(&primary_plane_state->base);
|
|
|
|
kfree(primary_plane_state);
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static void cirrus_reset_primary_plane(struct drm_plane *plane)
|
2023-08-30 17:31:07 +02:00
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
struct cirrus_primary_plane_state *primary_plane_state;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
if (plane->state) {
|
|
|
|
cirrus_primary_plane_atomic_destroy_state(plane, plane->state);
|
|
|
|
plane->state = NULL; /* must be set to NULL here */
|
|
|
|
}
|
|
|
|
|
|
|
|
primary_plane_state = kzalloc(sizeof(*primary_plane_state), GFP_KERNEL);
|
|
|
|
if (!primary_plane_state)
|
|
|
|
return;
|
|
|
|
__drm_gem_reset_shadow_plane(plane, &primary_plane_state->base);
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static const struct drm_plane_funcs cirrus_primary_plane_funcs = {
|
|
|
|
.update_plane = drm_atomic_helper_update_plane,
|
|
|
|
.disable_plane = drm_atomic_helper_disable_plane,
|
|
|
|
.destroy = drm_plane_cleanup,
|
|
|
|
.reset = cirrus_reset_primary_plane,
|
|
|
|
.atomic_duplicate_state = cirrus_primary_plane_atomic_duplicate_state,
|
|
|
|
.atomic_destroy_state = cirrus_primary_plane_atomic_destroy_state,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int cirrus_crtc_helper_atomic_check(struct drm_crtc *crtc, struct drm_atomic_state *state)
|
2023-08-30 17:31:07 +02:00
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
struct drm_crtc_state *crtc_state = drm_atomic_get_new_crtc_state(state, crtc);
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
if (!crtc_state->enable)
|
|
|
|
return 0;
|
|
|
|
|
|
|
|
ret = drm_atomic_helper_check_crtc_primary_plane(crtc_state);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
return 0;
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static void cirrus_crtc_helper_atomic_enable(struct drm_crtc *crtc,
|
|
|
|
struct drm_atomic_state *state)
|
2023-08-30 17:31:07 +02:00
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
struct cirrus_device *cirrus = to_cirrus(crtc->dev);
|
|
|
|
struct drm_crtc_state *crtc_state = drm_atomic_get_new_crtc_state(state, crtc);
|
|
|
|
int idx;
|
|
|
|
|
|
|
|
if (!drm_dev_enter(&cirrus->dev, &idx))
|
|
|
|
return;
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
cirrus_mode_set(cirrus, &crtc_state->mode);
|
2023-08-30 17:31:07 +02:00
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
/* Unblank (needed on S3 resume, vgabios doesn't do it then) */
|
|
|
|
outb(VGA_AR_ENABLE_DISPLAY, VGA_ATT_W);
|
|
|
|
|
|
|
|
drm_dev_exit(idx);
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static const struct drm_crtc_helper_funcs cirrus_crtc_helper_funcs = {
|
|
|
|
.atomic_check = cirrus_crtc_helper_atomic_check,
|
|
|
|
.atomic_enable = cirrus_crtc_helper_atomic_enable,
|
2023-08-30 17:31:07 +02:00
|
|
|
};
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static const struct drm_crtc_funcs cirrus_crtc_funcs = {
|
|
|
|
.reset = drm_atomic_helper_crtc_reset,
|
|
|
|
.destroy = drm_crtc_cleanup,
|
|
|
|
.set_config = drm_atomic_helper_set_config,
|
|
|
|
.page_flip = drm_atomic_helper_page_flip,
|
|
|
|
.atomic_duplicate_state = drm_atomic_helper_crtc_duplicate_state,
|
|
|
|
.atomic_destroy_state = drm_atomic_helper_crtc_destroy_state,
|
2023-08-30 17:31:07 +02:00
|
|
|
};
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static const struct drm_encoder_funcs cirrus_encoder_funcs = {
|
|
|
|
.destroy = drm_encoder_cleanup,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int cirrus_connector_helper_get_modes(struct drm_connector *connector)
|
|
|
|
{
|
|
|
|
int count;
|
|
|
|
|
|
|
|
count = drm_add_modes_noedid(connector,
|
|
|
|
connector->dev->mode_config.max_width,
|
|
|
|
connector->dev->mode_config.max_height);
|
|
|
|
drm_set_preferred_mode(connector, 1024, 768);
|
|
|
|
return count;
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct drm_connector_helper_funcs cirrus_connector_helper_funcs = {
|
|
|
|
.get_modes = cirrus_connector_helper_get_modes,
|
|
|
|
};
|
|
|
|
|
|
|
|
static const struct drm_connector_funcs cirrus_connector_funcs = {
|
|
|
|
.fill_modes = drm_helper_probe_single_connector_modes,
|
|
|
|
.destroy = drm_connector_cleanup,
|
|
|
|
.reset = drm_atomic_helper_connector_reset,
|
|
|
|
.atomic_duplicate_state = drm_atomic_helper_connector_duplicate_state,
|
|
|
|
.atomic_destroy_state = drm_atomic_helper_connector_destroy_state,
|
2023-08-30 17:31:07 +02:00
|
|
|
};
|
|
|
|
|
|
|
|
static int cirrus_pipe_init(struct cirrus_device *cirrus)
|
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
struct drm_device *dev = &cirrus->dev;
|
|
|
|
struct drm_plane *primary_plane;
|
|
|
|
struct drm_crtc *crtc;
|
|
|
|
struct drm_encoder *encoder;
|
|
|
|
struct drm_connector *connector;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
primary_plane = &cirrus->primary_plane;
|
|
|
|
ret = drm_universal_plane_init(dev, primary_plane, 0,
|
|
|
|
&cirrus_primary_plane_funcs,
|
|
|
|
cirrus_primary_plane_formats,
|
|
|
|
ARRAY_SIZE(cirrus_primary_plane_formats),
|
|
|
|
cirrus_primary_plane_format_modifiers,
|
|
|
|
DRM_PLANE_TYPE_PRIMARY, NULL);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
drm_plane_helper_add(primary_plane, &cirrus_primary_plane_helper_funcs);
|
|
|
|
drm_plane_enable_fb_damage_clips(primary_plane);
|
|
|
|
|
|
|
|
crtc = &cirrus->crtc;
|
|
|
|
ret = drm_crtc_init_with_planes(dev, crtc, primary_plane, NULL,
|
|
|
|
&cirrus_crtc_funcs, NULL);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
drm_crtc_helper_add(crtc, &cirrus_crtc_helper_funcs);
|
|
|
|
|
|
|
|
encoder = &cirrus->encoder;
|
|
|
|
ret = drm_encoder_init(dev, encoder, &cirrus_encoder_funcs,
|
|
|
|
DRM_MODE_ENCODER_DAC, NULL);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
encoder->possible_crtcs = drm_crtc_mask(crtc);
|
|
|
|
|
|
|
|
connector = &cirrus->connector;
|
|
|
|
ret = drm_connector_init(dev, connector, &cirrus_connector_funcs,
|
|
|
|
DRM_MODE_CONNECTOR_VGA);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
drm_connector_helper_add(connector, &cirrus_connector_helper_funcs);
|
|
|
|
|
|
|
|
ret = drm_connector_attach_encoder(connector, encoder);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
return 0;
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------ */
|
|
|
|
/* cirrus framebuffers & mode config */
|
|
|
|
|
2023-10-24 12:59:35 +02:00
|
|
|
static enum drm_mode_status cirrus_mode_config_mode_valid(struct drm_device *dev,
|
|
|
|
const struct drm_display_mode *mode)
|
2023-08-30 17:31:07 +02:00
|
|
|
{
|
2023-10-24 12:59:35 +02:00
|
|
|
const struct drm_format_info *format = drm_format_info(DRM_FORMAT_XRGB8888);
|
|
|
|
uint64_t pitch = drm_format_info_min_pitch(format, 0, mode->hdisplay);
|
|
|
|
|
|
|
|
if (pitch * mode->vdisplay > CIRRUS_VRAM_SIZE)
|
|
|
|
return MODE_MEM;
|
|
|
|
|
|
|
|
return MODE_OK;
|
2023-08-30 17:31:07 +02:00
|
|
|
}
|
|
|
|
|
|
|
|
static const struct drm_mode_config_funcs cirrus_mode_config_funcs = {
|
2023-10-24 12:59:35 +02:00
|
|
|
.fb_create = drm_gem_fb_create_with_dirty,
|
|
|
|
.mode_valid = cirrus_mode_config_mode_valid,
|
2023-08-30 17:31:07 +02:00
|
|
|
.atomic_check = drm_atomic_helper_check,
|
|
|
|
.atomic_commit = drm_atomic_helper_commit,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int cirrus_mode_config_init(struct cirrus_device *cirrus)
|
|
|
|
{
|
|
|
|
struct drm_device *dev = &cirrus->dev;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = drmm_mode_config_init(dev);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
dev->mode_config.min_width = 0;
|
|
|
|
dev->mode_config.min_height = 0;
|
|
|
|
dev->mode_config.max_width = CIRRUS_MAX_PITCH / 2;
|
|
|
|
dev->mode_config.max_height = 1024;
|
|
|
|
dev->mode_config.preferred_depth = 16;
|
|
|
|
dev->mode_config.prefer_shadow = 0;
|
|
|
|
dev->mode_config.funcs = &cirrus_mode_config_funcs;
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------ */
|
|
|
|
|
|
|
|
DEFINE_DRM_GEM_FOPS(cirrus_fops);
|
|
|
|
|
|
|
|
static const struct drm_driver cirrus_driver = {
|
|
|
|
.driver_features = DRIVER_MODESET | DRIVER_GEM | DRIVER_ATOMIC,
|
|
|
|
|
|
|
|
.name = DRIVER_NAME,
|
|
|
|
.desc = DRIVER_DESC,
|
|
|
|
.date = DRIVER_DATE,
|
|
|
|
.major = DRIVER_MAJOR,
|
|
|
|
.minor = DRIVER_MINOR,
|
|
|
|
|
|
|
|
.fops = &cirrus_fops,
|
|
|
|
DRM_GEM_SHMEM_DRIVER_OPS,
|
|
|
|
};
|
|
|
|
|
|
|
|
static int cirrus_pci_probe(struct pci_dev *pdev,
|
|
|
|
const struct pci_device_id *ent)
|
|
|
|
{
|
|
|
|
struct drm_device *dev;
|
|
|
|
struct cirrus_device *cirrus;
|
|
|
|
int ret;
|
|
|
|
|
|
|
|
ret = drm_aperture_remove_conflicting_pci_framebuffers(pdev, &cirrus_driver);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
ret = pcim_enable_device(pdev);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
ret = pci_request_regions(pdev, DRIVER_NAME);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
ret = -ENOMEM;
|
|
|
|
cirrus = devm_drm_dev_alloc(&pdev->dev, &cirrus_driver,
|
|
|
|
struct cirrus_device, dev);
|
|
|
|
if (IS_ERR(cirrus))
|
|
|
|
return PTR_ERR(cirrus);
|
|
|
|
|
|
|
|
dev = &cirrus->dev;
|
|
|
|
|
|
|
|
cirrus->vram = devm_ioremap(&pdev->dev, pci_resource_start(pdev, 0),
|
|
|
|
pci_resource_len(pdev, 0));
|
|
|
|
if (cirrus->vram == NULL)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
cirrus->mmio = devm_ioremap(&pdev->dev, pci_resource_start(pdev, 1),
|
|
|
|
pci_resource_len(pdev, 1));
|
|
|
|
if (cirrus->mmio == NULL)
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
ret = cirrus_mode_config_init(cirrus);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
ret = cirrus_pipe_init(cirrus);
|
|
|
|
if (ret < 0)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
drm_mode_config_reset(dev);
|
|
|
|
|
|
|
|
pci_set_drvdata(pdev, dev);
|
|
|
|
ret = drm_dev_register(dev, 0);
|
|
|
|
if (ret)
|
|
|
|
return ret;
|
|
|
|
|
|
|
|
drm_fbdev_generic_setup(dev, 16);
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
static void cirrus_pci_remove(struct pci_dev *pdev)
|
|
|
|
{
|
|
|
|
struct drm_device *dev = pci_get_drvdata(pdev);
|
|
|
|
|
|
|
|
drm_dev_unplug(dev);
|
|
|
|
drm_atomic_helper_shutdown(dev);
|
|
|
|
}
|
|
|
|
|
|
|
|
static const struct pci_device_id pciidlist[] = {
|
|
|
|
{
|
|
|
|
.vendor = PCI_VENDOR_ID_CIRRUS,
|
|
|
|
.device = PCI_DEVICE_ID_CIRRUS_5446,
|
|
|
|
/* only bind to the cirrus chip in qemu */
|
|
|
|
.subvendor = PCI_SUBVENDOR_ID_REDHAT_QUMRANET,
|
|
|
|
.subdevice = PCI_SUBDEVICE_ID_QEMU,
|
|
|
|
}, {
|
|
|
|
.vendor = PCI_VENDOR_ID_CIRRUS,
|
|
|
|
.device = PCI_DEVICE_ID_CIRRUS_5446,
|
|
|
|
.subvendor = PCI_VENDOR_ID_XEN,
|
|
|
|
.subdevice = 0x0001,
|
|
|
|
},
|
|
|
|
{ /* end if list */ }
|
|
|
|
};
|
|
|
|
|
|
|
|
static struct pci_driver cirrus_pci_driver = {
|
|
|
|
.name = DRIVER_NAME,
|
|
|
|
.id_table = pciidlist,
|
|
|
|
.probe = cirrus_pci_probe,
|
|
|
|
.remove = cirrus_pci_remove,
|
|
|
|
};
|
|
|
|
|
|
|
|
drm_module_pci_driver(cirrus_pci_driver)
|
|
|
|
|
|
|
|
MODULE_DEVICE_TABLE(pci, pciidlist);
|
|
|
|
MODULE_LICENSE("GPL");
|