--- /dev/null
+#include "adc.h"
+#include "interface.h"
+#include "monitor.h"
+#include "output.h"
+#include "serial.h"
+
+uint16_t track_current_samples[16] = { 0 };
+uint8_t track_current_head = 0;
+volatile uint16_t track_current_sum = 0;
+uint16_t overcurrent_limit = 1000<<4;
+uint8_t overcurrent_sent = 0;
+
+uint16_t input_voltage_samples[16] = { 0 };
+uint8_t input_voltage_head = 0;
+volatile uint16_t input_voltage_sum = 0;
+
+volatile uint8_t adc_state = 0;
+
+void monitor_init()
+{
+ adc_init();
+}
+
+void monitor_check()
+{
+ if(!(adc_state&1))
+ {
+ ++adc_state;
+ adc_read_async(adc_state>>1);
+ }
+
+ if(track_current_sum>overcurrent_limit)
+ {
+ output_set_power(0);
+ if(!overcurrent_sent)
+ {
+ overcurrent_sent = 1;
+ serial_write(0xFE);
+ serial_write(OVERCURRENT);
+ }
+ }
+ else
+ overcurrent_sent = 0;
+}
+
+uint8_t monitor_command()
+{
+ if(cmd_buf[0]==READ_TRACK_CURRENT)
+ {
+ if(cmd_length!=1)
+ return LENGTH_ERROR;
+
+ serial_write(0xFC);
+ serial_write(TRACK_CURRENT);
+ uint16_t value = track_current_sum>>4;
+ serial_write(value>>8);
+ serial_write(value);
+ }
+ else if(cmd_buf[0]==SET_OVERCURRENT_LIMIT)
+ {
+ if(cmd_length!=3)
+ return LENGTH_ERROR;
+
+ if(cmd_buf[1]&0xF0)
+ return INVALID_VALUE;
+
+ overcurrent_limit = (cmd_buf[1]<<12) | (cmd_buf[2]<<4);
+ }
+ else if(cmd_buf[0]==READ_INPUT_VOLTAGE)
+ {
+ if(cmd_length!=1)
+ return LENGTH_ERROR;
+
+ serial_write(0xFC);
+ serial_write(INPUT_VOLTAGE);
+ uint16_t value = (input_voltage_sum>>3)*5;
+ serial_write(value>>8);
+ serial_write(value);
+ }
+ else
+ return INVALID_COMMAND;
+
+ return COMMAND_OK;
+}
+
+static inline void adc_complete(uint16_t value)
+{
+ if(adc_state==1)
+ {
+ // Convert to milliamps: (v*5/1024-2.5)*1000/0.185
+ if(value<512) // Ignore negative current readings
+ value = 0;
+ else if(value>663) // Limit range so averaging won't overflow
+ value = 4000;
+ else
+ value = (value-512)*132/5;
+
+ uint8_t i = track_current_head;
+ track_current_sum -= track_current_samples[i];
+ track_current_samples[i] = value;
+ track_current_sum += value;
+ track_current_head = (i+1)&15;
+ }
+ else if(adc_state==3)
+ {
+ // Convert to centivolts: (v*5/1024)*100*11
+ if(value>744) // Limit range so averaging won't overflow
+ value = 4000;
+ else
+ value = value*43/8;
+
+ uint8_t i = input_voltage_head;
+ input_voltage_sum -= input_voltage_samples[i];
+ input_voltage_samples[i] = value;
+ input_voltage_sum += value;
+ input_voltage_head = (i+1)&15;
+ }
+
+ ++adc_state;
+}
+
+ADC_SET_CALLBACK(adc_complete)