Skip to content
Snippets Groups Projects
Commit 21dd3ad8 authored by Simon Gabl's avatar Simon Gabl
Browse files

Fix typo.

parent edc728ca
No related branches found
No related tags found
No related merge requests found
...@@ -115,7 +115,7 @@ void ForceExampleController::update(const ros::Time& /*time*/, const ros::Durati ...@@ -115,7 +115,7 @@ void ForceExampleController::update(const ros::Time& /*time*/, const ros::Durati
tau_ext = tau_measured - gravity - tau_ext_initial_; tau_ext = tau_measured - gravity - tau_ext_initial_;
tau_d << jacobian.transpose() * desired_force_torque; tau_d << jacobian.transpose() * desired_force_torque;
tau_error_ = tau_error_ + period.toSec() * (tau_d - tau_ext); tau_error_ = tau_error_ + period.toSec() * (tau_d - tau_ext);
// FF + PI control (PI gains are intially all 0) // FF + PI control (PI gains are initially all 0)
tau_cmd = tau_d + k_p_ * (tau_d - tau_ext) + k_i_ * tau_error_; tau_cmd = tau_d + k_p_ * (tau_d - tau_ext) + k_i_ * tau_error_;
tau_cmd << saturateTorqueRate(tau_cmd, tau_J_d); tau_cmd << saturateTorqueRate(tau_cmd, tau_J_d);
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment