add interpolation command in locomotion