First run
Dependencies: ContinuousServo Tach mbed
main.cpp@0:a0013f51f232, 2018-04-23 (annotated)
- Committer:
- nbchaskin
- Date:
- Mon Apr 23 15:15:49 2018 +0000
- Revision:
- 0:a0013f51f232
- Child:
- 1:be893bda5f00
stop at distance from target
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
nbchaskin | 0:a0013f51f232 | 1 | #include "mbed.h" |
nbchaskin | 0:a0013f51f232 | 2 | #include "ContinuousServo.h" |
nbchaskin | 0:a0013f51f232 | 3 | #include "Tach.h" |
nbchaskin | 0:a0013f51f232 | 4 | |
nbchaskin | 0:a0013f51f232 | 5 | Tach tLeft(p17,64); |
nbchaskin | 0:a0013f51f232 | 6 | Tach tRight(p13,64); |
nbchaskin | 0:a0013f51f232 | 7 | |
nbchaskin | 0:a0013f51f232 | 8 | ContinuousServo left(p23); |
nbchaskin | 0:a0013f51f232 | 9 | ContinuousServo right(p26); |
nbchaskin | 0:a0013f51f232 | 10 | AnalogIn sonar(p19); |
nbchaskin | 0:a0013f51f232 | 11 | float distance; |
nbchaskin | 0:a0013f51f232 | 12 | |
nbchaskin | 0:a0013f51f232 | 13 | int main() { |
nbchaskin | 0:a0013f51f232 | 14 | while(1) { |
nbchaskin | 0:a0013f51f232 | 15 | distance = //inches; |
nbchaskin | 0:a0013f51f232 | 16 | distance = //conversion to analog value; |
nbchaskin | 0:a0013f51f232 | 17 | if (sonar > distance){ |
nbchaskin | 0:a0013f51f232 | 18 | left.speed(); |
nbchaskin | 0:a0013f51f232 | 19 | right.speed(); |
nbchaskin | 0:a0013f51f232 | 20 | } |
nbchaskin | 0:a0013f51f232 | 21 | else { |
nbchaskin | 0:a0013f51f232 | 22 | break; |
nbchaskin | 0:a0013f51f232 | 23 | } |
nbchaskin | 0:a0013f51f232 | 24 | } |
nbchaskin | 0:a0013f51f232 | 25 | } |