Abstract: Systems and methods for controlling a vehicle. The systems and methods receive image data from at least one camera of the vehicle, detect a 2D measurement location of a static object in an image plane of the camera using the image data, receive an input vector of measurements from a sensor system of the vehicle, predict a predicted 3D location of the static object using a Unscented Kalman Filter (UKF) that incorporates a motion model for the vehicle and further using the 2D measurement location of the static object, and the input vector, and control at least one vehicle feature based on the predicted 3D location of the static object.