1 files changed, 39 insertions, 0 deletions

diff --git a/src/inc/spi/dev/display_dogm.c b/src/inc/spi/dev/display_dogm.c
new file mode 100755
index 0000000..a655769
--- /dev/null
+++ b/src/inc/spi/dev/display_dogm.c
@@ -0,0 +1,39 @@
+#include "display_dogm.h"
+
+void display_dogm_init()
+{
+  //DDRA |= (1<<PA7); // activate portA for display
+  //DDRC |= (1<<PC7); // activate portC for display
+  DDRD  |= (1<<PD7) | (1<<PD6);
+  PORTD |= (1<<PD7) | (1<<PD6);
+
+  // Wait time >40mS after VDD stable
+  _delay_ms(50); // 10ms for safty
+
+  display_dogm_exec(CMD_FUNCTION_SET);
+  display_dogm_exec(CMD_FUNCTION_SET);
+  display_dogm_exec(CMD_CONTRAST_SET);
+  display_dogm_exec(CMD_POWER_CONTROL);
+  display_dogm_exec(CMD_FOLLOWER_CONTROL);
+  display_dogm_exec(CMD_DISPLAY_ONOFF);
+  display_dogm_exec(CMD_ENTRY_MODE_SET);
+  display_dogm_exec(CMD_DISPLAY_CLEAR);
+}
+
+void display_dogm_putc(char c)
+{
+  PORTD &= ~(1<<PD7); // chip select: activate display
+  PORTD |=  (1<<PD6); // L=Commandmode, H=Datamode
+  spi_putc(c);
+  _delay_us(40);      // try and error value (you get chinese chars? increase!)
+  PORTD |=  (1<<PD7); // chip select: deactivate display
+}
+
+void display_dogm_exec(char c)
+{
+  PORTD &= ~(1<<PD7); // chip select: activate display
+  PORTD &= ~(1<<PD6); // L=Commandmode, H=Datamode
+  spi_putc(c);
+  _delay_ms(4);       // time the longest command takes on display
+  PORTD |=  (1<<PD7); // chip select: deactivate display
+}