^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) * linux/drivers/video/kyro/fbdev.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) * Copyright (C) 2002 STMicroelectronics
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5) * Copyright (C) 2003, 2004 Paul Mundt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) * This file is subject to the terms and conditions of the GNU General Public
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) * License. See the file COPYING in the main directory of this archive
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) * for more details.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/string.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) #include <linux/delay.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) #include <linux/fb.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) #include <linux/ioctl.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) #include <linux/pci.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) #include <asm/io.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) #include <video/kyro.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) #include "STG4000Reg.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) #include "STG4000Interface.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) * PCI Definitions
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) #define PCI_VENDOR_ID_ST 0x104a
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) #define PCI_DEVICE_ID_STG4000 0x0010
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) #define KHZ2PICOS(a) (1000000000UL/(a))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) /****************************************************************************/
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) static struct fb_fix_screeninfo kyro_fix = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) .id = "ST Kyro",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) .type = FB_TYPE_PACKED_PIXELS,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) .visual = FB_VISUAL_TRUECOLOR,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) .accel = FB_ACCEL_NONE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) static const struct fb_var_screeninfo kyro_var = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) /* 640x480, 16bpp @ 60 Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) .xres = 640,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) .yres = 480,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) .xres_virtual = 640,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) .yres_virtual = 480,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) .bits_per_pixel = 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) .red = { 11, 5, 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) .green = { 5, 6, 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) .blue = { 0, 5, 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) .activate = FB_ACTIVATE_NOW,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) .height = -1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) .width = -1,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) .pixclock = KHZ2PICOS(25175),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) .left_margin = 48,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) .right_margin = 16,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) .upper_margin = 33,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) .lower_margin = 10,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) .hsync_len = 96,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) .vsync_len = 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) .vmode = FB_VMODE_NONINTERLACED,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) typedef struct {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) STG4000REG __iomem *pSTGReg; /* Virtual address of PCI register region */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) u32 ulNextFreeVidMem; /* Offset from start of vid mem to next free region */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) u32 ulOverlayOffset; /* Offset from start of vid mem to overlay */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) u32 ulOverlayStride; /* Interleaved YUV and 422 mode Y stride */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) u32 ulOverlayUVStride; /* 422 mode U & V stride */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) } device_info_t;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) /* global graphics card info structure (one per card) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) static device_info_t deviceInfo;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) static char *mode_option = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) static int nopan = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) static int nowrap = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) static int nomtrr = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) /* PCI driver prototypes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) static int kyrofb_probe(struct pci_dev *pdev, const struct pci_device_id *ent);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) static void kyrofb_remove(struct pci_dev *pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) static struct fb_videomode kyro_modedb[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) /* 640x350 @ 85Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) NULL, 85, 640, 350, KHZ2PICOS(31500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) 96, 32, 60, 32, 64, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) FB_SYNC_HOR_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97) /* 640x400 @ 85Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) NULL, 85, 640, 400, KHZ2PICOS(31500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99) 96, 32, 41, 1, 64, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) /* 720x400 @ 85Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) NULL, 85, 720, 400, KHZ2PICOS(35500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 108, 36, 42, 1, 72, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) /* 640x480 @ 60Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) NULL, 60, 640, 480, KHZ2PICOS(25175),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 48, 16, 33, 10, 96, 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 0, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) /* 640x480 @ 72Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) NULL, 72, 640, 480, KHZ2PICOS(31500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 128, 24, 28, 9, 40, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 0, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) /* 640x480 @ 75Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) NULL, 75, 640, 480, KHZ2PICOS(31500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 120, 16, 16, 1, 64, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 0, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) /* 640x480 @ 85Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) NULL, 85, 640, 480, KHZ2PICOS(36000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 80, 56, 25, 1, 56, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 0, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) /* 800x600 @ 56Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) NULL, 56, 800, 600, KHZ2PICOS(36000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 128, 24, 22, 1, 72, 2,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) /* 800x600 @ 60Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) NULL, 60, 800, 600, KHZ2PICOS(40000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 88, 40, 23, 1, 128, 4,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) /* 800x600 @ 72Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) NULL, 72, 800, 600, KHZ2PICOS(50000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 64, 56, 23, 37, 120, 6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) /* 800x600 @ 75Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) NULL, 75, 800, 600, KHZ2PICOS(49500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 160, 16, 21, 1, 80, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) /* 800x600 @ 85Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) NULL, 85, 800, 600, KHZ2PICOS(56250),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 152, 32, 27, 1, 64, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) /* 1024x768 @ 60Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) NULL, 60, 1024, 768, KHZ2PICOS(65000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 160, 24, 29, 3, 136, 6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 0, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) /* 1024x768 @ 70Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) NULL, 70, 1024, 768, KHZ2PICOS(75000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 144, 24, 29, 3, 136, 6,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 0, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) /* 1024x768 @ 75Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) NULL, 75, 1024, 768, KHZ2PICOS(78750),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 176, 16, 28, 1, 96, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) /* 1024x768 @ 85Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) NULL, 85, 1024, 768, KHZ2PICOS(94500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 208, 48, 36, 1, 96, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) /* 1152x864 @ 75Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) NULL, 75, 1152, 864, KHZ2PICOS(108000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 256, 64, 32, 1, 128, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) /* 1280x960 @ 60Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) NULL, 60, 1280, 960, KHZ2PICOS(108000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 312, 96, 36, 1, 112, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) /* 1280x960 @ 85Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) NULL, 85, 1280, 960, KHZ2PICOS(148500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 224, 64, 47, 1, 160, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) /* 1280x1024 @ 60Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) NULL, 60, 1280, 1024, KHZ2PICOS(108000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 248, 48, 38, 1, 112, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) /* 1280x1024 @ 75Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) NULL, 75, 1280, 1024, KHZ2PICOS(135000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 248, 16, 38, 1, 144, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) /* 1280x1024 @ 85Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) NULL, 85, 1280, 1024, KHZ2PICOS(157500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 224, 64, 44, 1, 160, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) /* 1600x1200 @ 60Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) NULL, 60, 1600, 1200, KHZ2PICOS(162000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 304, 64, 46, 1, 192, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) /* 1600x1200 @ 65Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) NULL, 65, 1600, 1200, KHZ2PICOS(175500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 304, 64, 46, 1, 192, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) /* 1600x1200 @ 70Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) NULL, 70, 1600, 1200, KHZ2PICOS(189000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 304, 64, 46, 1, 192, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) /* 1600x1200 @ 75Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) NULL, 75, 1600, 1200, KHZ2PICOS(202500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 304, 64, 46, 1, 192, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) /* 1600x1200 @ 85Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) NULL, 85, 1600, 1200, KHZ2PICOS(229500),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 304, 64, 46, 1, 192, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) /* 1792x1344 @ 60Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) NULL, 60, 1792, 1344, KHZ2PICOS(204750),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 328, 128, 46, 1, 200, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) /* 1792x1344 @ 75Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) NULL, 75, 1792, 1344, KHZ2PICOS(261000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 352, 96, 69, 1, 216, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) /* 1856x1392 @ 60Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) NULL, 60, 1856, 1392, KHZ2PICOS(218250),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 352, 96, 43, 1, 224, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) /* 1856x1392 @ 75Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) NULL, 75, 1856, 1392, KHZ2PICOS(288000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 352, 128, 104, 1, 224, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) /* 1920x1440 @ 60Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) NULL, 60, 1920, 1440, KHZ2PICOS(234000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 344, 128, 56, 1, 208, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) }, {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) /* 1920x1440 @ 75Hz */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) NULL, 75, 1920, 1440, KHZ2PICOS(297000),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 352, 144, 56, 1, 224, 3,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) FB_SYNC_VERT_HIGH_ACT, FB_VMODE_NONINTERLACED
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) #define NUM_TOTAL_MODES ARRAY_SIZE(kyro_modedb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) * This needs to be kept ordered corresponding to kyro_modedb.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) enum {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) VMODE_640_350_85,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) VMODE_640_400_85,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) VMODE_720_400_85,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) VMODE_640_480_60,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) VMODE_640_480_72,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) VMODE_640_480_75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) VMODE_640_480_85,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) VMODE_800_600_56,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) VMODE_800_600_60,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) VMODE_800_600_72,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) VMODE_800_600_75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) VMODE_800_600_85,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) VMODE_1024_768_60,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) VMODE_1024_768_70,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) VMODE_1024_768_75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) VMODE_1024_768_85,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) VMODE_1152_864_75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) VMODE_1280_960_60,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) VMODE_1280_960_85,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) VMODE_1280_1024_60,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) VMODE_1280_1024_75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) VMODE_1280_1024_85,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) VMODE_1600_1200_60,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) VMODE_1600_1200_65,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) VMODE_1600_1200_70,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) VMODE_1600_1200_75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) VMODE_1600_1200_85,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) VMODE_1792_1344_60,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) VMODE_1792_1344_75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) VMODE_1856_1392_60,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) VMODE_1856_1392_75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) VMODE_1920_1440_60,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) VMODE_1920_1440_75,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) /* Accessors */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) static int kyro_dev_video_mode_set(struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) struct kyrofb_info *par = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) /* Turn off display */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) StopVTG(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) DisableRamdacOutput(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) /* Bring us out of VGA and into Hi-Res mode, if not already. */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) DisableVGA(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) if (InitialiseRamdac(deviceInfo.pSTGReg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) info->var.bits_per_pixel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) info->var.xres, info->var.yres,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) par->HSP, par->VSP, &par->PIXCLK) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) SetupVTG(deviceInfo.pSTGReg, par);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) ResetOverlayRegisters(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) /* Turn on display in new mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) EnableRamdacOutput(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) StartVTG(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) deviceInfo.ulNextFreeVidMem = info->var.xres * info->var.yres *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) info->var.bits_per_pixel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) deviceInfo.ulOverlayOffset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) static int kyro_dev_overlay_create(u32 ulWidth,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) u32 ulHeight, int bLinear)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) u32 offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) u32 stride, uvStride;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) if (deviceInfo.ulOverlayOffset != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) * Can only create one overlay without resetting the card or
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) * changing display mode
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) ResetOverlayRegisters(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) /* Overlays are addressed in multiples of 16bytes or 32bytes, so make
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) * sure the start offset is on an appropriate boundary.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) offset = deviceInfo.ulNextFreeVidMem;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) if ((offset & 0x1f) != 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) offset = (offset + 32L) & 0xffffffE0L;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) if (CreateOverlaySurface(deviceInfo.pSTGReg, ulWidth, ulHeight,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) bLinear, offset, &stride, &uvStride) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) deviceInfo.ulOverlayOffset = offset;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) deviceInfo.ulOverlayStride = stride;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) deviceInfo.ulOverlayUVStride = uvStride;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) deviceInfo.ulNextFreeVidMem = offset + (ulHeight * stride) + (ulHeight * 2 * uvStride);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) SetOverlayBlendMode(deviceInfo.pSTGReg, GLOBAL_ALPHA, 0xf, 0x0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) static int kyro_dev_overlay_viewport_set(u32 x, u32 y, u32 ulWidth, u32 ulHeight)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) if (deviceInfo.ulOverlayOffset == 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) /* probably haven't called CreateOverlay yet */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) if (ulWidth == 0 || ulWidth == 0xffffffff ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) ulHeight == 0 || ulHeight == 0xffffffff ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) (x < 2 && ulWidth + 2 == 0))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) /* Stop Ramdac Output */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) DisableRamdacOutput(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) SetOverlayViewPort(deviceInfo.pSTGReg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) x, y, x + ulWidth - 1, y + ulHeight - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) EnableOverlayPlane(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) /* Start Ramdac Output */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) EnableRamdacOutput(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) static inline unsigned long get_line_length(int x, int bpp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) return (unsigned long)((((x*bpp)+31)&~31) >> 3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) static int kyrofb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) struct kyrofb_info *par = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) if (!var->pixclock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) if (var->bits_per_pixel != 16 && var->bits_per_pixel != 32) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) printk(KERN_WARNING "kyrofb: depth not supported: %u\n", var->bits_per_pixel);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) switch (var->bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) case 16:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) var->red.offset = 11;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) var->red.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) var->green.offset = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) var->green.length = 6;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) var->blue.length = 5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) case 32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) var->transp.offset = 24;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) var->red.offset = 16;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) var->green.offset = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) var->blue.offset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) var->red.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) var->green.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) var->blue.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) var->transp.length = 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) /* Height/Width of picture in mm */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) var->height = var->width = -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) /* Timing information. All values are in picoseconds */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) /* par->PIXCLK is in 100Hz units. Convert to picoseconds -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) * ensuring we do not exceed 32 bit precision
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) * XXX: Enabling this really screws over the pixclock value when we
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) * read it back with fbset. As such, leaving this commented out appears
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) * to do the right thing (at least for now) .. bearing in mind that we
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) * have infact already done the KHZ2PICOS conversion in both the modedb
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) * and kyro_var. -- PFM.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) // var->pixclock = 1000000000 / (par->PIXCLK / 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) /* the header file claims we should use picoseconds
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) * - nobody else does though, the all use pixels and lines
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) * of h and v sizes. Both options here.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) * If we're being called by __fb_try_mode(), then we don't want to
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) * override any of the var settings that we've already parsed
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) * from our modedb. -- PFM.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) if ((var->activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_TEST)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) var->left_margin = par->HBP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) var->hsync_len = par->HST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) var->right_margin = par->HFP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) var->upper_margin = par->VBP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) var->vsync_len = par->VST;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) var->lower_margin = par->VFP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) if (par->HSP == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) var->sync |= FB_SYNC_HOR_HIGH_ACT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) if (par->VSP == 1)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) var->sync |= FB_SYNC_VERT_HIGH_ACT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) static int kyrofb_set_par(struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) struct kyrofb_info *par = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) unsigned long lineclock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) unsigned long frameclock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) /* Actual resolution */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) par->XRES = info->var.xres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) par->YRES = info->var.yres;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) /* pixel depth */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) par->PIXDEPTH = info->var.bits_per_pixel;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) /* Refresh rate */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) /* time for a line in ns */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) lineclock = (info->var.pixclock * (info->var.xres +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) info->var.right_margin +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) info->var.hsync_len +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) info->var.left_margin)) / 1000;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) /* time for a frame in ns (precision in 32bpp) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) frameclock = lineclock * (info->var.yres +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) info->var.lower_margin +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) info->var.vsync_len +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) info->var.upper_margin);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) /* Calculate refresh rate and horrizontal clocks */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) par->VFREQ = (1000000000 + (frameclock / 2)) / frameclock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) par->HCLK = (1000000000 + (lineclock / 2)) / lineclock;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) par->PIXCLK = ((1000000000 + (info->var.pixclock / 2))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) / info->var.pixclock) * 10;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) /* calculate horizontal timings */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) par->HFP = info->var.right_margin;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) par->HST = info->var.hsync_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) par->HBP = info->var.left_margin;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) par->HTot = par->XRES + par->HBP + par->HST + par->HFP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) /* calculate vertical timings */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) par->VFP = info->var.lower_margin;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) par->VST = info->var.vsync_len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) par->VBP = info->var.upper_margin;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) par->VTot = par->YRES + par->VBP + par->VST + par->VFP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) par->HSP = (info->var.sync & FB_SYNC_HOR_HIGH_ACT) ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) par->VSP = (info->var.sync & FB_SYNC_VERT_HIGH_ACT) ? 1 : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) kyro_dev_video_mode_set(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) /* length of a line in bytes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) info->fix.line_length = get_line_length(par->XRES, par->PIXDEPTH);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) info->fix.visual = FB_VISUAL_TRUECOLOR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) static int kyrofb_setcolreg(u_int regno, u_int red, u_int green,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) u_int blue, u_int transp, struct fb_info *info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) struct kyrofb_info *par = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) if (regno > 255)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) return 1; /* Invalid register */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) if (regno < 16) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) switch (info->var.bits_per_pixel) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) case 16:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) par->palette[regno] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) (red & 0xf800) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) ((green & 0xfc00) >> 5) |
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) ((blue & 0xf800) >> 11);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) case 32:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) red >>= 8; green >>= 8; blue >>= 8; transp >>= 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) par->palette[regno] =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) (transp << 24) | (red << 16) | (green << 8) | blue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) #ifndef MODULE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) static int __init kyrofb_setup(char *options)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) char *this_opt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) if (!options || !*options)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) while ((this_opt = strsep(&options, ","))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) if (!*this_opt)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) if (strcmp(this_opt, "nopan") == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) nopan = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) } else if (strcmp(this_opt, "nowrap") == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) nowrap = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) } else if (strcmp(this_opt, "nomtrr") == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) nomtrr = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) } else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) mode_option = this_opt;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) static int kyrofb_ioctl(struct fb_info *info,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) unsigned int cmd, unsigned long arg)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) overlay_create ol_create;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) overlay_viewport_set ol_viewport_set;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) void __user *argp = (void __user *)arg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) switch (cmd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) case KYRO_IOCTL_OVERLAY_CREATE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) if (copy_from_user(&ol_create, argp, sizeof(overlay_create)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) if (kyro_dev_overlay_create(ol_create.ulWidth,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) ol_create.ulHeight, 0) < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) printk(KERN_ERR "Kyro FB: failed to create overlay surface.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) case KYRO_IOCTL_OVERLAY_VIEWPORT_SET:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) if (copy_from_user(&ol_viewport_set, argp,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) sizeof(overlay_viewport_set)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) if (kyro_dev_overlay_viewport_set(ol_viewport_set.xOrgin,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) ol_viewport_set.yOrgin,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) ol_viewport_set.xSize,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) ol_viewport_set.ySize) != 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) printk(KERN_ERR "Kyro FB: failed to create overlay viewport.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) case KYRO_IOCTL_SET_VIDEO_MODE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) printk(KERN_ERR "Kyro FB: KYRO_IOCTL_SET_VIDEO_MODE is"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) "obsolete, use the appropriate fb_ioctl()"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) "command instead.\n");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) case KYRO_IOCTL_UVSTRIDE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) if (copy_to_user(argp, &deviceInfo.ulOverlayUVStride, sizeof(deviceInfo.ulOverlayUVStride)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) case KYRO_IOCTL_STRIDE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) if (copy_to_user(argp, &deviceInfo.ulOverlayStride, sizeof(deviceInfo.ulOverlayStride)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) case KYRO_IOCTL_OVERLAY_OFFSET:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) if (copy_to_user(argp, &deviceInfo.ulOverlayOffset, sizeof(deviceInfo.ulOverlayOffset)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) static const struct pci_device_id kyrofb_pci_tbl[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) { PCI_VENDOR_ID_ST, PCI_DEVICE_ID_STG4000,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) PCI_ANY_ID, PCI_ANY_ID, 0, 0, 0 },
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) { 0, }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) MODULE_DEVICE_TABLE(pci, kyrofb_pci_tbl);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) static struct pci_driver kyrofb_pci_driver = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) .name = "kyrofb",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) .id_table = kyrofb_pci_tbl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) .probe = kyrofb_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) .remove = kyrofb_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) static const struct fb_ops kyrofb_ops = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) .owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) .fb_check_var = kyrofb_check_var,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) .fb_set_par = kyrofb_set_par,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) .fb_setcolreg = kyrofb_setcolreg,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) .fb_ioctl = kyrofb_ioctl,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) .fb_fillrect = cfb_fillrect,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) .fb_copyarea = cfb_copyarea,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) .fb_imageblit = cfb_imageblit,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) static int kyrofb_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) struct fb_info *info;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) struct kyrofb_info *currentpar;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) unsigned long size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) if ((err = pci_enable_device(pdev))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) printk(KERN_WARNING "kyrofb: Can't enable pdev: %d\n", err);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) info = framebuffer_alloc(sizeof(struct kyrofb_info), &pdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) if (!info)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) currentpar = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) kyro_fix.smem_start = pci_resource_start(pdev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) kyro_fix.smem_len = pci_resource_len(pdev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) kyro_fix.mmio_start = pci_resource_start(pdev, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) kyro_fix.mmio_len = pci_resource_len(pdev, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) currentpar->regbase = deviceInfo.pSTGReg =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) ioremap(kyro_fix.mmio_start, kyro_fix.mmio_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) if (!currentpar->regbase)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) goto out_free_fb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) info->screen_base = pci_ioremap_wc_bar(pdev, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) if (!info->screen_base)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) goto out_unmap_regs;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) if (!nomtrr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) currentpar->wc_cookie = arch_phys_wc_add(kyro_fix.smem_start,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) kyro_fix.smem_len);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) kyro_fix.ypanstep = nopan ? 0 : 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) kyro_fix.ywrapstep = nowrap ? 0 : 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) info->fbops = &kyrofb_ops;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) info->fix = kyro_fix;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) info->pseudo_palette = currentpar->palette;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) info->flags = FBINFO_DEFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) SetCoreClockPLL(deviceInfo.pSTGReg, pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) deviceInfo.ulNextFreeVidMem = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) deviceInfo.ulOverlayOffset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) /* This should give a reasonable default video mode */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) if (!fb_find_mode(&info->var, info, mode_option, kyro_modedb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) NUM_TOTAL_MODES, &kyro_modedb[VMODE_1024_768_75], 32))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) info->var = kyro_var;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) fb_alloc_cmap(&info->cmap, 256, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) kyrofb_set_par(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) kyrofb_check_var(&info->var, info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) size = get_line_length(info->var.xres_virtual,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) info->var.bits_per_pixel);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) size *= info->var.yres_virtual;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) fb_memset(info->screen_base, 0, size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) if (register_framebuffer(info) < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) goto out_unmap;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) fb_info(info, "%s frame buffer device, at %dx%d@%d using %ldk/%ldk of VRAM\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) info->fix.id,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) info->var.xres, info->var.yres, info->var.bits_per_pixel,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) size >> 10, (unsigned long)info->fix.smem_len >> 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) pci_set_drvdata(pdev, info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) out_unmap:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) iounmap(info->screen_base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) out_unmap_regs:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) iounmap(currentpar->regbase);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) out_free_fb:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) framebuffer_release(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) static void kyrofb_remove(struct pci_dev *pdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) struct fb_info *info = pci_get_drvdata(pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) struct kyrofb_info *par = info->par;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) /* Reset the board */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) StopVTG(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) DisableRamdacOutput(deviceInfo.pSTGReg);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) /* Sync up the PLL */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) SetCoreClockPLL(deviceInfo.pSTGReg, pdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) deviceInfo.ulNextFreeVidMem = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) deviceInfo.ulOverlayOffset = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) iounmap(info->screen_base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) iounmap(par->regbase);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) arch_phys_wc_del(par->wc_cookie);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) unregister_framebuffer(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) framebuffer_release(info);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) static int __init kyrofb_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) #ifndef MODULE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) char *option = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) if (fb_get_options("kyrofb", &option))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) kyrofb_setup(option);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) return pci_register_driver(&kyrofb_pci_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) static void __exit kyrofb_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) pci_unregister_driver(&kyrofb_pci_driver);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) module_init(kyrofb_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) #ifdef MODULE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) module_exit(kyrofb_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) #endif
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) MODULE_AUTHOR("STMicroelectronics; Paul Mundt <lethal@linux-sh.org>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) MODULE_LICENSE("GPL");
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags