34,33 → 34,93 |
|
SPINLOCK_INITIALIZE(fb_lock); |
|
static unsigned char *fbaddress=NULL; |
static __u8 *fbaddress=NULL; |
static int xres,yres; |
static int position=0; |
static int columns=0; |
static int rows=0; |
static int pixelbytes=0; |
|
#define COL_WIDTH 8 |
#define ROW_HEIGHT (FONT_SCANLINES) |
#define ROW_PIX (xres*ROW_HEIGHT*3) |
#define ROW_PIX (xres*ROW_HEIGHT*pixelbytes) |
|
#define BGCOLOR 0x000080 |
#define FGCOLOR 0xffff00 |
|
#define RED(x) ((x >> 16) & 0xff) |
#define GREEN(x) ((x >> 8) & 0xff) |
#define BLUE(x) (x & 0xff) |
#define RED(x,bits) ((x >> (16+8-bits)) & ((1<<bits)-1)) |
#define GREEN(x,bits) ((x >> (8+8-bits)) & ((1<<bits)-1)) |
#define BLUE(x,bits) ((x >> (8-bits)) & ((1<<bits)-1)) |
|
#define POINTPOS(x,y,colidx) ((y*xres+x)*3+colidx) |
#define POINTPOS(x,y) ((y*xres+x)*pixelbytes) |
|
/***************************************************************/ |
/* Pixel specific fuctions */ |
|
/** Draw pixel of given color on screen */ |
static inline void putpixel(int x,int y,int color) |
{ |
fbaddress[POINTPOS(x,y,0)] = RED(color); |
fbaddress[POINTPOS(x,y,1)] = GREEN(color); |
fbaddress[POINTPOS(x,y,2)] = BLUE(color); |
int startbyte = POINTPOS(x,y); |
|
if (pixelbytes == 3) { |
fbaddress[startbyte] = RED(color,8); |
fbaddress[startbyte+1] = GREEN(color,8); |
fbaddress[startbyte+2] = BLUE(color,8); |
} else if (pixelbytes == 4) { |
*((__u32 *)(fbaddress+startbyte)) = color; |
} else { |
int compcolor; |
/* 5-bit, 5-bits, 5-bits */ |
compcolor = RED(color,5) << 10 \ |
| GREEN(color,5) << 5 \ |
| BLUE(color,5); |
*((__u16 *)(fbaddress+startbyte)) = compcolor; |
} |
} |
|
/** Return pixel color */ |
static inline int getpixel(int x,int y) |
{ |
int startbyte = POINTPOS(x,y); |
int color; |
int result; |
|
if (pixelbytes == 3) { |
result = fbaddress[startbyte] << 16 \ |
| fbaddress[startbyte+1] << 8 \ |
| fbaddress[startbyte+2]; |
} else if (pixelbytes == 4) { |
result = *((__u32 *)(fbaddress+startbyte)) & 0xffffff; |
} else { |
int red,green,blue; |
color = *((__u16 *)(fbaddress+startbyte)); |
red = (color >> 10) & 0x1f; |
green = (color >> 5) & 0x1f; |
blue = color & 0x1f; |
result = (red << 16) | (green << 8) | blue; |
} |
return result; |
} |
|
static void clear_line(int y); |
/** Scroll screen one row up */ |
static void scroll_screen(void) |
{ |
int i; |
|
for (i=0;i < (xres*yres*pixelbytes)-ROW_PIX; i++) |
fbaddress[i] = fbaddress[i+ROW_PIX]; |
|
/* Clear last row */ |
for (i=0; i < ROW_HEIGHT;i++) |
clear_line((rows-1)*ROW_HEIGHT+i); |
|
} |
|
|
/***************************************************************/ |
/* Screen specific function */ |
|
/** Fill line with color BGCOLOR */ |
static void clear_line(int y) |
{ |
80,25 → 140,10 |
|
static void invert_pixel(int x, int y) |
{ |
fbaddress[POINTPOS(x,y,0)] = ~fbaddress[POINTPOS(x,y,0)]; |
fbaddress[POINTPOS(x,y,1)] = ~fbaddress[POINTPOS(x,y,1)]; |
fbaddress[POINTPOS(x,y,2)] = ~fbaddress[POINTPOS(x,y,2)]; |
putpixel(x,y, ~getpixel(x,y)); |
} |
|
/** Scroll screen one row up */ |
static void scroll_screen(void) |
{ |
int i; |
|
for (i=0;i < (xres*yres*3)-ROW_PIX; i++) |
fbaddress[i] = fbaddress[i+ROW_PIX]; |
|
/* Clear last row */ |
for (i=0; i < ROW_HEIGHT;i++) |
clear_line((rows-1)*ROW_HEIGHT+i); |
|
} |
|
/** Draw one line of glyph at a given position */ |
static void draw_glyph_line(int glline, int x, int y) |
{ |
111,8 → 156,11 |
putpixel(x+i,y,BGCOLOR); |
} |
|
/***************************************************************/ |
/* Character-console functions */ |
|
/** Draw character at given position */ |
static void draw_glyph(unsigned char glyph, int col, int row) |
static void draw_glyph(__u8 glyph, int col, int row) |
{ |
int y; |
|
137,6 → 185,9 |
draw_glyph(chr, position % columns, position/columns); |
} |
|
/***************************************************************/ |
/* Stdout specific functions */ |
|
static void invert_cursor(void) |
{ |
invert_char(position % columns, position/columns); |
161,6 → 212,12 |
invert_cursor(); |
if (position % columns) |
position--; |
} else if (ch == '\t') { |
invert_cursor(); |
do { |
draw_char(' '); |
position++; |
} while (position % 8); |
} else { |
draw_char(ch); |
position++; |
184,13 → 241,15 |
* @param addr Address of framebuffer |
* @param x X resolution |
* @param y Y resolution |
* @param bytes Bytes per pixel (2,3,4) |
*/ |
void fb_init(__address addr, int x, int y) |
void fb_init(__address addr, int x, int y, int bytes) |
{ |
fbaddress = (unsigned char *)addr; |
|
xres = x; |
yres = y; |
pixelbytes = bytes; |
|
rows = y/ROW_HEIGHT; |
columns = x/COL_WIDTH; |