10/25/2015
Dependencies: PID mbed MaxSonar eeprom iSerial Fork_Boss_Communication_Robot
move.cpp
- Committer:
- palmdotax
- Date:
- 2015-12-14
- Revision:
- 8:8fbc0c858875
- Parent:
- 6:9ed82a812ece
- Child:
- 9:86701fec3f79
File content as of revision 8:8fbc0c858875:
#include "mbed.h" #include "move.h" DigitalOut dir1(D6); DigitalOut dir2(D7); PwmOut speeds(PC_8); DigitalOut dirr1(D4); DigitalOut dirr2(D5); PwmOut speeds2(D3); void move:: movespeed_1(int dir,float setpoint,float spd) { double dc=0; if(dir==1) { dir1=1; dir2=0; } else { dir1=0; dir2=1; } dc=setpoint+spd; speeds.write(dc); } void move:: movespeed_2(int dir,float setpoint,float spd) { double dc=0; if(dir==1) { dirr1=1; dirr2=0; } else { dirr1=0; dirr2=1; } dc=setpoint+spd; speeds.write(dc); }