利索能及
我要发布
收藏
专利号: 2018107195935
申请人: 杭州海康威视数字技术股份有限公司
专利类型:发明专利
专利状态:已下证
更新日期:2026-08-04
缴费截止日期: 暂无
联系人

摘要:

权利要求书:

1.一种车辆控制方法,其特征在于,所述方法包括:

获取自动驾驶车辆的当前位置点、姿态角和当前速度,以及获取所述自动驾驶车辆的期望路径和期望速度;

在所述期望路径上确定目标位置点,并在所述期望路径上确定与所述目标位置点相距预瞄距离的预瞄点,所述目标位置点为所述期望路径上距离所述当前位置点最近的位置点;

基于所述姿态角,确定所述自动驾驶车辆的当前行驶方向;确定当前预瞄偏差角,所述当前预瞄偏差角是指所述当前位置点和所述预瞄点的直线连线方向与所述自动驾驶车辆的当前行驶方向之间的夹角;确定期望预瞄偏差角,所述期望预瞄偏差角是指所述目标位置点和所述预瞄点的直线连线方向与所述期望路径在所述目标位置点处的切向方向之间的夹角;将所述期望预瞄偏差角和所述当前预瞄偏差角之间的角度差确定为方向转角;

基于所述当前速度和所述期望速度确定速度偏差;

基于所述方向转角和所述速度偏差控制所述自动驾驶车辆行驶。

2.根据权利要求1所述的方法,其特征在于,所述期望路径由多个位置点组成;

所述在所述期望路径上确定目标位置点,包括:

从所述多个位置点中获取与所述自动驾驶车辆的当前位置点之间的距离最小的位置点,并将获取的位置点确定为所述目标位置点。

3.根据权利要求1所述的方法,其特征在于,所述在所述期望路径上确定与所述目标位置点相距预瞄距离的预瞄点,包括:从所述目标位置点起,在所述期望路径上向所述自动驾驶车辆的前方推进预瞄距离,得到所述预瞄点。

4.根据权利要求1所述的方法,其特征在于,在所述期望路径的沿线上搭建有多个差分全球定位系统GPS基站,所述多个差分GPS基站中每个差分GPS基站到所述期望路径的最短距离处于预设距离范围之内;

所述获取自动驾驶车辆的当前位置点、姿态角和当前速度,包括:接收所述多个差分GPS基站中任一个差分GPS基站发送的定位信息,并获取所述自动驾驶车辆上的GPS的定位信息;

基于接收到的定位信息对所述自动驾驶车辆上的GPS的定位信息进行校正,并基于校正后的定位信息确定所述自动驾驶车辆的当前位置点;

通过所述自动驾驶车辆上安装的惯性导航设备测量所述自动驾驶车辆的姿态角,并通过所述惯性导航设备和所述自动驾驶车辆上安装的车载轮速编码器,确定所述当前速度。

5.一种车辆控制装置,其特征在于,所述装置包括:

获取模块,用于获取自动驾驶车辆的当前位置点、姿态角和当前速度,以及获取所述自动驾驶车辆的期望路径和期望速度;

第一确定模块,用于在所述期望路径上确定目标位置点,并在所述期望路径上确定与所述目标位置点相距预瞄距离的预瞄点,所述目标位置点为所述期望路径上距离所述当前位置点最近的位置点;

第二确定模块,用于基于所述当前位置点、所述姿态角、所述目标位置点和所述预瞄点确定方向转角,基于所述当前速度和所述期望速度确定速度偏差;

控制模块,用于基于所述方向转角和所述速度偏差控制所述自动驾驶车辆行驶;

所述第二确定模块具体用于:

基于所述姿态角,确定所述自动驾驶车辆的当前行驶方向;

确定当前预瞄偏差角,所述当前预瞄偏差角是指所述当前位置点和所述预瞄点的直线连线方向与所述自动驾驶车辆的当前行驶方向之间的夹角;

确定期望预瞄偏差角,所述期望预瞄偏差角是指所述目标位置点与所述预瞄点的直线连线方向与所述期望路径在所述目标位置点处的切向方向之间的夹角;

将所述期望预瞄偏差角和所述当前预瞄偏差角之间的角度差确定为所述方向转角。

6.根据权利要求5所述的装置,其特征在于,所述期望路径由多个位置点组成;

所述第一确定模块具体用于:

从所述多个位置点中获取与所述自动驾驶车辆的当前位置点之间的距离最小的位置点,并将获取的位置点确定为所述目标位置点。

7.根据权利要求5所述的装置,其特征在于,所述第一确定模块具体用于:从所述目标位置点起,在所述期望路径上向所述自动驾驶车辆的前方推进预瞄距离,得到所述预瞄点。

8.根据权利要求5所述的装置,其特征在于,在所述期望路径的沿线上搭建有多个差分全球定位系统GPS基站,所述多个差分GPS基站中每个差分GPS基站到所述期望路径的最短距离处于预设距离范围之内;

所述获取模块包括:

接收子模块,用于接收所述多个差分GPS基站中任一个差分GPS基站发送的定位信息,并获取所述自动驾驶车辆上的GPS的定位信息;

校正子模块,用于基于接收到的定位信息对所述自动驾驶车辆上的GPS的定位信息进行校正,并基于校正后的定位信息确定所述自动驾驶车辆的当前位置点;

确定子模块,用于通过所述自动驾驶车辆上安装的惯性导航设备测量所述自动驾驶车辆的姿态角,并通过所述惯性导航设备和所述自动驾驶车辆上安装的车载轮速编码器,确定所述当前速度。

9.一种自动驾驶设备,其特征在于,,包括:

GPS、传感器、车辆控制装置和执行机构;

所述GPS用于向所述车辆控制装置提供用于确定当前位置点的定位信息;

所述传感器用于测量姿态角和当前速度;

所述车辆控制装置用于对所述定位信息、所述姿态角和所述当前速度进行处理,所述车辆控制装置为权利要求5‑8任一所述的车辆控制装置;

所述执行机构用于接收所述车辆控制装置的处理结果,并根据所述处理结果控制所述自动驾驶车辆设备行驶。