Fix bug in ROM vis display of periods on the display

[uccvend-snackrom.git] / ROM2 / display_basic.c

diff --git a/ROM2/display_basic.c b/ROM2/display_basic.c
index 2849696..1d69793 100644 (file)
--- a/ROM2/display_basic.c
+++ b/ROM2/display_basic.c
@@ -15,6 +15,8 @@ void display_reset();
 
 void set_msg(char newmsg[11]) {
        int i;
+       int prevchar = 0;
+
        //display_reset();
        spi_enable();
        for (i=0; i < 10; i++) {
@@ -22,8 +24,32 @@ void set_msg(char newmsg[11]) {
        }
        display_send_byte(0xaf); // reset ptr to start
        for (i--; i >= 0; i--) {
+               if (prevchar && newmsg[i] == 0x2E) {
+                       display_send_byte(newmsg[i]&0x7f);
+                       continue;
+               }
+
+               // check if next character is a period
+               if (newmsg[i] == 0x2E) {
+                       prevchar = newmsg[i];
+                       continue;
+               }
+
+               if (prevchar) {
+                       display_send_byte(newmsg[i]&0x7f);
+                       display_send_byte(prevchar&0x7f);
+                       prevchar = 0;
+                       continue;
+               }
+
+               if (newmsg[i] == 0) break;
+               
                display_send_byte(newmsg[i]&0x7f);
        }
+       
+       if (prevchar) {
+               display_send_byte(prevchar&0x7f);
+       }
        spi_disable();
 }