基于MATLAB&SIMULINK开发自动驾驶系统第一讲之传感器配置和坐标系转换

1.1  自动驾驶工具箱中的坐标系统

自动驾驶工具箱使用这些坐标系:

- 世界坐标系:一个固定的通用坐标系,所有的车辆及其传感器都被放置在这个坐标系中

- 车辆坐标系:锚定在被控车辆上。通常情况下,车辆坐标系放在后轴中点正下方的地面上。

- 传感器坐标系:具体到一个特定的传感器,如相机或雷达。

- 空间:指的是空间。摄像机拍摄的图像空间坐标中的位置以像素为单位表示。

- 图案。棋盘模式坐标系统,通常用于校准摄像机传感器。

这些坐标系适用于整个自动驾驶工具箱功能,从感知到控制再到驾驶场景仿真。

1.1.1世界坐标系

所有的车辆、传感器及其相关的坐标系都放在世界坐标系中。  世界坐标系在全局路径规划、定位、制图和驾驶场景仿真中非常重要。自动驾驶工具箱使用ISO 8855中定义的右手笛卡尔世界坐标系,其中Z轴从地面向上指向。单位为米。

1.1.2 车辆坐标系

自动驾驶工具箱所使用的车辆坐标系(XV、YV、ZV)锚定在被控车辆上。被控车辆指的是包含感知车辆周围环境的传感器的车辆。

- XV轴指向车辆的前方。

- YV轴指向左边,如朝前看。

- ZV轴从地面指向上方,以保持右侧坐标系。

车辆坐标系遵循ISO 8855惯例进行旋转。每个轴在顺时针方向上都是正值,当看该轴的正方向时。

在大多数自动驾驶工具箱功能中,如三维驾驶场景仿真和视觉感知算法中,车辆坐标系的原点在后桥中点下方的地面上。在三维驾驶场景仿真中,原点在车辆纵向和横向中心的下方的地面上。

车辆坐标系中的位置用世界单位表示,通常是米。

由单个传感器返回的值被转换到车辆坐标系中,这样它们就可以被放置在一个统一的参考框架中。

在进行全局路径规划、定位、测绘和驾驶场景仿真时,可以用车辆的姿势来描述车辆的状态。车辆的转向角在逆时针方向为正值。

1.1.3 传感器坐标系

一个自动驾驶系统可以包含位于车辆上或车辆中任何地方的传感器。每个传感器的位置都包含其坐标系的原点。摄像头是自动驾驶系统中经常使用的一种传感器。在摄像机坐标系中表示的点以位于摄像机光学中心的原点来描述。

传感器的横摆、俯仰和侧倾角度遵循ISO惯例。当分别从Z轴、Y轴和X轴的正方向看时,这些角度具有正的顺时针方向。

1.1.4 空间坐标系

空间坐标使能够以比像素坐标更大的粒度来指定图像中的位置。在像素坐标系中,一个像素被视为一个离散的单位,由一个整数行和列对唯一标识。在空间坐标系中,图像中的位置用部分像素来表示。

1.1.5 模式坐标系

为了估计单目相机传感器的参数,常用的技术是使用校准图案的多幅图像来校准相机,如棋盘。在图案坐标系中,(XP,YP),XP轴指向右侧,YP轴指向下方。棋盘原点是棋盘左上角方块的右下角。

每个棋盘角都代表坐标系中的另一个点。例如,原点右边的角是(1,0),原点下方的角是(0,1)。

1.2 校准单目相机

单目摄像头是自动驾驶应用中常用的一种视觉传感器。当安装在被控车辆上时,这种摄像头可以探测物体,探测车道边界,并在场景中跟踪物体。

在使用摄像头之前,必须对其进行校准。摄像机校准是利用校准图案(如棋盘)的图像来估计摄像机的内在和外在参数的过程。估算出内在参数和外在参数后,就可以用它们来配置单眼相机的模型。

1.2.1 估算内在参数

相机的固有参数是相机的属性,如其焦距和光学中心。要估计单目相机的这些参数,请使用ComputerVision Toolbox函数和棋盘图案的图像。

- 如果相机有一个标准镜头,请使用估计CameraParameters函数。

- 如果相机具有鱼眼镜头,则使用估计FisheyeParameters函数。

另外,为了更好地将结果可视化,请使用Camera Calibrator应用程序。

1.2.2 放置外在参数估计的棋盘。

对于安装在车辆上的单目摄像机,外在参数定义了该摄像机的安装位置。这些参数包括摄像机相对于车辆坐标系的旋转角度,以及摄像机离地面的高度。

在估算外在参数之前, 必须从摄像机上捕捉到一个棋盘图案的图像。使用用来估计内在参数的相同棋盘图案。

棋盘使用以图案为中心的坐标系(XP,YP),其中XP轴指向右侧,YP轴指向下方。棋盘原点是棋盘左上角方格的右下角。

当将棋盘图案与车辆相对放置时,XP轴和YP轴必须与车辆的XV轴和YV轴对齐。在车辆坐标系中,XV轴指向车辆的正前方,YV轴指向左侧,如朝前看。原点在路面上,摄像机中心的正下方(摄像机的焦点)。

图案的方向可以是水平或垂直

水平方向

在水平方向上,棋盘图案在地面上,与地面平行。可以将图案放置在车辆前方、车辆后方或车辆的左侧或右侧。

垂直方向

在垂直方向,棋盘图案与地面垂直。可以将图案放置在车辆前方、车辆后方或车辆右侧的左侧。

1.2.3 估计外在参数

在将棋盘放置在想要的位置后,用单目相机捕捉它的图像。然后,使用估计MonoCameraParameters函数来估计外在参数。要使用该函数,必须指定以下内容:

- 摄像机的固有参数

- 在图像中探测到的关键点,在这种情况下,棋盘方块的角。

- 棋牌的世界积分

- 棋盘图案的原点离地面的高度。

例如,对于图像I和固有参数intrinsics,以下代码估计了外在参数。默认情况下,估计MonoCameraParameters假设相机朝向前方,并且棋盘图案具有水平方向。

[imagePoints,boardSize] = detectCheckerboardPoints(I);

squareSize = 0.029; % Square size in meters

worldPoints =generateCheckerboardPoints(boardSize,squareSize);

patternOriginHeight = 0; % Pattern is on ground

[pitch,yaw,roll,height] =estimateMonoCameraParameters(intrinsics,...

imagePoints,worldPoints,patternOriginHeight);

为了提高这些参数的估计精度,要采集多幅图像,并对图像点的值进行平均。

1.2.4 使用内在和外在参数配置摄像机

一旦获得了估计的内在和外在参数,就可以使用 monoCamera 对象来配置摄像机的模型。下面的示例代码显示了如何使用参数 intrinsics、高度、俯仰、横摆和侧倾来配置摄像机。

monoCam= monoCamera(intrinsics,height,'Pitch',pitch,'Yaw',yaw,'Roll',roll);

(0)

相关推荐