X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=arducontrol%2Fmonitor.c;h=c3804fc5c5632f37b3941e9feff83994105f31ac;hb=bb375547a3f3611fab8d1f9318d7588d203c8524;hp=9b5154dddfcf1d2209b3253436ac9b0ee2289421;hpb=3fb9da57664c39827f687d664343488b0136f4e1;p=model-railway-devices.git diff --git a/arducontrol/monitor.c b/arducontrol/monitor.c index 9b5154d..c3804fc 100644 --- a/arducontrol/monitor.c +++ b/arducontrol/monitor.c @@ -6,20 +6,17 @@ static uint16_t track_current_samples[16] = { 0 }; static uint8_t track_current_head = 0; -static volatile uint16_t track_current_sum = 0; +static uint16_t track_current_sum = 0; static uint16_t overcurrent_limit = 9707; static uint8_t overcurrent_sent = 0; static uint16_t input_voltage_samples[16] = { 0 }; static uint8_t input_voltage_head = 0; -static volatile uint16_t input_voltage_sum = 0; +static uint16_t input_voltage_sum = 0; static volatile uint8_t adc_state = 0; static volatile uint16_t adc_value = 0; -static uint16_t track_current_milliamps(void); -static uint16_t input_voltage_millivolts(void); - void monitor_init(void) { DDRB |= 0x02; @@ -74,12 +71,11 @@ uint8_t monitor_command(const uint8_t *cmd_buf, uint8_t cmd_length) { if(cmd_buf[0]==READ_TRACK_CURRENT) { - uint8_t reply[3]; - if(cmd_length!=1) return LENGTH_ERROR; - uint16_t value = track_current_milliamps(); + uint16_t value = monitor_track_current(); + uint8_t reply[3]; reply[0] = TRACK_CURRENT; reply[1] = value>>8; reply[2] = value; @@ -101,12 +97,11 @@ uint8_t monitor_command(const uint8_t *cmd_buf, uint8_t cmd_length) } else if(cmd_buf[0]==READ_INPUT_VOLTAGE) { - uint8_t reply[3]; - if(cmd_length!=1) return LENGTH_ERROR; - uint16_t value = input_voltage_millivolts(); + uint16_t value = monitor_input_voltage(); + uint8_t reply[3]; reply[0] = INPUT_VOLTAGE; reply[1] = value>>8; reply[2] = value; @@ -118,7 +113,7 @@ uint8_t monitor_command(const uint8_t *cmd_buf, uint8_t cmd_length) return COMMAND_OK; } -static uint16_t track_current_milliamps(void) +uint16_t monitor_track_current(void) { uint16_t value = track_current_sum; @@ -135,7 +130,7 @@ static uint16_t track_current_milliamps(void) } } -static uint16_t input_voltage_millivolts(void) +uint16_t monitor_input_voltage(void) { uint16_t value = input_voltage_sum;