endWrtDisp

Returns the robot state at the end of the trajectory with respect to displacement.