+ 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,cf,rf;
+ u8 d[2];
+ int ca,cb;
+ u8 a,b,c; // c = a over b
+
+ left=8;
+
+ a=fill&0x03;
+ ca=0;
+ for(cnt=0;cnt<a;cnt++) // contribution of a: alpha*a
+ ca+=alpha;
+
+ for(page=(y>>3);page<=((y+8)>>3);page++) { // page = y/8
+ DISPLAY_SET_PAGE_ADDR(page);
+ rmax=(page+1)<<3; // row max
+ if(rmax>y+left)
+ rmax=y+left;
+ cf=0;
+ for(col=x;col<x+8;col++) {
+ DISPLAY_SET_COL_ADDR(col);
+ d[0]=DISPLAY_DATA; // dummy read (p.16)
+ d[0]=DISPLAY_DATA;
+ d[1]=DISPLAY_DATA;
+ rf=0;
+ for(row=y;row<rmax;row++) {
+ // contribution of b: (255-alpha)*b
+ b=display_m2i(d,row);
+ cb=0;
+ for(cnt=0;cnt<b;cnt++)
+ cb+=(255-alpha);
+ // finally there is c
+ if((font[cf]>>row)&1) {
+ c=(ca+cb)>>8;
+ d[0]&=~(1<<row);
+ d[1]&=~(1<<row);
+ d[0]|=((c>>1)&1)<<row;
+ d[1]|=(c&1)<<row;
+ }
+ rf+=1;