[ergoCubSN002] Tune the velocity-acceleration KF on the ergoCubSN002 on the legs torso and arms (no wrist) #650
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
This PR tunes the gains of the Kalman filter for the joint velocities and acceleration in the EMS.
The filter has been tuned by an automatic procedure that is explained in https://github.com/ami-iit/component_bipedal-locomotion/issues/157
Here are some results for several joints, with both datasets collected while the robot was walking:
Velocity [rad/s]
Acceleration [rad/s^2]
Important
According to the plots, the velocity/acceleration of the torso roll appears smoother. This is likely because the original configuration did not enable the Kalman filter for the torso roll.
cc @isorrentino @DanielePucci