Update Pi and Lagrange Trajectories