X-Git-Url: https://git.defcon.no/?a=blobdiff_plain;f=draw.c;h=2fd89b412406574e36fe12e5301453338b3816e1;hb=dbcf64628d09e1f2136e119b3c2d4b0b331416b0;hp=f2355c388d80051735269a6ebee02055c63879e4;hpb=3e082840a952683d929f691852b8fb2830ab7ae9;p=avrfbosd

diff --git a/draw.c b/draw.c
index f2355c3..2fd89b4 100644
--- a/draw.c
+++ b/draw.c
@@ -1,39 +1,40 @@
 #include "draw.h"
 #include <stdlib.h>
+#include "font.h"
 
 extern uint8_t* screen_buffer;
 extern uint8_t hres_bytes;
 
 void sp(uint8_t x, uint8_t y, uint8_t color)
 {
-        if (color==0)      screen_buffer[(x/8) + (y*hres_bytes)] &= ~0x80 >> (x&7);
-        else if (color==1) screen_buffer[(x/8) + (y*hres_bytes)] |=  0x80 >> (x&7);
-        else               screen_buffer[(x/8) + (y*hres_bytes)] ^=  0x80 >> (x&7);
+	if (color==0)      screen_buffer[(x/8) + (y*hres_bytes)] &= ~0x80 >> (x&7);
+	else if (color==1) screen_buffer[(x/8) + (y*hres_bytes)] |=  0x80 >> (x&7);
+	else               screen_buffer[(x/8) + (y*hres_bytes)] ^=  0x80 >> (x&7);
 }
 
 void set_pixel(uint8_t x, uint8_t y, uint8_t color)
 {
-        if (x >= hres_bytes*8 || y >= VRES)
-                return;
-        sp(x,y,color);
+	if (x >= hres_bytes*8 || y >= VRES)
+		return;
+	sp(x,y,color);
 }
 
 void fill(uint8_t color)
 {
-        switch(color) {
-                case c_BLACK:
-                        for (int i = 0; i < (hres_bytes*VRES); i++)
-                                screen_buffer[i] = 0;
-                        break;
-                case c_WHITE:
-                        for (int i = 0; i < (hres_bytes*VRES); i++)
-                                screen_buffer[i] = 0xFF;
-                        break;
-                case c_INVERT:
-                        for (int i = 0; i < (hres_bytes*VRES); i++)
-                                screen_buffer[i] = ~screen_buffer[i];
-                        break;
-        }
+	switch(color) {
+		case c_BLACK:
+			for (int i = 0; i < (hres_bytes*VRES); i++)
+				screen_buffer[i] = 0;
+			break;
+		case c_WHITE:
+			for (int i = 0; i < (hres_bytes*VRES); i++)
+				screen_buffer[i] = 0xFF;
+			break;
+		case c_INVERT:
+			for (int i = 0; i < (hres_bytes*VRES); i++)
+				screen_buffer[i] = ~screen_buffer[i];
+			break;
+	}
 }
 
 
@@ -63,8 +64,8 @@ Bresenham's line algorithm, optimized and simplified.
 void draw_line(uint8_t x0, uint8_t y0, uint8_t x1, uint8_t y1, uint8_t c)
 {
 
-        if (x0 > hres_bytes*8 || y0 > VRES || x1 > hres_bytes*8 || y1 > VRES)
-                return;
+	if (x0 > hres_bytes*8 || y0 > VRES) // || x1 > hres_bytes*8 || y1 > VRES)
+		return;
 
 	int dx, dy, sx, sy, err, p;
 
@@ -77,7 +78,9 @@ void draw_line(uint8_t x0, uint8_t y0, uint8_t x1, uint8_t y1, uint8_t c)
 	while (1)
 	{
 		sp(x0, y0, c);
-	 	if ( ( x0 == x1 ) && ( y0 == y1 ) ) return;
+		if ( ( x0 == x1 ) && ( y0 == y1 ) ) return;
+		if ( x0 > hres_bytes*8  || y0 > VRES ) return;
+		
 		p = 2 * err;
 		if ( p > -dy )
 		{
@@ -118,30 +121,30 @@ void _draw_rect(uint8_t x0, uint8_t y0, uint8_t w, uint8_t h, int8_t c, int8_t f
 
 void _draw_circle(uint8_t x0, uint8_t y0, uint8_t radius, int8_t c, int8_t fc) {
 
-        int f = 1 - radius;
-        int ddF_x = 1;
-        int     ddF_y = -2 * radius;
-        int x = 0;
-        int y = radius;
-        uint8_t pyy = y,pyx = x;
-        
-        //there is a fill color
-        if (fc != -1)
-                draw_row(y0,x0-radius,x0+radius,fc);
-
-        sp(x0, y0 + radius,c);
-        sp(x0, y0 - radius,c);
-        sp(x0 + radius, y0,c);
-        sp(x0 - radius, y0,c);
-        
-        while(x < y) {
-                if(f >= 0) {
-                        y--;
-                        ddF_y += 2;
-                        f += ddF_y;
-                }
-                x++;
-                ddF_x += 2;
+	int f = 1 - radius;
+	int ddF_x = 1;
+	int     ddF_y = -2 * radius;
+	int x = 0;
+	int y = radius;
+	uint8_t pyy = y,pyx = x;
+
+	//there is a fill color
+	if (fc != -1)
+		draw_row(y0,x0-radius,x0+radius,fc);
+
+	sp(x0, y0 + radius,c);
+	sp(x0, y0 - radius,c);
+	sp(x0 + radius, y0,c);
+	sp(x0 - radius, y0,c);
+
+	while(x < y) {
+		if(f >= 0) {
+			y--;
+			ddF_y += 2;
+			f += ddF_y;
+		}
+		x++;
+		ddF_x += 2;
 		f += ddF_x;
 		//there is a fill color
 		if (fc > -1) {
@@ -163,10 +166,10 @@ void _draw_circle(uint8_t x0, uint8_t y0, uint8_t radius, int8_t c, int8_t fc) {
 		sp(x0 + x, y0 - y,c);
 		sp(x0 - x, y0 - y,c);
 		sp(x0 + y, y0 + x,c);
-                sp(x0 - y, y0 + x,c);
-                sp(x0 + y, y0 - x,c);
-                sp(x0 - y, y0 - x,c);
-        }
+		sp(x0 - y, y0 + x,c);
+		sp(x0 + y, y0 - x,c);
+		sp(x0 - y, y0 - x,c);
+	}
 }
 
 void draw_rect(uint8_t x0, uint8_t y0, uint8_t w, uint8_t h, uint8_t c)
@@ -189,4 +192,53 @@ void fill_circle(uint8_t x0, uint8_t y0, uint8_t radius, char c)
 	_draw_circle(x0, y0, radius, c, c);
 }
 
+void draw_8bpp_bitmap( uint8_t pos_x, uint8_t pos_y, uint8_t width, uint8_t height, const uint8_t* image )
+{
+	for ( int v = 0; v < height; v++ )
+	{
+		for ( int h = 0; h < width; h++ )
+		{
+			uint8_t t = image[v*width+h];
+			set_pixel( pos_x + h, pos_y + v, t);
+		}
+	}
+}
+
+void pgm_draw_8bpp_bitmap( uint8_t pos_x, uint8_t pos_y, uint8_t width, uint8_t height, const uint8_t* image )
+{
+	for ( int v = 0; v < height; v++ )
+	{
+		for ( int h = 0; h < width; h++ )
+		{
+			uint8_t t = pgm_read_byte(&(image[v*width+h]));
+			set_pixel( pos_x + h, pos_y + v, t);
+		}
+	}
+}
+
+void draw_char ( uint8_t pos_x, uint8_t pos_y, uint8_t ch)
+{
+	for ( int h = 0; h < font_height; h++ )
+	{
+		uint8_t fl = pgm_read_byte(&( font[ch-32][h]));
+		fl = fl<<(8-font_width);
+		
+		for ( int p = 0; p < font_width; p++ )
+		{
+			uint8_t ft = fl<<p;
+			ft = ft & 0x80;
+			ft = ft>>7;
+			set_pixel( pos_x+p, pos_y+h, ft);
+		}
+	}
+	
+}
+
+void draw_string ( uint8_t pos_x, uint8_t pos_y, const char *text)
+{
+	for (int i = 0; text[i] != 0; i++)
+	{
+		draw_char( pos_x+(font_width*i)+1, pos_y, text[i]);
+	}
+}