Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* tcx.c: TCX frame buffer driver |
| 2 | * |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 3 | * Copyright (C) 2003, 2006 David S. Miller (davem@davemloft.net) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 4 | * Copyright (C) 1996,1998 Jakub Jelinek (jj@ultra.linux.cz) |
| 5 | * Copyright (C) 1996 Miguel de Icaza (miguel@nuclecu.unam.mx) |
| 6 | * Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be) |
| 7 | * |
| 8 | * Driver layout based loosely on tgafb.c, see that file for credits. |
| 9 | */ |
| 10 | |
| 11 | #include <linux/module.h> |
| 12 | #include <linux/kernel.h> |
| 13 | #include <linux/errno.h> |
| 14 | #include <linux/string.h> |
| 15 | #include <linux/slab.h> |
| 16 | #include <linux/delay.h> |
| 17 | #include <linux/init.h> |
| 18 | #include <linux/fb.h> |
| 19 | #include <linux/mm.h> |
| 20 | |
| 21 | #include <asm/io.h> |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 22 | #include <asm/prom.h> |
| 23 | #include <asm/of_device.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 24 | #include <asm/fbio.h> |
| 25 | |
| 26 | #include "sbuslib.h" |
| 27 | |
| 28 | /* |
| 29 | * Local functions. |
| 30 | */ |
| 31 | |
| 32 | static int tcx_setcolreg(unsigned, unsigned, unsigned, unsigned, |
| 33 | unsigned, struct fb_info *); |
| 34 | static int tcx_blank(int, struct fb_info *); |
| 35 | |
Christoph Hellwig | 216d526 | 2006-01-14 13:21:25 -0800 | [diff] [blame] | 36 | static int tcx_mmap(struct fb_info *, struct vm_area_struct *); |
Christoph Hellwig | 67a6680 | 2006-01-14 13:21:25 -0800 | [diff] [blame] | 37 | static int tcx_ioctl(struct fb_info *, unsigned int, unsigned long); |
Tom 'spot' Callaway | 6ee7c15 | 2005-04-24 20:39:15 -0700 | [diff] [blame] | 38 | static int tcx_pan_display(struct fb_var_screeninfo *, struct fb_info *); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 39 | |
| 40 | /* |
| 41 | * Frame buffer operations |
| 42 | */ |
| 43 | |
| 44 | static struct fb_ops tcx_ops = { |
| 45 | .owner = THIS_MODULE, |
| 46 | .fb_setcolreg = tcx_setcolreg, |
| 47 | .fb_blank = tcx_blank, |
Tom 'spot' Callaway | 6ee7c15 | 2005-04-24 20:39:15 -0700 | [diff] [blame] | 48 | .fb_pan_display = tcx_pan_display, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 | .fb_fillrect = cfb_fillrect, |
| 50 | .fb_copyarea = cfb_copyarea, |
| 51 | .fb_imageblit = cfb_imageblit, |
| 52 | .fb_mmap = tcx_mmap, |
| 53 | .fb_ioctl = tcx_ioctl, |
Christoph Hellwig | 9ffb83b | 2005-11-12 12:11:12 -0800 | [diff] [blame] | 54 | #ifdef CONFIG_COMPAT |
| 55 | .fb_compat_ioctl = sbusfb_compat_ioctl, |
| 56 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | }; |
| 58 | |
| 59 | /* THC definitions */ |
| 60 | #define TCX_THC_MISC_REV_SHIFT 16 |
| 61 | #define TCX_THC_MISC_REV_MASK 15 |
| 62 | #define TCX_THC_MISC_VSYNC_DIS (1 << 25) |
| 63 | #define TCX_THC_MISC_HSYNC_DIS (1 << 24) |
| 64 | #define TCX_THC_MISC_RESET (1 << 12) |
| 65 | #define TCX_THC_MISC_VIDEO (1 << 10) |
| 66 | #define TCX_THC_MISC_SYNC (1 << 9) |
| 67 | #define TCX_THC_MISC_VSYNC (1 << 8) |
| 68 | #define TCX_THC_MISC_SYNC_ENAB (1 << 7) |
| 69 | #define TCX_THC_MISC_CURS_RES (1 << 6) |
| 70 | #define TCX_THC_MISC_INT_ENAB (1 << 5) |
| 71 | #define TCX_THC_MISC_INT (1 << 4) |
| 72 | #define TCX_THC_MISC_INIT 0x9f |
| 73 | #define TCX_THC_REV_REV_SHIFT 20 |
| 74 | #define TCX_THC_REV_REV_MASK 15 |
| 75 | #define TCX_THC_REV_MINREV_SHIFT 28 |
| 76 | #define TCX_THC_REV_MINREV_MASK 15 |
| 77 | |
| 78 | /* The contents are unknown */ |
| 79 | struct tcx_tec { |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 80 | u32 tec_matrix; |
| 81 | u32 tec_clip; |
| 82 | u32 tec_vdc; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 83 | }; |
| 84 | |
| 85 | struct tcx_thc { |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 86 | u32 thc_rev; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 | u32 thc_pad0[511]; |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 88 | u32 thc_hs; /* hsync timing */ |
| 89 | u32 thc_hsdvs; |
| 90 | u32 thc_hd; |
| 91 | u32 thc_vs; /* vsync timing */ |
| 92 | u32 thc_vd; |
| 93 | u32 thc_refresh; |
| 94 | u32 thc_misc; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 95 | u32 thc_pad1[56]; |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 96 | u32 thc_cursxy; /* cursor x,y position (16 bits each) */ |
| 97 | u32 thc_cursmask[32]; /* cursor mask bits */ |
| 98 | u32 thc_cursbits[32]; /* what to show where mask enabled */ |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 99 | }; |
| 100 | |
| 101 | struct bt_regs { |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 102 | u32 addr; |
| 103 | u32 color_map; |
| 104 | u32 control; |
| 105 | u32 cursor; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 106 | }; |
| 107 | |
| 108 | #define TCX_MMAP_ENTRIES 14 |
| 109 | |
| 110 | struct tcx_par { |
| 111 | spinlock_t lock; |
| 112 | struct bt_regs __iomem *bt; |
| 113 | struct tcx_thc __iomem *thc; |
| 114 | struct tcx_tec __iomem *tec; |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 115 | u32 __iomem *cplane; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 116 | |
| 117 | u32 flags; |
| 118 | #define TCX_FLAG_BLANKED 0x00000001 |
| 119 | |
| 120 | unsigned long physbase; |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 121 | unsigned long which_io; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | unsigned long fbsize; |
| 123 | |
| 124 | struct sbus_mmap_map mmap_map[TCX_MMAP_ENTRIES]; |
| 125 | int lowdepth; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 126 | }; |
| 127 | |
| 128 | /* Reset control plane so that WID is 8-bit plane. */ |
| 129 | static void __tcx_set_control_plane (struct tcx_par *par) |
| 130 | { |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 131 | u32 __iomem *p, *pend; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 132 | |
| 133 | if (par->lowdepth) |
| 134 | return; |
| 135 | |
| 136 | p = par->cplane; |
| 137 | if (p == NULL) |
| 138 | return; |
| 139 | for (pend = p + par->fbsize; p < pend; p++) { |
| 140 | u32 tmp = sbus_readl(p); |
| 141 | |
| 142 | tmp &= 0xffffff; |
| 143 | sbus_writel(tmp, p); |
| 144 | } |
| 145 | } |
| 146 | |
| 147 | static void tcx_reset (struct fb_info *info) |
| 148 | { |
| 149 | struct tcx_par *par = (struct tcx_par *) info->par; |
| 150 | unsigned long flags; |
| 151 | |
| 152 | spin_lock_irqsave(&par->lock, flags); |
| 153 | __tcx_set_control_plane(par); |
| 154 | spin_unlock_irqrestore(&par->lock, flags); |
| 155 | } |
| 156 | |
Tom 'spot' Callaway | 6ee7c15 | 2005-04-24 20:39:15 -0700 | [diff] [blame] | 157 | static int tcx_pan_display(struct fb_var_screeninfo *var, struct fb_info *info) |
| 158 | { |
| 159 | tcx_reset(info); |
| 160 | return 0; |
| 161 | } |
| 162 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 163 | /** |
| 164 | * tcx_setcolreg - Optional function. Sets a color register. |
| 165 | * @regno: boolean, 0 copy local, 1 get_user() function |
| 166 | * @red: frame buffer colormap structure |
| 167 | * @green: The green value which can be up to 16 bits wide |
| 168 | * @blue: The blue value which can be up to 16 bits wide. |
| 169 | * @transp: If supported the alpha value which can be up to 16 bits wide. |
| 170 | * @info: frame buffer info structure |
| 171 | */ |
| 172 | static int tcx_setcolreg(unsigned regno, |
| 173 | unsigned red, unsigned green, unsigned blue, |
| 174 | unsigned transp, struct fb_info *info) |
| 175 | { |
| 176 | struct tcx_par *par = (struct tcx_par *) info->par; |
| 177 | struct bt_regs __iomem *bt = par->bt; |
| 178 | unsigned long flags; |
| 179 | |
| 180 | if (regno >= 256) |
| 181 | return 1; |
| 182 | |
| 183 | red >>= 8; |
| 184 | green >>= 8; |
| 185 | blue >>= 8; |
| 186 | |
| 187 | spin_lock_irqsave(&par->lock, flags); |
| 188 | |
| 189 | sbus_writel(regno << 24, &bt->addr); |
| 190 | sbus_writel(red << 24, &bt->color_map); |
| 191 | sbus_writel(green << 24, &bt->color_map); |
| 192 | sbus_writel(blue << 24, &bt->color_map); |
| 193 | |
| 194 | spin_unlock_irqrestore(&par->lock, flags); |
| 195 | |
| 196 | return 0; |
| 197 | } |
| 198 | |
| 199 | /** |
| 200 | * tcx_blank - Optional function. Blanks the display. |
| 201 | * @blank_mode: the blank mode we want. |
| 202 | * @info: frame buffer structure that represents a single frame buffer |
| 203 | */ |
| 204 | static int |
| 205 | tcx_blank(int blank, struct fb_info *info) |
| 206 | { |
| 207 | struct tcx_par *par = (struct tcx_par *) info->par; |
| 208 | struct tcx_thc __iomem *thc = par->thc; |
| 209 | unsigned long flags; |
| 210 | u32 val; |
| 211 | |
| 212 | spin_lock_irqsave(&par->lock, flags); |
| 213 | |
| 214 | val = sbus_readl(&thc->thc_misc); |
| 215 | |
| 216 | switch (blank) { |
| 217 | case FB_BLANK_UNBLANK: /* Unblanking */ |
| 218 | val &= ~(TCX_THC_MISC_VSYNC_DIS | |
| 219 | TCX_THC_MISC_HSYNC_DIS); |
| 220 | val |= TCX_THC_MISC_VIDEO; |
| 221 | par->flags &= ~TCX_FLAG_BLANKED; |
| 222 | break; |
| 223 | |
| 224 | case FB_BLANK_NORMAL: /* Normal blanking */ |
| 225 | val &= ~TCX_THC_MISC_VIDEO; |
| 226 | par->flags |= TCX_FLAG_BLANKED; |
| 227 | break; |
| 228 | |
| 229 | case FB_BLANK_VSYNC_SUSPEND: /* VESA blank (vsync off) */ |
| 230 | val |= TCX_THC_MISC_VSYNC_DIS; |
| 231 | break; |
| 232 | case FB_BLANK_HSYNC_SUSPEND: /* VESA blank (hsync off) */ |
| 233 | val |= TCX_THC_MISC_HSYNC_DIS; |
| 234 | break; |
| 235 | |
| 236 | case FB_BLANK_POWERDOWN: /* Poweroff */ |
| 237 | break; |
| 238 | }; |
| 239 | |
| 240 | sbus_writel(val, &thc->thc_misc); |
| 241 | |
| 242 | spin_unlock_irqrestore(&par->lock, flags); |
| 243 | |
| 244 | return 0; |
| 245 | } |
| 246 | |
| 247 | static struct sbus_mmap_map __tcx_mmap_map[TCX_MMAP_ENTRIES] = { |
| 248 | { |
| 249 | .voff = TCX_RAM8BIT, |
| 250 | .size = SBUS_MMAP_FBSIZE(1) |
| 251 | }, |
| 252 | { |
| 253 | .voff = TCX_RAM24BIT, |
| 254 | .size = SBUS_MMAP_FBSIZE(4) |
| 255 | }, |
| 256 | { |
| 257 | .voff = TCX_UNK3, |
| 258 | .size = SBUS_MMAP_FBSIZE(8) |
| 259 | }, |
| 260 | { |
| 261 | .voff = TCX_UNK4, |
| 262 | .size = SBUS_MMAP_FBSIZE(8) |
| 263 | }, |
| 264 | { |
| 265 | .voff = TCX_CONTROLPLANE, |
| 266 | .size = SBUS_MMAP_FBSIZE(4) |
| 267 | }, |
| 268 | { |
| 269 | .voff = TCX_UNK6, |
| 270 | .size = SBUS_MMAP_FBSIZE(8) |
| 271 | }, |
| 272 | { |
| 273 | .voff = TCX_UNK7, |
| 274 | .size = SBUS_MMAP_FBSIZE(8) |
| 275 | }, |
| 276 | { |
| 277 | .voff = TCX_TEC, |
| 278 | .size = PAGE_SIZE |
| 279 | }, |
| 280 | { |
| 281 | .voff = TCX_BTREGS, |
| 282 | .size = PAGE_SIZE |
| 283 | }, |
| 284 | { |
| 285 | .voff = TCX_THC, |
| 286 | .size = PAGE_SIZE |
| 287 | }, |
| 288 | { |
| 289 | .voff = TCX_DHC, |
| 290 | .size = PAGE_SIZE |
| 291 | }, |
| 292 | { |
| 293 | .voff = TCX_ALT, |
| 294 | .size = PAGE_SIZE |
| 295 | }, |
| 296 | { |
| 297 | .voff = TCX_UNK2, |
| 298 | .size = 0x20000 |
| 299 | }, |
| 300 | { .size = 0 } |
| 301 | }; |
| 302 | |
Christoph Hellwig | 216d526 | 2006-01-14 13:21:25 -0800 | [diff] [blame] | 303 | static int tcx_mmap(struct fb_info *info, struct vm_area_struct *vma) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 304 | { |
| 305 | struct tcx_par *par = (struct tcx_par *)info->par; |
| 306 | |
| 307 | return sbusfb_mmap_helper(par->mmap_map, |
| 308 | par->physbase, par->fbsize, |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 309 | par->which_io, vma); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 310 | } |
| 311 | |
Christoph Hellwig | 67a6680 | 2006-01-14 13:21:25 -0800 | [diff] [blame] | 312 | static int tcx_ioctl(struct fb_info *info, unsigned int cmd, |
| 313 | unsigned long arg) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 314 | { |
| 315 | struct tcx_par *par = (struct tcx_par *) info->par; |
| 316 | |
| 317 | return sbusfb_ioctl_helper(cmd, arg, info, |
| 318 | FBTYPE_TCXCOLOR, |
| 319 | (par->lowdepth ? 8 : 24), |
| 320 | par->fbsize); |
| 321 | } |
| 322 | |
| 323 | /* |
| 324 | * Initialisation |
| 325 | */ |
| 326 | |
| 327 | static void |
| 328 | tcx_init_fix(struct fb_info *info, int linebytes) |
| 329 | { |
| 330 | struct tcx_par *par = (struct tcx_par *)info->par; |
| 331 | const char *tcx_name; |
| 332 | |
| 333 | if (par->lowdepth) |
| 334 | tcx_name = "TCX8"; |
| 335 | else |
| 336 | tcx_name = "TCX24"; |
| 337 | |
| 338 | strlcpy(info->fix.id, tcx_name, sizeof(info->fix.id)); |
| 339 | |
| 340 | info->fix.type = FB_TYPE_PACKED_PIXELS; |
| 341 | info->fix.visual = FB_VISUAL_PSEUDOCOLOR; |
| 342 | |
| 343 | info->fix.line_length = linebytes; |
| 344 | |
| 345 | info->fix.accel = FB_ACCEL_SUN_TCX; |
| 346 | } |
| 347 | |
| 348 | struct all_info { |
| 349 | struct fb_info info; |
| 350 | struct tcx_par par; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 351 | }; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 352 | |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 353 | static void tcx_unmap_regs(struct of_device *op, struct all_info *all) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 354 | { |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 355 | if (all->par.tec) |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 356 | of_iounmap(&op->resource[7], |
| 357 | all->par.tec, sizeof(struct tcx_tec)); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 358 | if (all->par.thc) |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 359 | of_iounmap(&op->resource[9], |
| 360 | all->par.thc, sizeof(struct tcx_thc)); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 361 | if (all->par.bt) |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 362 | of_iounmap(&op->resource[8], |
| 363 | all->par.bt, sizeof(struct bt_regs)); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 364 | if (all->par.cplane) |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 365 | of_iounmap(&op->resource[4], |
| 366 | all->par.cplane, all->par.fbsize * sizeof(u32)); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 367 | if (all->info.screen_base) |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 368 | of_iounmap(&op->resource[0], |
| 369 | all->info.screen_base, all->par.fbsize); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 370 | } |
| 371 | |
| 372 | static int __devinit tcx_init_one(struct of_device *op) |
| 373 | { |
| 374 | struct device_node *dp = op->node; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 375 | struct all_info *all; |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 376 | int linebytes, i, err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 377 | |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 378 | all = kzalloc(sizeof(*all), GFP_KERNEL); |
| 379 | if (!all) |
| 380 | return -ENOMEM; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 381 | |
| 382 | spin_lock_init(&all->par.lock); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 383 | |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 384 | all->par.lowdepth = |
| 385 | (of_find_property(dp, "tcx-8-bit", NULL) != NULL); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 386 | |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 387 | sbusfb_fill_var(&all->info.var, dp->node, 8); |
Tom 'spot' Callaway | 6ee7c15 | 2005-04-24 20:39:15 -0700 | [diff] [blame] | 388 | all->info.var.red.length = 8; |
| 389 | all->info.var.green.length = 8; |
| 390 | all->info.var.blue.length = 8; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 391 | |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 392 | linebytes = of_getintprop_default(dp, "linebytes", |
| 393 | all->info.var.xres); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 394 | all->par.fbsize = PAGE_ALIGN(linebytes * all->info.var.yres); |
| 395 | |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 396 | all->par.tec = of_ioremap(&op->resource[7], 0, |
| 397 | sizeof(struct tcx_tec), "tcx tec"); |
| 398 | all->par.thc = of_ioremap(&op->resource[9], 0, |
| 399 | sizeof(struct tcx_thc), "tcx thc"); |
| 400 | all->par.bt = of_ioremap(&op->resource[8], 0, |
| 401 | sizeof(struct bt_regs), "tcx dac"); |
| 402 | all->info.screen_base = of_ioremap(&op->resource[0], 0, |
| 403 | all->par.fbsize, "tcx ram"); |
| 404 | if (!all->par.tec || !all->par.thc || |
| 405 | !all->par.bt || !all->info.screen_base) { |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 406 | tcx_unmap_regs(op, all); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 407 | kfree(all); |
| 408 | return -ENOMEM; |
| 409 | } |
| 410 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 411 | memcpy(&all->par.mmap_map, &__tcx_mmap_map, sizeof(all->par.mmap_map)); |
| 412 | if (!all->par.lowdepth) { |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 413 | all->par.cplane = of_ioremap(&op->resource[4], 0, |
| 414 | all->par.fbsize * sizeof(u32), |
| 415 | "tcx cplane"); |
| 416 | if (!all->par.cplane) { |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 417 | tcx_unmap_regs(op, all); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 418 | kfree(all); |
| 419 | return -ENOMEM; |
| 420 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 421 | } else { |
| 422 | all->par.mmap_map[1].size = SBUS_MMAP_EMPTY; |
| 423 | all->par.mmap_map[4].size = SBUS_MMAP_EMPTY; |
| 424 | all->par.mmap_map[5].size = SBUS_MMAP_EMPTY; |
| 425 | all->par.mmap_map[6].size = SBUS_MMAP_EMPTY; |
| 426 | } |
| 427 | |
| 428 | all->par.physbase = 0; |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 429 | all->par.which_io = op->resource[0].flags & IORESOURCE_BITS; |
| 430 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 431 | for (i = 0; i < TCX_MMAP_ENTRIES; i++) { |
| 432 | int j; |
| 433 | |
| 434 | switch (i) { |
| 435 | case 10: |
| 436 | j = 12; |
| 437 | break; |
| 438 | |
| 439 | case 11: case 12: |
| 440 | j = i - 1; |
| 441 | break; |
| 442 | |
| 443 | default: |
| 444 | j = i; |
| 445 | break; |
| 446 | }; |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 447 | all->par.mmap_map[i].poff = op->resource[j].start; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 448 | } |
| 449 | |
| 450 | all->info.flags = FBINFO_DEFAULT; |
| 451 | all->info.fbops = &tcx_ops; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 452 | all->info.par = &all->par; |
| 453 | |
| 454 | /* Initialize brooktree DAC. */ |
| 455 | sbus_writel(0x04 << 24, &all->par.bt->addr); /* color planes */ |
| 456 | sbus_writel(0xff << 24, &all->par.bt->control); |
| 457 | sbus_writel(0x05 << 24, &all->par.bt->addr); |
| 458 | sbus_writel(0x00 << 24, &all->par.bt->control); |
| 459 | sbus_writel(0x06 << 24, &all->par.bt->addr); /* overlay plane */ |
| 460 | sbus_writel(0x73 << 24, &all->par.bt->control); |
| 461 | sbus_writel(0x07 << 24, &all->par.bt->addr); |
| 462 | sbus_writel(0x00 << 24, &all->par.bt->control); |
| 463 | |
| 464 | tcx_reset(&all->info); |
| 465 | |
Hareesh Nagarajan | 2c27d4e | 2005-12-12 14:42:07 -0800 | [diff] [blame] | 466 | tcx_blank(FB_BLANK_UNBLANK, &all->info); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 467 | |
| 468 | if (fb_alloc_cmap(&all->info.cmap, 256, 0)) { |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 469 | tcx_unmap_regs(op, all); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 470 | kfree(all); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 471 | return -ENOMEM; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 472 | } |
| 473 | |
Tom 'spot' Callaway | 6ee7c15 | 2005-04-24 20:39:15 -0700 | [diff] [blame] | 474 | fb_set_cmap(&all->info.cmap, &all->info); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 475 | tcx_init_fix(&all->info, linebytes); |
| 476 | |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 477 | err = register_framebuffer(&all->info); |
| 478 | if (err < 0) { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 479 | fb_dealloc_cmap(&all->info.cmap); |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 480 | tcx_unmap_regs(op, all); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 481 | kfree(all); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 482 | return err; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 483 | } |
| 484 | |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 485 | dev_set_drvdata(&op->dev, all); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 486 | |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 487 | printk("%s: TCX at %lx:%lx, %s\n", |
| 488 | dp->full_name, |
| 489 | all->par.which_io, |
| 490 | op->resource[0].start, |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 491 | all->par.lowdepth ? "8-bit only" : "24-bit depth"); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 492 | |
| 493 | return 0; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 494 | } |
| 495 | |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 496 | static int __devinit tcx_probe(struct of_device *dev, const struct of_device_id *match) |
| 497 | { |
| 498 | struct of_device *op = to_of_device(&dev->dev); |
| 499 | |
| 500 | return tcx_init_one(op); |
| 501 | } |
| 502 | |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 503 | static int __devexit tcx_remove(struct of_device *op) |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 504 | { |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 505 | struct all_info *all = dev_get_drvdata(&op->dev); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 506 | |
| 507 | unregister_framebuffer(&all->info); |
| 508 | fb_dealloc_cmap(&all->info.cmap); |
| 509 | |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 510 | tcx_unmap_regs(op, all); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 511 | |
| 512 | kfree(all); |
| 513 | |
David S. Miller | e3a411a3 | 2006-12-28 21:01:32 -0800 | [diff] [blame] | 514 | dev_set_drvdata(&op->dev, NULL); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 515 | |
| 516 | return 0; |
| 517 | } |
| 518 | |
| 519 | static struct of_device_id tcx_match[] = { |
| 520 | { |
| 521 | .name = "SUNW,tcx", |
| 522 | }, |
| 523 | {}, |
| 524 | }; |
| 525 | MODULE_DEVICE_TABLE(of, tcx_match); |
| 526 | |
| 527 | static struct of_platform_driver tcx_driver = { |
| 528 | .name = "tcx", |
| 529 | .match_table = tcx_match, |
| 530 | .probe = tcx_probe, |
| 531 | .remove = __devexit_p(tcx_remove), |
| 532 | }; |
| 533 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 534 | int __init tcx_init(void) |
| 535 | { |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 536 | if (fb_get_options("tcxfb", NULL)) |
| 537 | return -ENODEV; |
| 538 | |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 539 | return of_register_driver(&tcx_driver, &of_bus_type); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 540 | } |
| 541 | |
| 542 | void __exit tcx_exit(void) |
| 543 | { |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 544 | of_unregister_driver(&tcx_driver); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 545 | } |
| 546 | |
| 547 | module_init(tcx_init); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 548 | module_exit(tcx_exit); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 549 | |
| 550 | MODULE_DESCRIPTION("framebuffer driver for TCX chipsets"); |
David S. Miller | 50312ce | 2006-06-29 14:35:52 -0700 | [diff] [blame] | 551 | MODULE_AUTHOR("David S. Miller <davem@davemloft.net>"); |
| 552 | MODULE_VERSION("2.0"); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 553 | MODULE_LICENSE("GPL"); |