sbusfb.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:32k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  *  linux/drivers/video/sbusfb.c -- SBUS or UPA based frame buffer device
  3.  *
  4.  * Copyright (C) 1998 Jakub Jelinek
  5.  *
  6.  *  This driver is partly based on the Open Firmware console driver
  7.  *
  8.  * Copyright (C) 1997 Geert Uytterhoeven
  9.  *
  10.  *  and SPARC console subsystem
  11.  *
  12.  *      Copyright (C) 1995 Peter Zaitcev (zaitcev@yahoo.com)
  13.  *      Copyright (C) 1995-1997 David S. Miller (davem@caip.rutgers.edu)
  14.  *      Copyright (C) 1995-1996 Miguel de Icaza (miguel@nuclecu.unam.mx)
  15.  *      Copyright (C) 1996 Dave Redman (djhr@tadpole.co.uk)
  16.  *      Copyright (C) 1996-1998 Jakub Jelinek (jj@sunsite.mff.cuni.cz)
  17.  *      Copyright (C) 1996 Eddie C. Dost (ecd@skynet.be)
  18.  *
  19.  *  This file is subject to the terms and conditions of the GNU General Public
  20.  *  License. See the file COPYING in the main directory of this archive for
  21.  *  more details.
  22.  */
  23. #include <linux/config.h>
  24. #include <linux/module.h>
  25. #include <linux/kernel.h>
  26. #include <linux/errno.h>
  27. #include <linux/string.h>
  28. #include <linux/mm.h>
  29. #include <linux/tty.h>
  30. #include <linux/slab.h>
  31. #include <linux/vmalloc.h>
  32. #include <linux/delay.h>
  33. #include <linux/interrupt.h>
  34. #include <linux/fb.h>
  35. #include <linux/selection.h>
  36. #include <linux/init.h>
  37. #include <linux/console.h>
  38. #include <linux/kd.h>
  39. #include <linux/vt_kern.h>
  40. #include <asm/uaccess.h>
  41. #include <asm/pgtable.h> /* io_remap_page_range() */
  42. #include <video/sbusfb.h>
  43. #define DEFAULT_CURSOR_BLINK_RATE       (2*HZ/5)
  44. #define CURSOR_SHAPE 1
  45. #define CURSOR_BLINK 2
  46.     /*
  47.      *  Interface used by the world
  48.      */
  49. int sbusfb_init(void);
  50. int sbusfb_setup(char*);
  51. static int currcon;
  52. static int defx_margin = -1, defy_margin = -1;
  53. static char fontname[40] __initdata = { 0 };
  54. static int curblink __initdata = 1;
  55. static struct {
  56. int depth;
  57. int xres, yres;
  58. int x_margin, y_margin;
  59. } def_margins [] = {
  60. { 8, 1280, 1024, 64, 80 },
  61. { 8, 1152, 1024, 64, 80 },
  62. { 8, 1152, 900,  64, 18 },
  63. { 8, 1024, 768,  0,  0 },
  64. { 8, 800, 600, 16, 12 },
  65. { 8, 640, 480, 0, 0 },
  66. { 1, 1152, 900,  8,  18 },
  67. { 0 },
  68. };
  69. static int sbusfb_open(struct fb_info *info, int user);
  70. static int sbusfb_release(struct fb_info *info, int user);
  71. static int sbusfb_mmap(struct fb_info *info, struct file *file, 
  72. struct vm_area_struct *vma);
  73. static int sbusfb_get_fix(struct fb_fix_screeninfo *fix, int con,
  74. struct fb_info *info);
  75. static int sbusfb_get_var(struct fb_var_screeninfo *var, int con,
  76. struct fb_info *info);
  77. static int sbusfb_set_var(struct fb_var_screeninfo *var, int con,
  78. struct fb_info *info);
  79. static int sbusfb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
  80. struct fb_info *info);
  81. static int sbusfb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
  82. struct fb_info *info);
  83. static int sbusfb_ioctl(struct inode *inode, struct file *file, u_int cmd,
  84.     u_long arg, int con, struct fb_info *info);
  85. static void sbusfb_cursor(struct display *p, int mode, int x, int y);
  86. static void sbusfb_clear_margin(struct display *p, int s);
  87.     
  88.     /*
  89.      *  Interface to the low level console driver
  90.      */
  91. static int sbusfbcon_switch(int con, struct fb_info *info);
  92. static int sbusfbcon_updatevar(int con, struct fb_info *info);
  93. static void sbusfbcon_blank(int blank, struct fb_info *info);
  94.     /*
  95.      *  Internal routines
  96.      */
  97. static int sbusfb_getcolreg(u_int regno, u_int *red, u_int *green, u_int *blue,
  98.     u_int *transp, struct fb_info *info);
  99. static int sbusfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
  100.     u_int transp, struct fb_info *info);
  101. static void do_install_cmap(int con, struct fb_info *info);
  102. static struct fb_ops sbusfb_ops = {
  103. owner: THIS_MODULE,
  104. fb_open: sbusfb_open,
  105. fb_release: sbusfb_release,
  106. fb_get_fix: sbusfb_get_fix,
  107. fb_get_var: sbusfb_get_var,
  108. fb_set_var: sbusfb_set_var,
  109. fb_get_cmap: sbusfb_get_cmap,
  110. fb_set_cmap: sbusfb_set_cmap,
  111. fb_ioctl: sbusfb_ioctl,
  112. fb_mmap: sbusfb_mmap,
  113. };
  114.     /*
  115.      *  Open/Release the frame buffer device
  116.      */
  117. static int sbusfb_open(struct fb_info *info, int user)
  118. {
  119. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  120. if (user) {
  121. if (fb->open == 0) {
  122. fb->mmaped = 0;
  123. fb->vtconsole = -1;
  124. }
  125. fb->open++;
  126. } else
  127. fb->consolecnt++;
  128. return 0;
  129. }
  130. static int sbusfb_release(struct fb_info *info, int user)
  131. {
  132. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  133. if (user) {
  134. fb->open--;
  135. if (fb->open == 0) {
  136. if (fb->vtconsole != -1) {
  137. vt_cons[fb->vtconsole]->vc_mode = KD_TEXT;
  138. if (fb->mmaped) {
  139. fb->graphmode--;
  140. sbusfb_clear_margin(&fb_display[fb->vtconsole], 0);
  141. }
  142. }
  143. if (fb->reset)
  144. fb->reset(fb);
  145. }
  146. } else
  147. fb->consolecnt--;
  148. return 0;
  149. }
  150. static unsigned long sbusfb_mmapsize(struct fb_info_sbusfb *fb, long size)
  151. {
  152. if (size == SBUS_MMAP_EMPTY) return 0;
  153. if (size >= 0) return size;
  154. return fb->type.fb_size * (-size);
  155. }
  156. static int sbusfb_mmap(struct fb_info *info, struct file *file, 
  157. struct vm_area_struct *vma)
  158. {
  159. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  160. unsigned int size, page, r, map_size;
  161. unsigned long map_offset = 0;
  162. unsigned long off;
  163. int i;
  164.                                         
  165. size = vma->vm_end - vma->vm_start;
  166. if (vma->vm_pgoff > (~0UL >> PAGE_SHIFT))
  167. return -EINVAL;
  168. off = vma->vm_pgoff << PAGE_SHIFT;
  169. /* To stop the swapper from even considering these pages */
  170. vma->vm_flags |= (VM_SHM| VM_LOCKED);
  171. /* Each page, see which map applies */
  172. for (page = 0; page < size; ){
  173. map_size = 0;
  174. for (i = 0; fb->mmap_map[i].size; i++)
  175. if (fb->mmap_map[i].voff == off+page) {
  176. map_size = sbusfb_mmapsize(fb,fb->mmap_map[i].size);
  177. #ifdef __sparc_v9__
  178. #define POFF_MASK (PAGE_MASK|0x1UL)
  179. #else
  180. #define POFF_MASK (PAGE_MASK)
  181. #endif
  182. map_offset = (fb->physbase + fb->mmap_map[i].poff) & POFF_MASK;
  183. break;
  184. }
  185. if (!map_size){
  186. page += PAGE_SIZE;
  187. continue;
  188. }
  189. if (page + map_size > size)
  190. map_size = size - page;
  191. r = io_remap_page_range (vma->vm_start+page, map_offset, map_size, vma->vm_page_prot, fb->iospace);
  192. if (r)
  193. return -EAGAIN;
  194. page += map_size;
  195. }
  196. vma->vm_flags |= VM_IO;
  197. if (!fb->mmaped) {
  198. int lastconsole = 0;
  199. if (info->display_fg)
  200. lastconsole = info->display_fg->vc_num;
  201. fb->mmaped = 1;
  202. if (fb->consolecnt && fb_display[lastconsole].fb_info == info) {
  203. fb->vtconsole = lastconsole;
  204. fb->graphmode++;
  205. vt_cons [lastconsole]->vc_mode = KD_GRAPHICS;
  206. vc_cons[lastconsole].d->vc_sw->con_cursor(vc_cons[lastconsole].d,CM_ERASE);
  207. } else if (fb->unblank && !fb->blanked)
  208. (*fb->unblank)(fb);
  209. }
  210. return 0;
  211. }
  212. static void sbusfb_clear_margin(struct display *p, int s)
  213. {
  214. struct fb_info_sbusfb *fb = sbusfbinfod(p);
  215. if (fb->switch_from_graph)
  216. (*fb->switch_from_graph)(fb);
  217. if (fb->fill) {
  218. unsigned short rects [16];
  219. rects [0] = 0;
  220. rects [1] = 0;
  221. rects [2] = fb->var.xres_virtual;
  222. rects [3] = fb->y_margin;
  223. rects [4] = 0;
  224. rects [5] = fb->y_margin;
  225. rects [6] = fb->x_margin;
  226. rects [7] = fb->var.yres_virtual;
  227. rects [8] = fb->var.xres_virtual - fb->x_margin;
  228. rects [9] = fb->y_margin;
  229. rects [10] = fb->var.xres_virtual;
  230. rects [11] = fb->var.yres_virtual;
  231. rects [12] = fb->x_margin;
  232. rects [13] = fb->var.yres_virtual - fb->y_margin;
  233. rects [14] = fb->var.xres_virtual - fb->x_margin;
  234. rects [15] = fb->var.yres_virtual;
  235. (*fb->fill)(fb, p, s, 4, rects);
  236. } else {
  237. unsigned char *fb_base = p->screen_base, *q;
  238. int skip_bytes = fb->y_margin * fb->var.xres_virtual;
  239. int scr_size = fb->var.xres_virtual * fb->var.yres_virtual;
  240. int h, he, incr, size;
  241. he = fb->var.yres;
  242. if (fb->var.bits_per_pixel == 1) {
  243. fb_base -= (skip_bytes + fb->x_margin) / 8;
  244. skip_bytes /= 8;
  245. scr_size /= 8;
  246. fb_memset255 (fb_base, skip_bytes - fb->x_margin / 8);
  247. fb_memset255 (fb_base + scr_size - skip_bytes + fb->x_margin / 8, skip_bytes - fb->x_margin / 8);
  248. incr = fb->var.xres_virtual / 8;
  249. size = fb->x_margin / 8 * 2;
  250. for (q = fb_base + skip_bytes - fb->x_margin / 8, h = 0;
  251.      h <= he; q += incr, h++)
  252. fb_memset255 (q, size);
  253. } else {
  254. fb_base -= (skip_bytes + fb->x_margin);
  255. memset (fb_base, attr_bgcol(p,s), skip_bytes - fb->x_margin);
  256. memset (fb_base + scr_size - skip_bytes + fb->x_margin, attr_bgcol(p,s), skip_bytes - fb->x_margin);
  257. incr = fb->var.xres_virtual;
  258. size = fb->x_margin * 2;
  259. for (q = fb_base + skip_bytes - fb->x_margin, h = 0;
  260.      h <= he; q += incr, h++)
  261. memset (q, attr_bgcol(p,s), size);
  262. }
  263. }
  264. }
  265. static void sbusfb_disp_setup(struct display *p)
  266. {
  267. struct fb_info_sbusfb *fb = sbusfbinfod(p);
  268. if (fb->setup)
  269. fb->setup(p);
  270. sbusfb_clear_margin(p, 0);
  271. }
  272.     /*
  273.      *  Get the Fixed Part of the Display
  274.      */
  275. static int sbusfb_get_fix(struct fb_fix_screeninfo *fix, int con,
  276.   struct fb_info *info)
  277. {
  278. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  279. memcpy(fix, &fb->fix, sizeof(struct fb_fix_screeninfo));
  280. return 0;
  281. }
  282.     /*
  283.      *  Get the User Defined Part of the Display
  284.      */
  285. static int sbusfb_get_var(struct fb_var_screeninfo *var, int con,
  286.   struct fb_info *info)
  287. {
  288. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  289. memcpy(var, &fb->var, sizeof(struct fb_var_screeninfo));
  290. return 0;
  291. }
  292.     /*
  293.      *  Set the User Defined Part of the Display
  294.      */
  295. static int sbusfb_set_var(struct fb_var_screeninfo *var, int con,
  296.   struct fb_info *info)
  297. {
  298.        struct display *display;
  299.        int activate = var->activate;
  300.        if(con >= 0)
  301.                display = &fb_display[con];
  302.        else
  303.                display = info->disp;
  304.        /* simple check for equality until fully implemented -E */
  305.        if ((activate & FB_ACTIVATE_MASK) == FB_ACTIVATE_NOW) {
  306.                if (display->var.xres != var->xres ||
  307.                        display->var.yres != var->yres ||
  308.                        display->var.xres_virtual != var->xres_virtual ||
  309.                        display->var.yres_virtual != var->yres_virtual ||
  310.                        display->var.bits_per_pixel != var->bits_per_pixel ||
  311.                        display->var.accel_flags != var->accel_flags) {
  312.                        return -EINVAL;
  313.                }
  314.        }
  315.        return 0;
  316. }
  317.     /*
  318.      *  Hardware cursor
  319.      */
  320.      
  321. static int sbus_hw_scursor (struct fbcursor *cursor, struct fb_info_sbusfb *fb)
  322. {
  323. int op;
  324. int i, bytes = 0;
  325. struct fbcursor f;
  326. char red[2], green[2], blue[2];
  327. if (copy_from_user (&f, cursor, sizeof(struct fbcursor)))
  328. return -EFAULT;
  329. op = f.set;
  330. if (op & FB_CUR_SETSHAPE){
  331. if ((u32) f.size.fbx > fb->cursor.hwsize.fbx)
  332. return -EINVAL;
  333. if ((u32) f.size.fby > fb->cursor.hwsize.fby)
  334. return -EINVAL;
  335. if (f.size.fbx > 32)
  336. bytes = f.size.fby << 3;
  337. else
  338. bytes = f.size.fby << 2;
  339. }
  340. if (op & FB_CUR_SETCMAP){
  341. if (f.cmap.index || f.cmap.count != 2)
  342. return -EINVAL;
  343. if (copy_from_user (red, f.cmap.red, 2) ||
  344.     copy_from_user (green, f.cmap.green, 2) ||
  345.     copy_from_user (blue, f.cmap.blue, 2))
  346. return -EFAULT;
  347. }
  348. if (op & FB_CUR_SETCMAP)
  349. (*fb->setcursormap) (fb, red, green, blue);
  350. if (op & FB_CUR_SETSHAPE){
  351. u32 u;
  352. fb->cursor.size = f.size;
  353. memset ((void *)&fb->cursor.bits, 0, sizeof (fb->cursor.bits));
  354. if (copy_from_user (fb->cursor.bits [0], f.mask, bytes) ||
  355.     copy_from_user (fb->cursor.bits [1], f.image, bytes))
  356. return -EFAULT;
  357. if (f.size.fbx <= 32) {
  358. u = 0xffffffff << (32 - f.size.fbx);
  359. for (i = fb->cursor.size.fby - 1; i >= 0; i--) {
  360. fb->cursor.bits [0][i] &= u;
  361. fb->cursor.bits [1][i] &= fb->cursor.bits [0][i];
  362. }
  363. } else {
  364. u = 0xffffffff << (64 - f.size.fbx);
  365. for (i = fb->cursor.size.fby - 1; i >= 0; i--) {
  366. fb->cursor.bits [0][2*i+1] &= u;
  367. fb->cursor.bits [1][2*i] &= fb->cursor.bits [0][2*i];
  368. fb->cursor.bits [1][2*i+1] &= fb->cursor.bits [0][2*i+1];
  369. }
  370. }
  371. (*fb->setcurshape) (fb);
  372. }
  373. if (op & (FB_CUR_SETCUR | FB_CUR_SETPOS | FB_CUR_SETHOT)){
  374. if (op & FB_CUR_SETCUR)
  375. fb->cursor.enable = f.enable;
  376. if (op & FB_CUR_SETPOS)
  377. fb->cursor.cpos = f.pos;
  378. if (op & FB_CUR_SETHOT)
  379. fb->cursor.chot = f.hot;
  380. (*fb->setcursor) (fb);
  381. }
  382. return 0;
  383. }
  384. static unsigned char hw_cursor_cmap[2] = { 0, 0xff };
  385. static void
  386. sbusfb_cursor_timer_handler(unsigned long dev_addr)
  387. {
  388. struct fb_info_sbusfb *fb = (struct fb_info_sbusfb *)dev_addr;
  389.         
  390. if (!fb->setcursor) return;
  391.                                 
  392. if (fb->cursor.mode & CURSOR_BLINK) {
  393. fb->cursor.enable ^= 1;
  394. fb->setcursor(fb);
  395. }
  396. fb->cursor.timer.expires = jiffies + fb->cursor.blink_rate;
  397. add_timer(&fb->cursor.timer);
  398. }
  399. static void sbusfb_cursor(struct display *p, int mode, int x, int y)
  400. {
  401. struct fb_info_sbusfb *fb = sbusfbinfod(p);
  402. switch (mode) {
  403. case CM_ERASE:
  404. fb->cursor.mode &= ~CURSOR_BLINK;
  405. fb->cursor.enable = 0;
  406. (*fb->setcursor)(fb);
  407. break;
  408.   
  409. case CM_MOVE:
  410. case CM_DRAW:
  411. if (fb->cursor.mode & CURSOR_SHAPE) {
  412. fb->cursor.size.fbx = fontwidth(p);
  413. fb->cursor.size.fby = fontheight(p);
  414. fb->cursor.chot.fbx = 0;
  415. fb->cursor.chot.fby = 0;
  416. fb->cursor.enable = 1;
  417. memset (fb->cursor.bits, 0, sizeof (fb->cursor.bits));
  418. fb->cursor.bits[0][fontheight(p) - 2] = (0xffffffff << (32 - fontwidth(p)));
  419. fb->cursor.bits[1][fontheight(p) - 2] = (0xffffffff << (32 - fontwidth(p)));
  420. fb->cursor.bits[0][fontheight(p) - 1] = (0xffffffff << (32 - fontwidth(p)));
  421. fb->cursor.bits[1][fontheight(p) - 1] = (0xffffffff << (32 - fontwidth(p)));
  422. (*fb->setcursormap) (fb, hw_cursor_cmap, hw_cursor_cmap, hw_cursor_cmap);
  423. (*fb->setcurshape) (fb);
  424. }
  425. fb->cursor.mode = CURSOR_BLINK;
  426. if (fontwidthlog(p))
  427. fb->cursor.cpos.fbx = (x << fontwidthlog(p)) + fb->x_margin;
  428. else
  429. fb->cursor.cpos.fbx = (x * fontwidth(p)) + fb->x_margin;
  430. if (fontheightlog(p))
  431. fb->cursor.cpos.fby = (y << fontheightlog(p)) + fb->y_margin;
  432. else
  433. fb->cursor.cpos.fby = (y * fontheight(p)) + fb->y_margin;
  434. (*fb->setcursor)(fb);
  435. break;
  436. }
  437. }
  438.     /*
  439.      *  Get the Colormap
  440.      */
  441. static int sbusfb_get_cmap(struct fb_cmap *cmap, int kspc, int con,
  442.  struct fb_info *info)
  443. {
  444. if (!info->display_fg || con == info->display_fg->vc_num) /* current console? */
  445. return fb_get_cmap(cmap, kspc, sbusfb_getcolreg, info);
  446. else if (fb_display[con].cmap.len) /* non default colormap? */
  447. fb_copy_cmap(&fb_display[con].cmap, cmap, kspc ? 0 : 2);
  448. else
  449. fb_copy_cmap(fb_default_cmap(1<<fb_display[con].var.bits_per_pixel), cmap, kspc ? 0 : 2);
  450. return 0;
  451. }
  452.     /*
  453.      *  Set the Colormap
  454.      */
  455. static int sbusfb_set_cmap(struct fb_cmap *cmap, int kspc, int con,
  456.  struct fb_info *info)
  457. {
  458. int err;
  459. struct display *disp;
  460. if (con >= 0)
  461. disp = &fb_display[con];
  462. else
  463. disp = info->disp;
  464. if (!disp->cmap.len) { /* no colormap allocated? */
  465. if ((err = fb_alloc_cmap(&disp->cmap, 1<<disp->var.bits_per_pixel, 0)))
  466. return err;
  467. }
  468. if (con == currcon) { /* current console? */
  469. err = fb_set_cmap(cmap, kspc, sbusfb_setcolreg, info);
  470. if (!err) {
  471. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  472. if (fb->loadcmap)
  473. (*fb->loadcmap)(fb, &fb_display[con], cmap->start, cmap->len);
  474. }
  475. return err;
  476. } else
  477. fb_copy_cmap(cmap, &disp->cmap, kspc ? 0 : 1);
  478. return 0;
  479. }
  480. static int sbusfb_ioctl(struct inode *inode, struct file *file, u_int cmd,
  481. u_long arg, int con, struct fb_info *info)
  482. {
  483. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  484. int i;
  485. int lastconsole;
  486. switch (cmd){
  487. case FBIOGTYPE: /* return frame buffer type */
  488. if (copy_to_user((struct fbtype *)arg, &fb->type, sizeof(struct fbtype)))
  489. return -EFAULT;
  490. break;
  491. case FBIOGATTR: {
  492. struct fbgattr *fba = (struct fbgattr *) arg;
  493. i = verify_area (VERIFY_WRITE, (void *) arg, sizeof (struct fbgattr));
  494. if (i) return i;
  495. if (__put_user(fb->emulations[0], &fba->real_type) ||
  496.     __put_user(0, &fba->owner) ||
  497.     __copy_to_user(&fba->fbtype, &fb->type,
  498.    sizeof(struct fbtype)) ||
  499.     __put_user(0, &fba->sattr.flags) ||
  500.     __put_user(fb->type.fb_type, &fba->sattr.emu_type) ||
  501.     __put_user(-1, &fba->sattr.dev_specific[0]))
  502. return -EFAULT;
  503. for (i = 0; i < 4; i++) {
  504. if (put_user(fb->emulations[i], &fba->emu_types[i]))
  505. return -EFAULT;
  506. }
  507. break;
  508. }
  509. case FBIOSATTR:
  510. i = verify_area (VERIFY_READ, (void *) arg, sizeof (struct fbsattr));
  511. if (i) return i;
  512. return -EINVAL;
  513. case FBIOSVIDEO:
  514. if (fb->consolecnt) {
  515. lastconsole = info->display_fg->vc_num;
  516. if (vt_cons[lastconsole]->vc_mode == KD_TEXT)
  517.   break;
  518.   }
  519. if (get_user(i, (int *)arg))
  520. return -EFAULT;
  521. if (i){
  522. if (!fb->blanked || !fb->unblank)
  523. break;
  524. if (fb->consolecnt || (fb->open && fb->mmaped))
  525. (*fb->unblank)(fb);
  526. fb->blanked = 0;
  527. } else {
  528. if (fb->blanked || !fb->blank)
  529. break;
  530. (*fb->blank)(fb);
  531. fb->blanked = 1;
  532. }
  533. break;
  534. case FBIOGVIDEO:
  535. if (put_user(fb->blanked, (int *) arg))
  536. return -EFAULT;
  537. break;
  538. case FBIOGETCMAP_SPARC: {
  539. char *rp, *gp, *bp;
  540. int end, count, index;
  541. struct fbcmap *cmap;
  542. if (!fb->loadcmap)
  543. return -EINVAL;
  544. i = verify_area (VERIFY_READ, (void *) arg, sizeof (struct fbcmap));
  545. if (i) return i;
  546. cmap = (struct fbcmap *) arg;
  547. if (__get_user(count, &cmap->count) ||
  548.     __get_user(index, &cmap->index))
  549. return -EFAULT;
  550. if ((index < 0) || (index > 255))
  551. return -EINVAL;
  552. if (index + count > 256)
  553. count = 256 - index;
  554. if (__get_user(rp, &cmap->red) ||
  555.     __get_user(gp, &cmap->green) ||
  556.     __get_user(bp, &cmap->blue))
  557. return -EFAULT;
  558. if (verify_area (VERIFY_WRITE, rp, count))
  559. return -EFAULT;
  560. if (verify_area (VERIFY_WRITE, gp, count))
  561. return -EFAULT;
  562. if (verify_area (VERIFY_WRITE, bp, count))
  563. return -EFAULT;
  564. end = index + count;
  565. for (i = index; i < end; i++){
  566. if (__put_user(fb->color_map CM(i,0), rp) ||
  567.     __put_user(fb->color_map CM(i,1), gp) ||
  568.     __put_user(fb->color_map CM(i,2), bp))
  569. return -EFAULT;
  570. rp++; gp++; bp++;
  571. }
  572. (*fb->loadcmap)(fb, NULL, index, count);
  573. break;
  574. }
  575. case FBIOPUTCMAP_SPARC: { /* load color map entries */
  576. char *rp, *gp, *bp;
  577. int end, count, index;
  578. struct fbcmap *cmap;
  579. if (!fb->loadcmap || !fb->color_map)
  580. return -EINVAL;
  581. i = verify_area (VERIFY_READ, (void *) arg, sizeof (struct fbcmap));
  582. if (i) return i;
  583. cmap = (struct fbcmap *) arg;
  584. if (__get_user(count, &cmap->count) ||
  585.     __get_user(index, &cmap->index))
  586. return -EFAULT;
  587. if ((index < 0) || (index > 255))
  588. return -EINVAL;
  589. if (index + count > 256)
  590. count = 256 - index;
  591. if (__get_user(rp, &cmap->red) ||
  592.     __get_user(gp, &cmap->green) ||
  593.     __get_user(bp, &cmap->blue))
  594. return -EFAULT;
  595. if (verify_area (VERIFY_READ, rp, count))
  596. return -EFAULT;
  597. if (verify_area (VERIFY_READ, gp, count))
  598. return -EFAULT;
  599. if (verify_area (VERIFY_READ, bp, count))
  600. return -EFAULT;
  601. end = index + count;
  602. for (i = index; i < end; i++){
  603. if (__get_user(fb->color_map CM(i,0), rp))
  604. return -EFAULT;
  605. if (__get_user(fb->color_map CM(i,1), gp))
  606. return -EFAULT;
  607. if (__get_user(fb->color_map CM(i,2), bp))
  608. return -EFAULT;
  609. rp++; gp++; bp++;
  610. }
  611. (*fb->loadcmap)(fb, NULL, index, count);
  612. break;
  613. }
  614. case FBIOGCURMAX: {
  615. struct fbcurpos *p = (struct fbcurpos *) arg;
  616. if (!fb->setcursor) return -EINVAL;
  617. if(verify_area (VERIFY_WRITE, p, sizeof (struct fbcurpos)))
  618. return -EFAULT;
  619. if (__put_user(fb->cursor.hwsize.fbx, &p->fbx) ||
  620.     __put_user(fb->cursor.hwsize.fby, &p->fby))
  621. return -EFAULT;
  622. break;
  623. }
  624. case FBIOSCURSOR:
  625. if (!fb->setcursor) return -EINVAL;
  626.   if (fb->consolecnt) {
  627.   lastconsole = info->display_fg->vc_num; 
  628.   if (vt_cons[lastconsole]->vc_mode == KD_TEXT)
  629.   return -EINVAL; /* Don't let graphics programs hide our nice text cursor */
  630. fb->cursor.mode = CURSOR_SHAPE; /* Forget state of our text cursor */
  631. }
  632. return sbus_hw_scursor ((struct fbcursor *) arg, fb);
  633. case FBIOSCURPOS:
  634. if (!fb->setcursor) return -EINVAL;
  635. /* Don't let graphics programs move our nice text cursor */
  636.   if (fb->consolecnt) {
  637.   lastconsole = info->display_fg->vc_num; 
  638.   if (vt_cons[lastconsole]->vc_mode == KD_TEXT)
  639.   return -EINVAL; /* Don't let graphics programs move our nice text cursor */
  640.   }
  641. if (copy_from_user(&fb->cursor.cpos, (void *)arg, sizeof(struct fbcurpos)))
  642. return -EFAULT;
  643. (*fb->setcursor) (fb);
  644. break;
  645. default:
  646. if (fb->ioctl)
  647. return fb->ioctl(fb, cmd, arg);
  648. return -EINVAL;
  649. }
  650. return 0;
  651. }
  652.     /*
  653.      *  Setup: parse used options
  654.      */
  655. int __init sbusfb_setup(char *options)
  656. {
  657. char *p;
  658. for (p = options;;) {
  659. if (!strncmp(p, "nomargins", 9)) {
  660. defx_margin = 0; defy_margin = 0;
  661. } else if (!strncmp(p, "margins=", 8)) {
  662. int i, j;
  663. char *q;
  664. i = simple_strtoul(p+8,&q,10);
  665. if (i >= 0 && *q == 'x') {
  666.     j = simple_strtoul(q+1,&q,10);
  667.     if (j >= 0 && (*q == ' ' || !*q)) {
  668.      defx_margin = i; defy_margin = j;
  669.     }
  670. }
  671. } else if (!strncmp(p, "font=", 5)) {
  672. int i;
  673. for (i = 0; i < sizeof(fontname) - 1; i++)
  674. if (p[i+5] == ' ' || !p[i+5])
  675. break;
  676. memcpy(fontname, p+5, i);
  677. fontname[i] = 0;
  678. } else if (!strncmp(p, "noblink", 7))
  679. curblink = 0;
  680. while (*p && *p != ' ' && *p != ',') p++;
  681. if (*p != ',') break;
  682. p++;
  683. }
  684. return 0;
  685. }
  686. static int sbusfbcon_switch(int con, struct fb_info *info)
  687. {
  688. int x_margin, y_margin;
  689. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  690. int lastconsole;
  691.     
  692. /* Do we have to save the colormap? */
  693. if (fb_display[currcon].cmap.len)
  694. fb_get_cmap(&fb_display[currcon].cmap, 1, sbusfb_getcolreg, info);
  695. if (info->display_fg) {
  696. lastconsole = info->display_fg->vc_num;
  697. if (lastconsole != con && 
  698.     (fontwidth(&fb_display[lastconsole]) != fontwidth(&fb_display[con]) ||
  699.      fontheight(&fb_display[lastconsole]) != fontheight(&fb_display[con])))
  700. fb->cursor.mode |= CURSOR_SHAPE;
  701. }
  702. x_margin = (fb_display[con].var.xres_virtual - fb_display[con].var.xres) / 2;
  703. y_margin = (fb_display[con].var.yres_virtual - fb_display[con].var.yres) / 2;
  704. if (fb->margins)
  705. fb->margins(fb, &fb_display[con], x_margin, y_margin);
  706. if (fb->graphmode || fb->x_margin != x_margin || fb->y_margin != y_margin) {
  707. fb->x_margin = x_margin; fb->y_margin = y_margin;
  708. sbusfb_clear_margin(&fb_display[con], 0);
  709. }
  710. currcon = con;
  711. /* Install new colormap */
  712. do_install_cmap(con, info);
  713. return 0;
  714. }
  715.     /*
  716.      *  Update the `var' structure (called by fbcon.c)
  717.      */
  718. static int sbusfbcon_updatevar(int con, struct fb_info *info)
  719. {
  720. /* Nothing */
  721. return 0;
  722. }
  723.     /*
  724.      *  Blank the display.
  725.      */
  726. static void sbusfbcon_blank(int blank, struct fb_info *info)
  727. {
  728.     struct fb_info_sbusfb *fb = sbusfbinfo(info);
  729.     
  730.     if (blank && fb->blank)
  731.      return fb->blank(fb);
  732.     else if (!blank && fb->unblank)
  733.      return fb->unblank(fb);
  734. }
  735.     /*
  736.      *  Read a single color register and split it into
  737.      *  colors/transparent. Return != 0 for invalid regno.
  738.      */
  739. static int sbusfb_getcolreg(u_int regno, u_int *red, u_int *green, u_int *blue,
  740.   u_int *transp, struct fb_info *info)
  741. {
  742. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  743. if (!fb->color_map || regno > 255)
  744. return 1;
  745. *red = (fb->color_map CM(regno, 0)<<8) | fb->color_map CM(regno, 0);
  746. *green = (fb->color_map CM(regno, 1)<<8) | fb->color_map CM(regno, 1);
  747. *blue = (fb->color_map CM(regno, 2)<<8) | fb->color_map CM(regno, 2);
  748. *transp = 0;
  749. return 0;
  750. }
  751.     /*
  752.      *  Set a single color register. The values supplied are already
  753.      *  rounded down to the hardware's capabilities (according to the
  754.      *  entries in the var structure). Return != 0 for invalid regno.
  755.      */
  756. static int sbusfb_setcolreg(u_int regno, u_int red, u_int green, u_int blue,
  757.     u_int transp, struct fb_info *info)
  758. {
  759. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  760. if (!fb->color_map || regno > 255)
  761. return 1;
  762. red >>= 8;
  763. green >>= 8;
  764. blue >>= 8;
  765. fb->color_map CM(regno, 0) = red;
  766. fb->color_map CM(regno, 1) = green;
  767. fb->color_map CM(regno, 2) = blue;
  768. return 0;
  769. }
  770. static void do_install_cmap(int con, struct fb_info *info)
  771. {
  772. struct fb_info_sbusfb *fb = sbusfbinfo(info);
  773. if (con != currcon)
  774. return;
  775. if (fb_display[con].cmap.len)
  776. fb_set_cmap(&fb_display[con].cmap, 1, sbusfb_setcolreg, info);
  777. else
  778. fb_set_cmap(fb_default_cmap(1<<fb_display[con].var.bits_per_pixel),
  779.     1, sbusfb_setcolreg, info);
  780. if (fb->loadcmap)
  781. (*fb->loadcmap)(fb, &fb_display[con], 0, 256);
  782. }
  783. static int sbusfb_set_font(struct display *p, int width, int height)
  784. {
  785. int margin;
  786. int w = p->var.xres_virtual, h = p->var.yres_virtual;
  787. int depth = p->var.bits_per_pixel;
  788. struct fb_info_sbusfb *fb = sbusfbinfod(p);
  789. int x_margin, y_margin;
  790. if (depth > 8) depth = 8;
  791. x_margin = 0;
  792. y_margin = 0;
  793. if (defx_margin < 0 || defy_margin < 0) {
  794. for (margin = 0; def_margins[margin].depth; margin++)
  795. if (w == def_margins[margin].xres &&
  796.     h == def_margins[margin].yres &&
  797.     depth == def_margins[margin].depth) {
  798. x_margin = def_margins[margin].x_margin;
  799. y_margin = def_margins[margin].y_margin;
  800. break;
  801. }
  802. } else {
  803. x_margin = defx_margin;
  804. y_margin = defy_margin;
  805. }
  806. x_margin += ((w - 2*x_margin) % width) / 2;
  807. y_margin += ((h - 2*y_margin) % height) / 2;
  808. p->var.xres = w - 2*x_margin;
  809. p->var.yres = h - 2*y_margin;
  810. fb->cursor.mode |= CURSOR_SHAPE;
  811. if (fb->margins)
  812. fb->margins(fb, p, x_margin, y_margin);
  813. if (fb->x_margin != x_margin || fb->y_margin != y_margin) {
  814. fb->x_margin = x_margin; fb->y_margin = y_margin;
  815. sbusfb_clear_margin(p, 0);
  816. }
  817. return 1;
  818. }
  819. void sbusfb_palette(int enter)
  820. {
  821. int i;
  822. struct display *p;
  823. for (i = 0; i < MAX_NR_CONSOLES; i++) {
  824. p = &fb_display[i];
  825. if (p->dispsw && p->dispsw->setup == sbusfb_disp_setup &&
  826.     p->fb_info->display_fg &&
  827.     p->fb_info->display_fg->vc_num == i) {
  828. struct fb_info_sbusfb *fb = sbusfbinfod(p);
  829. if (fb->restore_palette) {
  830. if (enter)
  831. fb->restore_palette(fb);
  832. else if (vt_cons[i]->vc_mode != KD_GRAPHICS)
  833.          vc_cons[i].d->vc_sw->con_set_palette(vc_cons[i].d, color_table);
  834. }
  835. }
  836. }
  837. }
  838.     /*
  839.      *  Initialisation
  840.      */
  841.      
  842. extern void (*prom_palette)(int);
  843. static void __init sbusfb_init_fb(int node, int parent, int fbtype,
  844.   struct sbus_dev *sbdp)
  845. {
  846. struct fb_fix_screeninfo *fix;
  847. struct fb_var_screeninfo *var;
  848. struct display *disp;
  849. struct fb_info_sbusfb *fb;
  850. struct fbtype *type;
  851. int linebytes, w, h, depth;
  852. char *p = NULL;
  853. int margin;
  854. fb = kmalloc(sizeof(struct fb_info_sbusfb), GFP_ATOMIC);
  855. if (!fb) {
  856. prom_printf("Could not allocate sbusfb structuren");
  857. return;
  858. }
  859. if (!prom_palette)
  860. prom_palette = sbusfb_palette;
  861. memset(fb, 0, sizeof(struct fb_info_sbusfb));
  862. fix = &fb->fix;
  863. var = &fb->var;
  864. disp = &fb->disp;
  865. type = &fb->type;
  866. spin_lock_init(&fb->lock);
  867. fb->prom_node = node;
  868. fb->prom_parent = parent;
  869. fb->sbdp = sbdp;
  870. if (sbdp)
  871. fb->iospace = sbdp->reg_addrs[0].which_io;
  872. type->fb_type = fbtype;
  873. memset(&fb->emulations, 0xff, sizeof(fb->emulations));
  874. fb->emulations[0] = fbtype;
  875. #ifndef __sparc_v9__
  876. disp->screen_base = (unsigned char *)prom_getintdefault(node, "address", 0);
  877. #endif
  878. type->fb_height = h = prom_getintdefault(node, "height", 900);
  879. type->fb_width  = w = prom_getintdefault(node, "width", 1152);
  880. sizechange:
  881. type->fb_depth  = depth = (fbtype == FBTYPE_SUN2BW) ? 1 : 8;
  882. linebytes = prom_getintdefault(node, "linebytes", w * depth / 8);
  883. type->fb_size   = PAGE_ALIGN((linebytes) * h);
  884. if (defx_margin < 0 || defy_margin < 0) {
  885. for (margin = 0; def_margins[margin].depth; margin++)
  886. if (w == def_margins[margin].xres &&
  887.     h == def_margins[margin].yres &&
  888.     depth == def_margins[margin].depth) {
  889. fb->x_margin = def_margins[margin].x_margin;
  890. fb->y_margin = def_margins[margin].y_margin;
  891. break;
  892. }
  893. } else {
  894. fb->x_margin = defx_margin;
  895. fb->y_margin = defy_margin;
  896. }
  897. fb->x_margin += ((w - 2*fb->x_margin) & 7) / 2;
  898. fb->y_margin += ((h - 2*fb->y_margin) & 15) / 2;
  899. var->xres_virtual = w;
  900. var->yres_virtual = h;
  901. var->xres = w - 2*fb->x_margin;
  902. var->yres = h - 2*fb->y_margin;
  903. var->bits_per_pixel = depth;
  904. var->height = var->width = -1;
  905. var->pixclock = 10000;
  906. var->vmode = FB_VMODE_NONINTERLACED;
  907. var->red.length = var->green.length = var->blue.length = 8;
  908. fix->line_length = linebytes;
  909. fix->smem_len = type->fb_size;
  910. fix->type = FB_TYPE_PACKED_PIXELS;
  911. fix->visual = FB_VISUAL_PSEUDOCOLOR;
  912. fb->info.node = -1;
  913. fb->info.fbops = &sbusfb_ops;
  914. fb->info.disp = disp;
  915. strcpy(fb->info.fontname, fontname);
  916. fb->info.changevar = NULL;
  917. fb->info.switch_con = &sbusfbcon_switch;
  918. fb->info.updatevar = &sbusfbcon_updatevar;
  919. fb->info.blank = &sbusfbcon_blank;
  920. fb->info.flags = FBINFO_FLAG_DEFAULT;
  921. fb->cursor.hwsize.fbx = 32;
  922. fb->cursor.hwsize.fby = 32;
  923. if (depth > 1 && !fb->color_map)
  924. fb->color_map = kmalloc(256 * 3, GFP_ATOMIC);
  925. switch(fbtype) {
  926. #ifdef CONFIG_FB_CREATOR
  927. case FBTYPE_CREATOR:
  928. p = creatorfb_init(fb); break;
  929. #endif
  930. #ifdef CONFIG_FB_CGSIX
  931. case FBTYPE_SUNFAST_COLOR:
  932. p = cgsixfb_init(fb); break;
  933. #endif
  934. #ifdef CONFIG_FB_CGTHREE
  935. case FBTYPE_SUN3COLOR:
  936. p = cgthreefb_init(fb); break;
  937. #endif
  938. #ifdef CONFIG_FB_TCX
  939. case FBTYPE_TCXCOLOR:
  940. p = tcxfb_init(fb); break;
  941. #endif
  942. #ifdef CONFIG_FB_LEO
  943. case FBTYPE_SUNLEO:
  944. p = leofb_init(fb); break;
  945. #endif
  946. #ifdef CONFIG_FB_BWTWO
  947. case FBTYPE_SUN2BW:
  948. p = bwtwofb_init(fb); break;
  949. #endif
  950. #ifdef CONFIG_FB_CGFOURTEEN
  951. case FBTYPE_MDICOLOR:
  952. p = cgfourteenfb_init(fb); break;
  953. #endif
  954. #ifdef CONFIG_FB_P9100
  955. case FBTYPE_P9100COLOR:
  956. /* Temporary crock. For now we are a cg3 */
  957. p = p9100fb_init(fb); type->fb_type = FBTYPE_SUN3COLOR; break;
  958. #endif
  959. }
  960. if (!p) {
  961. if (fb->color_map)
  962. kfree(fb->color_map);
  963. kfree(fb);
  964. return;
  965. }
  966. if (p == SBUSFBINIT_SIZECHANGE)
  967. goto sizechange;
  968. disp->dispsw = &fb->dispsw;
  969. if (fb->setcursor) {
  970. fb->dispsw.cursor = sbusfb_cursor;
  971. if (curblink) {
  972. fb->cursor.blink_rate = DEFAULT_CURSOR_BLINK_RATE;
  973. init_timer(&fb->cursor.timer);
  974. fb->cursor.timer.expires = jiffies + fb->cursor.blink_rate;
  975. fb->cursor.timer.data = (unsigned long)fb;
  976. fb->cursor.timer.function = sbusfb_cursor_timer_handler;
  977. add_timer(&fb->cursor.timer);
  978. }
  979. }
  980. fb->cursor.mode = CURSOR_SHAPE;
  981. fb->dispsw.set_font = sbusfb_set_font;
  982. fb->setup = fb->dispsw.setup;
  983. fb->dispsw.setup = sbusfb_disp_setup;
  984. fb->dispsw.clear_margins = NULL;
  985. disp->var = *var;
  986. disp->visual = fix->visual;
  987. disp->type = fix->type;
  988. disp->type_aux = fix->type_aux;
  989. disp->line_length = fix->line_length;
  990. if (fb->blank)
  991. disp->can_soft_blank = 1;
  992. sbusfb_set_var(var, -1, &fb->info);
  993. if (register_framebuffer(&fb->info) < 0) {
  994. if (fb->color_map)
  995. kfree(fb->color_map);
  996. kfree(fb);
  997. return;
  998. }
  999. printk(KERN_INFO "fb%d: %sn", GET_FB_IDX(fb->info.node), p);
  1000. }
  1001. static inline int known_card(char *name)
  1002. {
  1003. char *p;
  1004. for (p = name; *p && *p != ','; p++);
  1005. if (*p == ',') name = p + 1;
  1006. if (!strcmp(name, "cgsix") || !strcmp(name, "cgthree+"))
  1007. return FBTYPE_SUNFAST_COLOR;
  1008. if (!strcmp(name, "cgthree") || !strcmp(name, "cgRDI"))
  1009. return FBTYPE_SUN3COLOR;
  1010. if (!strcmp(name, "cgfourteen"))
  1011. return FBTYPE_MDICOLOR;
  1012. if (!strcmp(name, "leo"))
  1013. return FBTYPE_SUNLEO;
  1014. if (!strcmp(name, "bwtwo"))
  1015. return FBTYPE_SUN2BW;
  1016. if (!strcmp(name, "tcx"))
  1017. return FBTYPE_TCXCOLOR;
  1018. if (!strcmp(name, "p9100"))
  1019. return FBTYPE_P9100COLOR;
  1020. return FBTYPE_NOTYPE;
  1021. }
  1022. #ifdef CONFIG_FB_CREATOR
  1023. static void creator_fb_scan_siblings(int root)
  1024. {
  1025. int node, child;
  1026. child = prom_getchild(root);
  1027. for (node = prom_searchsiblings(child, "SUNW,ffb"); node;
  1028.      node = prom_searchsiblings(prom_getsibling(node), "SUNW,ffb"))
  1029. sbusfb_init_fb(node, root, FBTYPE_CREATOR, NULL);
  1030. for (node = prom_searchsiblings(child, "SUNW,afb"); node;
  1031.      node = prom_searchsiblings(prom_getsibling(node), "SUNW,afb"))
  1032. sbusfb_init_fb(node, root, FBTYPE_CREATOR, NULL);
  1033. }
  1034. static void creator_fb_scan(void)
  1035. {
  1036. int root;
  1037. creator_fb_scan_siblings(prom_root_node);
  1038. root = prom_getchild(prom_root_node);
  1039. for (root = prom_searchsiblings(root, "upa"); root;
  1040.      root = prom_searchsiblings(prom_getsibling(root), "upa"))
  1041. creator_fb_scan_siblings(root);
  1042. }
  1043. #endif
  1044. int __init sbusfb_init(void)
  1045. {
  1046. int type;
  1047. struct sbus_dev *sbdp;
  1048. struct sbus_bus *sbus;
  1049. char prom_name[40];
  1050. extern int con_is_present(void);
  1051. if (!con_is_present()) return -ENXIO;
  1052. #ifdef CONFIG_FB_CREATOR
  1053. creator_fb_scan();
  1054. #endif
  1055. #ifdef CONFIG_SUN4
  1056. sbusfb_init_fb(0, 0, FBTYPE_SUN2BW, NULL);
  1057. #endif
  1058. #if defined(CONFIG_FB_CGFOURTEEN) && !defined(__sparc_v9__)
  1059. {
  1060. int root, node;
  1061. root = prom_getchild(prom_root_node);
  1062. root = prom_searchsiblings(root, "obio");
  1063. if (root && 
  1064.     (node = prom_searchsiblings(prom_getchild(root), "cgfourteen"))) {
  1065. sbusfb_init_fb(node, root, FBTYPE_MDICOLOR, NULL);
  1066. }
  1067. }
  1068. #endif
  1069. if (sbus_root == NULL)
  1070. return 0;
  1071. for_all_sbusdev(sbdp, sbus) {
  1072. type = known_card(sbdp->prom_name);
  1073. if (type == FBTYPE_NOTYPE)
  1074. continue;
  1075. if (prom_getproperty(sbdp->prom_node, "emulation",
  1076.      prom_name, sizeof(prom_name)) > 0) {
  1077. type = known_card(prom_name);
  1078. if (type == FBTYPE_NOTYPE)
  1079. type = known_card(sbdp->prom_name);
  1080. }
  1081. sbusfb_init_fb(sbdp->prom_node, sbdp->bus->prom_node, type, sbdp);
  1082. }
  1083. return 0;
  1084. }
  1085. MODULE_LICENSE("GPL");