Trajectory function

Compute trajectories