updating slerp function for hop trajectories in Util