Diff: main.cpp

Revision:

0:efb27fbc92c0

Child:

1:227db871d328

diff -r 000000000000 -r efb27fbc92c0 main.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Mon Jul 30 09:57:42 2012 +0000
@@ -0,0 +1,105 @@
+/*
+    D- (Orange) is pin5 on AUX
+    D+ (Yellow) is pin8 on AUX
+    GND is pin 1 on AUX
+    +12V is pin 3 on AUX
+
+ */
+
+#include "mbed.h"
+#include "Parameters.h"
+#include "PingDetect/PingDetect.h"
+
+Ticker t;
+
+
+DigitalOut l2(LED2);
+DigitalOut l3(LED3);
+DigitalOut l4(LED4);
+
+bool Input=0, NewInput=0;
+
+void Stop();
+
+void Start();
+
+void CalculateFFT();
+
+void Run();
+
+void Find();
+
+int Command = doNothing;
+int Found = notFound;
+
+PingDetect PD;
+
+int main() {
+
+    while (1) {
+
+//        PD.SendSerial(Command);
+        //
+        switch (Command) {
+            case start:
+                Start();
+                break;
+
+            case calcFFT:
+                CalculateFFT();
+                break;
+
+            case stop:
+                Stop();
+                break;
+                
+            case doNothing:
+                
+            default:
+                break;
+        }
+
+        Command = PD.ReadSerial(Command);
+    }
+}
+
+void Stop() {
+    t.detach();
+    l2=0;
+    l3=0;
+    l4=0;
+    Command = doNothing;
+}
+
+void Start() {
+    l2=1;
+    t.detach();
+//    t.attach_us(&Find,10000);
+    t.attach_us(&Find,5000);
+    Command = doNothing;
+}
+
+void CalculateFFT() {
+    t.detach();
+    PD.CalculateFFT();    
+    Command = doNothing;
+}
+
+void Run () {
+    l3=!l3;
+    PD.Run();
+}
+
+void Find() {
+    l4=!l4;
+    Found = PD.Search();
+    if(Found == found){
+        l2=0;
+        t.detach();
+//        wait_ms(1000-TIME_OFFSET);
+        wait_ms(1000-TIME_OFFSET);
+        t.attach(&Run,1);
+        Run();
+    }
+        
+}