10/25/2015
Dependencies: PID mbed MaxSonar eeprom iSerial Fork_Boss_Communication_Robot
move.cpp@6:9ed82a812ece, 2015-10-27 (annotated)
- Committer:
- palmdotax
- Date:
- Tue Oct 27 05:45:49 2015 +0000
- Revision:
- 6:9ed82a812ece
- Parent:
- 5:68b740d113e6
- Child:
- 8:8fbc0c858875
27/10/2015;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
palmdotax | 0:f02641e3fb91 | 1 | #include "mbed.h" |
palmdotax | 0:f02641e3fb91 | 2 | #include "move.h" |
palmdotax | 0:f02641e3fb91 | 3 | |
palmdotax | 0:f02641e3fb91 | 4 | |
palmdotax | 0:f02641e3fb91 | 5 | |
palmdotax | 4:e6ab360e7de6 | 6 | DigitalOut dir1(D6); |
palmdotax | 4:e6ab360e7de6 | 7 | DigitalOut dir2(D7); |
palmdotax | 4:e6ab360e7de6 | 8 | PwmOut speeds(PC_8); |
palmdotax | 5:68b740d113e6 | 9 | void move:: movespeed(int dir,float setpoint,float spd) |
palmdotax | 0:f02641e3fb91 | 10 | { |
palmdotax | 6:9ed82a812ece | 11 | double dc=0; |
palmdotax | 0:f02641e3fb91 | 12 | if(dir==1) |
palmdotax | 0:f02641e3fb91 | 13 | { |
palmdotax | 0:f02641e3fb91 | 14 | dir1=1; |
palmdotax | 0:f02641e3fb91 | 15 | dir2=0; |
palmdotax | 0:f02641e3fb91 | 16 | } |
palmdotax | 0:f02641e3fb91 | 17 | else |
palmdotax | 0:f02641e3fb91 | 18 | { |
palmdotax | 0:f02641e3fb91 | 19 | dir1=0; |
palmdotax | 0:f02641e3fb91 | 20 | dir2=1; |
palmdotax | 0:f02641e3fb91 | 21 | } |
palmdotax | 6:9ed82a812ece | 22 | dc=setpoint+spd; |
palmdotax | 6:9ed82a812ece | 23 | speeds.write(dc); |
palmdotax | 6:9ed82a812ece | 24 | |
palmdotax | 0:f02641e3fb91 | 25 | |
palmdotax | 0:f02641e3fb91 | 26 | } |