Update impedance controller methods

Update impedance controller methods.
This PR should be wait for https://github.com/fkanehiro/hrpsys-base/pull/388.