- Apply a hotfix for the "position_proportional_gain" bug of Gazebo (with Position command interface)
- Reduce the number of hardcoded parameters