#include <avr/interrupt.h>
#include <util/delay.h>
#include <stdio.h>
+#include "clock.h"
#include "modbus.h"
-#define TIMEOUT 0x2FF
+#define ECHO_TIMEOUT (CLOCK_HZ/20) // 50 ms
+#define MEASUREMENT_WAIT (4*ECHO_TIMEOUT)
#define N_TRIGGERS 3
#define N_SENSORS 12
pull_trigger(trig);
- starttime = TCNT1;
+ starttime = get_clock();
while (to_start || to_measure) {
uint8_t bits = 0;
- uint16_t now = TCNT1;
+ uint16_t now = get_clock();
- if (now-starttime >= TIMEOUT)
+ if (now-starttime >= ECHO_TIMEOUT)
break;
bits = get_pin(trig);
distances[trig*N_TRIG_SENSORS + i] = 0;
}
-static void do_measurements()
-{
- uint8_t trig;
-
- for (trig = 0; trig < N_TRIGGERS; trig++) {
- do_measurement(trig);
- _delay_ms(200);
- }
-}
-
static void led_set(uint8_t led, uint8_t state)
{
if (led == 0) {
- if (state) {
- PORTD |= _BV(PD4);
- // PORTC |= _BV(PC5);
- led_bitmap |= 1;
- } else {
- PORTD &= ~_BV(PD4);
- // PORTC &= ~_BV(PC5);
+ switch (state) {
+ case 0:
led_bitmap &= ~1;
+ led_bitmap &= ~2;
+ break;
+ case 1:
+ led_bitmap |= 1;
+ led_bitmap &= ~2;
+ break;
+ default: // error
+ led_bitmap |= 2;
+ break;
}
} else {
- if (state) {
- PORTB |= _BV(PB5);
- led_bitmap |= 2;
- } else {
- PORTB &= ~_BV(PB5);
- led_bitmap &= ~2;
+ switch (state) {
+ case 0:
+ led_bitmap &= ~4;
+ led_bitmap &= ~8;
+ break;
+ case 1:
+ led_bitmap |= 4;
+ led_bitmap &= ~8;
+ break;
+ default:
+ led_bitmap |= 8;
+ break;
}
}
}
+static void leds_update()
+{
+ if (led_bitmap & 1) {
+ PORTC |= _BV(PC5);
+ } else {
+ PORTC &= ~_BV(PC5);
+ }
+
+ if (led_bitmap & 2) {
+ DDRC &= ~_BV(PC5);
+ } else {
+ DDRC |= _BV(PC5);
+ }
+
+ if (led_bitmap & 4) {
+ PORTB |= _BV(PB5);
+ } else {
+ PORTB &= ~_BV(PB5);
+ }
+
+ if (led_bitmap & 8) {
+ DDRB |= _BV(PB5);
+ } else {
+ DDRB &= ~_BV(PB5);
+ }
+}
+
static void eval_bitmaps()
{
uint16_t free_b = 0, err_b = 0, mask;
err_bitmap = err_b;
if (led1_sensors) {
- if (led1_sensors & free_bitmap) {
+ if (led1_sensors & err_bitmap) {
+ led_set(0, 2);
+ } else if (led1_sensors & free_bitmap) {
led_set(0, 1);
} else {
led_set(0, 0);
}
if (led2_sensors) {
- if (led2_sensors & free_bitmap) {
+ if (led2_sensors & err_bitmap) {
+ led_set(1, 2);
+ } else if (led2_sensors & free_bitmap) {
led_set(1, 1);
} else {
led_set(1, 0);
DDRD |= _BV(PD7); // Trig D
DDRB |= _BV(PB4) | _BV(PB5); // Trig B, LED 2
DDRC |= _BV(PC4) | _BV(PC5); // Trig C, LED 1
- // temporary LED
- DDRD |= _BV(PD4);
// set up the timer
TCCR1A = 0;
for (trig = 0; trig < N_TRIGGERS; trig++) {
uint16_t now;
do_measurement(trig);
- now = TCNT1;
- while (TCNT1-now < 200)
+ now = get_clock();
+ while (get_clock()-now < MEASUREMENT_WAIT)
modbus_poll();
}
eval_bitmaps();
+ leds_update(); // might be written from modbus
// led_set(0,
// distances[4] > 100 || distances[11] > 100);
}