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