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