Correct small error in trajectory interpolation for HRP4