Robust vehicle state estimation method for synergistic trajectory planning and tracking control | Synapse