From 4ef979bff588ad08d697043d508ab31148d04ca4 Mon Sep 17 00:00:00 2001
From: AyushKulk <ayush.kulkarni04@gmail.com>
Date: Mon, 30 Oct 2023 16:55:15 -0700
Subject: [PATCH] v5

---
 src/LimitCalib.cpp | 11 ++---------
 1 file changed, 2 insertions(+), 9 deletions(-)

diff --git a/src/LimitCalib.cpp b/src/LimitCalib.cpp
index deeba5f73..b0167d393 100644
--- a/src/LimitCalib.cpp
+++ b/src/LimitCalib.cpp
@@ -32,10 +32,6 @@ void cleanup(int signum) {
 
 } // namespace
 
-bool customVecComparator(const navtypes::Vectord<2>& a, const navtypes::Vectord<2>& b) {
-	return a[0] < b[0];
-}
-
 // Runs limit switch calibration.
 // Registers limit switch callbacks for the relevant motors.
 // Then begins to run the motors.
@@ -79,18 +75,15 @@ int main() {
 		i++;
 	}
 	
-	// mess with putting the std Pos's in a vector to begin with 
-	// and then sort afterwards.
-	std::sort(targetPosVec.begin(), targetPosVec.end(), customVecComparator);
+	// std::sort(targetPosVec.begin(), targetPosVec.end(), customVecComparator);
 
 	robot::types::datatime_t currTime(0s);
-
 	profile.setTarget(currTime, getMotorPositionsRad(motorNames), targetPosVec);
 
 	JacobianVelController<2,2> controller([](Eigen::VectorXd x) { return x; }, {});
 	
-	navtypes::Vectord<2> targetVel = profile.getCommand(currTime);
 	double d;
+	navtypes::Vectord<2> targetVel = profile.getCommand(currTime);
 	navtypes::Vectord<2>  targetPos = controller.getCommand(currTime, targetVel, d);
 	i = 0;
 	for (const auto& element : sortedKeys) {