Update README.md
Merge remote-tracking branch 'origin/joint_impedance_ctrl_interface' into development
Cleaning code..