SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/video/tx3912fb.c

   1 /*
   2  *  drivers/video/tx3912fb.c
   3  *
   4  *  Copyright (C) 1999 Harald Koerfgen
   5  *  Copyright (C) 2001 Steven Hill (sjhill@realitydiluted.com)
   6  *
   7  * This file is subject to the terms and conditions of the GNU General Public
   8  * License. See the file COPYING in the main directory of this archive for
   9  * more details.
  10  *
  11  *  Framebuffer for LCD controller in TMPR3912/05 and PR31700 processors
  12  */
  13 #include <linux/module.h>
  14 #include <linux/kernel.h>
  15 #include <linux/errno.h>
  16 #include <linux/string.h>
  17 #include <linux/tty.h>
  18 #include <linux/delay.h>
  19 #include <linux/interrupt.h>
  20 #include <linux/init.h>
  21 #include <linux/pm.h>
  22 #include <linux/fb.h>
  23 #include <asm/io.h>
  24 #include <asm/bootinfo.h>
  25 #include <asm/uaccess.h>
  26 #include <asm/tx3912.h>
  27 #include <video/tx3912.h>
  28
  29 /*
  30  * Frame buffer, palette and console structures
  31  */
  32 static struct fb_info fb_info;
  33 static u32 cfb8[16];
  34
  35 static struct fb_fix_screeninfo tx3912fb_fix __initdata = {
  36         .id =           "tx3912fb",
  37         .smem_len =     ((240 * 320)/2),
  38         .type =         FB_TYPE_PACKED_PIXELS,
  39         .visual =       FB_VISUAL_TRUECOLOR,
  40         .xpanstep =     1,
  41         .ypanstep =     1,
  42         .ywrapstep =    1,
  43         .accel =        FB_ACCEL_NONE,
  44 };
  45
  46 static struct fb_var_screeninfo tx3912fb_var = {
  47         .xres =         240,
  48         .yres =         320,
  49         .xres_virtual = 240,
  50         .yres_virtual = 320,
  51         .bits_per_pixel =4,
  52         .red =          { 0, 4, 0 },    /* ??? */
  53         .green =        { 0, 4, 0 },
  54         .blue =         { 0, 4, 0 },
  55         .activate =     FB_ACTIVATE_NOW,
  56         .width =        -1,
  57         .height =       -1,
  58         .pixclock =     20000,
  59         .left_margin =  64,
  60         .right_margin = 64,
  61         .upper_margin = 32,
  62         .lower_margin = 32,
  63         .hsync_len =    64,
  64         .vsync_len =    2,
  65         .vmode =        FB_VMODE_NONINTERLACED,
  66 };
  67
  68 /*
  69  * Interface used by the world
  70  */
  71 int tx3912fb_init(void);
  72
  73 static int tx3912fb_setcolreg(u_int regno, u_int red, u_int green,
  74                               u_int blue, u_int transp,
  75                               struct fb_info *info);
  76
  77 /*
  78  * Macros
  79  */
  80 #define get_line_length(xres_virtual, bpp) \
  81                 (u_long) (((int) xres_virtual * (int) bpp + 7) >> 3)
  82
  83 /*
  84  * Frame buffer operations structure used by console driver
  85  */
  86 static struct fb_ops tx3912fb_ops = {
  87         .owner          = THIS_MODULE,
  88         .fb_setcolreg   = tx3912fb_setcolreg,
  89         .fb_fillrect    = cfb_fillrect,
  90         .fb_copyarea    = cfb_copyarea,
  91         .fb_imageblit   = cfb_imageblit,
  92 };
  93
  94 static int tx3912fb_check_var(struct fb_var_screeninfo *var, struct fb_info *info)
  95 {
  96         /*
  97          * Memory limit
  98          */
  99         line_length =
 100             get_line_length(var->xres_virtual, var->bits_per_pixel);
 101         if ((line_length * var->yres_virtual) > info->fix.smem_len)
 102                 return -ENOMEM;
 103
 104         return 0;
 105 }
 106
 107 static int tx3912fb_set_par(struct fb_info *info)
 108 {
 109         u_long tx3912fb_paddr = 0;
 110
 111         /* Disable the video logic */
 112         outl(inl(TX3912_VIDEO_CTRL1) &
 113              ~(TX3912_VIDEO_CTRL1_ENVID | TX3912_VIDEO_CTRL1_DISPON),
 114              TX3912_VIDEO_CTRL1);
 115         udelay(200);
 116
 117         /* Set start address for DMA transfer */
 118         outl(tx3912fb_paddr, TX3912_VIDEO_CTRL3);
 119
 120         /* Set end address for DMA transfer */
 121         outl((tx3912fb_paddr + tx3912fb_fix.smem_len + 1), TX3912_VIDEO_CTRL4);
 122
 123         /* Set the pixel depth */
 124         switch (info->var.bits_per_pixel) {
 125         case 1:
 126                 /* Monochrome */
 127                 outl(inl(TX3912_VIDEO_CTRL1) &
 128                      ~TX3912_VIDEO_CTRL1_BITSEL_MASK, TX3912_VIDEO_CTRL1);
 129                 info->fix.visual = FB_VISUAL_MONO10;
 130                 break;
 131         case 4:
 132                 /* 4-bit gray */
 133                 outl(inl(TX3912_VIDEO_CTRL1) &
 134                      ~TX3912_VIDEO_CTRL1_BITSEL_MASK, TX3912_VIDEO_CTRL1);
 135                 outl(inl(TX3912_VIDEO_CTRL1) |
 136                      TX3912_VIDEO_CTRL1_BITSEL_4BIT_GRAY,
 137                      TX3912_VIDEO_CTRL1);
 138                 info->fix.visual = FB_VISUAL_TRUECOLOR;
 139                 break;
 140         case 8:
 141                 /* 8-bit color */
 142                 outl(inl(TX3912_VIDEO_CTRL1) &
 143                      ~TX3912_VIDEO_CTRL1_BITSEL_MASK, TX3912_VIDEO_CTRL1);
 144                 outl(inl(TX3912_VIDEO_CTRL1) |
 145                      TX3912_VIDEO_CTRL1_BITSEL_8BIT_COLOR,
 146                      TX3912_VIDEO_CTRL1);
 147                 info->fix.visual = FB_VISUAL_TRUECOLOR;
 148                 break;
 149         case 2:
 150         default:
 151                 /* 2-bit gray */
 152                 outl(inl(TX3912_VIDEO_CTRL1) &
 153                      ~TX3912_VIDEO_CTRL1_BITSEL_MASK, TX3912_VIDEO_CTRL1);
 154                 outl(inl(TX3912_VIDEO_CTRL1) |
 155                      TX3912_VIDEO_CTRL1_BITSEL_2BIT_GRAY,
 156                      TX3912_VIDEO_CTRL1);
 157                 info->fix.visual = FB_VISUAL_PSEUDOCOLOR;
 158                 break;
 159         }
 160
 161         /* Enable the video clock */
 162         outl(inl(TX3912_CLK_CTRL) | TX3912_CLK_CTRL_ENVIDCLK,
 163              TX3912_CLK_CTRL);
 164
 165         /* Unfreeze video logic and enable DF toggle */
 166         outl(inl(TX3912_VIDEO_CTRL1) &
 167              ~(TX3912_VIDEO_CTRL1_ENFREEZEFRAME |
 168                TX3912_VIDEO_CTRL1_DFMODE)
 169              , TX3912_VIDEO_CTRL1);
 170         udelay(200);
 171
 172         /* Enable the video logic */
 173         outl(inl(TX3912_VIDEO_CTRL1) |
 174              (TX3912_VIDEO_CTRL1_ENVID | TX3912_VIDEO_CTRL1_DISPON),
 175              TX3912_VIDEO_CTRL1);
 176
 177         info->fix.line_length = get_line_length(var->xres_virtual,
 178                                             var->bits_per_pixel);
 179 }
 180
 181 /*
 182  * Set a single color register
 183  */
 184 static int tx3912fb_setcolreg(u_int regno, u_int red, u_int green,
 185                               u_int blue, u_int transp,
 186                               struct fb_info *info)
 187 {
 188         if (regno > 255)
 189                 return 1;
 190
 191         if (regno < 16)
 192                 ((u32 *)(info->pseudo_palette))[regno] = ((red & 0xe000) >> 8)
 193                     | ((green & 0xe000) >> 11)
 194                     | ((blue & 0xc000) >> 14);
 195         return 0;
 196 }
 197
 198 int __init tx3912fb_setup(char *options);
 199
 200 /*
 201  * Initialization of the framebuffer
 202  */
 203 int __init tx3912fb_init(void)
 204 {
 205         u_long tx3912fb_paddr = 0;
 206         int size = (info->var.bits_per_pixel == 8) ? 256 : 16;
 207         char *option = NULL;
 208
 209         if (fb_get_options("tx3912fb", &option))
 210                 return -ENODEV;
 211         tx3912fb_setup(option);
 212
 213         /* Disable the video logic */
 214         outl(inl(TX3912_VIDEO_CTRL1) &
 215              ~(TX3912_VIDEO_CTRL1_ENVID | TX3912_VIDEO_CTRL1_DISPON),
 216              TX3912_VIDEO_CTRL1);
 217         udelay(200);
 218
 219         /* Set start address for DMA transfer */
 220         outl(tx3912fb_paddr, TX3912_VIDEO_CTRL3);
 221
 222         /* Set end address for DMA transfer */
 223         outl((tx3912fb_paddr + tx3912fb_fix.smem_len + 1), TX3912_VIDEO_CTRL4);
 224
 225         /* Set the pixel depth */
 226         switch (tx3912fb_var.bits_per_pixel) {
 227         case 1:
 228                 /* Monochrome */
 229                 outl(inl(TX3912_VIDEO_CTRL1) &
 230                      ~TX3912_VIDEO_CTRL1_BITSEL_MASK, TX3912_VIDEO_CTRL1);
 231                 tx3912fb_fix.visual = FB_VISUAL_MONO10;
 232                 break;
 233         case 4:
 234                 /* 4-bit gray */
 235                 outl(inl(TX3912_VIDEO_CTRL1) &
 236                      ~TX3912_VIDEO_CTRL1_BITSEL_MASK, TX3912_VIDEO_CTRL1);
 237                 outl(inl(TX3912_VIDEO_CTRL1) |
 238                      TX3912_VIDEO_CTRL1_BITSEL_4BIT_GRAY,
 239                      TX3912_VIDEO_CTRL1);
 240                 tx3912fb_fix.visual = FB_VISUAL_TRUECOLOR;
 241                 tx3912fb_fix.grayscale = 1;
 242                 break;
 243         case 8:
 244                 /* 8-bit color */
 245                 outl(inl(TX3912_VIDEO_CTRL1) &
 246                      ~TX3912_VIDEO_CTRL1_BITSEL_MASK, TX3912_VIDEO_CTRL1);
 247                 outl(inl(TX3912_VIDEO_CTRL1) |
 248                      TX3912_VIDEO_CTRL1_BITSEL_8BIT_COLOR,
 249                      TX3912_VIDEO_CTRL1);
 250                 tx3912fb_fix.visual = FB_VISUAL_TRUECOLOR;
 251                 break;
 252         case 2:
 253         default:
 254                 /* 2-bit gray */
 255                 outl(inl(TX3912_VIDEO_CTRL1) &
 256                      ~TX3912_VIDEO_CTRL1_BITSEL_MASK, TX3912_VIDEO_CTRL1);
 257                 outl(inl(TX3912_VIDEO_CTRL1) |
 258                      TX3912_VIDEO_CTRL1_BITSEL_2BIT_GRAY,
 259                      TX3912_VIDEO_CTRL1);
 260                 tx3912fb_fix.visual = FB_VISUAL_PSEUDOCOLOR;
 261                 tx3912fb_fix.grayscale = 1;
 262                 break;
 263         }
 264
 265         /* Enable the video clock */
 266         outl(inl(TX3912_CLK_CTRL) | TX3912_CLK_CTRL_ENVIDCLK,
 267                 TX3912_CLK_CTRL);
 268
 269         /* Unfreeze video logic and enable DF toggle */
 270         outl(inl(TX3912_VIDEO_CTRL1) &
 271                 ~(TX3912_VIDEO_CTRL1_ENFREEZEFRAME | TX3912_VIDEO_CTRL1_DFMODE),
 272                 TX3912_VIDEO_CTRL1);
 273         udelay(200);
 274
 275         /* Clear the framebuffer */
 276         memset((void *) tx3912fb_fix.smem_start, 0xff, tx3912fb_fix.smem_len);
 277         udelay(200);
 278
 279         /* Enable the video logic */
 280         outl(inl(TX3912_VIDEO_CTRL1) |
 281                 (TX3912_VIDEO_CTRL1_ENVID | TX3912_VIDEO_CTRL1_DISPON),
 282                 TX3912_VIDEO_CTRL1);
 283
 284         /*
 285          * Memory limit
 286          */
 287         tx3912fb_fix.line_length =
 288             get_line_length(tx3912fb_var.xres_virtual, tx3912fb_var.bits_per_pixel);
 289         if ((tx3912fb_fix.line_length * tx3912fb_var.yres_virtual) > tx3912fb_fix.smem_len)
 290                 return -ENOMEM;
 291
 292         fb_info.fbops = &tx3912fb_ops;
 293         fb_info.var = tx3912fb_var;
 294         fb_info.fix = tx3912fb_fix;
 295         fb_info.pseudo_palette = pseudo_palette;
 296         fb_info.flags = FBINFO_DEFAULT;
 297
 298         /* Clear the framebuffer */
 299         memset((void *) fb_info.fix.smem_start, 0xff, fb_info.fix.smem_len);
 300         udelay(200);
 301
 302         fb_alloc_cmap(&info->cmap, size, 0);
 303
 304         if (register_framebuffer(&fb_info) < 0)
 305                 return -1;
 306
 307         printk(KERN_INFO "fb%d: TX3912 frame buffer using %uKB.\n",
 308                fb_info.node, (u_int) (fb_info.fix.smem_len >> 10));
 309         return 0;
 310 }
 311
 312 int __init tx3912fb_setup(char *options)
 313 {
 314         char *this_opt;
 315
 316         if (!options || !*options)
 317                 return 0;
 318
 319         while ((this_opt = strsep(&options, ","))) {
 320                 if (!strncmp(options, "bpp:", 4))
 321                         tx3912fb_var.bits_per_pixel = simple_strtoul(options+4, NULL, 0);
 322         }
 323         return 0;
 324 }
 325
 326 module_init(tx3912fb_init);
 327 MODULE_LICENSE("GPL");