pyrobosim.utils.trajectory.interpolate_trajectory

pyrobosim.utils.trajectory.interpolate_trajectory(traj: Trajectory, dt: float)

Interpolates a trajectory given a time step dt. Positions are interpolated linearly and the angle is interpolated using the Spherical Linear Interpolation (Slerp) method.

Parameters:
Returns:

Interpolated trajectory

Return type:

pyrobosim.utils.trajectory.Trajectory