Oskar Weigl
/
Eurobot_hbridge_test
asdf
main.cpp@0:c4ec289ae3a7, 2013-03-20 (annotated)
- Committer:
- madcowswe
- Date:
- Wed Mar 20 17:30:30 2013 +0000
- Revision:
- 0:c4ec289ae3a7
first commit
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
madcowswe | 0:c4ec289ae3a7 | 1 | #include "mbed.h" |
madcowswe | 0:c4ec289ae3a7 | 2 | DigitalOut EN(p25); |
madcowswe | 0:c4ec289ae3a7 | 3 | PwmOut IN1(p21); |
madcowswe | 0:c4ec289ae3a7 | 4 | PwmOut IN2(p22); |
madcowswe | 0:c4ec289ae3a7 | 5 | PwmOut IN3(p23); |
madcowswe | 0:c4ec289ae3a7 | 6 | PwmOut IN4(p24); |
madcowswe | 0:c4ec289ae3a7 | 7 | |
madcowswe | 0:c4ec289ae3a7 | 8 | //from -1 to 1 |
madcowswe | 0:c4ec289ae3a7 | 9 | void motorpower(float left, float right){ |
madcowswe | 0:c4ec289ae3a7 | 10 | IN1 = right < 0 ? -right : 0; |
madcowswe | 0:c4ec289ae3a7 | 11 | IN2 = right >= 0 ? right : 0; |
madcowswe | 0:c4ec289ae3a7 | 12 | IN3 = left >= 0 ? left : 0; |
madcowswe | 0:c4ec289ae3a7 | 13 | IN4 = left < 0 ? -left : 0; |
madcowswe | 0:c4ec289ae3a7 | 14 | } |
madcowswe | 0:c4ec289ae3a7 | 15 | |
madcowswe | 0:c4ec289ae3a7 | 16 | int main() { |
madcowswe | 0:c4ec289ae3a7 | 17 | |
madcowswe | 0:c4ec289ae3a7 | 18 | motorpower(0, 0); |
madcowswe | 0:c4ec289ae3a7 | 19 | EN = 1; |
madcowswe | 0:c4ec289ae3a7 | 20 | |
madcowswe | 0:c4ec289ae3a7 | 21 | while(1) { |
madcowswe | 0:c4ec289ae3a7 | 22 | wait(1); |
madcowswe | 0:c4ec289ae3a7 | 23 | motorpower(0.2, 0.2); |
madcowswe | 0:c4ec289ae3a7 | 24 | wait(1); |
madcowswe | 0:c4ec289ae3a7 | 25 | motorpower(-0.2, 0.2); |
madcowswe | 0:c4ec289ae3a7 | 26 | wait(1); |
madcowswe | 0:c4ec289ae3a7 | 27 | motorpower(0,0); |
madcowswe | 0:c4ec289ae3a7 | 28 | } |
madcowswe | 0:c4ec289ae3a7 | 29 | } |