X-Git-Url: https://hackdaworld.org/gitweb/?p=my-code%2Farm.git;a=blobdiff_plain;f=betty%2Fdisplay.c;h=bb742415ad3a22f81a9c44566e3da4bd6b08efca;hp=a439fcdff09b4483953574e30d2a8d920300583e;hb=4018a282d71b67d91e37b81edee111ff028d66c2;hpb=8d3d33c4904bfbdc95b290c5e5e6e60c92e30d7a

diff --git a/betty/display.c b/betty/display.c
index a439fcd..bb74241 100644
--- a/betty/display.c
+++ b/betty/display.c
@@ -17,8 +17,8 @@
  */
 
 #include "display.h"
-#include "system.h"
-#include "default_logo.h"
+
+// debug
 #include "uart.h"
 
 /*
@@ -89,21 +89,16 @@ void display_init(void) {
 	DISPLAY_SET_ON;
 }
 
-void display_load_logo(u8 *src) {
+void display_logo(u8 *src) {
 
-	u8 *s;
 	u8 page,width;
 
-	s=src;
-	if(s==0)
-		s=default_logo;
-
 	for(page=0;page<DISPLAY_PAGE_MAX;page++) {
 		DISPLAY_SET_COL_ADDR(0);
 		DISPLAY_SET_PAGE_ADDR(page);
 		for(width=0;width<DISPLAY_DIMX;width++) {
-			DISPLAY_DATA=*s++;
-			DISPLAY_DATA=*s++;
+			DISPLAY_DATA=*src++;
+			DISPLAY_DATA=*src++;
 		}
 	}
 }
@@ -129,9 +124,10 @@ void display_draw_rectangle(u8 x,u8 y,u8 w,u8 h,u8 fill,u8 alpha) {
 			rmax=y+h;
 		for(col=x;col<x+w;col++) {
 			DISPLAY_SET_COL_ADDR(col);
-			d[0]=DISPLAY_DATA;		// dummy read (p.16)
+			d[0]=DISPLAY_DATA; // dummy read (p.16)
 			d[0]=DISPLAY_DATA;
 			d[1]=DISPLAY_DATA;
+			row=DISPLAY_DATA; // aligne
 			for(row=y;row<rmax;row++) {
 				// contribution of b: (255-alpha)*b
 				b=display_m2i(d,row);
@@ -146,17 +142,82 @@ void display_draw_rectangle(u8 x,u8 y,u8 w,u8 h,u8 fill,u8 alpha) {
 				d[1]|=(c&1)<<row;
 			}
 			DISPLAY_SET_COL_ADDR(col);
-			DISPLAY_DATA=b[0];
-			DISPLAY_DATA=b[1];
+			DISPLAY_DATA=d[0];
+			DISPLAY_DATA=d[1];
 		}
 		h-=(rmax-y);
 		y=rmax;
 	}
 }
 
+void display_rectangle_page(u8 x,u8 p,u8 w,u8 h,u8 fill,u8 alpha) {
+
+	u8 page,col,row;
+	u8 buf[2];
+	u8 b,c;
+
+	for(page=p;page<p+h;page++) {
+		DISPLAY_SET_PAGE_ADDR(page);
+		for(col=x;col<x+w;col++) {
+			DISPLAY_SET_COL_ADDR(col);
+			buf[0]=DISPLAY_DATA; // dummy read
+			buf[0]=DISPLAY_DATA;
+			buf[1]=DISPLAY_DATA;
+			row=DISPLAY_DATA; // aligne dummy read
+			for(row=0;row<8;row++) {
+				b=display_m2i(buf,row);
+				c=(b*(255-alpha)+fill*255)>>8;
+				buf[0]&=~(1<<row);
+				buf[1]&=~(1<<row);
+				if(c&2)
+					buf[0]|=(1<<row);
+				if(c&1)
+					buf[1]|=(1<<row);
+			}
+			DISPLAY_SET_COL_ADDR(col);
+			DISPLAY_DATA=buf[0];
+			DISPLAY_DATA=buf[1];
+		}
+	}
+}
+
+void display_font_page(u8 x,u8 page,u8 *font,u8 fill) {
+
+	/* this only draws page aligned fonts! */
+	u8 cnt,row;
+	u8 c[16];
+
+	/* set the page */
+	DISPLAY_SET_PAGE_ADDR(page);
+
+	/* read old content */
+	DISPLAY_SET_COL_ADDR(x);
+	c[0]=DISPLAY_DATA; // dummy read
+	for(cnt=0;cnt<16;cnt++) {
+		c[cnt++]=DISPLAY_DATA;
+		c[cnt]=DISPLAY_DATA;
+	}
+	cnt=DISPLAY_DATA; // 2 byte aligne dummy read
+
+	/* write new content */
+	DISPLAY_SET_COL_ADDR(x);
+	for(cnt=0;cnt<16;cnt++) {
+		for(row=0;row<8;row++) {
+			if((font[cnt>>1]>>row)&1) {
+				c[cnt]&=~(1<<row);
+				c[cnt+1]&=~(1<<row);
+				c[cnt]|=(((fill>>1)&1)<<row);
+				c[cnt+1]|=((fill&1)<<row);
+			}
+		}
+		DISPLAY_DATA=c[cnt++];
+		DISPLAY_DATA=c[cnt];
+	}
+}
+
 void display_draw_font(u8 x,u8 y,u8 *font,u8 fill,u8 alpha) {
 
-	u8 page,col,row,rmax,cnt,left;
+	u8 page,col,row,rmax,cnt,left,cf,rf;
 	u8 d[2];
 	int ca,cb;
 	u8 a,b,c;			// c = a over b
@@ -197,8 +258,8 @@ void display_draw_font(u8 x,u8 y,u8 *font,u8 fill,u8 alpha) {
 				rf+=1;
 			}
 			DISPLAY_SET_COL_ADDR(col);
-			DISPLAY_DATA=b[0];
-			DISPLAY_DATA=b[1];
+			DISPLAY_DATA=d[0];
+			DISPLAY_DATA=d[1];
 			cf+=1;
 		}
 		left-=(rmax-y);
@@ -206,26 +267,6 @@ void display_draw_font(u8 x,u8 y,u8 *font,u8 fill,u8 alpha) {
 	}
 }
 
-void display_draw_buf(u8 x,u8 y,u8 w,u8 h,u8 *buf,u8 alpha) {
-
-	u8 page,col,row,rmax,cnt;
-	u8 d[2];
-	int ca,cb;
-	u8 a,b,c;
-
-	for(page=(y>>3);page<=((y+h)>>3);page++) {
-		DISPLAY_SET_PAGE_ADDR(page);
-		for(col=x;col<x+w;col++) {
-			DISPLAY_SET_COL_ADDR(col);
-			d[0]=DISPLAY_DATA;
-			d[0]=DISPLAY_DATA;
-			d[1]=DISPLAY_DATA;
-			for(row=y;row<rmax;row++) {
-			}
-		}
-	}
-}
-
 void display_bl_init(void) {
 
 	IODIR0|=(1<<4);