Make normalizeVector private

src/control/PlanarArmController.h

@@ -51,25 +51,6 @@ template <unsigned int N> class PlanarArmController {
 		setpoint = normalizeVectorWithinRadius(newSetPoint, radius);
 	}
 
-	/**
-	 * @brief Normalize the input vector to have a set radius,
-	 *  	  while maintaining the same direction it did before if it exceeds that set radius.
-	 *
-	 * @param input The input vector to normalize.
-	 * @param radius The radius to normalize the vector to.
-	 */
-	Eigen::Vector2d normalizeVectorWithinRadius(Eigen::Vector2d input, double radius) {
-		if (input.norm() > radius) {
-			// TODO: will need to eventually shrink velocity vector until it is within radius
-			// instead of just normalizing it.
-
-			input.normalize();
-			input *= radius;
-		}
-
-		return input;
-	}
-
 	/**
 	 * @brief Gets the current end effector setpoint / target position.
 	 *
@@ -155,5 +136,24 @@ template <unsigned int N> class PlanarArmController {
 	Eigen::Vector2d velocity;
 	std::optional<robot::types::datatime_t> velTimestamp;
 	const double safetyFactor;
+
+	/**
+	 * @brief Normalize the input vector to have a set radius,
+	 *  	  while maintaining the same direction it did before if it exceeds that set radius.
+	 *
+	 * @param input The input vector to normalize.
+	 * @param radius The radius to normalize the vector to.
+	 */
+	Eigen::Vector2d normalizeVectorWithinRadius(Eigen::Vector2d input, double radius) {
+		if (input.norm() > radius) {
+			// TODO: will need to eventually shrink velocity vector until it is within radius
+			// instead of just normalizing it.
+
+			input.normalize();
+			input *= radius;
+		}
+
+		return input;
+	}
 };
 } // namespace control