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

diff --git a/betty/display.c b/betty/display.c
index 210cd17..71791fc 100644
--- a/betty/display.c
+++ b/betty/display.c
@@ -6,20 +6,86 @@
  */
 
 #include "display.h"
+#include "system.h"
+#include "default_logo.h"
+#include "uart.h"
 
 /*
  * functions
  */
 
+void display_clear_screen(void) {
+
+	u32 cnt;
+
+	DISPLAY_SET_PAGE_ADDR(0);
+	DISPLAY_SET_C_ADDR(0);
+
+	for(cnt=0;cnt<DISPLAY_RAM_CONTENT;cnt++)
+		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_UW_CORNER(0x1c,0x0a);
+	DISPLAY_SET_LW_CORNER(0x75,0x81);
+
+	DISPLAY_SET_PWM_FRC(0,0);
+
+	DISPLAY_SET_WHITE(0,0,0,0);
+	DISPLAY_SET_LGRAY(4,4,4,4);
+	DISPLAY_SET_DGRAY(6,6,6,6);
+	DISPLAY_SET_BLACK(9,9,9,9);
+
+	DISPLAY_SET_SEGMENT_REMAP_00H;
+	DISPLAY_SET_COM_ODIR_REMAPPED;
+
+	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) {
+
+	u32 cnt;
+	u8 *s;
+
+	s=src;
+	if(s==0)
+		s=default_logo;
+
+	DISPLAY_SET_PAGE_ADDR(0);
+	DISPLAY_SET_C_ADDR(0);
+
+	for(cnt=0;cnt<DISPLAY_RAM_CONTENT;cnt++)
+		DISPLAY_DATA=s[cnt];
 }
 
 void display_bl_init(void) {
 
-	PINSEL0&=~(1<<9|(1<<8));
 	IODIR0|=(1<<4);
+	IOSET0=(1<<4);	// off by default
 }
 
 void display_bl_toggle(void) {