本发明涉及用于传感器诊断的系统和方法。一种控制地面车辆的方法包括为该车辆设置构造成检测车辆位置的第一传感器、构造成检测该车辆的行驶路径的第二传感器以及控制器。该方法还包括通过第一传感器在行驶工况的时间间隔期间获得多个车辆位置坐标，并且通过该控制器基于该多个车辆位置坐标来计算第一路径曲率参数。该方法另外包括通过第二传感器基于该时间间隔期间的行驶路径来获得第二路径曲率参数。该方法还包括通过该控制器将第一路径曲率参数与第二路径曲率参数进行比较，并且响应于第二路径曲率与第一路径曲率之间的差超过阈值，而根据诊断模式来自动操作该控制器。