joe carter
/
nitrocarproject
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; + { + + } + } + } +}