Diff: main.cpp

Revision:

1:ff0fc50372c8

Parent:

0:453d27750ab3

Child:

3:39e6440ccd45

diff -r 453d27750ab3 -r ff0fc50372c8 main.cpp
--- a/main.cpp	Tue May 05 00:24:18 2015 +0000
+++ b/main.cpp	Tue May 05 00:43:24 2015 +0000
@@ -1,12 +1,34 @@
 #include "mbed.h"
+#include "telemetry.h"
+#include "telemetry-mbed.h"
+
+MODSERIAL telemetry_serial(PTA2, PTA1);
+telemetry::MbedHal telemetry_hal(telemetry_serial);
+telemetry::Telemetry telemetry_obj(telemetry_hal);
+
+telemetry::Numeric<uint32_t> tele_time_ms(telemetry_obj, "time", "Time", "ms", 0);
+telemetry::NumericArray<uint16_t, 128> tele_linescan(telemetry_obj, "linescan", "Linescan", "ADC", 0);
+telemetry::Numeric<float> tele_motor_pwm(telemetry_obj, "motor", "Motor PWM", "%DC", 0);
 
 DigitalOut myled(LED1);
 
 int main() {
+
+    telemetry_obj.transmit_header();
+    uint16_t data [128] = [0];
+    //uint16_t* data = cam1.read();
+    
     while(1) {
         myled = 1;
         wait(0.2);
         myled = 0;
         wait(0.2);
+        
+        /*for (uint16_t i=0; i<128; i++) {
+            tele_linescan[i] = data[i];
+        }
+        */
+        telemetry_obj.do_io();
+        
     }
 }