Fix usage of static dimension

source/RobotAPI/libraries/ukfm/UnscentedKalmanFilter.cpp

@@ -186,8 +186,8 @@ UnscentedKalmanFilter<SystemModelT>::calculateClosestPosSemidefMatrix(
 {
     const StateCovT new_P = ((cov + cov.transpose()) / 2.0f);
     Eigen::EigenSolver<StateCovT> solver(new_P);
-    Eigen::Matrix<FloatT, 6, 6> D = solver.eigenvalues().real().asDiagonal();
-    const Eigen::Matrix<FloatT, 6, 6> V = solver.eigenvectors().real();
+    Eigen::Matrix<FloatT, dim::state, dim::state> D = solver.eigenvalues().real().asDiagonal();
+    const Eigen::Matrix<FloatT, dim::state, dim::state> V = solver.eigenvectors().real();
     D = D.cwiseMax(0);
 
     return (V * D * V.inverse());