12874c5fdSThomas Gleixner // SPDX-License-Identifier: GPL-2.0-or-later 2f7018c21STomi Valkeinen /* 3f7018c21STomi Valkeinen * drivers/video/geode/gx1fb_core.c 4f7018c21STomi Valkeinen * -- Geode GX1 framebuffer driver 5f7018c21STomi Valkeinen * 6f7018c21STomi Valkeinen * Copyright (C) 2005 Arcom Control Systems Ltd. 7f7018c21STomi Valkeinen */ 8f7018c21STomi Valkeinen 9f7018c21STomi Valkeinen #include <linux/module.h> 10f7018c21STomi Valkeinen #include <linux/kernel.h> 11f7018c21STomi Valkeinen #include <linux/errno.h> 12f7018c21STomi Valkeinen #include <linux/string.h> 13f7018c21STomi Valkeinen #include <linux/mm.h> 14f7018c21STomi Valkeinen #include <linux/delay.h> 15f7018c21STomi Valkeinen #include <linux/fb.h> 16f7018c21STomi Valkeinen #include <linux/init.h> 17f7018c21STomi Valkeinen #include <linux/pci.h> 18f7018c21STomi Valkeinen 19f7018c21STomi Valkeinen #include "geodefb.h" 20f7018c21STomi Valkeinen #include "display_gx1.h" 21f7018c21STomi Valkeinen #include "video_cs5530.h" 22f7018c21STomi Valkeinen 23f7018c21STomi Valkeinen static char mode_option[32] = "640x480-16@60"; 24f7018c21STomi Valkeinen static int crt_option = 1; 25f7018c21STomi Valkeinen static char panel_option[32] = ""; 26f7018c21STomi Valkeinen 27f7018c21STomi Valkeinen /* Modes relevant to the GX1 (taken from modedb.c) */ 28f7018c21STomi Valkeinen static const struct fb_videomode gx1_modedb[] = { 29f7018c21STomi Valkeinen /* 640x480-60 VESA */ 30f7018c21STomi Valkeinen { NULL, 60, 640, 480, 39682, 48, 16, 33, 10, 96, 2, 31f7018c21STomi Valkeinen 0, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 32f7018c21STomi Valkeinen /* 640x480-75 VESA */ 33f7018c21STomi Valkeinen { NULL, 75, 640, 480, 31746, 120, 16, 16, 01, 64, 3, 34f7018c21STomi Valkeinen 0, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 35f7018c21STomi Valkeinen /* 640x480-85 VESA */ 36f7018c21STomi Valkeinen { NULL, 85, 640, 480, 27777, 80, 56, 25, 01, 56, 3, 37f7018c21STomi Valkeinen 0, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 38f7018c21STomi Valkeinen /* 800x600-60 VESA */ 39f7018c21STomi Valkeinen { NULL, 60, 800, 600, 25000, 88, 40, 23, 01, 128, 4, 40f7018c21STomi Valkeinen FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 41f7018c21STomi Valkeinen FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 42f7018c21STomi Valkeinen /* 800x600-75 VESA */ 43f7018c21STomi Valkeinen { NULL, 75, 800, 600, 20202, 160, 16, 21, 01, 80, 3, 44f7018c21STomi Valkeinen FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 45f7018c21STomi Valkeinen FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 46f7018c21STomi Valkeinen /* 800x600-85 VESA */ 47f7018c21STomi Valkeinen { NULL, 85, 800, 600, 17761, 152, 32, 27, 01, 64, 3, 48f7018c21STomi Valkeinen FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 49f7018c21STomi Valkeinen FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 50f7018c21STomi Valkeinen /* 1024x768-60 VESA */ 51f7018c21STomi Valkeinen { NULL, 60, 1024, 768, 15384, 160, 24, 29, 3, 136, 6, 52f7018c21STomi Valkeinen 0, FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 53f7018c21STomi Valkeinen /* 1024x768-75 VESA */ 54f7018c21STomi Valkeinen { NULL, 75, 1024, 768, 12690, 176, 16, 28, 1, 96, 3, 55f7018c21STomi Valkeinen FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 56f7018c21STomi Valkeinen FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 57f7018c21STomi Valkeinen /* 1024x768-85 VESA */ 58f7018c21STomi Valkeinen { NULL, 85, 1024, 768, 10582, 208, 48, 36, 1, 96, 3, 59f7018c21STomi Valkeinen FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 60f7018c21STomi Valkeinen FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 61f7018c21STomi Valkeinen /* 1280x960-60 VESA */ 62f7018c21STomi Valkeinen { NULL, 60, 1280, 960, 9259, 312, 96, 36, 1, 112, 3, 63f7018c21STomi Valkeinen FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 64f7018c21STomi Valkeinen FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 65f7018c21STomi Valkeinen /* 1280x960-85 VESA */ 66f7018c21STomi Valkeinen { NULL, 85, 1280, 960, 6734, 224, 64, 47, 1, 160, 3, 67f7018c21STomi Valkeinen FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 68f7018c21STomi Valkeinen FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 69f7018c21STomi Valkeinen /* 1280x1024-60 VESA */ 70f7018c21STomi Valkeinen { NULL, 60, 1280, 1024, 9259, 248, 48, 38, 1, 112, 3, 71f7018c21STomi Valkeinen FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 72f7018c21STomi Valkeinen FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 73f7018c21STomi Valkeinen /* 1280x1024-75 VESA */ 74f7018c21STomi Valkeinen { NULL, 75, 1280, 1024, 7407, 248, 16, 38, 1, 144, 3, 75f7018c21STomi Valkeinen FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 76f7018c21STomi Valkeinen FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 77f7018c21STomi Valkeinen /* 1280x1024-85 VESA */ 78f7018c21STomi Valkeinen { NULL, 85, 1280, 1024, 6349, 224, 64, 44, 1, 160, 3, 79f7018c21STomi Valkeinen FB_SYNC_HOR_HIGH_ACT | FB_SYNC_VERT_HIGH_ACT, 80f7018c21STomi Valkeinen FB_VMODE_NONINTERLACED, FB_MODE_IS_VESA }, 81f7018c21STomi Valkeinen }; 82f7018c21STomi Valkeinen 83f7018c21STomi Valkeinen static int gx1_line_delta(int xres, int bpp) 84f7018c21STomi Valkeinen { 85f7018c21STomi Valkeinen int line_delta = xres * (bpp >> 3); 86f7018c21STomi Valkeinen 87f7018c21STomi Valkeinen if (line_delta > 2048) 88f7018c21STomi Valkeinen line_delta = 4096; 89f7018c21STomi Valkeinen else if (line_delta > 1024) 90f7018c21STomi Valkeinen line_delta = 2048; 91f7018c21STomi Valkeinen else 92f7018c21STomi Valkeinen line_delta = 1024; 93f7018c21STomi Valkeinen return line_delta; 94f7018c21STomi Valkeinen } 95f7018c21STomi Valkeinen 96f7018c21STomi Valkeinen static int gx1fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info) 97f7018c21STomi Valkeinen { 98f7018c21STomi Valkeinen struct geodefb_par *par = info->par; 99f7018c21STomi Valkeinen 100f7018c21STomi Valkeinen /* Maximum resolution is 1280x1024. */ 101f7018c21STomi Valkeinen if (var->xres > 1280 || var->yres > 1024) 102f7018c21STomi Valkeinen return -EINVAL; 103f7018c21STomi Valkeinen 104f7018c21STomi Valkeinen if (par->panel_x && (var->xres > par->panel_x || var->yres > par->panel_y)) 105f7018c21STomi Valkeinen return -EINVAL; 106f7018c21STomi Valkeinen 107f7018c21STomi Valkeinen /* Only 16 bpp and 8 bpp is supported by the hardware. */ 108f7018c21STomi Valkeinen if (var->bits_per_pixel == 16) { 109f7018c21STomi Valkeinen var->red.offset = 11; var->red.length = 5; 110f7018c21STomi Valkeinen var->green.offset = 5; var->green.length = 6; 111f7018c21STomi Valkeinen var->blue.offset = 0; var->blue.length = 5; 112f7018c21STomi Valkeinen var->transp.offset = 0; var->transp.length = 0; 113f7018c21STomi Valkeinen } else if (var->bits_per_pixel == 8) { 114f7018c21STomi Valkeinen var->red.offset = 0; var->red.length = 8; 115f7018c21STomi Valkeinen var->green.offset = 0; var->green.length = 8; 116f7018c21STomi Valkeinen var->blue.offset = 0; var->blue.length = 8; 117f7018c21STomi Valkeinen var->transp.offset = 0; var->transp.length = 0; 118f7018c21STomi Valkeinen } else 119f7018c21STomi Valkeinen return -EINVAL; 120f7018c21STomi Valkeinen 121f7018c21STomi Valkeinen /* Enough video memory? */ 122f7018c21STomi Valkeinen if (gx1_line_delta(var->xres, var->bits_per_pixel) * var->yres > info->fix.smem_len) 123f7018c21STomi Valkeinen return -EINVAL; 124f7018c21STomi Valkeinen 125f7018c21STomi Valkeinen /* FIXME: Check timing parameters here? */ 126f7018c21STomi Valkeinen 127f7018c21STomi Valkeinen return 0; 128f7018c21STomi Valkeinen } 129f7018c21STomi Valkeinen 130f7018c21STomi Valkeinen static int gx1fb_set_par(struct fb_info *info) 131f7018c21STomi Valkeinen { 132f7018c21STomi Valkeinen struct geodefb_par *par = info->par; 133f7018c21STomi Valkeinen 134f7018c21STomi Valkeinen if (info->var.bits_per_pixel == 16) 135f7018c21STomi Valkeinen info->fix.visual = FB_VISUAL_TRUECOLOR; 136f7018c21STomi Valkeinen else 137f7018c21STomi Valkeinen info->fix.visual = FB_VISUAL_PSEUDOCOLOR; 138f7018c21STomi Valkeinen 139f7018c21STomi Valkeinen info->fix.line_length = gx1_line_delta(info->var.xres, info->var.bits_per_pixel); 140f7018c21STomi Valkeinen 141f7018c21STomi Valkeinen par->dc_ops->set_mode(info); 142f7018c21STomi Valkeinen 143f7018c21STomi Valkeinen return 0; 144f7018c21STomi Valkeinen } 145f7018c21STomi Valkeinen 146f7018c21STomi Valkeinen static inline u_int chan_to_field(u_int chan, struct fb_bitfield *bf) 147f7018c21STomi Valkeinen { 148f7018c21STomi Valkeinen chan &= 0xffff; 149f7018c21STomi Valkeinen chan >>= 16 - bf->length; 150f7018c21STomi Valkeinen return chan << bf->offset; 151f7018c21STomi Valkeinen } 152f7018c21STomi Valkeinen 153f7018c21STomi Valkeinen static int gx1fb_setcolreg(unsigned regno, unsigned red, unsigned green, 154f7018c21STomi Valkeinen unsigned blue, unsigned transp, 155f7018c21STomi Valkeinen struct fb_info *info) 156f7018c21STomi Valkeinen { 157f7018c21STomi Valkeinen struct geodefb_par *par = info->par; 158f7018c21STomi Valkeinen 159f7018c21STomi Valkeinen if (info->var.grayscale) { 160f7018c21STomi Valkeinen /* grayscale = 0.30*R + 0.59*G + 0.11*B */ 161f7018c21STomi Valkeinen red = green = blue = (red * 77 + green * 151 + blue * 28) >> 8; 162f7018c21STomi Valkeinen } 163f7018c21STomi Valkeinen 164f7018c21STomi Valkeinen /* Truecolor has hardware independent palette */ 165f7018c21STomi Valkeinen if (info->fix.visual == FB_VISUAL_TRUECOLOR) { 166f7018c21STomi Valkeinen u32 *pal = info->pseudo_palette; 167f7018c21STomi Valkeinen u32 v; 168f7018c21STomi Valkeinen 169f7018c21STomi Valkeinen if (regno >= 16) 170f7018c21STomi Valkeinen return -EINVAL; 171f7018c21STomi Valkeinen 172f7018c21STomi Valkeinen v = chan_to_field(red, &info->var.red); 173f7018c21STomi Valkeinen v |= chan_to_field(green, &info->var.green); 174f7018c21STomi Valkeinen v |= chan_to_field(blue, &info->var.blue); 175f7018c21STomi Valkeinen 176f7018c21STomi Valkeinen pal[regno] = v; 177f7018c21STomi Valkeinen } else { 178f7018c21STomi Valkeinen if (regno >= 256) 179f7018c21STomi Valkeinen return -EINVAL; 180f7018c21STomi Valkeinen 181f7018c21STomi Valkeinen par->dc_ops->set_palette_reg(info, regno, red, green, blue); 182f7018c21STomi Valkeinen } 183f7018c21STomi Valkeinen 184f7018c21STomi Valkeinen return 0; 185f7018c21STomi Valkeinen } 186f7018c21STomi Valkeinen 187f7018c21STomi Valkeinen static int gx1fb_blank(int blank_mode, struct fb_info *info) 188f7018c21STomi Valkeinen { 189f7018c21STomi Valkeinen struct geodefb_par *par = info->par; 190f7018c21STomi Valkeinen 191f7018c21STomi Valkeinen return par->vid_ops->blank_display(info, blank_mode); 192f7018c21STomi Valkeinen } 193f7018c21STomi Valkeinen 194f7018c21STomi Valkeinen static int gx1fb_map_video_memory(struct fb_info *info, struct pci_dev *dev) 195f7018c21STomi Valkeinen { 196f7018c21STomi Valkeinen struct geodefb_par *par = info->par; 197f7018c21STomi Valkeinen unsigned gx_base; 198f7018c21STomi Valkeinen int fb_len; 199f7018c21STomi Valkeinen int ret; 200f7018c21STomi Valkeinen 201f7018c21STomi Valkeinen gx_base = gx1_gx_base(); 202f7018c21STomi Valkeinen if (!gx_base) 203f7018c21STomi Valkeinen return -ENODEV; 204f7018c21STomi Valkeinen 205f7018c21STomi Valkeinen ret = pci_enable_device(dev); 206f7018c21STomi Valkeinen if (ret < 0) 207f7018c21STomi Valkeinen return ret; 208f7018c21STomi Valkeinen 209f7018c21STomi Valkeinen ret = pci_request_region(dev, 0, "gx1fb (video)"); 210f7018c21STomi Valkeinen if (ret < 0) 211f7018c21STomi Valkeinen return ret; 212f7018c21STomi Valkeinen par->vid_regs = pci_ioremap_bar(dev, 0); 213f7018c21STomi Valkeinen if (!par->vid_regs) 214f7018c21STomi Valkeinen return -ENOMEM; 215f7018c21STomi Valkeinen 216f7018c21STomi Valkeinen if (!request_mem_region(gx_base + 0x8300, 0x100, "gx1fb (display controller)")) 217f7018c21STomi Valkeinen return -EBUSY; 218f7018c21STomi Valkeinen par->dc_regs = ioremap(gx_base + 0x8300, 0x100); 219f7018c21STomi Valkeinen if (!par->dc_regs) 220f7018c21STomi Valkeinen return -ENOMEM; 221f7018c21STomi Valkeinen 222f7018c21STomi Valkeinen if ((fb_len = gx1_frame_buffer_size()) < 0) 223f7018c21STomi Valkeinen return -ENOMEM; 224f7018c21STomi Valkeinen info->fix.smem_start = gx_base + 0x800000; 225f7018c21STomi Valkeinen info->fix.smem_len = fb_len; 226f7018c21STomi Valkeinen info->screen_base = ioremap(info->fix.smem_start, info->fix.smem_len); 227f7018c21STomi Valkeinen if (!info->screen_base) 228f7018c21STomi Valkeinen return -ENOMEM; 229f7018c21STomi Valkeinen 230f7018c21STomi Valkeinen dev_info(&dev->dev, "%d Kibyte of video memory at 0x%lx\n", 231f7018c21STomi Valkeinen info->fix.smem_len / 1024, info->fix.smem_start); 232f7018c21STomi Valkeinen 233f7018c21STomi Valkeinen return 0; 234f7018c21STomi Valkeinen } 235f7018c21STomi Valkeinen 236f7018c21STomi Valkeinen static int parse_panel_option(struct fb_info *info) 237f7018c21STomi Valkeinen { 238f7018c21STomi Valkeinen struct geodefb_par *par = info->par; 239f7018c21STomi Valkeinen 240f7018c21STomi Valkeinen if (strcmp(panel_option, "") != 0) { 241f7018c21STomi Valkeinen int x, y; 242f7018c21STomi Valkeinen char *s; 243f7018c21STomi Valkeinen x = simple_strtol(panel_option, &s, 10); 244f7018c21STomi Valkeinen if (!x) 245f7018c21STomi Valkeinen return -EINVAL; 246f7018c21STomi Valkeinen y = simple_strtol(s + 1, NULL, 10); 247f7018c21STomi Valkeinen if (!y) 248f7018c21STomi Valkeinen return -EINVAL; 249f7018c21STomi Valkeinen par->panel_x = x; 250f7018c21STomi Valkeinen par->panel_y = y; 251f7018c21STomi Valkeinen } 252f7018c21STomi Valkeinen return 0; 253f7018c21STomi Valkeinen } 254f7018c21STomi Valkeinen 2558a48ac33SJani Nikula static const struct fb_ops gx1fb_ops = { 256f7018c21STomi Valkeinen .owner = THIS_MODULE, 257f7018c21STomi Valkeinen .fb_check_var = gx1fb_check_var, 258f7018c21STomi Valkeinen .fb_set_par = gx1fb_set_par, 259f7018c21STomi Valkeinen .fb_setcolreg = gx1fb_setcolreg, 260f7018c21STomi Valkeinen .fb_blank = gx1fb_blank, 261f7018c21STomi Valkeinen /* No HW acceleration for now. */ 262f7018c21STomi Valkeinen .fb_fillrect = cfb_fillrect, 263f7018c21STomi Valkeinen .fb_copyarea = cfb_copyarea, 264f7018c21STomi Valkeinen .fb_imageblit = cfb_imageblit, 265f7018c21STomi Valkeinen }; 266f7018c21STomi Valkeinen 267f7018c21STomi Valkeinen static struct fb_info *gx1fb_init_fbinfo(struct device *dev) 268f7018c21STomi Valkeinen { 269f7018c21STomi Valkeinen struct geodefb_par *par; 270f7018c21STomi Valkeinen struct fb_info *info; 271f7018c21STomi Valkeinen 272f7018c21STomi Valkeinen /* Alloc enough space for the pseudo palette. */ 273f7018c21STomi Valkeinen info = framebuffer_alloc(sizeof(struct geodefb_par) + sizeof(u32) * 16, dev); 274f7018c21STomi Valkeinen if (!info) 275f7018c21STomi Valkeinen return NULL; 276f7018c21STomi Valkeinen 277f7018c21STomi Valkeinen par = info->par; 278f7018c21STomi Valkeinen 279f7018c21STomi Valkeinen strcpy(info->fix.id, "GX1"); 280f7018c21STomi Valkeinen 281f7018c21STomi Valkeinen info->fix.type = FB_TYPE_PACKED_PIXELS; 282f7018c21STomi Valkeinen info->fix.type_aux = 0; 283f7018c21STomi Valkeinen info->fix.xpanstep = 0; 284f7018c21STomi Valkeinen info->fix.ypanstep = 0; 285f7018c21STomi Valkeinen info->fix.ywrapstep = 0; 286f7018c21STomi Valkeinen info->fix.accel = FB_ACCEL_NONE; 287f7018c21STomi Valkeinen 288f7018c21STomi Valkeinen info->var.nonstd = 0; 289f7018c21STomi Valkeinen info->var.activate = FB_ACTIVATE_NOW; 290f7018c21STomi Valkeinen info->var.height = -1; 291f7018c21STomi Valkeinen info->var.width = -1; 292f7018c21STomi Valkeinen info->var.accel_flags = 0; 293f7018c21STomi Valkeinen info->var.vmode = FB_VMODE_NONINTERLACED; 294f7018c21STomi Valkeinen 295f7018c21STomi Valkeinen info->fbops = &gx1fb_ops; 296f7018c21STomi Valkeinen info->flags = FBINFO_DEFAULT; 297f7018c21STomi Valkeinen info->node = -1; 298f7018c21STomi Valkeinen 299f7018c21STomi Valkeinen info->pseudo_palette = (void *)par + sizeof(struct geodefb_par); 300f7018c21STomi Valkeinen 301f7018c21STomi Valkeinen info->var.grayscale = 0; 302f7018c21STomi Valkeinen 303f7018c21STomi Valkeinen /* CRT and panel options */ 304f7018c21STomi Valkeinen par->enable_crt = crt_option; 305f7018c21STomi Valkeinen if (parse_panel_option(info) < 0) 306f7018c21STomi Valkeinen printk(KERN_WARNING "gx1fb: invalid 'panel' option -- disabling flat panel\n"); 307f7018c21STomi Valkeinen if (!par->panel_x) 308f7018c21STomi Valkeinen par->enable_crt = 1; /* fall back to CRT if no panel is specified */ 309f7018c21STomi Valkeinen 310f7018c21STomi Valkeinen if (fb_alloc_cmap(&info->cmap, 256, 0) < 0) { 311f7018c21STomi Valkeinen framebuffer_release(info); 312f7018c21STomi Valkeinen return NULL; 313f7018c21STomi Valkeinen } 314f7018c21STomi Valkeinen return info; 315f7018c21STomi Valkeinen } 316f7018c21STomi Valkeinen 317f7018c21STomi Valkeinen static int gx1fb_probe(struct pci_dev *pdev, const struct pci_device_id *id) 318f7018c21STomi Valkeinen { 319f7018c21STomi Valkeinen struct geodefb_par *par; 320f7018c21STomi Valkeinen struct fb_info *info; 321f7018c21STomi Valkeinen int ret; 322f7018c21STomi Valkeinen 323f7018c21STomi Valkeinen info = gx1fb_init_fbinfo(&pdev->dev); 324f7018c21STomi Valkeinen if (!info) 325f7018c21STomi Valkeinen return -ENOMEM; 326f7018c21STomi Valkeinen par = info->par; 327f7018c21STomi Valkeinen 328f7018c21STomi Valkeinen /* GX1 display controller and CS5530 video device */ 329f7018c21STomi Valkeinen par->dc_ops = &gx1_dc_ops; 330f7018c21STomi Valkeinen par->vid_ops = &cs5530_vid_ops; 331f7018c21STomi Valkeinen 332f7018c21STomi Valkeinen if ((ret = gx1fb_map_video_memory(info, pdev)) < 0) { 333f7018c21STomi Valkeinen dev_err(&pdev->dev, "failed to map frame buffer or controller registers\n"); 334f7018c21STomi Valkeinen goto err; 335f7018c21STomi Valkeinen } 336f7018c21STomi Valkeinen 337f7018c21STomi Valkeinen ret = fb_find_mode(&info->var, info, mode_option, 338f7018c21STomi Valkeinen gx1_modedb, ARRAY_SIZE(gx1_modedb), NULL, 16); 339f7018c21STomi Valkeinen if (ret == 0 || ret == 4) { 340f7018c21STomi Valkeinen dev_err(&pdev->dev, "could not find valid video mode\n"); 341f7018c21STomi Valkeinen ret = -EINVAL; 342f7018c21STomi Valkeinen goto err; 343f7018c21STomi Valkeinen } 344f7018c21STomi Valkeinen 345f7018c21STomi Valkeinen /* Clear the frame buffer of garbage. */ 346f7018c21STomi Valkeinen memset_io(info->screen_base, 0, info->fix.smem_len); 347f7018c21STomi Valkeinen 348f7018c21STomi Valkeinen gx1fb_check_var(&info->var, info); 349f7018c21STomi Valkeinen gx1fb_set_par(info); 350f7018c21STomi Valkeinen 351f7018c21STomi Valkeinen if (register_framebuffer(info) < 0) { 352f7018c21STomi Valkeinen ret = -EINVAL; 353f7018c21STomi Valkeinen goto err; 354f7018c21STomi Valkeinen } 355f7018c21STomi Valkeinen pci_set_drvdata(pdev, info); 356f7018c21STomi Valkeinen fb_info(info, "%s frame buffer device\n", info->fix.id); 357f7018c21STomi Valkeinen return 0; 358f7018c21STomi Valkeinen 359f7018c21STomi Valkeinen err: 360f7018c21STomi Valkeinen if (info->screen_base) { 361f7018c21STomi Valkeinen iounmap(info->screen_base); 362f7018c21STomi Valkeinen pci_release_region(pdev, 0); 363f7018c21STomi Valkeinen } 364f7018c21STomi Valkeinen if (par->vid_regs) { 365f7018c21STomi Valkeinen iounmap(par->vid_regs); 366f7018c21STomi Valkeinen pci_release_region(pdev, 1); 367f7018c21STomi Valkeinen } 368f7018c21STomi Valkeinen if (par->dc_regs) { 369f7018c21STomi Valkeinen iounmap(par->dc_regs); 370f7018c21STomi Valkeinen release_mem_region(gx1_gx_base() + 0x8300, 0x100); 371f7018c21STomi Valkeinen } 372f7018c21STomi Valkeinen 373f7018c21STomi Valkeinen fb_dealloc_cmap(&info->cmap); 374f7018c21STomi Valkeinen framebuffer_release(info); 375f7018c21STomi Valkeinen 376f7018c21STomi Valkeinen return ret; 377f7018c21STomi Valkeinen } 378f7018c21STomi Valkeinen 379f7018c21STomi Valkeinen static void gx1fb_remove(struct pci_dev *pdev) 380f7018c21STomi Valkeinen { 381f7018c21STomi Valkeinen struct fb_info *info = pci_get_drvdata(pdev); 382f7018c21STomi Valkeinen struct geodefb_par *par = info->par; 383f7018c21STomi Valkeinen 384f7018c21STomi Valkeinen unregister_framebuffer(info); 385f7018c21STomi Valkeinen 386f7018c21STomi Valkeinen iounmap((void __iomem *)info->screen_base); 387f7018c21STomi Valkeinen pci_release_region(pdev, 0); 388f7018c21STomi Valkeinen 389f7018c21STomi Valkeinen iounmap(par->vid_regs); 390f7018c21STomi Valkeinen pci_release_region(pdev, 1); 391f7018c21STomi Valkeinen 392f7018c21STomi Valkeinen iounmap(par->dc_regs); 393f7018c21STomi Valkeinen release_mem_region(gx1_gx_base() + 0x8300, 0x100); 394f7018c21STomi Valkeinen 395f7018c21STomi Valkeinen fb_dealloc_cmap(&info->cmap); 396f7018c21STomi Valkeinen 397f7018c21STomi Valkeinen framebuffer_release(info); 398f7018c21STomi Valkeinen } 399f7018c21STomi Valkeinen 400f7018c21STomi Valkeinen #ifndef MODULE 401f7018c21STomi Valkeinen static void __init gx1fb_setup(char *options) 402f7018c21STomi Valkeinen { 403f7018c21STomi Valkeinen char *this_opt; 404f7018c21STomi Valkeinen 405f7018c21STomi Valkeinen if (!options || !*options) 406f7018c21STomi Valkeinen return; 407f7018c21STomi Valkeinen 408f7018c21STomi Valkeinen while ((this_opt = strsep(&options, ","))) { 409f7018c21STomi Valkeinen if (!*this_opt) 410f7018c21STomi Valkeinen continue; 411f7018c21STomi Valkeinen 412f7018c21STomi Valkeinen if (!strncmp(this_opt, "mode:", 5)) 413f7018c21STomi Valkeinen strlcpy(mode_option, this_opt + 5, sizeof(mode_option)); 414f7018c21STomi Valkeinen else if (!strncmp(this_opt, "crt:", 4)) 415f7018c21STomi Valkeinen crt_option = !!simple_strtoul(this_opt + 4, NULL, 0); 416f7018c21STomi Valkeinen else if (!strncmp(this_opt, "panel:", 6)) 417f7018c21STomi Valkeinen strlcpy(panel_option, this_opt + 6, sizeof(panel_option)); 418f7018c21STomi Valkeinen else 419f7018c21STomi Valkeinen strlcpy(mode_option, this_opt, sizeof(mode_option)); 420f7018c21STomi Valkeinen } 421f7018c21STomi Valkeinen } 422f7018c21STomi Valkeinen #endif 423f7018c21STomi Valkeinen 424f7018c21STomi Valkeinen static struct pci_device_id gx1fb_id_table[] = { 425f7018c21STomi Valkeinen { PCI_VENDOR_ID_CYRIX, PCI_DEVICE_ID_CYRIX_5530_VIDEO, 426f7018c21STomi Valkeinen PCI_ANY_ID, PCI_ANY_ID, PCI_BASE_CLASS_DISPLAY << 16, 427f7018c21STomi Valkeinen 0xff0000, 0 }, 428f7018c21STomi Valkeinen { 0, } 429f7018c21STomi Valkeinen }; 430f7018c21STomi Valkeinen 431f7018c21STomi Valkeinen MODULE_DEVICE_TABLE(pci, gx1fb_id_table); 432f7018c21STomi Valkeinen 433f7018c21STomi Valkeinen static struct pci_driver gx1fb_driver = { 434f7018c21STomi Valkeinen .name = "gx1fb", 435f7018c21STomi Valkeinen .id_table = gx1fb_id_table, 436f7018c21STomi Valkeinen .probe = gx1fb_probe, 437f7018c21STomi Valkeinen .remove = gx1fb_remove, 438f7018c21STomi Valkeinen }; 439f7018c21STomi Valkeinen 440f7018c21STomi Valkeinen static int __init gx1fb_init(void) 441f7018c21STomi Valkeinen { 442f7018c21STomi Valkeinen #ifndef MODULE 443f7018c21STomi Valkeinen char *option = NULL; 444f7018c21STomi Valkeinen 445f7018c21STomi Valkeinen if (fb_get_options("gx1fb", &option)) 446f7018c21STomi Valkeinen return -ENODEV; 447f7018c21STomi Valkeinen gx1fb_setup(option); 448f7018c21STomi Valkeinen #endif 449f7018c21STomi Valkeinen return pci_register_driver(&gx1fb_driver); 450f7018c21STomi Valkeinen } 451f7018c21STomi Valkeinen 452f7018c21STomi Valkeinen static void gx1fb_cleanup(void) 453f7018c21STomi Valkeinen { 454f7018c21STomi Valkeinen pci_unregister_driver(&gx1fb_driver); 455f7018c21STomi Valkeinen } 456f7018c21STomi Valkeinen 457f7018c21STomi Valkeinen module_init(gx1fb_init); 458f7018c21STomi Valkeinen module_exit(gx1fb_cleanup); 459f7018c21STomi Valkeinen 460f7018c21STomi Valkeinen module_param_string(mode, mode_option, sizeof(mode_option), 0444); 461f7018c21STomi Valkeinen MODULE_PARM_DESC(mode, "video mode (<x>x<y>[-<bpp>][@<refr>])"); 462f7018c21STomi Valkeinen 463f7018c21STomi Valkeinen module_param_named(crt, crt_option, int, 0444); 464f7018c21STomi Valkeinen MODULE_PARM_DESC(crt, "enable CRT output. 0 = off, 1 = on (default)"); 465f7018c21STomi Valkeinen 466f7018c21STomi Valkeinen module_param_string(panel, panel_option, sizeof(panel_option), 0444); 467f7018c21STomi Valkeinen MODULE_PARM_DESC(panel, "size of attached flat panel (<x>x<y>)"); 468f7018c21STomi Valkeinen 469f7018c21STomi Valkeinen MODULE_DESCRIPTION("framebuffer driver for the AMD Geode GX1"); 470f7018c21STomi Valkeinen MODULE_LICENSE("GPL"); 471