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