开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
fbcon-cfb32.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：9k
源码类别：

嵌入式Linux

开发平台：

Unix_Linux

fbcon-cfb32.c：源码内容
  1. /*
  2.  *  linux/drivers/video/cfb32.c -- Low level frame buffer operations for 32 bpp
  3.  *    truecolor packed pixels
  4.  *
  5.  * Created 28 Dec 1997 by Geert Uytterhoeven
  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.  */
  12. #include <linux/module.h>
  13. #include <linux/tty.h>
  14. #include <linux/console.h>
  15. #include <linux/string.h>
  16. #include <linux/fb.h>
  18. #include <video/fbcon.h>
  19. #include <video/fbcon-cfb32.h>
  22.     /*
  23.      *  32 bpp packed pixels
  24.      */
  26. void fbcon_cfb32_setup(struct display *p)
  27. {
  28.     p->next_line = p->line_length ? p->line_length : p->var.xres_virtual<<2;
  29.     p->next_plane = 0;
  30. }
  32. void fbcon_cfb32_bmove(struct display *p, int sy, int sx, int dy, int dx,
  33.        int height, int width)
  34. {
  35.     int bytes = p->next_line, linesize = bytes * fontheight(p), rows;
  36.     u8 *src, *dst;
  38.     if (sx == 0 && dx == 0 && width * fontwidth(p) * 4 == bytes) {
  39. fb_memmove(p->screen_base + dy * linesize,
  40.   p->screen_base + sy * linesize,
  41.   height * linesize);
  42. return;
  43.     }
  44.     if (fontwidthlog(p)) {
  45. sx <<= fontwidthlog(p)+2;
  46. dx <<= fontwidthlog(p)+2;
  47. width <<= fontwidthlog(p)+2;
  48.     } else {
  49. sx *= fontwidth(p)*4;
  50. dx *= fontwidth(p)*4;
  51. width *= fontwidth(p)*4;
  52.     }
  53.     if (dy < sy || (dy == sy && dx < sx)) {
  54. src = p->screen_base + sy * linesize + sx;
  55. dst = p->screen_base + dy * linesize + dx;
  56. for (rows = height * fontheight(p); rows--;) {
  57.     fb_memmove(dst, src, width);
  58.     src += bytes;
  59.     dst += bytes;
  60. }
  61.     } else {
  62. src = p->screen_base + (sy+height) * linesize + sx - bytes;
  63. dst = p->screen_base + (dy+height) * linesize + dx - bytes;
  64. for (rows = height * fontheight(p); rows--;) {
  65.     fb_memmove(dst, src, width);
  66.     src -= bytes;
  67.     dst -= bytes;
  68. }
  69.     }
  70. }
  72. static inline void rectfill(u8 *dest, int width, int height, u32 data,
  73.     int linesize)
  74. {
  75.     int i;
  77.     while (height-- > 0) {
  78. u32 *p = (u32 *)dest;
  79. for (i = 0; i < width/4; i++) {
  80.     fb_writel(data, p++);
  81.     fb_writel(data, p++);
  82.     fb_writel(data, p++);
  83.     fb_writel(data, p++);
  84. }
  85. if (width & 2) {
  86.     fb_writel(data, p++);
  87.     fb_writel(data, p++);
  88. }
  89. if (width & 1)
  90.     fb_writel(data, p++);
  91. dest += linesize;
  92.     }
  93. }
  95. void fbcon_cfb32_clear(struct vc_data *conp, struct display *p, int sy, int sx,
  96.        int height, int width)
  97. {
  98.     u8 *dest;
  99.     int bytes = p->next_line, lines = height * fontheight(p);
  100.     u32 bgx;
  102.     dest = p->screen_base + sy * fontheight(p) * bytes + sx * fontwidth(p) * 4;
  104.     bgx = ((u32 *)p->dispsw_data)[attr_bgcol_ec(p, conp)];
  106.     width *= fontwidth(p)/4;
  107.     if (width * 16 == bytes)
  108. rectfill(dest, lines * width * 4, 1, bgx, bytes);
  109.     else
  110. rectfill(dest, width * 4, lines, bgx, bytes);
  111. }
  113. void fbcon_cfb32_putc(struct vc_data *conp, struct display *p, int c, int yy,
  114.       int xx)
  115. {
  116.     u8 *dest, *cdat, bits;
  117.     int bytes = p->next_line, rows;
  118.     u32 eorx, fgx, bgx, *pt;
  120.     dest = p->screen_base + yy * fontheight(p) * bytes + xx * fontwidth(p) * 4;
  121.     if (fontwidth(p) <= 8)
  122. cdat = p->fontdata + (c & p->charmask) * fontheight(p);
  123.     else
  124. cdat = p->fontdata + ((c & p->charmask) * fontheight(p) << 1);
  125.     fgx = ((u32 *)p->dispsw_data)[attr_fgcol(p, c)];
  126.     bgx = ((u32 *)p->dispsw_data)[attr_bgcol(p, c)];
  127.     eorx = fgx ^ bgx;
  129.     for (rows = fontheight(p); rows--; dest += bytes) {
  130. bits = *cdat++;
  131. pt = (u32 *) dest;
  132. fb_writel((-(bits >> 7) & eorx) ^ bgx, pt++);
  133. fb_writel((-(bits >> 6 & 1) & eorx) ^ bgx, pt++);
  134. fb_writel((-(bits >> 5 & 1) & eorx) ^ bgx, pt++);
  135. fb_writel((-(bits >> 4 & 1) & eorx) ^ bgx, pt++);
  136. if (fontwidth(p) < 8)
  137.     continue;
  138. fb_writel((-(bits >> 3 & 1) & eorx) ^ bgx, pt++);
  139. fb_writel((-(bits >> 2 & 1) & eorx) ^ bgx, pt++);
  140. fb_writel((-(bits >> 1 & 1) & eorx) ^ bgx, pt++);
  141. fb_writel((-(bits & 1) & eorx) ^ bgx, pt++);
  142. if (fontwidth(p) < 12)
  143.     continue;
  144. bits = *cdat++;
  145. fb_writel((-(bits >> 7) & eorx) ^ bgx, pt++);
  146. fb_writel((-(bits >> 6 & 1) & eorx) ^ bgx, pt++);
  147. fb_writel((-(bits >> 5 & 1) & eorx) ^ bgx, pt++);
  148. fb_writel((-(bits >> 4 & 1) & eorx) ^ bgx, pt++);
  149. if (fontwidth(p) < 16)
  150.     continue;
  151. fb_writel((-(bits >> 3 & 1) & eorx) ^ bgx, pt++);
  152. fb_writel((-(bits >> 2 & 1) & eorx) ^ bgx, pt++);
  153. fb_writel((-(bits >> 1 & 1) & eorx) ^ bgx, pt++);
  154. fb_writel((-(bits & 1) & eorx) ^ bgx, pt++);
  155.     }
  156. }
  158. void fbcon_cfb32_putcs(struct vc_data *conp, struct display *p,
  159.        const unsigned short *s, int count, int yy, int xx)
  160. {
  161.     u8 *cdat, *dest, *dest0, bits;
  162.     u16 c;
  163.     int rows, bytes = p->next_line;
  164.     u32 eorx, fgx, bgx, *pt;
  166.     dest0 = p->screen_base + yy * fontheight(p) * bytes + xx * fontwidth(p) * 4;
  167.     c = scr_readw(s);
  168.     fgx = ((u32 *)p->dispsw_data)[attr_fgcol(p, c)];
  169.     bgx = ((u32 *)p->dispsw_data)[attr_bgcol(p, c)];
  170.     eorx = fgx ^ bgx;
  171.     while (count--) {
  172. c = scr_readw(s++) & p->charmask;
  173. if (fontwidth(p) <= 8)
  174.     cdat = p->fontdata + c * fontheight(p);
  175. else
  176.     cdat = p->fontdata + (c * fontheight(p) << 1);
  177. for (rows = fontheight(p), dest = dest0; rows--; dest += bytes) {
  178.     bits = *cdat++;
  179.     pt = (u32 *) dest;
  180.     fb_writel((-(bits >> 7) & eorx) ^ bgx, pt++);
  181.     fb_writel((-(bits >> 6 & 1) & eorx) ^ bgx, pt++);
  182.     fb_writel((-(bits >> 5 & 1) & eorx) ^ bgx, pt++);
  183.     fb_writel((-(bits >> 4 & 1) & eorx) ^ bgx, pt++);
  184.     if (fontwidth(p) < 8)
  185. continue;
  186.     fb_writel((-(bits >> 3 & 1) & eorx) ^ bgx, pt++);
  187.     fb_writel((-(bits >> 2 & 1) & eorx) ^ bgx, pt++);
  188.     fb_writel((-(bits >> 1 & 1) & eorx) ^ bgx, pt++);
  189.     fb_writel((-(bits & 1) & eorx) ^ bgx, pt++);
  190.     if (fontwidth(p) < 12)
  191. continue;
  192.     bits = *cdat++;
  193.     fb_writel((-(bits >> 7) & eorx) ^ bgx, pt++);
  194.     fb_writel((-(bits >> 6 & 1) & eorx) ^ bgx, pt++);
  195.     fb_writel((-(bits >> 5 & 1) & eorx) ^ bgx, pt++);
  196.     fb_writel((-(bits >> 4 & 1) & eorx) ^ bgx, pt++);
  197.     if (fontwidth(p) < 16)
  198. continue;
  199.     fb_writel((-(bits >> 3 & 1) & eorx) ^ bgx, pt++);
  200.     fb_writel((-(bits >> 2 & 1) & eorx) ^ bgx, pt++);
  201.     fb_writel((-(bits >> 1 & 1) & eorx) ^ bgx, pt++);
  202.     fb_writel((-(bits & 1) & eorx) ^ bgx, pt++);
  203. }
  204. dest0 += fontwidth(p)*4;
  205.     }
  206. }
  208. void fbcon_cfb32_revc(struct display *p, int xx, int yy)
  209. {
  210.     u8 *dest;
  211.     int bytes = p->next_line, rows;
  213.     dest = p->screen_base + yy * fontheight(p) * bytes + xx * fontwidth(p) * 4;
  214.     for (rows = fontheight(p); rows--; dest += bytes) {
  215. switch (fontwidth(p)) {
  216. case 16:
  217.     fb_writel(fb_readl(dest+(4*12)) ^ 0xffffffff, dest+(4*12));
  218.     fb_writel(fb_readl(dest+(4*13)) ^ 0xffffffff, dest+(4*13));
  219.     fb_writel(fb_readl(dest+(4*14)) ^ 0xffffffff, dest+(4*14));
  220.     fb_writel(fb_readl(dest+(4*15)) ^ 0xffffffff, dest+(4*15));
  221.     /* FALL THROUGH */
  222. case 12:
  223.     fb_writel(fb_readl(dest+(4*8)) ^ 0xffffffff, dest+(4*8));
  224.     fb_writel(fb_readl(dest+(4*9)) ^ 0xffffffff, dest+(4*9));
  225.     fb_writel(fb_readl(dest+(4*10)) ^ 0xffffffff, dest+(4*10));
  226.     fb_writel(fb_readl(dest+(4*11)) ^ 0xffffffff, dest+(4*11));
  227.     /* FALL THROUGH */
  228. case 8:
  229.     fb_writel(fb_readl(dest+(4*4)) ^ 0xffffffff, dest+(4*4));
  230.     fb_writel(fb_readl(dest+(4*5)) ^ 0xffffffff, dest+(4*5));
  231.     fb_writel(fb_readl(dest+(4*6)) ^ 0xffffffff, dest+(4*6));
  232.     fb_writel(fb_readl(dest+(4*7)) ^ 0xffffffff, dest+(4*7));
  233.     /* FALL THROUGH */
  234. case 4:
  235.     fb_writel(fb_readl(dest+(4*0)) ^ 0xffffffff, dest+(4*0));
  236.     fb_writel(fb_readl(dest+(4*1)) ^ 0xffffffff, dest+(4*1));
  237.     fb_writel(fb_readl(dest+(4*2)) ^ 0xffffffff, dest+(4*2));
  238.     fb_writel(fb_readl(dest+(4*3)) ^ 0xffffffff, dest+(4*3));
  239.     /* FALL THROUGH */
  240. }
  241.     }
  242. }
  244. void fbcon_cfb32_clear_margins(struct vc_data *conp, struct display *p,
  245.        int bottom_only)
  246. {
  247.     int bytes = p->next_line;
  248.     u32 bgx;
  250.     unsigned int right_start = conp->vc_cols*fontwidth(p);
  251.     unsigned int bottom_start = conp->vc_rows*fontheight(p);
  252.     unsigned int right_width, bottom_width;
  254.     bgx = ((u32 *)p->dispsw_data)[attr_bgcol_ec(p, conp)];
  256.     if (!bottom_only && (right_width = p->var.xres-right_start))
  257. rectfill(p->screen_base+right_start*4, right_width,
  258.  p->var.yres_virtual, bgx, bytes);
  259.     if ((bottom_width = p->var.yres-bottom_start))
  260. rectfill(p->screen_base+(p->var.yoffset+bottom_start)*bytes,
  261.  right_start, bottom_width, bgx, bytes);
  262. }
  265.     /*
  266.      *  `switch' for the low level operations
  267.      */
  269. struct display_switch fbcon_cfb32 = {
  270.     setup: fbcon_cfb32_setup,
  271.     bmove: fbcon_cfb32_bmove,
  272.     clear: fbcon_cfb32_clear,
  273.     putc: fbcon_cfb32_putc,
  274.     putcs: fbcon_cfb32_putcs,
  275.     revc: fbcon_cfb32_revc,
  276.     clear_margins: fbcon_cfb32_clear_margins,
  277.     fontwidthmask: FONTWIDTH(4)|FONTWIDTH(8)|FONTWIDTH(12)|FONTWIDTH(16)
  278. };
  281. #ifdef MODULE
  282. MODULE_LICENSE("GPL");
  284. int init_module(void)
  285. {
  286.     return 0;
  287. }
  289. void cleanup_module(void)
  290. {}
  291. #endif /* MODULE */
  294.     /*
  295.      *  Visible symbols for modules
  296.      */
  298. EXPORT_SYMBOL(fbcon_cfb32);
  299. EXPORT_SYMBOL(fbcon_cfb32_setup);
  300. EXPORT_SYMBOL(fbcon_cfb32_bmove);
  301. EXPORT_SYMBOL(fbcon_cfb32_clear);
  302. EXPORT_SYMBOL(fbcon_cfb32_putc);
  303. EXPORT_SYMBOL(fbcon_cfb32_putcs);
  304. EXPORT_SYMBOL(fbcon_cfb32_revc);
  305. EXPORT_SYMBOL(fbcon_cfb32_clear_margins);