CN106909153A - 无人车横向控制方法和装置 - Google Patents

无人车横向控制方法和装置 Download PDF

Info

Publication number
CN106909153A
CN106909153A CN201710169068.6A CN201710169068A CN106909153A CN 106909153 A CN106909153 A CN 106909153A CN 201710169068 A CN201710169068 A CN 201710169068A CN 106909153 A CN106909153 A CN 106909153A
Authority
CN
China
Prior art keywords
vehicle
angle
little
aim
differential seat
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201710169068.6A
Other languages
English (en)
Other versions
CN106909153B (zh
Inventor
张潮
王帅强
贾士伟
李祎翔
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Jingdong Qianshi Technology Co Ltd
Original Assignee
Beijing Jingdong Century Trading Co Ltd
Beijing Jingdong Shangke Information Technology Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Beijing Jingdong Century Trading Co Ltd, Beijing Jingdong Shangke Information Technology Co Ltd filed Critical Beijing Jingdong Century Trading Co Ltd
Priority to CN201710169068.6A priority Critical patent/CN106909153B/zh
Publication of CN106909153A publication Critical patent/CN106909153A/zh
Application granted granted Critical
Publication of CN106909153B publication Critical patent/CN106909153B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明提出一种无人车横向控制方法，包括：确定多个预瞄点；获取车辆航向角与各个预瞄点处航向角的角度差；确定最小的角度差为车轮转角变化量。通过这样的方法，能够获取多个预瞄点，并选出最小的角度差，从而避免了车辆频繁的大幅度转向，提高了无人车行驶的平稳度。

Description

无人车横向控制方法和装置
技术领域
本发明涉及无人车技术领域，特别是一种无人车横向控制方法和装置。
背景技术
随着科技的发展，汽车保有量急剧增加，交通环境恶化，道路事故频发，无人驾驶汽车作为智能交通的一部分，能够有效缓解驾驶员疲劳，降低事故发生率，提高道路和车辆利用率。无人车是无人驾驶汽车的简称，无人车可以通过自身安装的传感器检测道路信息，自主完成路径规划并抵达目的地。通过获取组合导航系统数据，控制中心发出方向盘转角指令信号，实现无人车的横向控制。
现有技术中采用PID(Proportion Integral Differential，比例微分积分)控制算法和预瞄点算法实现无人车的横向控制。PID控制算法是对系统偏差做PID运算，获得车辆车轮转角；预瞄点算法从规划路径中获取预瞄点，通过当前位置和预瞄位置的偏差运算获取车轮转角，控制车辆按规划路径行驶。但是，这样的算法往往会导致频繁输出转角控制指令，造成方向盘抖动，行驶不平稳。
发明内容
本发明的一个目的在于提高无人车行驶的平稳度。
根据本发明的一个实施例，提出一种无人车横向控制方法，包括：确定多个预瞄点；获取车辆航向角与各个预瞄点处航向角的角度差；确定最小的角度差为车轮转角变化量。
可选地，确定多个预瞄点包括：从预定路径上选择与车辆位置点的距离在预定预瞄距离范围内的多个点作为预瞄点。
可选地，车辆位置点为车辆当前位置或经过系统时延后车辆所处的预测点位置。
可选地，车辆航向角为车辆当前航向角或经过系统时延后车辆所处的预测点位置的预测点车辆航向角。
可选地，还包括：根据当前车辆转弯半径、当前速度和系统时延确定预测点位置和预测点车辆航向角。
可选地，获取车辆航向角与各个预瞄点处航向角的角度差包括：根据预测点位置、预测点车辆航向角和预瞄点的位置确定到各个预瞄点的车轮转角；根据车辆轴距、车轮转角和当前速度确定车辆到各个预瞄点的曲线距离；根据曲线距离和当前速度确定从车辆预测点位置到各个预瞄点的行驶时间；根据行驶时间、当前速度、车轮转角确定到各个预瞄点的角度差。
可选地，还包括：将角度差最小的预瞄点作为唯一预瞄点。
通过这样的方法，能够获取多个预瞄点，并选出最小的角度差，从而避免了车辆频繁的大幅度转向，提高了无人车行驶的平稳度。
根据本发明的另一个实施例，提出一种无人车横向控制装置，包括：预瞄点确定单元，用于确定多个预瞄点；角度差获取单元，用于获取车辆航向角与各个预瞄点处航向角的角度差；转角变化确定单元，用于确定最小的角度差为车轮转角变化量。
可选地，预瞄点确定单元用于从预定路径上选择与车辆位置点的距离在预定预瞄距离范围内的多个点作为预瞄点。
可选地，车辆位置点为车辆当前位置或经过系统时延后车辆所处的预测点位置。
可选地，车辆航向角为车辆当前航向角或经过系统时延后车辆所处的预测点位置的预测点车辆航向角。
可选地，还包括：预测点确定单元，用于根据当前车辆转弯半径、当前速度和系统时延确定预测点位置和预测点车辆航向角。
可选地，角度差获取单元包括：车轮转角确定子单元，用于根据预测点位置、预测点车辆航向角和预瞄点的位置确定到各个预瞄点的车轮转角；曲线距离确定子单元，用于根据车辆轴距、车轮转角和当前速度确定车辆到各个预瞄点的曲线距离；行驶时间确定子单元，用于根据曲线距离和当前速度确定从车辆预测点位置到各个预瞄点的行驶时间；角度差确定子单元，用于根据行驶时间、当前速度、车轮转角确定到各个预瞄点的角度差。
可选地，还包括：唯一预瞄点确定单元，用于将角度差最小的预瞄点作为唯一预瞄点。
这样的装置能够获取多个预瞄点，并选出最小的角度差作为车轮转角，从而避免了车辆频繁的大幅度转向，提高了无人车行驶的平稳度。
根据本发明的又一个实施例，提出一种无人车横向控制装置，包括：存储器；以及耦接至存储器的处理器，处理器被配置为基于存储在存储器的指令执行上文中任意一种无人车横向控制方法。
这样的装置能够获取多个预瞄点，并选出最小的角度差作为车轮转角，从而避免了车辆频繁的大幅度转向，提高了无人车行驶的平稳度。
根据本发明的再一个实施例，提出一种计算机可读存储介质，其上存储有计算机程序指令，该指令被处理器执行时实现上文中任意一种无人车横向控制方法的步骤。
这样的计算机可读存储介质能够执行上文中的无人车横向控制方法，从而避免了车辆频繁的大幅度转向，提高了无人车行驶的平稳度。
附图说明
此处所说明的附图用来提供对本发明的进一步理解，构成本申请的一部分，本发明的示意性实施例及其说明用于解释本发明，并不构成对本发明的不当限定。在附图中：
图1为本发明的无人车横向控制方法的一个实施例的流程图。
图2为本发明的无人车横向控制方法中确定预瞄点的一个实施例的流程图。
图3为本发明的无人车横向控制方法的又一个实施例的流程图。
图4为本发明的无人车横向控制方法中确定角度差的一个实施例的流程图。
图5为本发明的无人车横向控制方法的再一个实施例的流程图。
图6为本发明的无人车横向控制装置的一个实施例的示意图。
图7为本发明的无人车横向控制装置的另一个实施例的示意图。
图8为本发明的无人车横向控制装置中角度差获取单元的一个实施例的示意图。
图9为本发明的无人车横向控制装置的一个实施例的效果图。
图10为本发明的无人车横向控制装置的再一个实施例的示意图。
图11为本发明的无人车横向控制装置的另外一个实施例的示意图。
具体实施方式
下面通过附图和实施例，对本发明的技术方案做进一步的详细描述。
本发明的无人车横向控制方法的一个实施例的流程图如图1所示。
在步骤101中，确定多个预瞄点。在一个实施例中，可以根据预定路径在探测范围内选取多个点作为预瞄点。
在步骤102中，获取车辆航向角与各个预瞄点处航向角的角度差。在一个实施例中，车辆航向角可以是车辆当前的航向角。预瞄点处的航向角可以是车辆行驶到预瞄点位置时的航向角。在一个实施例中，可以计算车辆到达各个预瞄点的路径，得到到达各个预瞄点处的航向角，进而计算车辆当前航向角与预瞄点处航向角的角度差。在一个实施例中，还可以根据车辆到达各个预瞄点的路径直接计算角度差。
在步骤103中，将车辆当前航向角与各个预瞄点处航向角的角度差进行比较，确定最小的角度差为车轮转角变化量。在一个实施例中，还可以将该车轮转角变化量对应的预瞄点作为唯一预瞄点，以该唯一预瞄点为基准进行车辆驱动操作。
通过这样的方法，能够获取多个预瞄点，并选出最小的角度差，从而避免了车辆频繁的大幅度转向，提高了无人车行驶的平稳度。
本发明的无人车横向控制方法中确定预瞄点的一个实施例的流程图如图2所示。
在步骤201中，确定预定路径上的点。在一个实施例中，无人车上的探测器能够获取一定范围内的预定路径探测数据，可以获取能够探测到的预定路径上的所有点到无人车的距离。
在步骤202中，从预定路径上的点中选择与车辆位置点的距离在预定预瞄距离范围内的多个点作为预瞄点。在一个实施例中，可以根据测试效果或具体需要设定预定预瞄距离范围，将预定预瞄距离范围内预定路径上的所有点作为预瞄点。在一个实施例中，也可以设定选点数量，从预定预瞄距离范围内预定路径上选择多个点作为预瞄点。
通过这样的方法，能够从预定路径上选择多个点作为预瞄点，一方面能够保证无人车不会偏离预定路径，另一方面也避免车辆频繁计算预瞄点，提高车辆平稳度。
在一个实施例中，由于无人车的软硬件系统会存在系统时延，因此为了减少误差，可以以车辆经过系统时延后的预测位置作为车辆位置计算角度差，从而提高准确度。
本发明的无人车横向控制方法的又一个实施例的流程图如图3所示。
在步骤301中，根据当前车辆转弯半径、当前速度和系统时延确定预测点位置和预测点车辆航向角。在一个实施例中，可以获取车辆当前行驶速度、当前车辆航向角，结合配置的系统时延进行计算。
在步骤302中，从预定路径上选择与车辆位置点的距离在预定预瞄距离范围内的多个点作为预瞄点。在一个实施例中，可以采用图2实施例中的方式获取多个预瞄点。在一个实施例中，车辆位置点可以为车辆当前位置，也可以为预测点位置。
在步骤303中，获取经过系统时延后车辆所处的预测点位置的预测点车辆航向角与各个预瞄点处航向角的角度差。
在步骤304中，确定最小的角度差为车轮转角变化量，将角度差最小的预瞄点作为唯一预瞄点。
通过这样的方法，能够先根据车辆的系统时延计算预测点位置和预测点车辆航向角，进而以预测点位置和预测点车辆航向角为基准计算角度差，从而弥补了系统时延造成的影响，提高了角度差计算的准确性。
本发明的无人车横向控制方法中确定角度差的一个实施例的流程图如图4所示。
在步骤401中，根据预测点位置、预测点车辆航向角和预瞄点的位置确定到各个预瞄点的车轮转角。
在步骤402中，根据车辆轴距、车轮转角和当前速度确定车辆到各个预瞄点的曲线距离。
在步骤403中，根据曲线距离和当前速度确定从车辆预测点位置到各个预瞄点的行驶时间。
在步骤404中，根据行驶时间、当前速度、车轮转角确定到各个预瞄点的角度差。
通过这样的方法，能够根据车辆行驶数据和车辆自身状态数据确定角度差，运算过程清晰且复杂度小，提高了计算效率且降低了对无人车硬件的要求，有利于提高无人车的反应速度，且有利于推广应用。
本发明的无人车横向控制方法的再一个实施例的流程图如图5所示。
在步骤501中，在预定时间、事件或周期的激发下开始无人车横向定位过程。
在步骤502中，获取无人车道路数据和车辆信息。无人车道路数据可以采用矩阵R进行标识。
在步骤503中，提取矩阵R中的车辆当前位置S、当前速度V和车辆当前航向角Vehicle_A。
在步骤504中，获取前一周期的车轮转角WA。
在步骤505中，基于系统设定或服务器数据得到车辆轴距WL。
在步骤506中，计算车辆当前位置到预瞄点位置的转弯半径WR，在一个实施例中，可以如公式
WR＝WL*WA (1)
计算转弯半径WR。
在步骤507中，基于系统设定或服务器数据得到系统时延T。
在步骤508中，计算车辆当前位置到预测位置的弧长AL。在一个实施例中，可以采用公式
AL＝V*T (2)
计算弧长AL。
在步骤509中，计算车辆当前位置到预测点位置的直线距离LD。在一个实施例中，可以采用公式
LD＝2*WR*sin(AL/(2WR)) (3)
计算直线距离LD。
在步骤510中，确定车辆预测点位置相对于当前位置的坐标(Xc,Yc)，并获取车辆预测点位置相对大地的坐标(XC,YC)。在一个实施例中，可以采用公式(4)(5)计算(Xc,Yc)，采用公式(6)(7)计算(XC,YC)：
Xc＝LD2/(2*WR) (4)
Yc＝sqrt(LD2*(1-LD2/(4*WR2))) (5)
XC＝Xc*cos(Vehicle_A-π/2)-Yc*sin(Vehicle_A-π/2)
+Xc (5)
YC＝Xc*sin(Vehicle_A-π/2)+Yc*cos(Vehicle_A-π/2)
+Yc (6)
在步骤511中，确定预定点位置的航向变化量C_Y。在一个实施例中，可以采用公式：
C_Y＝V*T*tan(WA)/WL (7)
计算预定点位置的航向变化量C_Y。
在步骤512中，获取车辆预测点位置与预定路径上点的距离，取最近点(XR,YR)。
在步骤513中，根据预定预瞄距离，得到多个预瞄点，均以(XP，YP)表示。在一个实施例中，可以以(XR,YR)为起始点，根据预定预瞄距离修改(XR,YR)坐标，得到(XP，YP)。
在步骤514中，计算车辆预测点位置与各个预瞄点位置的横向偏差BIAS，可以根据公式：
BIAS＝(XP-XC)*sin(π+Vehicle_A+C_Y)-(YP-YC)*
cos(π+Vehicle_A+C_Y) (8)
计算横向偏差BIAS。
在步骤515中，计算车轮转角WA_A,转弯半径RL,曲线距离SL，行驶时间T_T。可以采用公式：
WA_A＝arctan((2*WL*BIAS)/L2) (9)
计算车轮转角WA_A，其中，L为车辆预测点位置与该预瞄点的直线距离；
可以采用公式：
RL＝WL/tan(WA_A) (10)
计算车辆转弯半径RL；
采用公式：
SL＝2*RL*arcsin(L/(2*RL)) (11)
计算曲线长度SL；
采用公式：
T_T＝SL/V (12)
计算行驶时间T_T。
在步骤516中，计算车轮转角变化量WA_A_C。在一个实施例中，可以采用公式：
WA_A_C＝(V*T_T*tan(WA_A))/WL (13)
计算车轮转角变化量WA_A_C。
在步骤517中，车辆在预瞄点位置的航向角Vehicle_A_F。在一个实施例中，可以利用公式：
Vehicle_A_F＝Vehicle_A+WA_A_C (14)
计算车辆在预瞄点位置的航向角Vehicle_A_F。
在步骤518中，预瞄点航向角角度差处理，获取角度差最小的车轮转角WA，该最小的车轮转角WA对应的预瞄点即为唯一预瞄点。
在步骤519中，流程结束，等待下一次横向控制计算。
通过这样的方法，能够根据车辆行驶数据和车辆自身状态数据确定角度差，运算过程清晰且复杂度小，提高了计算效率且降低了对无人车硬件的要求，有利于提高无人车的反应速度，且有利于推广应用。
本发明的无人车横向控制装置的一个实施例的示意图如图6所示。预瞄点确定单元601能够确定多个预瞄点。在一个实施例中，可以根据预定路径在探测范围内选取多个点作为预瞄点。角度差获取单元602能够获取车辆航向角与各个预瞄点处航向角的角度差。在一个实施例中，可以计算车辆到达各个预瞄点的路径，得到到达各个预瞄点处的航向角，进而计算车辆当前航向角与预瞄点处航向角的角度差。在一个实施例中，还可以根据车辆到达各个预瞄点的路径直接计算角度差。转角变化确定单元603能够将车辆当前航向角与各个预瞄点处航向角的角度差进行比较，确定最小的角度差为车轮转角变化量。在一个实施例中，还可以将该车轮转角变化量对应的预瞄点作为唯一预瞄点，以该唯一预瞄点为基准进行车辆驱动操作。
这样的装置能够获取多个预瞄点，并选出最小的角度差，从而避免了车辆频繁的大幅度转向，提高了无人车行驶的平稳度。
在一个实施例中，预瞄点确定单元601可以先确定预定路径上的点，进而从预定路径上选择与车辆位置点的距离在预定预瞄距离范围内的多个点作为预瞄点。在一个实施例中，无人车上的探测器能够获取一定范围内的预定路径探测数据，可以获取能够探测到的预定路径上的所有点到无人车的距离。在一个实施例中，可以根据测试效果或具体需要设定预定预瞄距离范围，将预定预瞄距离范围内预定路径上的所有点作为预瞄点。在一个实施例中，也可以设定选点数量，从预定预瞄距离范围内预定路径上选择多个点作为预瞄点。
这样的装置能够从预定路径上选择多个点作为预瞄点，一方面能够保证无人车不会偏离预定路径，另一方面也避免车辆以固定距离的路径上的点作为预瞄点而导致的频繁修改车轮转角，提高车辆平稳度。
在一个实施例中，由于无人车的软硬件系统会存在系统时延，因此为了减少误差，可以以车辆经过系统时延后的预测位置作为车辆位置计算角度差以提高准确度。本发明的无人车横向控制装置的另一个实施例的示意图如图7所示。其中，预瞄点确定单元701、角度差获取单元702和转角变化确定单元703的结构和功能与图6所示的实施例中相似。无人车横向控制装置还包括预测点确定单元704，能够根据当前车辆转弯半径、当前速度和系统时延确定预测点位置和预测点车辆航向角。在一个实施例中，可以获取车辆当前行驶速度、当前车辆航向角，结合配置的系统时延进行计算。预瞄点确定单元701从预定路径上选择与车辆位置点的距离在预定预瞄距离范围内的多个点作为预瞄点。在一个实施例中，车辆位置点可以为车辆当前位置，也可以为预测点位置。角度差获取单元702能够获取经过系统时延后车辆所处的预测点位置的预测点车辆航向角与各个预瞄点处航向角的角度差。转角变化确定单元703能够确定最小的角度差为车轮转角变化量，将角度差最小的预瞄点作为唯一预瞄点。
这样的装置能够先根据车辆的系统时延计算预测点位置和预测点车辆航向角，进而以预测点位置和预测点车辆航向角为基准计算角度差，从而弥补了系统时延造成的影响，提高了角度差计算的准确性。
本发明的无人车横向控制装置中角度差获取单元的一个实施例的示意图如图8所示。其中，车轮转角确定子单元801能够根据预测点位置、预测点车辆航向角和预瞄点的位置确定到各个预瞄点的车轮转角。曲线距离确定子单元802能够根据车辆轴距、车轮转角和当前速度确定车辆到各个预瞄点的曲线距离。行驶时间确定子单元803能够根据曲线距离和当前速度确定从车辆预测点位置到各个预瞄点的行驶时间。角度差确定子单元804能够根据行驶时间、当前速度、车轮转角确定到各个预瞄点的角度差。
这样的装置能够根据车辆行驶数据和车辆自身状态数据确定角度差，运算过程清晰且复杂度小，提高了计算效率且降低了对无人车硬件的要求，有利于提高无人车的反应速度，且有利于推广应用。
本发明的无人车横向控制装置的一个实施例的效果图如图9所示。采用MATLAB进行仿真调试，其中，平滑曲线所示的为规划路径，星形标识所示的为无人车实际行驶路径。从对比可以看出，无人车实际行驶路径基本符合规划路径，且更为平滑，从而能够在保证无人车不会偏离预定路径的同时，避免车辆以固定距离的路径上的点作为预瞄点而导致的频繁修改车轮转角，提高车辆平稳度。
本发明无人车横向控制装置的另一个实施例的结构示意图如图10所示。无人车横向控制装置包括存储器1010和处理器1020。其中：存储器1010可以是磁盘、闪存或其它任何非易失性存储介质。存储器用于存储物品三维重建方法的对应实施例中的指令。处理器1020耦接至存储器1010，可以作为一个或多个集成电路来实施，例如微处理器或微控制器。该处理器1020用于执行存储器中存储的指令，能够实现无人车横向控制，且提高无人车行驶的稳定度。
在一个实施例中，还可以如图11所示，无人车横向控制装置1100包括存储器1110和处理器1120。处理器1120通过BUS总线1130耦合至存储器1110。该无人车横向控制装置1100还可以通过存储接口1140连接至外部存储装置1150以便调用外部数据，还可以通过网络接口1160连接至网络或者另外一台计算机系统(未标出)。此处不再进行详细介绍。
在该实施例中，通过存储器存储数据指令，再通过处理器处理上述指令，能够实现无人车横向控制，且提高无人车行驶的稳定度。
在另一个实施例中，一种计算机可读存储介质，其上存储有计算机程序指令，该指令被处理器执行时实现无人车横向控制方法的对应实施例中的方法的步骤。本领域内的技术人员应明白，本发明的实施例可提供为方法、装置、或计算机程序产品。因此，本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且，本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用非瞬时性存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明是参照根据本发明实施例的方法、设备(系统)和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器，使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中，使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品，该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上，使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理，从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
至此，已经详细描述了本发明。为了避免遮蔽本发明的构思，没有描述本领域所公知的一些细节。本领域技术人员根据上面的描述，完全可以明白如何实施这里公开的技术方案。
可能以许多方式来实现本发明的方法以及装置。例如，可通过软件、硬件、固件或者软件、硬件、固件的任何组合来实现本发明的方法以及装置。用于所述方法的步骤的上述顺序仅是为了进行说明，本发明的方法的步骤不限于以上具体描述的顺序，除非以其它方式特别说明。此外，在一些实施例中，还可将本发明实施为记录在记录介质中的程序，这些程序包括用于实现根据本发明的方法的机器可读指令。因而，本发明还覆盖存储用于执行根据本发明的方法的程序的记录介质。
最后应当说明的是：以上实施例仅用以说明本发明的技术方案而非对其限制；尽管参照较佳实施例对本发明进行了详细的说明，所属领域的普通技术人员应当理解：依然可以对本发明的具体实施方式进行修改或者对部分技术特征进行等同替换；而不脱离本发明技术方案的精神，其均应涵盖在本发明请求保护的技术方案范围当中。

Claims (16)

1.一种无人车横向控制方法，包括：
确定多个预瞄点；
获取车辆航向角与各个预瞄点处航向角的角度差；
确定最小的所述角度差为车轮转角变化量。
2.根据权利要求1所述的方法，其中，所述确定多个预瞄点包括：
从预定路径上选择与车辆位置点的距离在预定预瞄距离范围内的多个点作为所述预瞄点。
3.根据权利要求2所述的方法，所述车辆位置点为车辆当前位置或经过系统时延后车辆所处的预测点位置。
4.根据权利要求1所述的方法，其中，所述车辆航向角为车辆当前航向角或经过系统时延后车辆所处的预测点位置的预测点车辆航向角。
5.根据权利要求4所述的方法，还包括：
根据当前车辆转弯半径、当前速度和系统时延确定所述预测点位置和所述预测点车辆航向角。
6.根据权利要求4或5所述的方法，其中，所述获取车辆航向角与各个所述预瞄点处航向角的角度差包括：
根据所述预测点位置、所述预测点车辆航向角和所述预瞄点的位置确定到各个所述预瞄点的车轮转角；
根据车辆轴距、所述车轮转角和当前速度确定车辆到各个所述预瞄点的曲线距离；
根据所述曲线距离和当前速度确定从所述车辆预测点位置到各个所述预瞄点的行驶时间；
根据所述行驶时间、所述当前速度、所述车轮转角确定到各个所述预瞄点的所述角度差。
7.根据权利要求1～5任意一项所述的方法，还包括：
将所述角度差最小的所述预瞄点作为唯一预瞄点。
8.一种无人车横向控制装置，包括：
预瞄点确定单元，用于确定多个预瞄点；
角度差获取单元，用于获取车辆航向角与各个所述预瞄点处航向角的角度差；
转角变化确定单元，用于确定最小的所述角度差为车轮转角变化量。
9.根据权利要求8所述的装置，其中，所述预瞄点确定单元具体用于从预定路径上选择与车辆位置点的距离在预定预瞄距离范围内的多个点作为所述预瞄点。
10.根据权利要求9所述的装置，所述车辆位置点为车辆当前位置或经过系统时延后车辆所处的预测点位置。
11.根据权利要求8所述的装置，其中，
所述车辆航向角为车辆当前航向角或经过系统时延后车辆所处的预测点位置的预测点车辆航向角。
12.根据权利要求11所述的装置，还包括：
预测点确定单元，用于根据当前车辆转弯半径、当前速度和系统时延确定所述预测点位置和所述预测点车辆航向角。
13.根据权利要求11或12所述的装置，其中，所述角度差获取单元包括：
车轮转角确定子单元，用于根据所述预测点位置、所述预测点车辆航向角和所述预瞄点的位置确定到各个所述预瞄点的车轮转角；
曲线距离确定子单元，用于根据车辆轴距、所述车轮转角和当前速度确定车辆到各个所述预瞄点的曲线距离；
行驶时间确定子单元，用于根据所述曲线距离和当前速度确定从所述车辆预测点位置到各个所述预瞄点的行驶时间；
角度差确定子单元，用于根据所述行驶时间、所述当前速度、所述车轮转角确定到各个所述预瞄点的所述角度差。
14.根据权利要求8～12任意一项所述的装置，还包括：
唯一预瞄点确定单元，用于将所述角度差最小的所述预瞄点作为唯一预瞄点。
15.一种无人车横向控制装置，包括：
存储器；以及
耦接至所述存储器的处理器，所述处理器被配置为基于存储在所述存储器的指令执行如权利要求1至7任意一项所述的方法。
16.一种计算机可读存储介质，其上存储有计算机程序指令，该指令被处理器执行时实现权利要求1至7任意一项所述的方法的步骤。
CN201710169068.6A 2017-03-21 2017-03-21 无人车横向控制方法和装置 Active CN106909153B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710169068.6A CN106909153B (zh) 2017-03-21 2017-03-21 无人车横向控制方法和装置

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710169068.6A CN106909153B (zh) 2017-03-21 2017-03-21 无人车横向控制方法和装置

Publications (2)

Publication Number Publication Date
CN106909153A true CN106909153A (zh) 2017-06-30
CN106909153B CN106909153B (zh) 2020-07-31

Family

ID=59195280

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710169068.6A Active CN106909153B (zh) 2017-03-21 2017-03-21 无人车横向控制方法和装置

Country Status (1)

Country Link
CN (1) CN106909153B (zh)

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107918388A (zh) * 2017-11-08 2018-04-17 深圳市招科智控科技有限公司 港口集装箱搬运无人车轨迹控制方法及装置
CN108549373A (zh) * 2018-04-10 2018-09-18 清华大学 一种基于导航角偏差进行车辆运行信息处理的方法和装置
CN108549371A (zh) * 2018-03-28 2018-09-18 安徽农业大学 一种高地隙植保机械路径跟踪方法及系统
CN108609014A (zh) * 2018-05-04 2018-10-02 奇瑞汽车股份有限公司 智能车辆的横向控制方法及装置
CN109703566A (zh) * 2018-12-29 2019-05-03 百度在线网络技术（北京）有限公司 一种速度控制指令处理方法和车辆
CN109976341A (zh) * 2019-03-21 2019-07-05 驭势科技（北京）有限公司 一种自动驾驶车辆附着路网的方法、车载设备及存储介质
CN109976387A (zh) * 2019-05-07 2019-07-05 江苏盛海智能科技有限公司 一种无人车探测轨迹的方法及终端
CN110001637A (zh) * 2019-04-10 2019-07-12 吉林大学 一种基于多点跟踪的无人驾驶汽车路径跟踪控制装置及控制方法
CN110789531A (zh) * 2019-10-09 2020-02-14 福瑞泰克智能系统有限公司 一种车辆过弯速度确定方法、装置、电子设备和车辆
CN111284478A (zh) * 2020-03-13 2020-06-16 联创汽车电子有限公司 预瞄路径跟踪计算方法及跟踪计算模块
CN112859826A (zh) * 2019-11-26 2021-05-28 北京京东乾石科技有限公司 用于控制无人搬运车的方法和装置
CN113129460A (zh) * 2021-03-17 2021-07-16 深圳成谷软件有限公司 智能交通系统中的车辆的行驶方向确定方法及车载单元
WO2022095460A1 (zh) * 2020-11-06 2022-05-12 广州小鹏自动驾驶科技有限公司 一种车辆横向控制方法、装置、车辆和可读存储介质

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101118500A (zh) * 2007-08-02 2008-02-06 上海交通大学 自主驾驶车辆行驶过程的软件仿真方法
US20110202238A1 (en) * 2007-08-03 2011-08-18 Cambridge Enterprise Limited Active steering controller
CN202453757U (zh) * 2011-12-14 2012-09-26 长安大学 一种基于视觉的自动寻迹智能车控制装置
CN103764483A (zh) * 2011-08-31 2014-04-30 丰田自动车株式会社 车辆的行驶控制装置
CN103941742A (zh) * 2014-04-29 2014-07-23 中国科学院自动化研究所 一种无人机滑跑纠偏控制装置及方法
CN104571112A (zh) * 2015-01-14 2015-04-29 中国科学院合肥物质科学研究院 基于转弯曲率估计的无人车横向控制方法
KR20150061781A (ko) * 2013-11-28 2015-06-05 현대모비스 주식회사 차량 코너링 제어 방법 및 그 장치
CN104859650A (zh) * 2015-05-28 2015-08-26 吉林大学 一种多时间尺度的车辆横摆稳定性滚动优化控制方法
CN104960520A (zh) * 2015-07-16 2015-10-07 北京工业大学 基于Pure Pursuit算法的预瞄点确定方法
CN105651286A (zh) * 2016-02-26 2016-06-08 中国科学院宁波材料技术与工程研究所 一种移动机器人视觉导航方法与系统、以及仓库系统
CN105867377A (zh) * 2016-04-13 2016-08-17 浙江理工大学 一种农业机械自动导航控制方法

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101118500A (zh) * 2007-08-02 2008-02-06 上海交通大学 自主驾驶车辆行驶过程的软件仿真方法
US20110202238A1 (en) * 2007-08-03 2011-08-18 Cambridge Enterprise Limited Active steering controller
CN103764483A (zh) * 2011-08-31 2014-04-30 丰田自动车株式会社 车辆的行驶控制装置
CN202453757U (zh) * 2011-12-14 2012-09-26 长安大学 一种基于视觉的自动寻迹智能车控制装置
KR20150061781A (ko) * 2013-11-28 2015-06-05 현대모비스 주식회사 차량 코너링 제어 방법 및 그 장치
CN103941742A (zh) * 2014-04-29 2014-07-23 中国科学院自动化研究所 一种无人机滑跑纠偏控制装置及方法
CN104571112A (zh) * 2015-01-14 2015-04-29 中国科学院合肥物质科学研究院 基于转弯曲率估计的无人车横向控制方法
CN104859650A (zh) * 2015-05-28 2015-08-26 吉林大学 一种多时间尺度的车辆横摆稳定性滚动优化控制方法
CN104960520A (zh) * 2015-07-16 2015-10-07 北京工业大学 基于Pure Pursuit算法的预瞄点确定方法
CN105651286A (zh) * 2016-02-26 2016-06-08 中国科学院宁波材料技术与工程研究所 一种移动机器人视觉导航方法与系统、以及仓库系统
CN105867377A (zh) * 2016-04-13 2016-08-17 浙江理工大学 一种农业机械自动导航控制方法

Cited By (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107918388A (zh) * 2017-11-08 2018-04-17 深圳市招科智控科技有限公司 港口集装箱搬运无人车轨迹控制方法及装置
CN108549371A (zh) * 2018-03-28 2018-09-18 安徽农业大学 一种高地隙植保机械路径跟踪方法及系统
CN108549373A (zh) * 2018-04-10 2018-09-18 清华大学 一种基于导航角偏差进行车辆运行信息处理的方法和装置
CN108609014A (zh) * 2018-05-04 2018-10-02 奇瑞汽车股份有限公司 智能车辆的横向控制方法及装置
CN109703566A (zh) * 2018-12-29 2019-05-03 百度在线网络技术（北京）有限公司 一种速度控制指令处理方法和车辆
CN109976341A (zh) * 2019-03-21 2019-07-05 驭势科技（北京）有限公司 一种自动驾驶车辆附着路网的方法、车载设备及存储介质
CN110001637B (zh) * 2019-04-10 2023-09-29 吉林大学 一种基于多点跟踪的无人驾驶汽车路径跟踪控制装置及控制方法
CN110001637A (zh) * 2019-04-10 2019-07-12 吉林大学 一种基于多点跟踪的无人驾驶汽车路径跟踪控制装置及控制方法
CN109976387A (zh) * 2019-05-07 2019-07-05 江苏盛海智能科技有限公司 一种无人车探测轨迹的方法及终端
CN110789531A (zh) * 2019-10-09 2020-02-14 福瑞泰克智能系统有限公司 一种车辆过弯速度确定方法、装置、电子设备和车辆
CN112859826A (zh) * 2019-11-26 2021-05-28 北京京东乾石科技有限公司 用于控制无人搬运车的方法和装置
CN111284478A (zh) * 2020-03-13 2020-06-16 联创汽车电子有限公司 预瞄路径跟踪计算方法及跟踪计算模块
WO2022095460A1 (zh) * 2020-11-06 2022-05-12 广州小鹏自动驾驶科技有限公司 一种车辆横向控制方法、装置、车辆和可读存储介质
CN113129460A (zh) * 2021-03-17 2021-07-16 深圳成谷软件有限公司 智能交通系统中的车辆的行驶方向确定方法及车载单元
CN113129460B (zh) * 2021-03-17 2024-01-02 深圳成谷科技有限公司 智能交通系统中的车辆的行驶方向确定方法及车载单元

Also Published As

Publication number Publication date
CN106909153B (zh) 2020-07-31

Similar Documents

Publication Publication Date Title
CN106909153A (zh) 无人车横向控制方法和装置
JP6784794B2 (ja) 自動運転車の経路計画用のドリフト補正の方法
JP6878493B2 (ja) 自動運転車両（ａｄｖ）に用いるピッチ角の補正方法
CN106092121B (zh) 车辆导航方法和装置
JP6653381B2 (ja) 自律走行車の制御フィードバックに基づくマップ更新方法およびシステム
CN108508883B (zh) 车辆位置估计设备和方法及使用其的车辆
US11377119B2 (en) Drifting correction between planning stage and controlling stage of operating autonomous driving vehicles
CN106575477B (zh) 驾驶辅助装置及驾驶辅助方法
CN111060094A (zh) 车辆定位方法和装置
JP6779326B2 (ja) 複数のスレッドを使用して自動運転車両に用いられる基準線を生成するための方法及びシステム
CN110531750A (zh) 用于自动驾驶车辆的pid嵌入式lqr
US20180354504A1 (en) Parking Support Method and Device
CN108255171A (zh) 用于提高自主驾驶车辆的稳定性的方法和系统
US11353867B1 (en) Redundant lateral velocity determination and use in secondary vehicle control systems
WO2019233081A1 (zh) 一种自动驾驶方法及装置
KR101669622B1 (ko) 무인주행차량의 자율주행을 위한 최적화기반 경로계획 방법 및 그 장치
CN111208814B (zh) 用于自动车辆的、利用动态模型的、基于记忆的最优运动规划
CN107521559A (zh) 转向角标定方法、运动轨迹计算方法和设备和车载设备
CN112558607A (zh) 单舵轮agv车自动校准的方法、装置及设备
CN108693872A (zh) 自动导引运输车的导航方法、系统和自动导引运输车
KR101655290B1 (ko) 차량의 자동 주차 방법, 자동 주차 인프라 장치 및 이를 이용한 자동 주차 장치
KR20200037123A (ko) 에뮬레이션 기반의 자율 주행 차량의 3점 방향 전환 계획
WO2018179649A1 (ja) 地図作成システム及びロボットシステム
US11579612B2 (en) Position and attitude estimation apparatus and position and attitude estimation method
CN112660147A (zh) 控制车辆调头的方法、装置、设备和存储介质

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right
TR01 Transfer of patent right

Effective date of registration: 20210305

Address after: Room a1905, 19 / F, building 2, No. 18, Kechuang 11th Street, Daxing District, Beijing, 100176

Patentee after: Beijing Jingdong Qianshi Technology Co.,Ltd.

Address before: 101, 1st floor, building 2, yard 20, Suzhou street, Haidian District, Beijing 100080

Patentee before: Beijing Jingbangda Trading Co.,Ltd.

Effective date of registration: 20210305

Address after: 101, 1st floor, building 2, yard 20, Suzhou street, Haidian District, Beijing 100080

Patentee after: Beijing Jingbangda Trading Co.,Ltd.

Address before: 100195 Beijing Haidian Xingshikou Road 65 West Cedar Creative Garden 4 District 11 Building East 1-4 Floor West 1-4 Floor

Patentee before: BEIJING JINGDONG SHANGKE INFORMATION TECHNOLOGY Co.,Ltd.

Patentee before: BEIJING JINGDONG CENTURY TRADING Co.,Ltd.