diff --git a/MecanumRobotPS2Control.ino b/MecanumRobotPS2Control.ino index 74887c5..1433612 100644 --- a/MecanumRobotPS2Control.ino +++ b/MecanumRobotPS2Control.ino @@ -111,7 +111,7 @@ long SPDMotor::getEncoderPosition() { SPDMotor *motorLF = new SPDMotor(18, 31, true, 12, 34, 35); // <- Encoder reversed to make +position measurement be forward. SPDMotor *motorRF = new SPDMotor(19, 38, false, 8, 36, 37); // <- NOTE: Motor Dir pins reversed for opposite operation SPDMotor *motorLR = new SPDMotor( 3, 49, true, 9, 43, 42); // <- Encoder reversed to make +position measurement be forward. -SPDMotor *motorRR = new SPDMotor( 2, A1, false, 5, A4, A5); // <- NOTE: Motor Dir pins reversed for opposite operation +SPDMotor *motorRR = new SPDMotor( 2, A1, false, 5, A5, A4); // <- NOTE: Motor Dir pins reversed for opposite operation void setup() {