joe carter
/
nitrocarproject
main_programs/main5.h
- Committer:
- joe
- Date:
- 2010-08-20
- Revision:
- 0:960b355eaa84
File content as of revision 0:960b355eaa84:
#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; { } } } }