compilation errors fixed, debug now!

[my-code/arm.git] / betty / display.c

diff --git a/betty/display.c b/betty/display.c
index a439fcd..46e8480 100644 (file)
--- 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*alpha)>>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);