Make Get Trajectory Angular Velocity

Make Get Trajectory Angular Velocity