Preliminary modbus rtu implementation.

[openparking.git] / firmware / firmware.c

diff --git a/firmware/firmware.c b/firmware/firmware.c
index 67508e62e8e0ce0ae09e9d93ddcf1634ed403e4f..9b925210d48cbceee072333ea204e34a77cbfaab 100755 (executable)
--- a/firmware/firmware.c
+++ b/firmware/firmware.c
@@ -2,7 +2,7 @@
 #include <avr/interrupt.h>
 #include <util/delay.h>
 #include <stdio.h>
-#include "rs485.h"
+#include "modbus.h"
 
 #define TIMEOUT 0x2FF
 
@@ -104,9 +104,7 @@ static void led_set(uint8_t led, uint8_t state)
 
 int main()
 {
-       char obuf[120];
-
-       rs485_init();
+       modbus_init();
 
        // output pins
        DDRD |= _BV(PD7); // Trig D
@@ -123,15 +121,8 @@ int main()
        sei();
 
        while(1) {
-               do_measurements();
-
-               sprintf(obuf, "%3d %3d %3d %3d %3d %3d %3d %3d %3d %3d %3d %3d\r\n",
-                       distances[0], distances[1], distances[2],
-                       distances[3], distances[4], distances[5],
-                       distances[6], distances[7], distances[8],
-                       distances[9], distances[10], distances[11]);
-
-               rs485_send(obuf);
+               // do_measurements();
+               modbus_poll();
                led_set(0,
                        distances[4] > 100 || distances[11] > 100);
        }