SoftBodyController for hrpsys-base