| 0,0 → 1,241 |
|---|
| #include "glib.h" |
| #include <stdlib.h> |
| |
| #include "../vga.h" |
| |
| #define fontaddr 0xffa6eL /* indirizzo set caratteri */ |
| |
| BYTE * flbaddr; |
| WORD bpr; |
| WORD height, width; |
| |
| inline void memsetw(void *dst, unsigned int c, unsigned long int memdiv2) |
| { |
| __asm__ __volatile__("push %%edi |
| push %%eax |
| push %%ecx |
| movl %2, %%edi |
| cld |
| rep |
| stosw |
| pop %%ecx |
| pop %%eax |
| pop %%edi" |
| : |
| : "c" (memdiv2), "a" (c), "b" (dst)); |
| |
| } |
| |
| |
| static void circlepixels(WORD x, WORD y, WORD sx, WORD sy, DWORD c) |
| { |
| grx_plot(sx + x, sy + y, c); |
| grx_plot(sx - x, sy + y, c); |
| grx_plot(sx + x, sy - y, c); |
| grx_plot(sx - x, sy - y, c); |
| grx_plot(sx + y, sy + x, c); |
| grx_plot(sx - y, sy + x, c); |
| grx_plot(sx + y, sy - x, c); |
| grx_plot(sx - y, sy - x, c); |
| } |
| |
| void grx_circle(WORD sx, WORD sy, WORD r, DWORD c) |
| { |
| int x, y, d; |
| |
| if (r < 1) { |
| grx_plot(sx, sy, c); |
| return; |
| } |
| x = 0; |
| y = r; |
| d = 1 - r; |
| circlepixels(x, y, sx, sy, c); |
| while (x < y) { |
| if (d < 0) |
| d += x * 2 + 3; |
| else { |
| d += x * 2 - y * 2 + 5; |
| y--; |
| } |
| x++; |
| circlepixels(x, y, sx, sy, c); |
| } |
| } |
| |
| /* grx_disc by Massy */ |
| |
| static __inline__ void discpixels(WORD x, WORD y, WORD sx, WORD sy, DWORD c) |
| { |
| grx_line(sx + x, sy + y, sx + x, sy - y, c); |
| grx_line(sx - x, sy + y, sx - x, sy - y, c); |
| grx_line(sx + y, sy + x, sx + y, sy - x , c); |
| grx_line(sx - y, sy + x, sx - y, sy - x , c); |
| } |
| |
| void grx_disc(WORD sx, WORD sy, WORD r, DWORD c) |
| { |
| int x, y, d; |
| |
| if (r < 1) { |
| grx_plot(sx, sy, c); |
| return; |
| } |
| x = 0; |
| y = r; |
| d = 1 - r; |
| discpixels(x, y, sx, sy, c); |
| while (x < y) { |
| if (d < 0) |
| d += x * 2 + 3; |
| else { |
| d += x * 2 - y * 2 + 5; |
| y--; |
| } |
| x++; |
| discpixels(x, y, sx, sy, c); |
| } |
| } |
| |
| int grx_setbuffer(BYTE *vbuf, WORD w, WORD h) |
| { |
| |
| //This functions are designed to work only whit 16 bpp |
| |
| flbaddr = vbuf; |
| width = w; |
| height = h; |
| bpr = 2 * w; |
| |
| return 1; |
| |
| } |
| |
| void grx_clear(DWORD color) |
| { |
| |
| grx_box(0, 0, width, height, color); |
| |
| } |
| |
| void grx_putimage(WORD x1, WORD y1, WORD x2, WORD y2, BYTE *buf) |
| { |
| |
| } |
| |
| void grx_box(WORD x1, WORD y1, WORD x2, WORD y2, DWORD color) |
| { |
| BYTE * addr; |
| int dx, y; |
| |
| addr = flbaddr + (x1 << 1) + bpr * y1; |
| dx = (x2 - x1 + 1) << 1; |
| |
| for (y = y1; y <= y2; y++) { |
| memsetw(addr,color,(dx>>1)); |
| addr += bpr; |
| } |
| } |
| |
| void grx_rect(WORD x1, WORD y1, WORD x2, WORD y2, DWORD color) |
| { |
| BYTE * addr; |
| int dx, y; |
| |
| addr = flbaddr + (x1 << 1) + bpr * y1; |
| dx = (x2 - x1) << 1; |
| |
| memsetw(addr,color,(dx>>1)+1); |
| addr += bpr; |
| |
| for (y = y1 + 1; y <= y2 - 1; y++) { |
| *(WORD *)(addr) = (WORD)(color); |
| *(WORD *)(addr + dx) = (WORD)(color); |
| addr += bpr; |
| } |
| memsetw(addr,color,(dx>>1)+1); |
| |
| } |
| |
| void grx_text(char *text, WORD x, WORD y, DWORD fg, DWORD bg) |
| { |
| BYTE * fp; |
| BYTE * addr; |
| int r, c, bits; |
| |
| addr = flbaddr; |
| while (*text) { |
| fp = (BYTE *)(fontaddr + (8 * *(BYTE *)text)); |
| for (r=0; r<8; r++) { |
| bits = *(BYTE *)(fp++); |
| for (c=0; c<8; c++) |
| if (bits & (0x80>>c)) |
| *(WORD *)(addr + (y + r) * bpr + ((x + c) << 1)) = (WORD)(fg); |
| else |
| *(WORD *)(addr + (y + r) * bpr + ((x + c) << 1)) = (WORD)(bg); |
| } |
| text++; |
| x += 8; |
| } |
| } |
| |
| void grx_line(WORD x1, WORD y1, WORD x2, WORD y2, DWORD color) |
| { |
| register int t, distance; |
| BYTE * addr; |
| int xerr=0, yerr=0, deltax, deltay; |
| int incx, incy; |
| |
| addr = flbaddr;; |
| deltax = x2 - x1; /* compute both distances */ |
| deltay = y2 - y1; |
| |
| if (deltax > 0) /* compute increments */ |
| incx = 1; |
| else if (deltax == 0) |
| incx = 0; |
| else |
| incx = -1; |
| |
| if (deltay > 0) |
| incy = 1; |
| else if (deltay == 0) |
| incy = 0; |
| else |
| incy = -1; |
| |
| deltax = abs(deltax); /* determine greater distance */ |
| deltay = abs(deltay); |
| if (deltax > deltay) |
| distance = deltax; |
| else |
| distance = deltay; |
| |
| for (t=0; t<=distance+1; t++) { /* draw the line */ |
| *(WORD *)(addr + y1 * bpr + (x1 << 1)) = (WORD)color; |
| xerr += deltax; |
| yerr += deltay; |
| if (xerr > distance) { |
| xerr -= distance; |
| x1 += incx; |
| } |
| if (yerr > distance) { |
| yerr -= distance; |
| y1 += incy; |
| } |
| } |
| } |
| |
| void grx_plot(WORD x, WORD y, DWORD color) |
| { |
| *(WORD *)(flbaddr + y * bpr + (x << 1)) = (WORD)color; |
| } |
| |
| DWORD grx_getpixel(WORD x, WORD y) |
| { |
| DWORD rv; |
| |
| (DWORD)rv = *(WORD *)(flbaddr + y * bpr + (x << 1)); |
| return rv; |
| } |
| |