diff --git a/src/systems/mecanum_drive/MecanumDrive.cc b/src/systems/mecanum_drive/MecanumDrive.cc index e323775f22..c7a2f8d8b8 100644 --- a/src/systems/mecanum_drive/MecanumDrive.cc +++ b/src/systems/mecanum_drive/MecanumDrive.cc @@ -574,7 +574,7 @@ void MecanumDrivePrivate::UpdateOdometry(const UpdateInfo &_info, return; } - this->odom.Update(frontLeftPos->Data()[0], frontRightPos->Data()[0], backLeftPos->Data()[0], backRightPos->Data()[0],std::chrono::steady_clock::time_point(_info.simTime)); + this->odom.Update(frontLeftPos->Data()[0],frontRightPos->Data()[0],backLeftPos->Data()[0],backRightPos->Data()[0],std::chrono::steady_clock::time_point(_info.simTime)); // Throttle publishing auto diff = _info.simTime - this->lastOdomPubTime; diff --git a/test/integration/mecanum_drive_system.cc b/test/integration/mecanum_drive_system.cc index 7e66d6999e..bf8bd3d301 100644 --- a/test/integration/mecanum_drive_system.cc +++ b/test/integration/mecanum_drive_system.cc @@ -168,7 +168,7 @@ class MecanumDriveTest : public InternalFixture<::testing::TestWithParam> // change. To find the final pose of the model, we have to do the // following similarity transformation - math::Pose3d tOdomModel(0.554283, 0, -0.325, 0, 0, 0); + math::Pose3d tOdomModel(0.554283,0,-0.325,0,0,0); auto finalModelFramePose = tOdomModel * odomPoses.back() * tOdomModel.Inverse();