diff --git a/display/software/.idea/workspace.xml b/display/software/.idea/workspace.xml
index 0a3a506..f1e4220 100644
--- a/display/software/.idea/workspace.xml
+++ b/display/software/.idea/workspace.xml
@@ -1,17 +1,18 @@
 <?xml version="1.0" encoding="UTF-8"?>
 <project version="4">
   <component name="ChangeListManager">
-    <list default="true" id="9fad4545-a424-4a82-86dc-76602cf3eef3" name="Default" comment="">
+    <list default="true" id="9fad4545-a424-4a82-86dc-76602cf3eef3" name="Default" comment="began working on actual code for parsing values from uart&#10;not working yet!">
       <change type="MODIFICATION" beforePath="$PROJECT_DIR$/displayboard/src/main.c" afterPath="$PROJECT_DIR$/displayboard/src/main.c" />
       <change type="MODIFICATION" beforePath="$PROJECT_DIR$/.idea/workspace.xml" afterPath="$PROJECT_DIR$/.idea/workspace.xml" />
     </list>
     <ignored path="bikegenerator.iws" />
     <ignored path=".idea/workspace.xml" />
     <file path="/Makefile" changelist="9fad4545-a424-4a82-86dc-76602cf3eef3" time="1371032328243" ignored="false" />
-    <file path="/Dummy.txt" changelist="9fad4545-a424-4a82-86dc-76602cf3eef3" time="1371215015916" ignored="false" />
-    <file path="/main.c" changelist="9fad4545-a424-4a82-86dc-76602cf3eef3" time="1371210598726" ignored="false" />
+    <file path="/Dummy.txt" changelist="9fad4545-a424-4a82-86dc-76602cf3eef3" time="1371242759237" ignored="false" />
+    <file path="/main.c" changelist="9fad4545-a424-4a82-86dc-76602cf3eef3" time="1371243598804" ignored="false" />
     <file path="/uart.c" changelist="9fad4545-a424-4a82-86dc-76602cf3eef3" time="1371164805619" ignored="false" />
     <file path="/a.java" changelist="9fad4545-a424-4a82-86dc-76602cf3eef3" time="1371206947114" ignored="false" />
+    <file path="/utils.c" changelist="9fad4545-a424-4a82-86dc-76602cf3eef3" time="1371240856046" ignored="false" />
     <option name="TRACKING_ENABLED" value="true" />
     <option name="SHOW_DIALOG" value="false" />
     <option name="HIGHLIGHT_CONFLICTS" value="true" />
@@ -75,25 +76,20 @@
       <file leaf-file-name="main.c" pinned="false" current="true" current-in-tab="true">
         <entry file="file://$PROJECT_DIR$/displayboard/src/main.c">
           <provider selected="true" editor-type-id="text-editor">
-            <state line="135" column="8" selection-start="3155" selection-end="3155" vertical-scroll-proportion="1.2080537">
-              <folding />
+            <state line="198" column="6" selection-start="4939" selection-end="4939" vertical-scroll-proportion="1.4441965">
+              <folding>
+                <element signature="n#{&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}#0;n#static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}#0;n#const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t digitbuffer[6] = { 0,0,0,0,0,0 };&#10;volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0" expanded="false" />
+                <element signature="n#{&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}#0;n#static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}#0;n#const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t digitbuffer[6] = { 0,0,0,0,0,0 };&#10;volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0" expanded="false" />
+                <element signature="n#{&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}#0;n#static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}#0;n#const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t digitbuffer[6] = { 0,0,0,0,0,0 };&#10;volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0" expanded="false" />
+              </folding>
             </state>
           </provider>
         </entry>
       </file>
-      <file leaf-file-name="uart.c" pinned="false" current="false" current-in-tab="false">
-        <entry file="file://$PROJECT_DIR$/displayboard/src/uart.c">
+      <file leaf-file-name="main.c" pinned="false" current="false" current-in-tab="false">
+        <entry file="file://$PROJECT_DIR$/powerboard/src/main.c">
           <provider selected="true" editor-type-id="text-editor">
-            <state line="479" column="0" selection-start="15703" selection-end="15703" vertical-scroll-proportion="0.0">
-              <folding />
-            </state>
-          </provider>
-        </entry>
-      </file>
-      <file leaf-file-name="main.h" pinned="false" current="false" current-in-tab="false">
-        <entry file="file://$PROJECT_DIR$/displayboard/src/main.h">
-          <provider selected="true" editor-type-id="text-editor">
-            <state line="6" column="20" selection-start="117" selection-end="125" vertical-scroll-proportion="0.0">
+            <state line="56" column="0" selection-start="1379" selection-end="2104" vertical-scroll-proportion="0.0">
               <folding />
             </state>
           </provider>
@@ -127,11 +123,11 @@
         <option value="$PROJECT_DIR$/displayboard/src/main.h" />
         <option value="$PROJECT_DIR$/displayboard/src/uart.h" />
         <option value="$PROJECT_DIR$/powerboard/src/main.h" />
-        <option value="$PROJECT_DIR$/powerboard/src/utils.h" />
-        <option value="$PROJECT_DIR$/powerboard/src/utils.c" />
         <option value="$PROJECT_DIR$/powerboard/Makefile" />
-        <option value="$PROJECT_DIR$/powerboard/src/main.c" />
         <option value="$PROJECT_DIR$/displayboard/src/uart.c" />
+        <option value="$PROJECT_DIR$/powerboard/src/utils.c" />
+        <option value="$PROJECT_DIR$/powerboard/src/utils.h" />
+        <option value="$PROJECT_DIR$/powerboard/src/main.c" />
         <option value="$PROJECT_DIR$/displayboard/src/main.c" />
       </list>
     </option>
@@ -277,8 +273,8 @@
     <property name="restartRequiresConfirmation" value="true" />
     <property name="MemberChooser.showClasses" value="true" />
     <property name="GoToClass.includeLibraries" value="false" />
-    <property name="options.splitter.details.proportions" value="0.2" />
     <property name="options.searchVisible" value="true" />
+    <property name="options.splitter.details.proportions" value="0.2" />
   </component>
   <component name="RecentsManager">
     <key name="CopyFile.RECENT_KEYS">
@@ -303,19 +299,6 @@
       <option name="PORT" value="5005" />
       <method />
     </configuration>
-    <configuration default="true" type="Applet" factoryName="Applet">
-      <module name="" />
-      <option name="MAIN_CLASS_NAME" />
-      <option name="HTML_FILE_NAME" />
-      <option name="HTML_USED" value="false" />
-      <option name="WIDTH" value="400" />
-      <option name="HEIGHT" value="300" />
-      <option name="POLICY_FILE" value="$APPLICATION_HOME_DIR$/bin/appletviewer.policy" />
-      <option name="VM_PARAMETERS" />
-      <option name="ALTERNATIVE_JRE_PATH_ENABLED" value="false" />
-      <option name="ALTERNATIVE_JRE_PATH" />
-      <method />
-    </configuration>
     <configuration default="true" type="TestNG" factoryName="TestNG">
       <extension name="coverage" enabled="false" merge="false" sample_coverage="true" runner="idea" />
       <module name="" />
@@ -344,6 +327,19 @@
       <listeners />
       <method />
     </configuration>
+    <configuration default="true" type="Applet" factoryName="Applet">
+      <module name="" />
+      <option name="MAIN_CLASS_NAME" />
+      <option name="HTML_FILE_NAME" />
+      <option name="HTML_USED" value="false" />
+      <option name="WIDTH" value="400" />
+      <option name="HEIGHT" value="300" />
+      <option name="POLICY_FILE" value="$APPLICATION_HOME_DIR$/bin/appletviewer.policy" />
+      <option name="VM_PARAMETERS" />
+      <option name="ALTERNATIVE_JRE_PATH_ENABLED" value="false" />
+      <option name="ALTERNATIVE_JRE_PATH" />
+      <method />
+    </configuration>
     <configuration default="true" type="Application" factoryName="Application">
       <extension name="coverage" enabled="false" merge="false" sample_coverage="true" runner="idea" />
       <option name="MAIN_CLASS_NAME" />
@@ -457,14 +453,22 @@
       <created>1371215016953</created>
       <updated>1371215016953</updated>
     </task>
-    <option name="localTasksCounter" value="12" />
+    <task id="LOCAL-00012" summary="began working on actual code for parsing values from uart&#10;not working yet!">
+      <created>1371215050508</created>
+      <updated>1371215050508</updated>
+    </task>
+    <task id="LOCAL-00013" summary="changed currents to unsigned int and checked while getting these values.">
+      <created>1371242761894</created>
+      <updated>1371242761894</updated>
+    </task>
+    <option name="localTasksCounter" value="14" />
     <servers />
   </component>
   <component name="ToolWindowManager">
     <frame x="-4" y="25" width="1608" height="853" extended-state="6" />
     <editor active="false" />
     <layout>
-      <window_info id="Changes" active="true" anchor="bottom" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="true" weight="0.32670453" sideWeight="0.5" order="11" side_tool="false" content_ui="tabs" />
+      <window_info id="Changes" active="true" anchor="bottom" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="true" weight="0.3252841" sideWeight="0.5" order="11" side_tool="false" content_ui="tabs" />
       <window_info id="Palette" active="false" anchor="right" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="false" weight="0.33" sideWeight="0.5" order="3" side_tool="false" content_ui="tabs" />
       <window_info id="Ant Build" active="false" anchor="right" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="false" weight="0.25" sideWeight="0.5" order="1" side_tool="false" content_ui="tabs" />
       <window_info id="Database" active="false" anchor="right" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="false" weight="0.33" sideWeight="0.5" order="6" side_tool="false" content_ui="tabs" />
@@ -479,7 +483,7 @@
       <window_info id="Maven Projects" active="false" anchor="right" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="false" weight="0.33" sideWeight="0.5" order="5" side_tool="false" content_ui="tabs" />
       <window_info id="Commander" active="false" anchor="right" auto_hide="false" internal_type="SLIDING" type="SLIDING" visible="false" weight="0.4" sideWeight="0.5" order="0" side_tool="false" content_ui="tabs" />
       <window_info id="Application Servers" active="false" anchor="bottom" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="false" weight="0.33" sideWeight="0.5" order="10" side_tool="false" content_ui="tabs" />
-      <window_info id="Project" active="false" anchor="left" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="true" weight="0.3011583" sideWeight="0.67329544" order="0" side_tool="false" content_ui="combo" />
+      <window_info id="Project" active="false" anchor="left" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="true" weight="0.3011583" sideWeight="0.67471594" order="0" side_tool="false" content_ui="combo" />
       <window_info id="Run" active="false" anchor="bottom" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="false" weight="0.33" sideWeight="0.5" order="3" side_tool="false" content_ui="tabs" />
       <window_info id="Cvs" active="false" anchor="bottom" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="false" weight="0.25" sideWeight="0.5" order="5" side_tool="false" content_ui="tabs" />
       <window_info id="Message" active="false" anchor="bottom" auto_hide="false" internal_type="DOCKED" type="DOCKED" visible="false" weight="0.33" sideWeight="0.5" order="1" side_tool="false" content_ui="tabs" />
@@ -530,7 +534,7 @@
     <option name="WRAP_WHEN_TYPING_REACHES_RIGHT_MARGIN" value="false" />
     <option name="FORCE_NON_EMPTY_COMMENT" value="false" />
     <option name="CLEAR_INITIAL_COMMIT_MESSAGE" value="false" />
-    <option name="LAST_COMMIT_MESSAGE" value="removed unnecessary uart1 code" />
+    <option name="LAST_COMMIT_MESSAGE" value="changed currents to unsigned int and checked while getting these values." />
     <option name="MAKE_NEW_CHANGELIST_ACTIVE" value="false" />
     <option name="OPTIMIZE_IMPORTS_BEFORE_PROJECT_COMMIT" value="false" />
     <option name="CHECK_FILES_UP_TO_DATE_BEFORE_COMMIT" value="false" />
@@ -555,6 +559,8 @@
     <MESSAGE value="minor changes, made counters 8bit" />
     <MESSAGE value="changed power to 16bit&#10;added output of relais states" />
     <MESSAGE value="removed unnecessary uart1 code" />
+    <MESSAGE value="began working on actual code for parsing values from uart&#10;not working yet!" />
+    <MESSAGE value="changed currents to unsigned int and checked while getting these values." />
   </component>
   <component name="XDebuggerManager">
     <breakpoint-manager />
@@ -594,21 +600,11 @@
         <state line="30" column="22" selection-start="656" selection-end="673" vertical-scroll-proportion="0.66273934" />
       </provider>
     </entry>
-    <entry file="file://$PROJECT_DIR$/powerboard/src/utils.h">
-      <provider selected="true" editor-type-id="text-editor">
-        <state line="5" column="40" selection-start="150" selection-end="150" vertical-scroll-proportion="0.16703786" />
-      </provider>
-    </entry>
     <entry file="file://$PROJECT_DIR$/powerboard/Makefile">
       <provider selected="true" editor-type-id="text-editor">
         <state line="62" column="28" selection-start="1637" selection-end="1637" vertical-scroll-proportion="0.33407572" />
       </provider>
     </entry>
-    <entry file="file://$PROJECT_DIR$/powerboard/src/utils.c">
-      <provider selected="true" editor-type-id="text-editor">
-        <state line="21" column="28" selection-start="449" selection-end="449" vertical-scroll-proportion="0.26726058" />
-      </provider>
-    </entry>
     <entry file="file://$PROJECT_DIR$/powerboard/src/main.h">
       <provider selected="true" editor-type-id="text-editor">
         <state line="23" column="31" selection-start="648" selection-end="648" vertical-scroll-proportion="0.66592425">
@@ -621,38 +617,54 @@
         <state line="21" column="22" selection-start="465" selection-end="465" vertical-scroll-proportion="-0.70469797" />
       </provider>
     </entry>
-    <entry file="file://$PROJECT_DIR$/powerboard/src/main.c">
+    <entry file="file://$PROJECT_DIR$/displayboard/src/uart.h">
       <provider selected="true" editor-type-id="text-editor">
-        <state line="47" column="6" selection-start="1206" selection-end="1206" vertical-scroll-proportion="-3.6577182">
+        <state line="141" column="11" selection-start="5298" selection-end="5298" vertical-scroll-proportion="-0.40939596" />
+      </provider>
+    </entry>
+    <entry file="file://$PROJECT_DIR$/powerboard/src/utils.h">
+      <provider selected="true" editor-type-id="text-editor">
+        <state line="5" column="44" selection-start="154" selection-end="154" vertical-scroll-proportion="0.110456556">
+          <folding />
+        </state>
+      </provider>
+    </entry>
+    <entry file="file://$PROJECT_DIR$/powerboard/src/utils.c">
+      <provider selected="true" editor-type-id="text-editor">
+        <state line="26" column="0" selection-start="548" selection-end="548" vertical-scroll-proportion="0.5743741">
           <folding />
         </state>
       </provider>
     </entry>
     <entry file="file://$PROJECT_DIR$/displayboard/src/main.h">
       <provider selected="true" editor-type-id="text-editor">
-        <state line="6" column="20" selection-start="117" selection-end="125" vertical-scroll-proportion="0.0">
+        <state line="6" column="20" selection-start="117" selection-end="125" vertical-scroll-proportion="0.13254787">
           <folding />
         </state>
       </provider>
     </entry>
     <entry file="file://$PROJECT_DIR$/displayboard/src/uart.c">
       <provider selected="true" editor-type-id="text-editor">
-        <state line="479" column="0" selection-start="15703" selection-end="15703" vertical-scroll-proportion="0.0">
+        <state line="479" column="0" selection-start="15703" selection-end="15703" vertical-scroll-proportion="1.5405406">
           <folding />
         </state>
       </provider>
     </entry>
-    <entry file="file://$PROJECT_DIR$/displayboard/src/uart.h">
+    <entry file="file://$PROJECT_DIR$/powerboard/src/main.c">
       <provider selected="true" editor-type-id="text-editor">
-        <state line="141" column="11" selection-start="5298" selection-end="5298" vertical-scroll-proportion="-0.40939596">
+        <state line="56" column="0" selection-start="1379" selection-end="2104" vertical-scroll-proportion="0.0">
           <folding />
         </state>
       </provider>
     </entry>
     <entry file="file://$PROJECT_DIR$/displayboard/src/main.c">
       <provider selected="true" editor-type-id="text-editor">
-        <state line="135" column="8" selection-start="3155" selection-end="3155" vertical-scroll-proportion="1.2080537">
-          <folding />
+        <state line="198" column="6" selection-start="4939" selection-end="4939" vertical-scroll-proportion="1.4441965">
+          <folding>
+            <element signature="n#{&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}#0;n#static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}#0;n#const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t digitbuffer[6] = { 0,0,0,0,0,0 };&#10;volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0" expanded="false" />
+            <element signature="n#{&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}#0;n#static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}#0;n#const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t digitbuffer[6] = { 0,0,0,0,0,0 };&#10;volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0" expanded="false" />
+            <element signature="n#{&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}#0;n#static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}#0;n#const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0;n#volatile uint8_t digitbuffer[6] = { 0,0,0,0,0,0 };&#10;volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };&#10;uint8_t digit = 0;&#10;uint8_t leddigit = 0;&#10;&#10;// values send over uart from powerboard&#10;uint16_t voltage = 0;&#10;int16_t current_in = 0;&#10;int16_t current_out = 0;&#10;uint8_t dumpsw = 0; //TODO: make bitfield&#10;uint8_t loadsw = 0; //TODO: make bitfield&#10;uint8_t gensw = 0;  //TODO: make bitfield&#10;&#10;uint16_t power_gen = 0;&#10;uint16_t power_load = 0;&#10;&#10;unsigned char data_count = 0;&#10;unsigned char data_in[BUFSIZE];&#10;char command_in[BUFSIZE];&#10;&#10;const uint8_t digit_translate[10] = {&#10;    63, 6, 91, 79, 102, 109, 125, 7, 127, 111&#10;};&#10;&#10;&#10;static void timer_init(void) {&#10;&#9;// clock is 8MHz&#10;&#9;TCCR1B |= _BV(WGM12) | _BV(CS11) | _BV(CS10) ; // CTC Mode for Timer 1 (16Bit) with prescale of 64&#10;&#9;OCR1A   = 250;    // 500Hz&#10;&#9;TIMSK   = _BV(OCIE1A);&#10;&#9;sei();&#9;// enable interrupts&#10;}&#10;&#10;static void ports_init(void) {&#10;    // make column / digit driver pins to output&#10;    LEDDIG_DDR |= _BV(LEDS_MID1) | _BV(LEDS_MID2) | _BV(LEDS_LOAD) | _BV(LEDS_GEN);&#10;    SEVENSEGDIG_DDR |= _BV(DIG0) | _BV(DIG1) | _BV(DIG2) | _BV(DIG3) | _BV(DIG4) | _BV(DIG5);&#10;&#10;    // make data ports to output&#10;    LED_DDR = 0xff;&#10;    SEVENSEG_DDR = 0xff;&#10;&#10;    SEVENSEGDIG_PORT = 0;&#10;    SEVENSEG_PORT = 0;&#10;&#10;    LEDDIG_PORT = 0;&#10;    LED_PORT = 0;&#10;}&#10;&#10;static void print_sevenseg(uint8_t display, uint16_t value) {&#10;    uint8_t d[3];&#10;    d[2] = (value % 1000 / 100 );&#10;    d[1] = (value % 100 / 10 );&#10;    d[0] = (value % 10);&#10;&#10;    if(display == 0) {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i] = digit_translate[d[i]];&#10;        }&#10;    } else {&#10;        for(uint8_t i = 0; i&lt; 3; i++) {&#10;           digitbuffer[i+3] = digit_translate[d[i]];&#10;        }&#10;    }&#10;}&#10;&#10;#ifdef DEBUG&#10;void pretty_print_all_values(void) {&#10;    uart_puts_P(&quot;Voltage:   &quot;);&#10;    uart_print_uint16(voltage);&#10;    uart_puts_P(&quot;mV\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Load:      &quot;);&#10;    uart_print_uint16(current_out);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_load);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;Generator: &quot;);&#10;    uart_print_uint16(current_in);&#10;    uart_puts_P(&quot;mA  &quot;);&#10;    uart_print_uint16( power_gen);&#10;    uart_puts_P(&quot;W\r\n&quot;);&#10;&#10;    uart_puts_P(&quot;switches (load, dump, gen): &quot;);&#10;    uart_putc(48 + loadsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + dumpsw);&#10;    uart_putc(',');&#10;    uart_putc(48 + gensw);&#10;    uart_puts_P(&quot;\r\n&quot;);&#10;}&#10;#endif&#10;&#10;void process_command() {&#10;    if(strstr(command_in,&quot;A&quot;) != NULL) {&#10;        // we have an A and B (from check in work_uart()&#10;        // so our message should be complete and consist of:&#10;        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n&#10;&#10;        //A12.5,65464,00000,00000,00000,1,0,1B&#10;&#10;        char *token;&#10;        uint8_t tokencounter = 0;&#10;&#10;        char *start = strrchr(command_in, 'A');&#10;&#10;        // remove first (B is ignored by atoi)&#10;        start++;&#10;&#10;#ifdef DEBUG&#10;        uart_puts_P(&quot;from start: &quot;);&#10;        uart_puts(start);&#10;        uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;        token = strtok(start, &quot;,&quot;);&#10;&#10;        while( token ) {&#10;#ifdef DEBUG&#10;            uart_puts_P(&quot;token= &quot;);&#10;            uart_puts(token);&#10;            uart_puts_P(&quot;\r\n&quot;);&#10;#endif&#10;&#10;            switch(tokencounter) {&#10;                case 0:&#10;                    voltage = atoi(token);&#10;                    break;&#10;                case 1:&#10;                    current_in = atoi(token);&#10;                    break;&#10;                case 2:&#10;                    current_out = atoi(token);&#10;                    break;&#10;                case 3:&#10;                    power_gen = atoi(token);&#10;                    break;&#10;                case 4:&#10;                    power_load = atoi(token);&#10;                    break;&#10;                case 5:&#10;                    if(atoi(token) == 1) loadsw = 1;&#10;                    else loadsw = 0;&#10;                    break;&#10;                case 6:&#10;                    if(atoi(token) == 1) dumpsw = 1;&#10;                    else dumpsw = 0;&#10;                    break;&#10;                case 7:&#10;                    if(atoi(token) == 1) gensw = 1;&#10;                    else gensw = 0;&#10;                    break;&#10;            }&#10;&#10;            tokencounter++;&#10;            token = strtok(NULL, &quot;,&quot;);&#10;        }&#10;#ifdef DEBUG&#10;        pretty_print_all_values();&#10;#endif&#10;&#10;    }&#10;}&#10;&#10;void work_uart(){&#10;    unsigned int c = uart_getc();&#10;&#10;    if ( !(c &amp; UART_NO_DATA) ) {&#10;&#10;        data_in[data_count] = c;&#10;&#10;        if (data_in[data_count] == 'B') {  // finish reading when newline is received&#10;            data_count = 0;&#10;&#10;            memcpy(command_in, data_in, BUFSIZE);&#10;&#10;            // Now clear data_in, the UART can reuse it now&#10;            memset(data_in, 0, BUFSIZE);&#10;&#10;            process_command();&#10;        } else {&#10;            data_count++;&#10;        }&#10;    }&#10;}&#10;&#10;&#10;&#10;&#10;int main(void) {&#10;&#9;ports_init();&#10;&#9;timer_init();&#10;    uart_init(UART_BAUD_SELECT(19200,F_CPU));&#10;    memset(data_in, 0, BUFSIZE);&#10;&#10;&#9;while(1) {&#10;&#10;&#9;    work_uart();&#10;&#10;        if(syscounter &gt;= 200) {&#10;            uart_putc('a'); // send a to receive values&#10;&#10;            print_sevenseg(0, power_gen);&#10;            print_sevenseg(1, power_load);&#10;&#10;            syscounter = 0;&#10;        }&#10;&#9;}&#10;&#9;&#10;&#9;return(0);&#10;}&#10;&#10;// system timer&#10;SIGNAL(TIMER1_COMPA_vect) {&#10;&#9;syscounter++;&#10;&#10;&#9;// output to sevensegment and leds&#10;&#9;// make this here to reduce display flicker&#10;    digit++;&#10;    if(digit &gt;5) digit = 0;&#10;    leddigit++;&#10;    if(leddigit &gt;3) leddigit = 0;&#10;&#10;    SEVENSEG_PORT = digitbuffer[digit];&#10;    SEVENSEGDIG_PORT = _BV(digit+DIG0);&#10;&#10;    LED_PORT = leddigitbuffer[leddigit];&#10;    LEDDIG_PORT = _BV(leddigit);&#10;}#0" expanded="false" />
+          </folding>
         </state>
       </provider>
     </entry>
diff --git a/display/software/displayboard/src/main.c b/display/software/displayboard/src/main.c
index f73833b..ded16d3 100644
--- a/display/software/displayboard/src/main.c
+++ b/display/software/displayboard/src/main.c
@@ -7,6 +7,8 @@
 #include "main.h"
 #include "uart.h"
 
+#define BUFSIZE 40
+
 volatile uint16_t syscounter = 0;
 volatile uint8_t digitbuffer[6] = { 0,0,0,0,0,0 };
 volatile uint8_t leddigitbuffer[4] = { 0,0,0,0 };
@@ -25,8 +27,8 @@ uint16_t power_gen = 0;
 uint16_t power_load = 0;
 
 unsigned char data_count = 0;
-unsigned char data_in[20];
-char command_in[20];
+unsigned char data_in[BUFSIZE];
+char command_in[BUFSIZE];
 
 const uint8_t digit_translate[10] = {
     63, 6, 91, 79, 102, 109, 125, 7, 127, 111
@@ -57,7 +59,6 @@ static void ports_init(void) {
     LED_PORT = 0;
 }
 
-
 static void print_sevenseg(uint8_t display, uint16_t value) {
     uint8_t d[3];
     d[2] = (value % 1000 / 100 );
@@ -75,69 +76,125 @@ static void print_sevenseg(uint8_t display, uint16_t value) {
     }
 }
 
-static void receive_values_from_powerboard(void) {
-    uint16_t uart_char;
-    static char buffer[20];
-    // send a to request data from powerboard
-    uart_putc('a');
+#ifdef DEBUG
+void pretty_print_all_values(void) {
+    uart_puts_P("Voltage:   ");
+    uart_print_uint16(voltage);
+    uart_puts_P("mV\r\n");
 
-    // input format is:
-    // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n
+    uart_puts_P("Load:      ");
+    uart_print_uint16(current_out);
+    uart_puts_P("mA  ");
+    uart_print_uint16( power_load);
+    uart_puts_P("W\r\n");
 
-    uart_char = uart_getc();
+    uart_puts_P("Generator: ");
+    uart_print_uint16(current_in);
+    uart_puts_P("mA  ");
+    uart_print_uint16( power_gen);
+    uart_puts_P("W\r\n");
 
-    if(uart_char != UART_NO_DATA) {
+    uart_puts_P("switches (load, dump, gen): ");
+    uart_putc(48 + loadsw);
+    uart_putc(',');
+    uart_putc(48 + dumpsw);
+    uart_putc(',');
+    uart_putc(48 + gensw);
+    uart_puts_P("\r\n");
+}
+#endif
 
+void process_command() {
+    if(strstr(command_in,"A") != NULL) {
+        // we have an A and B (from check in work_uart()
+        // so our message should be complete and consist of:
+        // A$voltage,$current_in,$current_out,$power_in,$power_out,loadsw,dumpsw,gensw\n
 
+        //A12.5,65464,00000,00000,00000,1,0,1B
+
+        char *token;
+        uint8_t tokencounter = 0;
+
+        char *start = strrchr(command_in, 'A');
+
+        // remove first (B is ignored by atoi)
+        start++;
+
+#ifdef DEBUG
+        uart_puts_P("from start: ");
+        uart_puts(start);
+        uart_puts_P("\r\n");
+#endif
+
+        token = strtok(start, ",");
+
+        while( token ) {
+#ifdef DEBUG
+            uart_puts_P("token= ");
+            uart_puts(token);
+            uart_puts_P("\r\n");
+#endif
+
+            switch(tokencounter) {
+                case 0:
+                    voltage = atoi(token);
+                    break;
+                case 1:
+                    current_in = atoi(token);
+                    break;
+                case 2:
+                    current_out = atoi(token);
+                    break;
+                case 3:
+                    power_gen = atoi(token);
+                    break;
+                case 4:
+                    power_load = atoi(token);
+                    break;
+                case 5:
+                    if(atoi(token) == 1) loadsw = 1;
+                    else loadsw = 0;
+                    break;
+                case 6:
+                    if(atoi(token) == 1) dumpsw = 1;
+                    else dumpsw = 0;
+                    break;
+                case 7:
+                    if(atoi(token) == 1) gensw = 1;
+                    else gensw = 0;
+                    break;
+            }
+
+            tokencounter++;
+            token = strtok(NULL, ",");
+        }
+#ifdef DEBUG
+        pretty_print_all_values();
+#endif
 
     }
-
-    voltage = 12200;
-    current_in = 1500;
-    current_out = 1600;
-    power_gen += 1;
-    power_load += 2;
-
 }
 
-/*
-void process_command() {
-    if(strstr(command_in,"a") != NULL) {
-        //
-
-    if(strcasestr(command_in,"?") != NULL)
-    print_value("goto", variable_goto);
-    else
-    variable_goto = parse_assignment(command_in);
-    }
-    else if(strcasestr(command_in,"A") != NULL){
-    if(strcasestr(command_in,"?") != NULL)
-    print_value("A", variable_A);
-    else
-    variable_A = parse_assignment(command_in);
-    }
-}   */
-
 void work_uart(){
-  unsigned int c = uart_getc();
+    unsigned int c = uart_getc();
 
-  if ( !(c & UART_NO_DATA) ) {
+    if ( !(c & UART_NO_DATA) ) {
 
-    data_in[data_count] = c;
+        data_in[data_count] = c;
 
-    if (data_in[data_count] == '\n') {  // finish reading when newline is received
-      data_count = 0;
+        if (data_in[data_count] == 'B') {  // finish reading when newline is received
+            data_count = 0;
 
-      // copy_command
-      memcpy(command_in, data_in, 20);
-      // Now clear data_in, the UART can reuse it now
-      memset(data_in, 0, 20);
+            memcpy(command_in, data_in, BUFSIZE);
 
-      //process_command();
-    } else {
-      data_count++;
+            // Now clear data_in, the UART can reuse it now
+            memset(data_in, 0, BUFSIZE);
+
+            process_command();
+        } else {
+            data_count++;
+        }
     }
-  }
 }
 
 
@@ -147,14 +204,14 @@ int main(void) {
 	ports_init();
 	timer_init();
     uart_init(UART_BAUD_SELECT(19200,F_CPU));
+    memset(data_in, 0, BUFSIZE);
 
 	while(1) {
 
 	    work_uart();
 
-        if(syscounter == 200) {
-
-            receive_values_from_powerboard();
+        if(syscounter >= 200) {
+            uart_putc('a'); // send a to receive values
 
             print_sevenseg(0, power_gen);
             print_sevenseg(1, power_load);