A vehicle, system and method of driving the vehicle. A radar system obtains a measured location of an object in an environment of the vehicle. A processor predicts a location of the object, determines a distance between the predicted location of the object and the measured location of the object, determines a confidence level for the predicted location the object based on the determined distance, selects a tracking state for the object based on the confidence level, and drives the vehicle to avoid the object according to the tracking state of the object. The processor and radar system may be onboard the vehicle.