Diff: main_programs/main5.h

Revision:

0:960b355eaa84

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main_programs/main5.h	Fri Aug 20 11:18:40 2010 +0000
@@ -0,0 +1,48 @@
+#include "mbed.h"
+#include "LIS302.h"
+#include "Servo.h"
+Servo myservo(p21);
+LIS302 acc (p5,p6,p7,p8);
+DigitalOut led1(LED1);
+DigitalOut led2(LED2);
+DigitalOut led3(LED3);
+DigitalOut led4(LED4);
+
+int main() {
+    float samples [5] = {0};
+    int index = 0;
+    int flipped_right = 1;
+    int flipped_left = 1;
+    while (1) {
+
+        wait (0.1);
+        samples[index] = acc.y();
+        index++;
+        if (index >= 5) {
+            index = 0;
+        }
+        int i;
+        flipped_right = 1;
+        flipped_left =1;
+        for (i=0; i<5; i++) {
+            if (samples[i] > -1.0) {
+                flipped_left = 0;
+            }
+
+            if (samples[i] < 1.0) {
+                flipped_right = 0;
+            }
+        }
+
+        if (flipped_left||flipped_right) {
+            led1 = !led1;
+            led2 = !led2;
+            led3 = !led3;
+            led4 = !led4;
+            myservo = 1;
+            {
+
+            }
+        }
+    }
+}