Update state data
Begin trajectory comparison