diff --git a/src/quadarm_task_priority_ctrl.cpp b/src/quadarm_task_priority_ctrl.cpp
index 864baa73ab7ff6d845ed8cc377d190d9939a6c0e..8c1c992ef418a674a14cd43d13a912dcf14ce6e8 100644
--- a/src/quadarm_task_priority_ctrl.cpp
+++ b/src/quadarm_task_priority_ctrl.cpp
@@ -375,8 +375,8 @@ void CQuadarm_Task_Priority_Ctrl::task_cog(MatrixXd& JG,MatrixXd& JG_pseudo,Matr
   joint_pose.resize(this->arm_.nj);
 
   // This should be done, otherwise an eigen assertion arises in the robot computer
-  vector<Eigen::Matrix4d,Eigen::aligned_allocator<Eigen::Matrix4d> > Transf(this->arm_.nj);
-  //vector<Matrix4d> Transf(this->arm_.nj); // Vector of HT of frames relative to each links
+  //vector<Eigen::Matrix4d,Eigen::aligned_allocator<Eigen::Matrix4d> > Transf(this->arm_.nj);
+  vector<Matrix4d> Transf(this->arm_.nj); // Vector of HT of frames relative to each links
   Transf.resize(this->arm_.nj);
   // Eigen stuff
   vector<MatrixXd> T_base_to_joint(this->arm_.nj+1); // Vector of HT of frame links relative to base