X-Git-Url: https://hackdaworld.org/gitweb/?a=blobdiff_plain;f=betty%2Fdisplay.c;h=e102141d2a562ce4d7a87cea7c902fac3dbf832d;hb=b02acd993d27fd99503d9c9c53e10b19ec1c207c;hp=210cd17766cb92358a9736f7228ac29f0f166492;hpb=94909b5b893d5c60bc44bbafec8de1b3c86d9595;p=my-code%2Farm.git

diff --git a/betty/display.c b/betty/display.c
index 210cd17..e102141 100644
--- a/betty/display.c
+++ b/betty/display.c
@@ -6,20 +6,90 @@
  */
 
 #include "display.h"
+#include "system.h"
+#include "default_logo.h"
+#include "uart.h"
 
 /*
  * functions
  */
 
+void display_clear_screen(void) {
+
+	u8 page,width;
+
+	for(page=0;page<DISPLAY_PAGE_MAX;page++) {
+		DISPLAY_SET_C_ADDR(0);
+		DISPLAY_SET_PAGE_ADDR(page);
+		for(width=0;width<DISPLAY_DIMX;width++) {
+			DISPLAY_DATA=0x00;
+			DISPLAY_DATA=0x00;
+		}
+	}
+}
+
 void display_init(void) {
 
-	BCFG1=0x00000c42;
+	DISPLAY_EXIT_POWER_SAVE;
+
+	DISPLAY_SOFT_RESET;
+	pause(0xffffff);
+
+	DISPLAY_START_OSCILLATOR;
+
+	DISPLAY_SET_REGULATOR(7);
+
+	DISPLAY_SET_CONTRAST(0x38);
+
+	DISPLAY_SET_CONV_FACTOR(0x01);
+
+	DISPLAY_SET_PWM_FRC(0,0);
+
+	// gray scale palette
+	DISPLAY_SET_WHITE(0,0,0,0);
+	DISPLAY_SET_LGRAY(2,2,2,2);
+	DISPLAY_SET_DGRAY(6,6,6,6);
+	DISPLAY_SET_BLACK(9,9,9,9);
+
+	DISPLAY_SET_POWER(DISPLAY_REGULATOR|DISPLAY_OPAMP);
+	pause(0xffffff);
+	DISPLAY_SET_POWER(DISPLAY_V_BOOST|DISPLAY_REGULATOR|DISPLAY_OPAMP);
+	
+	DISPLAY_RAM_CONTENTS_ON;
+
+	DISPLAY_NORMAL;
+
+	display_clear_screen();
+
+	DISPLAY_SET_ON;
+}
+
+void display_load_logo(u8 *src) {
+
+	u8 *s;
+	u8 page,width;
+	u32 cnt;
+
+	s=src;
+	if(s==0)
+		s=default_logo;
+
+	cnt=0;
+	for(page=0;page<DISPLAY_PAGE_MAX;page++) {
+		DISPLAY_SET_C_ADDR(0);
+		DISPLAY_SET_PAGE_ADDR(page);
+		for(width=0;width<DISPLAY_DIMX;width++) {
+			DISPLAY_DATA=s[cnt];
+			DISPLAY_DATA=s[cnt+1];
+			cnt+=2;
+		}
+	}
 }
 
 void display_bl_init(void) {
 
-	PINSEL0&=~(1<<9|(1<<8));
 	IODIR0|=(1<<4);
+	IOSET0=(1<<4);	// off by default
 }
 
 void display_bl_toggle(void) {