main5.h

00001 #include "mbed.h"
00002 #include "LIS302.h"
00003 #include "Servo.h"
00004 Servo myservo(p21);
00005 LIS302 acc (p5,p6,p7,p8);
00006 DigitalOut led1(LED1);
00007 DigitalOut led2(LED2);
00008 DigitalOut led3(LED3);
00009 DigitalOut led4(LED4);
00010 
00011 int main() {
00012     float samples [5] = {0};
00013     int index = 0;
00014     int flipped_right = 1;
00015     int flipped_left = 1;
00016     while (1) {
00017 
00018         wait (0.1);
00019         samples[index] = acc.y();
00020         index++;
00021         if (index >= 5) {
00022             index = 0;
00023         }
00024         int i;
00025         flipped_right = 1;
00026         flipped_left =1;
00027         for (i=0; i<5; i++) {
00028             if (samples[i] > -1.0) {
00029                 flipped_left = 0;
00030             }
00031 
00032             if (samples[i] < 1.0) {
00033                 flipped_right = 0;
00034             }
00035         }
00036 
00037         if (flipped_left||flipped_right) {
00038             led1 = !led1;
00039             led2 = !led2;
00040             led3 = !led3;
00041             led4 = !led4;
00042             myservo = 1;
00043             {
00044 
00045             }
00046         }
00047     }
00048 }