h3n3/darkwater_cplus_640
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

debug messages

Browse Source
This commit is contained in:
shrkey
2016-10-09 22:24:47 +01:00
parent 53de56fd93
commit 31ea5623c5
1 changed files with 3 additions and 0 deletions
Download Patch File Download Diff File Expand all files Collapse all files

3
darkwater/DW640.cpp
View File

@@ -235,10 +235,13 @@ void DW640::setMotorSpeed(uint8_t motor, uint16_t speed) {
} else if( speed > 1500 && speed <= 2000 ) {
} else if( speed > 0 && speed <= 255 ) {
printf("fwd %d", speed);
runMotor( DW_FORWARD, in1, in2, speed );
} else if( speed < 0 && speed >= -255 ) {
printf("rv %d", speed);
runMotor( DW_REVERSE, in1, in2, abs(speed) );
} else if( speed == 0 || speed == 1500 ) {
printf("stp %d", speed);
runMotor( DW_STOP, in1, in2, speed );
}