自动驾驶全链路(感知、定位、规划、控制)的核心是空间位置与运动状态的精准描述,依赖一套层级清晰的坐标系体系,不同坐标系承担差异化核心职能,按全链路核心度、工程使用优先级排序如下:
★★★★★ 车体坐标系(Vehicle Coordinate System, VCS/Body Frame)
全链路核心枢纽,自动驾驶最重要的基准坐标系
- 标准定义:严格遵循ISO 8855道路车辆国际标准,行业主流工程定义为:原点在车辆后轴中心向地面的投影点(部分厂商定义在车辆质心/前轴中心,以整车标定为准),X轴沿车辆纵向向前(车头方向),Y轴沿车辆横向向左(驾驶员左侧),Z轴垂直地面向上,符合右手笛卡尔坐标系规则,单位为米(m)。
- 核心特点:与车身刚性绑定,相对位置永久固定,不受车辆运动、转向、俯仰影响;是所有传感器数据的统一局部基准,也是规划控制指令的唯一输出基准,承上启下衔接全功能模块。
- 核心用途:多传感器融合的统一基准、车辆运动学/动力学建模、局部路径规划、横向/纵向车辆控制、障碍物相对位置与碰撞风险评估,是决策、规划、控制模块的唯一基准坐标系。
★★★★★ 传感器坐标系(Sensor Coordinate System)
感知数据的原生基准,自动驾驶环境感知的基础每个车载传感器都有独立的坐标系,原点与轴向由硬件安装位置定义,最终通过标定转换到车体坐标系,是感知数据处理的第一基准,核心分类如下:
- 激光雷达坐标系(LiDAR Coordinate System)原点在激光雷达光学扫描中心,行业主流轴向与车体坐标系对齐(X轴向前,Y轴向左,Z轴向上),是点云数据采集、3D障碍物检测、点云配准定位、高精地图匹配的核心基准,支撑L2+及以上自动驾驶的核心感知与定位能力。
- 相机坐标系(Camera Coordinate System)原点在相机光心,X轴沿图像平面向右,Y轴沿图像平面向下,Z轴沿相机光轴向前,符合针孔成像模型,是图像特征提取、2D/3D目标检测、语义分割、单目/双目测距、视觉SLAM的基础坐标系。
- 毫米波雷达坐标系(Radar Coordinate System)原点在雷达天线相位中心,轴向通常与车体坐标系对齐,是动态目标距离、径向速度测量的基准,支撑恶劣天气下的感知补充、盲区监测、前向碰撞预警等功能。
- IMU坐标系(IMU Coordinate System)原点在IMU测量中心,工程上通常与车体坐标系刚性对齐,是车辆三轴角速度、三轴线加速度的测量基准,为GNSS+IMU组合导航提供高频位姿更新,直接决定定位与控制的实时性和精度。
★★★★☆ 局部导航坐标系(站心坐标系 ENU/NED)
连接车体与全球坐标系的核心桥梁,组合导航与局部规划的核心基准
- 核心定义:以地表某一固定参考点(车辆启动点/当前定位点)为原点的局部平面直角坐标系,分为两大主流制式:
- ENU坐标系(东北天,East-North-Up):自动驾驶行业绝对主流,X轴指向地理东向,Y轴指向地理北向,Z轴垂直地面向上,右手定则,单位米;
- NED坐标系(北东地,North-East-Down):航空与惯导领域主流,X轴指向地理北向,Y轴指向地理东向,Z轴垂直地面向下,部分车规级惯导原生输出该制式数据。
- 核心特点:将球面大地坐标转换为平面笛卡尔坐标系,百公里级局部区域内无投影形变,可直接用欧氏几何计算,计算效率高、无累计误差,坐标值直观。
- 核心用途:GNSS+IMU组合导航的位姿解算基准、局部路径规划、多车协同感知统一基准、激光/视觉SLAM的世界坐标系,定位模块高频输出的车辆位姿均基于该坐标系。
★★★★☆ WGS84大地坐标系(World Geodetic System 1984)
全球定位的绝对基准,自动驾驶全局位置的唯一通用锚点
- 核心定义:全球通用的地心大地坐标系,是GNSS(GPS、北斗、GLONASS、Galileo)的原生输出坐标系,原点为地球质心,Z轴指向国际协议地球北极,X轴指向本初子午线与赤道的交点,Y轴与X、Z轴构成右手正交坐标系;点位用经度λ、纬度φ、海拔高度h描述,核心参数:长半轴6378137m,扁率1/298.257223563。
- 核心特点:全球统一、无歧义的绝对地理基准,无局部累计误差,但属于球面坐标系,无法直接用于平面几何计算,必须经过投影转换才能进行距离、轨迹运算。
- 核心用途:GNSS原始定位数据输出基准、高精地图的绝对地理锚定、跨区域全局路径规划、不同设备/地图厂商的坐标统一基准,是车辆获取全球绝对位置的源头。
★★★★☆ UTM坐标系(通用横轴墨卡托投影坐标系)
全球主流平面投影坐标系,高精地图与大范围规划的核心平面基准
- 核心定义:基于WGS84的横轴墨卡托投影坐标系,将地球按经度划分为60个投影带,每个带覆盖6°经度,单独投影后转换为平面直角坐标系,单位为米;每个带设置中央子午线,X轴(北向)沿中央子午线向北,Y轴(东向)垂直中央子午线向东,通过固定偏移量避免负坐标(东向偏移500000米,南半球北向偏移10000000米)。
- 核心特点:单个投影带内(东西向约600km)投影形变极小、精度极高,平面坐标可直接用于欧氏几何计算,兼顾全球通用性与局部高精度,是国际高精地图的主流存储坐标系。
- 核心用途:高精地图的主流存储与加载坐标系、城市级/高速级大范围全局路径规划、多车/车路协同的全局平面坐标基准,Apollo等主流自动驾驶框架均采用其作为地图与规划模块的核心坐标系。
- 工程注意:跨投影带行驶时坐标会出现不连续,需进行带间转换,或切换为局部ENU坐标系解决。
★★★☆☆ 地心地固坐标系(ECEF,Earth-Centered Earth-Fixed)
GNSS解算的中间基准,全球坐标系转换的核心桥梁
- 核心定义:与WGS84同源的地心直角坐标系,原点在地球质心,X轴指向本初子午线与赤道的交点,Y轴在赤道平面内与X轴垂直向东,Z轴指向地球北极,与地球固连、同步自转,右手定则,单位为米。
- 核心特点:笛卡尔直角坐标系,可直接进行3D空间几何计算,是WGS84经纬度与ENU/UTM平面坐标系转换的核心中间媒介,GNSS接收机的原始定位解算均基于该坐标系完成。
- 核心用途:GNSS定位内部解算基准、WGS84与ENU/UTM坐标系转换的中间环节、全球长距离基线解算与差分定位计算。
★★★☆☆ 高斯-克吕格坐标系(Gauss-Kruger)
国内主流测绘投影坐标系,国内自动驾驶落地的重要配套基准
- 核心定义:与UTM同源的横轴墨卡托投影坐标系,是国内测绘、交通、地图行业的法定基准,分为6°带(与UTM分带一致,大范围测绘)和3°带(高精度城市测绘),基于国内北斗法定的CGCS2000国家大地坐标系构建,平面直角坐标系,单位为米。
- 核心用途:国内测绘、交通基建、国产地图的原生坐标系,是国内自动驾驶落地时地图与基建数据对接的核心基准,也是封闭园区、矿区、港口等限定场景自动驾驶的常用地图与定位基准。
★★★☆☆ 视觉专用坐标系(图像坐标系/像素坐标系)
视觉感知算法的专项基准
- 图像坐标系:原点在图像光学中心(主点),X轴沿图像平面向右,Y轴沿图像平面向下,单位毫米,是相机坐标系与像素坐标系的转换桥梁;
- 像素坐标系:原点在图像左上角,X轴沿图像行向右,Y轴沿图像列向下,单位像素,是图像数据的最终存储与处理坐标系。
- 核心用途:所有视觉感知算法(目标检测、语义分割、车道线识别、单目测距)的基础,图像处理、特征提取、目标识别均在该坐标系下完成,通过相机内参转换到相机坐标系,再通过外参转换到车体坐标系。
★★☆☆☆ 专项场景坐标系
特定模块的专用坐标系,按需使用,上层应用极少直接接触:
- 高精地图自定义坐标系:地图厂商基于UTM/高斯-克吕格投影自定义的局部平面坐标系,通常加入固定偏移与缩放,用于高精地图的加密与高效存储,地图匹配模块需适配该坐标系。
- OpenDRIVE道路坐标系:自动驾驶仿真与高精地图的行业标准道路坐标系,分为惯性坐标系、参考线坐标系(s/t/h轴)、局部坐标系,用于道路元素、车道线的精准描述,是仿真与规划模块的重要基准。
- 地心惯性坐标系(ECI):原点在地球质心,坐标轴相对于恒星固定,不随地球自转,仅用于GNSS卫星轨道解算,自动驾驶上层应用几乎不直接使用。
自动驾驶坐标系核心转换链路(工程落地核心)
像素坐标系 →(相机内参)→ 相机坐标系 →(传感器外参/标定)→ 车体坐标系 →(车辆位姿)→ 局部ENU坐标系 →(大地测量公式)→ ECEF坐标系 ↔(投影/反投影)↔ WGS84大地坐标系 ↔(投影/反投影)↔ UTM/高斯-克吕格坐标系
工程核心注意事项
- 所有坐标系的轴向定义必须严格统一,避免左右手定则、轴向方向混淆导致的定位与感知错误;
- 传感器外参标定精度直接决定坐标系转换精度,是自动驾驶感知与定位精度的核心前提;
- 严禁直接将WGS84经纬度作为平面坐标计算距离,必须先投影到UTM/ENU平面坐标系后再进行计算。