diff --git a/src/robot_control/DQ_ClassicQPController.cpp b/src/robot_control/DQ_ClassicQPController.cpp index 6243e32..719f6cd 100644 --- a/src/robot_control/DQ_ClassicQPController.cpp +++ b/src/robot_control/DQ_ClassicQPController.cpp @@ -1,5 +1,5 @@ /** -(C) Copyright 2019 DQ Robotics Developers +(C) Copyright 2019-2024 DQ Robotics Developers This file is part of DQ Robotics. @@ -17,7 +17,14 @@ This file is part of DQ Robotics. along with DQ Robotics. If not, see . Contributors: -- Murilo M. Marinho (murilomarinho@ieee.org) + + 1. Murilo M. Marinho (murilomarinho@ieee.org) + Responsible for the original implementation + + 2. Juan Jose Quiroz Omana + Fixed bug 59 (https://github.com/dqrobotics/python/issues/59) + - Initialized a default damping to match the Matlab implementation + of the class DQ_ClassicQPController.m */ #include @@ -28,14 +35,14 @@ namespace DQ_robotics DQ_ClassicQPController::DQ_ClassicQPController(DQ_Kinematics* robot, DQ_QuadraticProgrammingSolver* solver): DQ_QuadraticProgrammingController (robot,solver) { - + set_damping(1e-3); // Default damping. } DQ_ClassicQPController::DQ_ClassicQPController(const std::shared_ptr &robot, const std::shared_ptr &solver): DQ_QuadraticProgrammingController(robot,solver) { - + set_damping(1e-3); // Default damping. } MatrixXd DQ_ClassicQPController::compute_objective_function_symmetric_matrix(const MatrixXd &J, const VectorXd&) diff --git a/src/robot_control/DQ_KinematicController.cpp b/src/robot_control/DQ_KinematicController.cpp index a44d698..4704aff 100644 --- a/src/robot_control/DQ_KinematicController.cpp +++ b/src/robot_control/DQ_KinematicController.cpp @@ -54,15 +54,16 @@ DQ_KinematicController::DQ_KinematicController(const std::shared_ptr