CN108549373A - 一种基于导航角偏差进行车辆运行信息处理的方法和装置 - Google Patents
一种基于导航角偏差进行车辆运行信息处理的方法和装置 Download PDFInfo
- Publication number
- CN108549373A CN108549373A CN201810315831.6A CN201810315831A CN108549373A CN 108549373 A CN108549373 A CN 108549373A CN 201810315831 A CN201810315831 A CN 201810315831A CN 108549373 A CN108549373 A CN 108549373A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- information
- angular displacement
- navigation
- roadside device
- 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.)
- Pending
Links
- 238000006073 displacement reaction Methods 0.000 title claims abstract description 95
- 238000000034 method Methods 0.000 title claims abstract description 37
- 230000010365 information processing Effects 0.000 title claims abstract description 15
- 238000004891 communication Methods 0.000 claims abstract description 54
- 238000012545 processing Methods 0.000 claims description 5
- 238000005516 engineering process Methods 0.000 description 23
- 238000010586 diagram Methods 0.000 description 10
- 230000006870 function Effects 0.000 description 7
- 230000008569 process Effects 0.000 description 6
- 230000005540 biological transmission Effects 0.000 description 5
- 230000019771 cognition Effects 0.000 description 4
- 238000013507 mapping Methods 0.000 description 4
- 101001093748 Homo sapiens Phosphatidylinositol N-acetylglucosaminyltransferase subunit P Proteins 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000010295 mobile communication Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 239000000178 monomer Substances 0.000 description 1
- 230000006855 networking Effects 0.000 description 1
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
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)
- Navigation (AREA)
- Traffic Control Systems (AREA)
Abstract
一种基于导航角偏差进行车辆运行信息处理的方法和装置,应用于车路协同环境下设置有路侧设备的轨迹跟踪区域,包括:从当前建立通信连接的路侧设备上,获取车辆当前所在区域的局部导航信息;根据车辆的位置信息和获得的局部导航信息确定车辆的导航角偏差。本发明实施例通过路侧设备获取局部导航信息,提升了车辆轨迹控制的实时性;进一步的,基于实时的导航角偏差进行方向盘转角的计算,提高了车辆轨迹控制的准确性。
Description
技术领域
本文涉及但不限于车路协同环境下的自动驾驶技术,尤指一种基于导航角偏差进行车辆运行信息处理的方法和装置。
背景技术
车辆的轨迹跟踪和控制是实现自动驾驶功能的重要组成部分。
目前,车辆的轨迹跟踪和控制包括基于高精度地图和高精度车载传感器实现的车辆轨迹的跟踪和控制;上述方案进行轨迹跟踪和控制时,需要获取全局的交通数据,信息量大、传输时间长、影响轨迹控制的实时性;由于实时性受到影响,用于车辆轨迹控制的方向盘转角的准确度也受到影响;此外,上述方案运算精度过度依赖车载传感器的精度,而高精度车载传感器成本过高,无法在单体车辆上进行推广,实用性较差。
发明内容
以下是对本文详细描述的主题的概述。本概述并非是为了限制权利要求的保护范围。
本发明实施例提供一种基于导航角偏差进行车辆运行信息处理的方法和装置,能够提升车辆轨迹控制的实时性和车辆轨迹控制的准确性。
本发明实施例提供了一种基于导航角偏差进行车辆运行信息处理的方法,应用于设置有路侧设备的轨迹跟踪区域,包括:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆当前所在区域的局部导航信息;
根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差。
可选的,所述局部导航信息包括:
由当前建立通信连接的所述路侧设备生成的:基于在所述轨迹跟踪区域预先设置的道路坐标点,以所述车辆当前所在区域内包含的所有道路坐标点作为组成元素,构建生成的坐标序列。
可选的,所述根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差包括:
根据所述位置信息和所述局部导航信息,确定当前航向信息和期望航向信息;
根据确定的当前航向信息和期望航向信息,确定车辆当前的导航角偏差。
可选的,所述位置信息包括当前坐标V(Vx,Vy)和当前航向向量所述根据车辆的位置信息和获得的局部导航信息确定车辆的导航角偏差包括:
在所述局部导航信息中,确定沿车辆运行方向与所述当前坐标V(Vx,Vy)距离最近的道路坐标点为就近路点A(Ax,Ay);在所述局部导航信息中,确定沿车辆运行方向与所述就近路点A(Ax,Ay)的距离为预瞄距离d的预瞄点B(Bx,By);
根据所述当前坐标V(Vx,Vy)和所述预瞄点B(Bx,By),确定所述期望航向向量
将所述期望航向向量与所述当前航向向量的夹角,确定为所述导航角偏差。
可选的,所述确定车辆的导航角偏差后,所述方法还包括:
根据当前获得的所述导航角偏差和在前获得的所述导航角偏差,进行车辆的轨迹控制。
可选的,所述进行车辆的轨迹控制包括:
将当前获得的所述导航角偏差和在前获得的所述导航角偏差,输入比例积分微分PID控制器;
由PID控制器根据下述公式计算输出进行车辆轨迹控制的方向盘转角:
根据计算输出的所述方向盘转角控制车辆的运行轨迹;
其中,e(n)表示时刻n的航向角偏差,KP、KI、Kd为PID控制器的参数。
可选的,所述确定车辆的导航角偏差之前,所述方法还包括:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆的所述位置信息。
另一方面,本发明实施例还提供一种基于导航角偏差进行车辆运行信息处理的装置,应用于设置有路侧设备的轨迹跟踪区域,包括:获取单元和确定偏差单元;其中,
获取单元用于:与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆当前所在区域的局部导航信息;
确定偏差单元用于:根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差。
可选的,所述局部导航信息包括:
由当前建立通信连接的所述路侧设备生成的:基于在所述轨迹跟踪区域预先设置的道路坐标点,以所述车辆当前所在区域内包含的所有道路坐标点作为组成元素,构建生成的坐标序列。
可选的,所述确定偏差单元具体用于:
根据所述位置信息和所述局部导航信息,确定当前航向信息和期望航向信息;
根据确定的当前航向信息和期望航向信息,确定车辆当前的导航角偏差。
可选的,所述位置信息包括当前坐标V(Vx,Vy)和当前航向向量所述确定偏差单元具体用于:
在所述局部导航信息中,确定沿车辆运行方向与当前坐标V(Vx,Vy)距离最近的道路坐标点为就近路点A(Ax,Ay);在所述局部导航信息中,确定沿车辆运行方向与所述就近路点A(Ax,Ay)的距离为预瞄距离d的预瞄点B(Bx,By);
根据所述当前坐标V(Vx,Vy)和所述预瞄点B(Bx,By),确定所述期望航向向量
将所述期望航向向量与当前航向向量的夹角,确定为所述导航角偏差。
可选的,所述装置还包括控制单元,用于:
根据当前获得的所述导航角偏差和在前获得的所述导航角偏差,进行车辆的轨迹控制。
可选的,所述控制单元具体用于:
将当前获得的所述导航角偏差和在前获得的所述导航角偏差,输入比例积分微分PID控制器;
由PID控制器根据下述公式计算输出进行车辆轨迹控制的方向盘转角:
根据计算输出的所述方向盘转角控制车辆的运行轨迹;
其中,e(n)表示时刻n的航向角偏差,KP、KI、Kd为PID控制器的参数。
可选的,所述获取单元还用于:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆的所述位置信息。
再一方面,本发明实施例还提供一种计算机存储介质,所述计算机存储介质中存储有计算机可执行指令,所述计算机可执行指令用于执行上述基于导航角偏差进行车辆运行信息处理的方法。
还一方面,本发明实施例还提供一种终端,包括:存储器和处理器;其中,
处理器被配置为执行存储器中的程序指令;
程序指令在处理器读取执行以下操作:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆当前所在区域的局部导航信息;
根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差。
与相关技术相比,本申请技术方案包括:从当前建立通信连接的路侧设备上,获取车辆当前所在区域的局部导航信息;根据车辆的位置信息和获得的局部导航信息确定车辆的导航角偏差。本发明实施例通过路侧设备获取局部导航信息,提升了车辆轨迹控制的实时性;进一步的,基于实时的导航角偏差进行方向盘转角的计算,提高了车辆轨迹控制的准确性。
本发明的其它特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本发明而了解。本发明的目的和其他优点可通过在说明书、权利要求书以及附图中所特别指出的结构来实现和获得。
附图说明
附图用来提供对本发明技术方案的进一步理解,并且构成说明书的一部分,与本申请的实施例一起用于解释本发明的技术方案,并不构成对本发明技术方案的限制。
图1为本发明实施例基于导航角偏差进行车辆运行信息处理的方法的流程图;
图2为本发明实施例基于导航角偏差进行车辆运行信息处理的装置的结构框图;
图3为本发明应用示例的方法流程图;
图4为本发明应用示例车辆行驶过程中导航角偏差的示意图;
图5为本发明应用示例车辆行驶过程中另一导航角偏差的示意图;
图6为本发明应用示例车辆轨迹跟踪示意图;
图7为本发明应用示例跟踪误差曲线图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白,下文中将结合附图对本发明的实施例进行详细说明。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互任意组合。
在附图的流程图示出的步骤可以在诸如一组计算机可执行指令的计算机系统中执行。并且,虽然在流程图中示出了逻辑顺序,但是在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤。
本发明实施例可以应用于车路协同环境下设置有路侧设备的轨迹跟踪区域,图1为本发明实施例基于导航角偏差进行车辆运行信息处理的方法的流程图,如图1所示,包括:
步骤101、与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆当前所在区域的局部导航信息;
需要说明的是,本发明实施例上述车辆包括:进行自动驾驶的车辆;路侧设备可以包括参照智能车路协同系统(i-VICS,Intelligent Vehicle InfrastructureCooperation System)体系架构,设置在车辆运行环境中的设备;其中,车路协同系统采用先进的无线通信和新一代互联网等技术,可以实现车车、车路动态实时信息的交互;在动态交通信息采集与融合的基础上开展车路协同安全和道路主动控制,能够充分实现人、车、路的有效协同,保证交通安全,提高通行效率,构建具备安全、高效和环保的道路交通系统。
可选的,本发明实施例局部导航信息包括:
由当前建立通信连接的所述路侧设备生成的:基于在所述轨迹跟踪区域预先设置的道路坐标点,以所述车辆当前所在区域内包含的所有道路坐标点作为组成元素,构建生成的坐标序列。
需要说明的是,本发明实施例路侧设备之间的间距一般为几百米至一千米,因此,每一次与车辆建立通信连接的路侧设备一般只有一个;与路侧设备建立通信连接时,可以及时的从路侧设备获取局部导航信息;车辆当前所在区域可以由本领域技术人员根据路侧设备的间距和分布进行设定;例如、设定车辆运行前方的两个路点到车辆运行后方的一个路点所覆盖的区域为车辆当前所在区域;本发明实施例可以应用于车路协同环境下设置有多个路侧设备的轨迹跟踪区域,路侧设备的设置分布,可以由本领域技术人员根据轨迹跟踪的应用环境进行分析确定。
本发明实施例路车设备可以采用包括:专用短程通信技术(DSRC,DedicatedShort Range Communications)、第四代移动通信技术(4G)、车联网(LTE-V)等通信方式实现信息交互。
本发明实施例通过路测设备实现了车路动态实时信息交互,实现了车路之间的有效协同,提升了自动驾驶过程的通信效率,为安全、高效的道路交通提供技术基础。
步骤102、根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差。
可选的,根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差包括:
根据所述位置信息和所述局部导航信息,确定当前航向信息和期望航向信息;
根据确定的当前航向信息和期望航向信息,确定车辆当前的导航角偏差。
可选的,本发明实施例位置信息包括当前坐标V(Vx,Vy)和当前航向向量所述根据车辆的位置信息和获得的局部导航信息确定车辆的导航角偏差包括:
在所述局部导航信息中,确定沿车辆运行方向与所述当前坐标V(Vx,Vy)距离最近的道路坐标点为就近路点A(Ax,Ay);在所述局部导航信息中,确定沿车辆运行方向与所述就近路点A(Ax,Ay)的距离为预瞄距离d的预瞄点B(Bx,By);
根据所述当前坐标V(Vx,Vy)和所述预瞄点B(Bx,By),确定所述期望航向向量
将所述期望航向向量与所述当前航向向量的夹角,确定为所述导航角偏差。
需要说明的是,位置信息中包含的当前坐标V(Vx,Vy)和当前航向向量均可以通过相关技术获得。
本发明实施例在车路协同环境下实现了车辆的轨迹跟踪功能,基于路侧设备,实现了不依赖高精度车载传感器的条件下车辆运行轨迹的跟踪,降低了自动驾驶技术进行轨迹跟踪处理的成本,为自动驾驶技术的推广和普及提供应用基础。本发明实施例车路协同环境下的交通环境感知技术与基于车载传感器的交通信息感知技术相比,实现了更为全面、实时和准确的道路信息,为车辆的轨迹跟踪提供数据基础。
可选的,本发明实施例确定车辆的导航角偏差后,所述方法还包括:
根据当前获得的所述导航角偏差和在前获得的所述导航角偏差,进行车辆的轨迹控制。
可选的,本发明实施例进行车辆的轨迹控制包括:
将当前获得的所述导航角偏差和在前获得的所述导航角偏差,输入比例积分微分PID控制器;
由PID控制器根据下述公式计算输出进行车辆轨迹控制的方向盘转角:
根据计算输出的所述方向盘转角控制车辆的运行轨迹;
其中,e(n)表示时刻n的航向角偏差,KP、KI、Kd为PID控制器的参数。
需要说明的是,本发明实施例还可以将车辆的当前车速输入PID控制器,基于相关技术及应用场景,本发明实施例可以设定一个车速与PID参数的对应关系表,根据车辆的当前车速可以从设定的对应关系表中确定相应的PID参数,并基于确定的PID参数计算方向盘转角。
另外,本发明实施例方向盘转角信息可以通过车内局域网络(CAN)总线进行接收,通过接收的方向盘转角信息可以实现车辆的轨迹控制。
本发明实施例在车路协同环境下实现了车辆的轨迹跟踪功能,基于路侧设备,实现了不依赖高精度车载传感器的条件下车辆运行轨迹的控制,降低了自动驾驶技术进行轨迹跟踪控制的成本,为自动驾驶技术的推广和普及提供应用基础。本发明实施例车路协同环境下的交通环境感知技术与基于车载传感器的交通信息感知技术相比,为车辆的轨迹规划和控制提供了实时准确的数据。
本发明实施例在不依赖高精度传感器的基础上,实现了车辆运行轨迹的实时获取,提升了车辆轨迹控制的准确性。
可选的,确定车辆的导航角偏差之前,本发明实施例方法还包括:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆的所述位置信息。
与相关技术相比,本申请技术方案包括:从当前建立通信连接的路侧设备上,获取车辆当前所在区域的局部导航信息;根据车辆的位置信息和获得的局部导航信息确定车辆的导航角偏差。本发明实施例通过路侧设备获取局部导航信息,提升了车辆轨迹控制的实时性;进一步的,基于实时的导航角偏差进行方向盘转角的计算,提高了车辆轨迹控制的准确性。
图2为本发明实施例基于导航角偏差进行车辆运行信息处理的装置的结构框图,如图2所示,包括:获取单元和确定偏差单元;其中,
获取单元用于:与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆当前所在区域的局部导航信息;
可选的,本发明实施例局部导航信息包括:
由当前建立通信连接的所述路侧设备生成的:基于在所述轨迹跟踪区域预先设置的道路坐标点,以所述车辆当前所在区域内包含的所有道路坐标点作为组成元素,构建生成的坐标序列。
确定偏差单元用于:根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差。
本发明实施例装置可以应用于车路协同环境下设置有路侧设备的轨迹跟踪区域。
需要说明的是,本发明实施例上述车辆包括:进行自动驾驶的车辆;路侧设备可以包括参照车路协同(V2X)技术,设置在车辆运行环境中的设备。本发明实施例装置可以内置于自动驾驶的车辆上,也可以通过有线或无线的方式与自动驾驶车辆进行通信连接。
可选的,本发明实施例确定偏差单元具体用于:
根据所述位置信息和所述局部导航信息,确定当前航向信息和期望航向信息;
根据确定的当前航向信息和期望航向信息,确定车辆当前的导航角偏差。
可选的,所述位置信息包括当前坐标V(Vx,Vy)和当前航向向量所述确定偏差单元具体用于:
在所述局部导航信息中,确定沿车辆运行方向与当前坐标V(Vx,Vy)距离最近的道路坐标点为就近路点A(Ax,Ay);在所述局部导航信息中,确定沿车辆运行方向与所述就近路点A(Ax,Ay)的距离为预瞄距离d的预瞄点B(Bx,By);
根据所述当前坐标V(Vx,Vy)和所述预瞄点B(Bx,By),确定所述期望航向向量
将所述期望航向向量与当前航向向量的夹角,确定为所述导航角偏差。
可选的,本发明实施例装置还包括控制单元,用于:
根据当前获得的所述导航角偏差和在前获得的所述导航角偏差,进行车辆的轨迹控制。
可选的,本发明实施例控制单元具体用于:
将当前获得的所述导航角偏差和在前获得的所述导航角偏差,输入比例积分微分PID控制器;
由PID控制器根据下述公式计算输出进行车辆轨迹控制的方向盘转角:
根据计算输出的所述方向盘转角控制车辆的运行轨迹;
其中,e(n)表示时刻n的航向角偏差,KP、KI、Kd为PID控制器的参数。
需要说明的是,本发明实施例还可以将车辆的当前车速输入PID控制器,基于相关技术及应用场景,本发明实施例可以设定一个车速与PID参数的对应关系表,根据车辆的当前车速可以从设定的对应关系表中确定相应的PID参数,并基于确定的PID参数计算方向盘转角。
可选的,本发明实施例获取单元还用于:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆的所述位置信息。
本发明实施例还提供一种计算机存储介质,所述计算机存储介质中存储有计算机可执行指令,所述计算机可执行指令用于执行上述处理车辆运行信息的方法。
本发明实施例还提供一种终端,包括:存储器和处理器;其中,
处理器被配置为执行存储器中的程序指令;
程序指令在处理器读取执行以下操作:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆当前所在区域的局部导航信息;
根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差。
本发明还提供一种处理车辆运行信息的方法,包括:
与车辆建立通信连接;
与车辆建立通信连接时,向车辆发送车辆当前所在区域的局部导航信息。
需要说明的是,本发明实施例局部导航信息包含用于确定车辆当前的导航角偏差的道路点坐标。
可选的,向车辆发送车辆当前所在区域的局部导航信息之前,本发明实施例方法还包括:
基于在所述轨迹跟踪区域预先设置的道路坐标点,以所述车辆当前所在区域内包含的所有道路坐标点作为组成元素,构建生成作为所述局部导航信息的坐标序列。
本发明还提供一种处理车辆运行信息的装置,包括:连接单元和发送单元;其中,
连接单元用于:与车辆建立通信连接;
发送单元用于:与车辆建立通信连接时,向车辆发送车辆当前所在区域的局部导航信息。
可选的,本发明实施例装置还包括生成单元,用于:
以所述车辆当前所在区域内包含的所有预先设置的道路坐标点作为导航的基础坐标,构建生成的路点坐标序列。
本发明实施例上述装置可以设置于路侧设备,也可以通过相关技术中的通信方式实现路侧设备通信的连接。
本发明实施例还提供一种计算机存储介质,所述计算机存储介质中存储有计算机可执行指令,所述计算机可执行指令用于执行上述基于导航角偏差进行车辆运行信息处理的方法。
本发明实施例还提供一种终端,包括:存储器和处理器;其中,
处理器被配置为执行存储器中的程序指令;
程序指令在处理器读取执行以下操作:
与车辆建立通信连接;
与车辆建立通信连接时,向车辆发送车辆当前所在区域的局部导航信息。
以下通过应用示例对本发明实施例方法进行清楚详细的说明,应用示例仅用于陈述本发明,并不用于限定本发明的保护范围。
应用示例
本应用示例以具备自动驾驶功能的车辆为例,对车辆进行90度弯道轨迹的跟踪控制进行说明。本应用示例车辆与路侧设备均设置有保证车辆和路侧设备通信(车路通信)的通信设备和实现车辆定位的定位系统(例如、GPS定位系统);
本应用示例车辆的控制器通过车内局域网络(CAN)总线接收采用本发明实施例计算获得的方向盘转角度数信息,通过接收到的方向盘转角度数信息可以实现对车辆的转向控制;
图3为本发明应用示例的方法流程图,如图3所示,包括:
步骤301、车辆向路侧设备发送目的地址;
步骤302、接收到目的地址的路侧设备,基于初始地址到目的地址生成车辆当前所在区域的局部导航信息;
这里,初始地址可以是当前地址,也可以是预先输入的地址。
本应用示例可以采用一个n×3的数组来存放路点坐标序列,即导航信息中的n个路点的坐标信息;
步骤303、车辆在行驶过程中,与路侧设备建立通信连接,从建立通信连接的路侧设备获取局部导航信息;
步骤304、车辆根据自身当前所处的位置信息和获得的局部导航信息确定车辆的导航角偏差。
可选的,本应用示例位置信息包括当前坐标V(Vx,Vy)和当前航向向量
本应用示例确定车辆的导航角偏差包括:
根据车辆的位置信息和获得的局部导航信息确定车辆的导航角偏差包括:
在所述局部导航信息中,确定沿车辆运行方向与所述当前坐标V(Vx,Vy)距离最近的道路坐标点为就近路点A(Ax,Ay);在所述局部导航信息中,确定沿车辆运行方向与所述就近路点A(Ax,Ay)的距离为预瞄距离d的预瞄点B(Bx,By);
根据所述当前坐标V(Vx,Vy)和所述预瞄点B(Bx,By),确定所述期望航向向量
将所述期望航向向量与所述当前航向向量的夹角,确定为所述导航角偏差。
本应用示例预瞄距离d可以由本领域技术人员经验设定为固定值或动态值。
图4为本发明应用示例车辆行驶过程中导航角偏差的示意图,在图4中显示出了当前航向向量和期望航向向量期望航向向量与所述当前航向向量的夹角为所述导航角偏差e;若在逆时针方向180度范围内,e为正值,大小就为夹角的度数;若在顺时针方向180度范围内,e为负值,大小依然为夹角的度数。若e为正值,表示车辆需要向左转才能回到轨迹上,e值越大表示航向角偏差越大;图5为本发明应用示例车辆行驶过程中另一导航角偏差的示意图,在图5中显示出了车辆移动后当前航向向量和期望航向向量期望航向向量与所述当前航向向量的夹角为所述导航角偏差;
步骤305、根据导航角偏差计算偏差变化率,将导航角偏差、计算获得的偏差变化率和车辆的当前车速作为PID控制器的输入;
步骤306、PID控制器计算输出方向盘转角;具体的,可以根据下述公式计算输出进行车辆轨迹控制的方向盘转角:
其中,
e(n)表示n时刻时的航向角偏差,KP、KI、Kd为PID控制器的参数值。
需要说明的是,本发明实施例可以按照预设周期获得导航角偏差;根据获得的导航角偏差实时计算方向盘转角;例如,设定预设周期为0.1,实时进行轨迹控制。
步骤307、根据方向盘转角进行车辆的轨迹控制。
较相关技术使用的高精度传感器;本发明应用示例采用基于V2I技术的通讯设备实现了轨迹跟踪和控制;相对相关技术,在降低成本的同时,通过路测设备提升了轨迹跟踪的实时性。图6为本发明应用示例车辆轨迹跟踪示意图,如图6所示,车辆的运行轨迹很好的实现了参考轨迹的跟踪。图7为本发明应用示例跟踪误差曲线图,如图7所示,车辆在运行过程中横向偏差的最大值0.41米;本发明应用示例自动驾驶车辆跟踪误差较小,满足自动驾驶车辆的轨迹跟踪和控制要求。
本领域普通技术人员可以理解上述方法中的全部或部分步骤可通过程序来指令相关硬件(例如处理器)完成,所述程序可以存储于计算机可读存储介质中,如只读存储器、磁盘或光盘等。可选地,上述实施例的全部或部分步骤也可以使用一个或多个集成电路来实现。相应地,上述实施例中的每个模块/单元可以采用硬件的形式实现,例如通过集成电路来实现其相应功能,也可以采用软件功能模块的形式实现,例如通过处理器执行存储于存储器中的程序/指令来实现其相应功能。本发明不限制于任何特定形式的硬件和软件的结合。
虽然本发明所揭露的实施方式如上,但所述的内容仅为便于理解本发明而采用的实施方式,并非用以限定本发明。任何本发明所属领域内的技术人员,在不脱离本发明所揭露的精神和范围的前提下,可以在实施的形式及细节上进行任何的修改与变化,但本发明的专利保护范围,仍须以所附的权利要求书所界定的范围为准。
Claims (16)
1.一种基于导航角偏差进行车辆运行信息处理的方法,应用于设置有路侧设备的轨迹跟踪区域,其特征在于,包括:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆当前所在区域的局部导航信息;
根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差。
2.根据权利要求1所述的方法,其特征在于,所述局部导航信息包括:
由当前建立通信连接的所述路侧设备生成的:基于在所述轨迹跟踪区域预先设置的道路坐标点,以所述车辆当前所在区域内包含的所有道路坐标点作为组成元素,构建生成的坐标序列。
3.根据权利要求2所述的方法,其特征在于,所述根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差包括:
根据所述位置信息和所述局部导航信息,确定当前航向信息和期望航向信息;
根据确定的当前航向信息和期望航向信息,确定车辆当前的导航角偏差。
4.根据权利要求3所述的方法,其特征在于,所述位置信息包括当前坐标V(Vx,Vy)和当前航向向量所述根据车辆的位置信息和获得的局部导航信息确定车辆的导航角偏差包括:
在所述局部导航信息中,确定沿车辆运行方向与所述当前坐标V(Vx,Vy)距离最近的道路坐标点为就近路点A(Ax,Ay);在所述局部导航信息中,确定沿车辆运行方向与所述就近路点A(Ax,Ay)的距离为预瞄距离d的预瞄点B(Bx,By);
根据所述当前坐标V(Vx,Vy)和所述预瞄点B(Bx,By),确定所述期望航向向量
将所述期望航向向量与所述当前航向向量的夹角,确定为所述导航角偏差。
5.根据权利要求1~4任一项所述的方法,其特征在于,所述确定车辆的导航角偏差后,所述方法还包括:
根据当前获得的所述导航角偏差和在前获得的所述导航角偏差,进行车辆的轨迹控制。
6.根据权利要求5所述的方法,其特征在于,所述进行车辆的轨迹控制包括:
将当前获得的所述导航角偏差和在前获得的所述导航角偏差,输入比例积分微分PID控制器;
由PID控制器根据下述公式计算输出进行车辆轨迹控制的方向盘转角:
根据计算输出的所述方向盘转角控制车辆的运行轨迹;
其中,e(n)表示时刻n的航向角偏差,KP、KI、Kd为PID控制器的参数。
7.根据权利要求1~4任一项所述的方法,其特征在于,所述确定车辆的导航角偏差之前,所述方法还包括:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆的所述位置信息。
8.一种基于导航角偏差进行车辆运行信息处理的装置,应用于设置有路侧设备的轨迹跟踪区域,其特征在于,包括:获取单元和确定偏差单元;其中,
获取单元用于:与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆当前所在区域的局部导航信息;
确定偏差单元用于:根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差。
9.根据权利要求8所述的装置,其特征在于,所述局部导航信息包括:
由当前建立通信连接的所述路侧设备生成的:基于在所述轨迹跟踪区域预先设置的道路坐标点,以所述车辆当前所在区域内包含的所有道路坐标点作为组成元素,构建生成的坐标序列。
10.根据权利要求9所述的装置,其特征在于,所述确定偏差单元具体用于:
根据所述位置信息和所述局部导航信息,确定当前航向信息和期望航向信息;
根据确定的当前航向信息和期望航向信息,确定车辆当前的导航角偏差。
11.根据权利要求10所述的装置,其特征在于,所述位置信息包括当前坐标V(Vx,Vy)和当前航向向量所述确定偏差单元具体用于:
在所述局部导航信息中,确定沿车辆运行方向与当前坐标V(Vx,Vy)距离最近的道路坐标点为就近路点A(Ax,Ay);在所述局部导航信息中,确定沿车辆运行方向与所述就近路点A(Ax,Ay)的距离为预瞄距离d的预瞄点B(Bx,By);
根据所述当前坐标V(Vx,Vy)和所述预瞄点B(Bx,By),确定所述期望航向向量
将所述期望航向向量与当前航向向量的夹角,确定为所述导航角偏差。
12.根据权利要求8~11任一项所述的装置,其特征在于,所述装置还包括控制单元,用于:
根据当前获得的所述导航角偏差和在前获得的所述导航角偏差,进行车辆的轨迹控制。
13.根据权利要求12所述的装置,其特征在于,所述控制单元具体用于:
将当前获得的所述导航角偏差和在前获得的所述导航角偏差,输入比例积分微分PID控制器;
由PID控制器根据下述公式计算输出进行车辆轨迹控制的方向盘转角:
根据计算输出的所述方向盘转角控制车辆的运行轨迹;
其中,e(n)表示时刻n的航向角偏差,KP、KI、Kd为PID控制器的参数。
14.根据权利要求8~11任一项所述的装置,其特征在于,所述获取单元还用于:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆的所述位置信息。
15.一种计算机存储介质,所述计算机存储介质中存储有计算机可执行指令,所述计算机可执行指令用于执行权利要求1~7中任一项所述的基于导航角偏差进行车辆运行信息处理的方法。
16.一种终端,包括:存储器和处理器;其中,
处理器被配置为执行存储器中的程序指令;
程序指令在处理器读取执行以下操作:
与路侧设备建立通信连接时,从建立通信连接的路侧设备上获取车辆当前所在区域的局部导航信息;
根据车辆的位置信息和获得的局部导航信息确定车辆当前的导航角偏差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810315831.6A CN108549373A (zh) | 2018-04-10 | 2018-04-10 | 一种基于导航角偏差进行车辆运行信息处理的方法和装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810315831.6A CN108549373A (zh) | 2018-04-10 | 2018-04-10 | 一种基于导航角偏差进行车辆运行信息处理的方法和装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108549373A true CN108549373A (zh) | 2018-09-18 |
Family
ID=63514639
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810315831.6A Pending CN108549373A (zh) | 2018-04-10 | 2018-04-10 | 一种基于导航角偏差进行车辆运行信息处理的方法和装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108549373A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109683616A (zh) * | 2018-12-26 | 2019-04-26 | 芜湖哈特机器人产业技术研究院有限公司 | 一种单舵轮后置驱动移动平台的直线路径引导方法 |
CN111260950A (zh) * | 2020-01-17 | 2020-06-09 | 清华大学 | 一种基于轨迹预测的轨迹跟踪方法、介质和车载设备 |
CN112141210A (zh) * | 2020-08-21 | 2020-12-29 | 天津市天波科达科技有限公司 | 一种基于电子差速底盘的航向控制方法及装置 |
CN112590930A (zh) * | 2020-12-11 | 2021-04-02 | 国汽(北京)智能网联汽车研究院有限公司 | 自主运行设备的转向角度确定方法、装置及计算机设备 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997031302A1 (fr) * | 1996-02-20 | 1997-08-28 | Komatsu Ltd. | Procede et dispositif de conduite d'un vehicule sans pilote |
CN101221447A (zh) * | 2008-01-18 | 2008-07-16 | 中国农业大学 | 一种机械自动转向控制方法 |
CN102358287A (zh) * | 2011-09-05 | 2012-02-22 | 北京航空航天大学 | 一种用于车辆自动驾驶机器人的轨迹跟踪控制方法 |
CN102393744A (zh) * | 2011-11-22 | 2012-03-28 | 湖南大学 | 一种无人驾驶汽车的导航方法 |
CN102495631A (zh) * | 2011-12-09 | 2012-06-13 | 中国科学院合肥物质科学研究院 | 一种无人驾驶车辆跟踪预定轨迹的智能控制方法 |
CN104571112A (zh) * | 2015-01-14 | 2015-04-29 | 中国科学院合肥物质科学研究院 | 基于转弯曲率估计的无人车横向控制方法 |
CN105973244A (zh) * | 2015-10-29 | 2016-09-28 | 乐卡汽车智能科技(北京)有限公司 | 获取地图信息的方法、导航方法及设备 |
CN106909153A (zh) * | 2017-03-21 | 2017-06-30 | 北京京东尚科信息技术有限公司 | 无人车横向控制方法和装置 |
-
2018
- 2018-04-10 CN CN201810315831.6A patent/CN108549373A/zh active Pending
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO1997031302A1 (fr) * | 1996-02-20 | 1997-08-28 | Komatsu Ltd. | Procede et dispositif de conduite d'un vehicule sans pilote |
CN101221447A (zh) * | 2008-01-18 | 2008-07-16 | 中国农业大学 | 一种机械自动转向控制方法 |
CN102358287A (zh) * | 2011-09-05 | 2012-02-22 | 北京航空航天大学 | 一种用于车辆自动驾驶机器人的轨迹跟踪控制方法 |
CN102393744A (zh) * | 2011-11-22 | 2012-03-28 | 湖南大学 | 一种无人驾驶汽车的导航方法 |
CN102495631A (zh) * | 2011-12-09 | 2012-06-13 | 中国科学院合肥物质科学研究院 | 一种无人驾驶车辆跟踪预定轨迹的智能控制方法 |
CN104571112A (zh) * | 2015-01-14 | 2015-04-29 | 中国科学院合肥物质科学研究院 | 基于转弯曲率估计的无人车横向控制方法 |
CN105973244A (zh) * | 2015-10-29 | 2016-09-28 | 乐卡汽车智能科技(北京)有限公司 | 获取地图信息的方法、导航方法及设备 |
CN106909153A (zh) * | 2017-03-21 | 2017-06-30 | 北京京东尚科信息技术有限公司 | 无人车横向控制方法和装置 |
Non-Patent Citations (1)
Title |
---|
程航: "AGV小车轨迹跟踪控制策略的研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109683616A (zh) * | 2018-12-26 | 2019-04-26 | 芜湖哈特机器人产业技术研究院有限公司 | 一种单舵轮后置驱动移动平台的直线路径引导方法 |
CN109683616B (zh) * | 2018-12-26 | 2021-07-09 | 芜湖哈特机器人产业技术研究院有限公司 | 一种单舵轮后置驱动移动平台的直线路径引导方法 |
CN111260950A (zh) * | 2020-01-17 | 2020-06-09 | 清华大学 | 一种基于轨迹预测的轨迹跟踪方法、介质和车载设备 |
CN111260950B (zh) * | 2020-01-17 | 2021-03-26 | 清华大学 | 一种基于轨迹预测的轨迹跟踪方法、介质和车载设备 |
CN112141210A (zh) * | 2020-08-21 | 2020-12-29 | 天津市天波科达科技有限公司 | 一种基于电子差速底盘的航向控制方法及装置 |
CN112141210B (zh) * | 2020-08-21 | 2022-08-02 | 天津市天波科达科技有限公司 | 一种基于电子差速底盘的航向控制方法及装置 |
CN112590930A (zh) * | 2020-12-11 | 2021-04-02 | 国汽(北京)智能网联汽车研究院有限公司 | 自主运行设备的转向角度确定方法、装置及计算机设备 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103456185B (zh) | 智能车在城市道路行驶中的接力导航方法 | |
CN108549373A (zh) | 一种基于导航角偏差进行车辆运行信息处理的方法和装置 | |
CN105976606B (zh) | 一种智能城市交通管理平台 | |
CN104537829B (zh) | 一种智能交通物理仿真平台及用于该智能交通物理仿真平台的定位方法 | |
CN106092121A (zh) | 车辆导航方法和装置 | |
CN103177596B (zh) | 一种交叉路口自主管控系统 | |
CN108437972A (zh) | 一种基于位置偏差的轨迹跟踪方法和装置 | |
CN111137298B (zh) | 一种车辆自动驾驶方法、装置、系统和存储介质 | |
CN103207634A (zh) | 一种智能车辆中差分gps与惯性导航数据融合的系统和方法 | |
CN102903258A (zh) | 一种车辆自动导航方法、导航图案信息编制方法及其车辆导航设备 | |
CN105466440A (zh) | 利用天气预报信息优化路径的导航装置、系统及方法 | |
CN105371859B (zh) | 基于安全驾驶地图的车道级别的导航引导系统和方法 | |
CN104750115B (zh) | 一种移动设备的激光主动式导航系统及导航方法 | |
CN107272008A (zh) | 一种带惯性补偿的agv激光导航系统 | |
CN104460665A (zh) | 基于道路曲率地图的磁导航无人车及其地图的建立方法 | |
CN104900112B (zh) | 车辆驾驶教学智能辅助指导方法及系统 | |
CN103256937A (zh) | 路径匹配的方法及装置 | |
CN105278533A (zh) | 一种全向移动平台导航方法 | |
CN111829536B (zh) | 导航地图路网生成方法、装置、存储介质及电子设备 | |
CN108556845A (zh) | 一种新型车辆跟驰系统和方法 | |
CN109189079B (zh) | 基于gps定位的移动机器人导航控制方法 | |
CN104952278B (zh) | 一种基于地图的停车场车辆定位系统及方法 | |
CN101469992A (zh) | 车辆导航的处理方法、装置及车辆导航系统 | |
CN107591013A (zh) | 一种同行路线上不同车辆位置信息实时共享方法和系统 | |
CN111487979B (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 | ||
RJ01 | Rejection of invention patent application after publication | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180918 |