Skip to content

Commit 98a1236

Browse files
committed
Fixed issue #1478, #1599, #1709, motors being opposite, updated turning algorithm
1 parent 59a153a commit 98a1236

File tree

1 file changed

+6
-6
lines changed

1 file changed

+6
-6
lines changed

ArduinoRobotMotorBoard.cpp

Lines changed: 6 additions & 6 deletions
Original file line numberDiff line numberDiff line change
@@ -170,20 +170,20 @@ void RobotMotorBoard::motorsWrite(int speedL, int speedR){
170170
speedL*=(1-motorAdjustment);
171171
}
172172

173-
if(speedL>0){
174-
analogWrite(IN_A1,speedL);
173+
if(speedR>0){
174+
analogWrite(IN_A1,speedR);
175175
analogWrite(IN_A2,0);
176176
}else{
177177
analogWrite(IN_A1,0);
178-
analogWrite(IN_A2,-speedL);
178+
analogWrite(IN_A2,-speedR);
179179
}
180180

181-
if(speedR>0){
182-
analogWrite(IN_B1,speedR);
181+
if(speedL>0){
182+
analogWrite(IN_B1,speedL);
183183
analogWrite(IN_B2,0);
184184
}else{
185185
analogWrite(IN_B1,0);
186-
analogWrite(IN_B2,-speedR);
186+
analogWrite(IN_B2,-speedL);
187187
}
188188
}
189189
void RobotMotorBoard::motorsWritePct(int speedLpct, int speedRpct){

0 commit comments

Comments
 (0)