Test Trajectory Calculation