First off, determine whether the localization is off or the controller is sloppy. If the localizer is off, consider changing to something like tracking wheels or reign in the constraints (at least reduce accel/angular velocity). If the localizer is roughly on target, you can try adding feedback (and also probably reducing the constraints).