本发明涉及一种用于车辆跟踪和定位的方法，包括：由控制器从第一车辆的传感器接收里程计数据、来自所述第一车辆的全球定位系统(GPS)装置的地理空间数据、来自所述第一车辆的惯性测量单元(IMU)的惯性数据；使用来自所述传感器的所述里程计数据、来自所述GPS装置的所述地理空间数据及来自所述第一车辆的所述IMU的所述惯性数据估计所述第一车辆的估计当前位置及所述第一车辆的估计当前轨迹；将惯性数据输入到贝叶斯网络中以确定第一车辆的预测位置和第一车辆的预测轨迹，以及使用里程计数据和地理空间数据使用第一车辆的估计当前位置和估计当前轨迹来更新贝叶斯网络。