Diff: ProcVisDemo.cpp

Revision:

0:9ac39e20730c

Child:

1:e88b745f2ca2

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/ProcVisDemo.cpp	Fri Apr 25 18:26:26 2014 +0000
@@ -0,0 +1,62 @@
+#include "mbed.h"
+#include "Serial_HL.h"
+
+SerialBLK pc(USBTX, USBRX);
+SvProtocol ua0(&pc);
+
+BusOut leds(LED1,LED2,LED3,LED4);
+
+void CommandHandler();
+
+int main(void)
+{
+    pc.format(8,SerialBLK::None,1);
+    pc.baud(115200);
+    leds = 9;
+
+    ua0.SvMessage("SvTest_Serial_HL"); // Meldung zum PC senden
+
+    int16_t sv1=0, sv2=100;
+    Timer stw;
+    stw.start();
+    while(1) {
+        CommandHandler();
+        if( ua0.acqON && (stw.read_ms()>100) ) { // 10Hz
+            // dieser Teil wird mit 10Hz aufgerufen
+            stw.reset();
+            sv1++;
+            sv2++;
+            if( ua0.acqON ) {
+                // nur wenn vom PC aus das Senden eingeschaltet wurde
+                // wird auch etwas gesendet
+                ua0.WriteSvI16(1, sv1);
+                ua0.WriteSvI16(2, sv2);
+            }
+        }
+    }
+    return 1;
+}
+
+void CommandHandler()
+{
+    uint8_t cmd;
+    int16_t idata1, idata2;
+
+    // Fragen ob überhaupt etwas im RX-Reg steht
+    if( !pc.IsDataAvail() )
+        return;
+
+    // wenn etwas im RX-Reg steht
+    // Kommando lesen
+    cmd = ua0.GetCommand();
+
+    if( cmd==2 ) {
+        // cmd2 hat 2 int16 Parameter
+        idata1 = ua0.ReadI16();
+        idata2 = ua0.ReadI16();
+        // für die Analyse den Wert einfach nur zum PC zurücksenden
+        ua0.SvPrintf("Command2 %d %d", idata1, idata2);
+    }
+}
+
+