logging.c

   1 #ifdef USE_LOGGING
   2
   3 #include <avr/io.h>
   4 #include <avr/eeprom.h>
   5
   6 #include "lights.h"
   7
   8 #define LOG_BUFFER 128
   9 static unsigned char log_buffer_ee[LOG_BUFFER] EEMEM;
  10 static unsigned char log_buffer_count;
  11 static unsigned char log_buffer[LOG_BUFFER];
  12 static unsigned char log_state EEMEM;
  13 /* Upper 4 bits are reset count, lower 4 bits are reset reason from MCUSR */
  14 static unsigned char reboot_count EEMEM = 0;
  15 static unsigned char can_write_eeprom = 0;
  16
  17 void log_set_state(unsigned char val)
  18 {
  19         if (can_write_eeprom)
  20                 eeprom_write_byte(&log_state, val);
  21 }
  22
  23 void log_init()
  24 {
  25         unsigned char r_count;
  26
  27         r_count = eeprom_read_byte(&reboot_count);
  28         r_count >>= 4;
  29
  30         if (r_count < 5) {
  31                 r_count++;
  32                 eeprom_write_byte(&reboot_count,
  33                         (r_count << 4) | (MCUSR & 0xF));
  34                 MCUSR = 0;
  35                 can_write_eeprom = 1;
  36         } else {
  37                 //eeprom_write_byte(&log_state, 0xFF);
  38                 can_write_eeprom = 0;
  39         }
  40
  41         log_set_state(1);
  42         log_buffer_count = 0;
  43 }
  44
  45 void log_byte(unsigned char byte) {
  46         if (log_buffer_count >= LOG_BUFFER)
  47                 return;
  48
  49         // eeprom_write_word(&log_buffer[log_buffer_count], word);
  50         log_buffer[log_buffer_count++] = byte;
  51
  52         if (log_buffer_count == LOG_BUFFER)
  53                 log_flush();
  54 }
  55
  56 void log_word(uint16_t word) {
  57         log_byte(word & 0xFF);
  58         log_byte(word >> 8);
  59 }
  60
  61 void log_flush() {
  62         unsigned char i;
  63
  64         log_buffer_count = LOG_BUFFER;
  65
  66         if (!can_write_eeprom)
  67                 return;
  68
  69         for (i=0; i < LOG_BUFFER; i++) {
  70                 eeprom_write_byte(&log_buffer_ee[i],
  71                         log_buffer[i]);
  72         }
  73         log_set_state(0x42);
  74 }
  75
  76 #endif
  77