heres the code
Dependencies: Motor Servo mbed
main.cpp@0:e8eaa22280a2, 2018-10-09 (annotated)
- Committer:
- JackTamas
- Date:
- Tue Oct 09 14:12:58 2018 +0000
- Revision:
- 0:e8eaa22280a2
- Child:
- 2:e43e3a2eb025
heres the code
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
JackTamas | 0:e8eaa22280a2 | 1 | #include "mbed.h" |
JackTamas | 0:e8eaa22280a2 | 2 | #include "stdio.h" |
JackTamas | 0:e8eaa22280a2 | 3 | #include "Motor.h" |
JackTamas | 0:e8eaa22280a2 | 4 | #include "Servo.h" |
JackTamas | 0:e8eaa22280a2 | 5 | |
JackTamas | 0:e8eaa22280a2 | 6 | Servo gate(p22); |
JackTamas | 0:e8eaa22280a2 | 7 | Servo celly(p21); |
JackTamas | 0:e8eaa22280a2 | 8 | int i; |
JackTamas | 0:e8eaa22280a2 | 9 | float x; |
JackTamas | 0:e8eaa22280a2 | 10 | int j=1; |
JackTamas | 0:e8eaa22280a2 | 11 | |
JackTamas | 0:e8eaa22280a2 | 12 | int main() { |
JackTamas | 0:e8eaa22280a2 | 13 | while (1) { |
JackTamas | 0:e8eaa22280a2 | 14 | gate.calibrate(0.0009, 90.0); |
JackTamas | 0:e8eaa22280a2 | 15 | celly.calibrate(0.0009, 90.0); |
JackTamas | 0:e8eaa22280a2 | 16 | gate = 0.5; //set gate to halfway point |
JackTamas | 0:e8eaa22280a2 | 17 | x = (rand()%9)+1; |
JackTamas | 0:e8eaa22280a2 | 18 | if (x <= 7) { |
JackTamas | 0:e8eaa22280a2 | 19 | gate = 1.0; //gate has a 70% chance to go one way |
JackTamas | 0:e8eaa22280a2 | 20 | wait (1.5); //gives time for crab to get down track and begin navy celebration |
JackTamas | 0:e8eaa22280a2 | 21 | for (i=0; i<=1;i++) { |
JackTamas | 0:e8eaa22280a2 | 22 | celly = -j; |
JackTamas | 0:e8eaa22280a2 | 23 | } |
JackTamas | 0:e8eaa22280a2 | 24 | } |
JackTamas | 0:e8eaa22280a2 | 25 | else { //30% chance the gate will go the other way |
JackTamas | 0:e8eaa22280a2 | 26 | gate = 0.0; } |
JackTamas | 0:e8eaa22280a2 | 27 | } |
JackTamas | 0:e8eaa22280a2 | 28 | } |