CN110703783A - 一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法 - Google Patents

一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法 Download PDF

Info

Publication number
CN110703783A
CN110703783A CN201911095004.1A CN201911095004A CN110703783A CN 110703783 A CN110703783 A CN 110703783A CN 201911095004 A CN201911095004 A CN 201911095004A CN 110703783 A CN110703783 A CN 110703783A
Authority
CN
China
Prior art keywords
reference track
point
track point
real
vehicle
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
CN201911095004.1A
Other languages
English (en)
Other versions
CN110703783B (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.)
Shanghai Jiaotong University
Original Assignee
Shanghai Jiaotong University
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 Shanghai Jiaotong University filed Critical Shanghai Jiaotong University
Priority to CN201911095004.1A priority Critical patent/CN110703783B/zh
Publication of CN110703783A publication Critical patent/CN110703783A/zh
Application granted granted Critical
Publication of CN110703783B publication Critical patent/CN110703783B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface

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

一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法
技术领域
本发明涉及无人驾驶领域,具体地说,特别涉及到一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法。
背景技术
轨迹跟踪,是无人驾驶的最基本环节。轨迹跟踪,指的是无人车在得到一条参考轨迹(由一系列参考轨迹点组成)之后,对车辆进行实时有效地控制,使无人车安全地跟随参考轨迹指定的路线进行自主行驶。
轨迹跟踪需要车辆进行实时地精准地定位,判断当前处于参考轨迹的哪个参考轨迹点,并选择合适的预瞄模型,对车辆进行精准的纵横向控制,从而达到轨迹跟踪的效果。同时,如果车辆使用的是具有语义信息的语义拓扑地图时,也需要通过判断当前经过了哪个参考轨迹点来获取当前轨迹点的语意,从而指导车辆执行相关动作。因此,如何实时地鲁棒地判断当前车辆经过了参考轨迹的哪个参考轨迹点是非常重要的。
目前的判断方法都存在各自的缺陷。比如以距离最近为原则找寻当前车辆位置距离最近的参考轨迹点,这种方法无法应对参考轨迹中出现轨迹重叠或交叉的情况,极有可能将当前经过轨迹点判断为已经过或未经过的轨迹点,从而导致无人车发生跟随错误轨迹行驶的情况发生。同时,若以车辆实时位置到参考轨迹点的距离大小方式进行判断,则在刚刚经过当前轨迹点后,存在车辆位置到刚经过的参考轨迹点的距离小于到后一个参考轨迹点的距离时,则会判断当前瞄准的参考轨迹点依然为上一个刚经过的点。因此,轨迹跟踪中亟需一种可以在参考轨迹出现重叠或交叉的情况下,仍然能鲁棒地依次判断当前经过的跟踪参考轨迹点的算法。
发明内容
本发明的目的在于针对现有技术中的不足,提供一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法,在轨迹跟踪时可以实时地判别当前经过了哪些参考轨迹点,并立即对后一个参考轨迹点进行跟踪的功能,从而使得车辆可以得到当前的预瞄点及预瞄点的语意信息,从而进行局部轨迹规划,进行轨迹跟踪和避开障碍物的控制。
本发明所解决的技术问题可以采用以下技术方案来实现:
一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法,包括如下步骤:
1)从参考轨迹的出发点开始,在每三个连续的参考轨迹点中的第二个参考轨迹点处,取第一个参考轨迹点和第二个参考轨迹点所连成的直线与第二个参考轨迹点和第三个参考轨迹点所连成直线的角平分线,并得到角平分线在全局坐标下的直线表达式;
2)将车辆在全局坐标系下的实时x-y坐标代入角平分线的直线表达式得到实时位置的结果值,并将第三个参考轨迹点的x-y坐标代入角平分线的直线表达式得到第三个参考轨迹点的结果值;
3)若实时位置的结果值和第三个参考轨迹点的结果值异号,则说明车辆的当前坐标与第三个参考轨迹点位于角平分线的两侧,即认定为车辆尚未通过第二个参考轨迹点,返回步骤2);
若实时位置的结果值和第三个参考轨迹点的结果值同号,则说明车辆的当前坐标与第三个参考轨迹点位于角平分线的同侧,即认定为车辆已经通过第二个参考轨迹点,进入步骤4);
4)对后三个连续的参考轨迹点的进行步骤1)至步骤3)的判断,实时地得到车辆当前经过的参考轨迹点,直到到达最后一个参考轨迹点为止。
进一步的,所述全局坐标系的构建方法为:在参考轨迹附近任取一个原点并建立x-y坐标系,将车辆实时位置点及所有参考轨迹点的经纬度坐标转换到该x-y坐标系下。
进一步的,当前判断目标为参考轨迹的出发点时,取出发点和出发点后一个参考轨迹点所连成直线在出发点处的垂线,并得到垂线在全局坐标下的直线表达式;
然后将车辆在全局坐标系下的实时x-y坐标代入垂线的直线表达式得到实时位置的结果值,并将出发点后一个参考轨迹点的x-y坐标代入垂线的直线表达式得到出发点后一个参考轨迹点的结果值;
若实时位置的结果值和出发点后一个参考轨迹点的结果值异号,即判定为车辆尚未通过出发点;若实时位置的结果值和出发点后一个参考轨迹点的结果值同号,则判定为车辆已经通过出发点。
进一步的,当前判断目标为参考轨迹的终点时,取终点和终点前一个参考轨迹点所连成直线在终点处的垂线,并得到垂线在全局坐标下的直线表达式;
然后将车辆在全局坐标系下的实时x-y坐标代入垂线的直线表达式得到实时位置的结果值,并将终点前一个参考轨迹点的x-y坐标代入垂线的直线表达式得到终点前一个参考轨迹点的结果值;
若实时位置的结果值和终点前一个参考轨迹点的结果值同号,即判定为车辆尚未抵达终点;若实时位置的结果值和终点前一个参考轨迹点的结果值异号,则判定为车辆已经抵达终点。
进一步的,从参考轨迹的出发点开始,按照参考轨迹的行进路线,对每一个当前参考轨迹点只做车辆是否经过当前参考轨迹点的判断,并只在判断得到车辆经过当前参考轨迹点时,才对后一个参考轨迹点进行判断。
进一步的,在车辆轨迹跟踪时,按照参考轨迹经过的顺序将所有参考轨迹点进行排序,每经过一个参考轨迹点就将该参考轨迹点的序号记录下来;在轨迹跟踪调试时,若出现问题需要重新运行程序,程序运行伊始便会从记录的最后一个参考轨迹点的序号开始进行判断,实现从中断点继续测试。
进一步的,参考轨迹的起始参考点序号可通过手动输入,重新运行程序时便会从手动输入的起始参考点开始进行判断。
与现有技术相比,本发明的有益效果在于:
1.本发明可实时地鲁棒地判断当前经过的参考轨迹点,可按照参考轨迹依次地对参考轨迹点进行判断,不受参考轨迹重叠、交叉或接近所带来的影响。
2.本发明可在车辆刚刚经过当前参考轨迹点时立即对后一个参考轨迹点进行跟踪,解决了依靠距离对参考轨迹点进行判断所带来的经过当前参考轨迹点后无法立即切换到下一个轨迹参考点的问题。
3.本发明可使无人驾驶车辆从程序中段位置或任意指定参考轨迹点位置重新开始调试,解决了按照顺序依次判断轨迹点所带来的每次运行从起始点开始判断的问题。
附图说明
图1为本发明所述的参考轨迹点的算法的示意图。
图2为本发明所述的参考轨迹点的算法的逻辑示意图。
具体实施方式
为使本发明实现的技术手段、创作特征、达成目的与功效易于明白了解,下面结合具体实施方式,进一步阐述本发明。
本发明的第一个目的是提供一种无人驾驶车辆在轨迹跟踪时可以实时地判别当前经过了哪些参考轨迹点,并立即对后一个参考轨迹点进行跟踪的功能,从而使得车辆可以得到当前的预瞄点及预瞄点的语意信息,从而进行局部轨迹规划,进行轨迹跟踪和避开障碍物的控制。
实现本发明第一个目的的技术方案是:
由出发点开始,在每三个连续参考轨迹点中的第二个轨迹点处取第一点和第二点所连成的直线与第二点和第三点所连成直线的角平分线并得到该角平分线在全局坐标下(在试验场地附近任取一个原点并建立x-y坐标系,将车辆实时位置点及所有参考轨迹点的经纬度坐标转换到该坐标系下)的直线表达式,随后将车辆在全局坐标下的实时x-y坐标代入角平分线的直线方程得到结果值,并将第三个参考轨迹点的x-y坐标代入角平分线的直线方程得到结果值,一旦这两个结果值异号,则说明当前车辆坐标与第三个参考轨迹点分别位于角平分线两侧,即认定为尚未通过第二个参考轨迹点;一旦这两个结果值同号,则说明当前车辆坐标与第三个参考轨迹点位于此角平分线同侧,即认定为已通过第二个参考轨迹点,之后立即进行对后三个连续参考轨迹点的同样判断。从而可实时地得到当前经过的参考轨迹点。
本发明的第二个目的是使无人驾驶车辆在判别当前参考轨迹点时不会因为参考轨迹的重叠、交叉、接近(如掉头行驶)所造成的判断失误问题,从而鲁棒地对参考轨迹进行跟踪。
实现本发明第二个目的的技术方案是:
从参考轨迹出发点开始,按照参考轨迹的行进路线,依次判断每一个参考轨迹点,只做是否经过当前参考轨迹点的判断,并只在判断得到经过当前参考轨迹点时才对后一个参考轨迹点进行判断。因此,当轨迹发生重叠、交叉或较接近的情况时,不会错误地判断为经过其他轨迹点,从而导致车辆行驶方向发生错误的改变。
本发明的第三个目的是使无人驾驶车辆在轨迹跟踪调试过程中时,时常会出现需要中断运行中的程序并重新运行该程序的情况。如果出现问题,程序随时可从当前参考轨迹点或从指定参考轨迹点重新进行路径跟踪。
实现本发明第三个目的的技术方案是:
在车辆轨迹跟踪时,按照参考轨迹经过的顺序将所有参考轨迹点进行排序,每经过一个参考轨迹点就将该点的序号记录下来,存到文档当中。在轨迹跟踪调试时,一旦出现问题需要重新运行程序,程序运行伊始便会从此文档中的最后一个参考轨迹点的序号开始进行判断,因此便可从中断点继续测试。同时,也可在文档中的最后一行人为手动输入期望的参考轨迹起始点序号,重新运行程序时便会从此序号开始进行判断。
实施例
参见图1和图2,当无人驾驶车辆开始进行轨迹跟踪时,首先获取所有参考轨迹点的全局坐标系下的坐标,并获取指定起始参考轨迹点的序号。
由指定参考轨迹点开始,如图1中的B点,计算点A与点B的距离S1及点B与下一个点C的距离S2,取S1,S2中的最小值S1并在线段BC上取离B点距离与S1相同的点E,取E点与A点中点F,并计算由B、F连成直线在全局坐标系下的方程。
从无人驾驶车辆的组合导航实时订阅车辆的位置经纬度坐标,并转换为车辆在全局坐标下的坐标。将车辆实时位置坐标代入方程计算得到结果V1,并将参考轨迹点C的全局坐标代入方程计算得到结果V2,判断V1和V2的乘积是否大于0。如果结果小于0,说明此时车辆的位置和参考轨迹点C处于直线BF的两侧,因此还未经过点B,重新订阅车辆位置信息并重复计算,知道结果大于0为止。如果结果大于0,说明此时车辆的位置和参考轨迹点C处于直线BF的同一侧,则说明此时无人驾驶车辆已经经过了点B,此时需要判断点B是否为参考轨迹的最后一个参考轨迹点,如果是则程序结束,无人驾驶车辆刹停,如果不是则将点B及后两个参考轨迹点C,D依次再代入上述计算,判断是否经过点C,直到到达最后一个参考轨迹点为止。
当前判断目标为参考轨迹的出发点时,取出发点和出发点后一个参考轨迹点所连成直线在出发点处的垂线,并得到垂线在全局坐标下的直线表达式;
然后将车辆在全局坐标系下的实时x-y坐标代入垂线的直线表达式得到实时位置的结果值,并将出发点后一个参考轨迹点的x-y坐标代入垂线的直线表达式得到出发点后一个参考轨迹点的结果值;
若实时位置的结果值和出发点后一个参考轨迹点的结果值异号,即判定为车辆尚未通过出发点;若实时位置的结果值和出发点后一个参考轨迹点的结果值同号,则判定为车辆已经通过出发点。
当前判断目标为参考轨迹的终点时,取终点和终点前一个参考轨迹点所连成直线在终点处的垂线,并得到垂线在全局坐标下的直线表达式;
然后将车辆在全局坐标系下的实时x-y坐标代入垂线的直线表达式得到实时位置的结果值,并将终点前一个参考轨迹点的x-y坐标代入垂线的直线表达式得到终点前一个参考轨迹点的结果值;
若实时位置的结果值和终点前一个参考轨迹点的结果值同号,即判定为车辆尚未抵达终点;若实时位置的结果值和终点前一个参考轨迹点的结果值异号,则判定为车辆已经抵达终点。
以上显示和描述了本发明的基本原理和主要特征和本发明的优点。本行业的技术人员应该了解,本发明不受上述实施例的限制,上述实施例和说明书中描述的只是说明本发明的原理,在不脱离本发明精神和范围的前提下,本发明还会有各种变化和改进,这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。

Claims (7)

1.一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法,其特征在于,包括如下步骤:
1)从参考轨迹的出发点开始,在每三个连续的参考轨迹点中的第二个参考轨迹点处,取第一个参考轨迹点和第二个参考轨迹点所连成的直线与第二个参考轨迹点和第三个参考轨迹点所连成直线的角平分线,并得到角平分线在全局坐标下的直线表达式;
2)将车辆在全局坐标系下的实时x-y坐标代入角平分线的直线表达式得到实时位置的结果值,并将第三个参考轨迹点的x-y坐标代入角平分线的直线表达式得到第三个参考轨迹点的结果值;
3)若实时位置的结果值和第三个参考轨迹点的结果值异号,则说明车辆的当前坐标与第三个参考轨迹点位于角平分线的两侧,即认定为车辆尚未通过第二个参考轨迹点,返回步骤2);
若实时位置的结果值和第三个参考轨迹点的结果值同号,则说明车辆的当前坐标与第三个参考轨迹点位于角平分线的同侧,即认定为车辆已经通过第二个参考轨迹点,进入步骤4);
4)对后三个连续的参考轨迹点的进行步骤1)至步骤3)的判断,实时地得到车辆当前经过的参考轨迹点,直到到达最后一个参考轨迹点为止。
2.根据权利要求1所述的无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法,其特征在于,所述全局坐标系的构建方法为:在参考轨迹附近任取一个原点并建立x-y坐标系,将车辆实时位置点及所有参考轨迹点的经纬度坐标转换到该x-y坐标系下。
3.根据权利要求1所述的无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法,其特征在于,当前判断目标为参考轨迹的出发点时,取出发点和出发点后一个参考轨迹点所连成直线在出发点处的垂线,并得到垂线在全局坐标下的直线表达式;
然后将车辆在全局坐标系下的实时x-y坐标代入垂线的直线表达式得到实时位置的结果值,并将出发点后一个参考轨迹点的x-y坐标代入垂线的直线表达式得到出发点后一个参考轨迹点的结果值;
若实时位置的结果值和出发点后一个参考轨迹点的结果值异号,即判定为车辆尚未通过出发点;若实时位置的结果值和出发点后一个参考轨迹点的结果值同号,则判定为车辆已经通过出发点。
4.根据权利要求1所述的无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法,其特征在于,当前判断目标为参考轨迹的终点时,取终点和终点前一个参考轨迹点所连成直线在终点处的垂线,并得到垂线在全局坐标下的直线表达式;
然后将车辆在全局坐标系下的实时x-y坐标代入垂线的直线表达式得到实时位置的结果值,并将终点前一个参考轨迹点的x-y坐标代入垂线的直线表达式得到终点前一个参考轨迹点的结果值;
若实时位置的结果值和终点前一个参考轨迹点的结果值同号,即判定为车辆尚未抵达终点;若实时位置的结果值和终点前一个参考轨迹点的结果值异号,则判定为车辆已经抵达终点。
5.根据权利要求1所述的无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法,其特征在于,从参考轨迹的出发点开始,按照参考轨迹的行进路线,对每一个当前参考轨迹点只做车辆是否经过当前参考轨迹点的判断,并只在判断得到车辆经过当前参考轨迹点时,才对后一个参考轨迹点进行判断。
6.根据权利要求1所述的无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法,其特征在于,在车辆轨迹跟踪时,按照参考轨迹经过的顺序将所有参考轨迹点进行排序,每经过一个参考轨迹点就将该参考轨迹点的序号记录下来;在轨迹跟踪调试时,若出现问题需要重新运行程序,程序运行伊始便会从记录的最后一个参考轨迹点的序号开始进行判断,实现从中断点继续测试。
7.根据权利要求6所述的无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法,其特征在于,参考轨迹的起始参考点序号可通过手动输入,重新运行程序时便会从手动输入的起始参考点开始进行判断。
CN201911095004.1A 2019-11-11 2019-11-11 一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法 Active CN110703783B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911095004.1A CN110703783B (zh) 2019-11-11 2019-11-11 一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911095004.1A CN110703783B (zh) 2019-11-11 2019-11-11 一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法

Publications (2)

Publication Number Publication Date
CN110703783A true CN110703783A (zh) 2020-01-17
CN110703783B CN110703783B (zh) 2021-07-27

Family

ID=69205687

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911095004.1A Active CN110703783B (zh) 2019-11-11 2019-11-11 一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法

Country Status (1)

Country Link
CN (1) CN110703783B (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113895463A (zh) * 2021-11-25 2022-01-07 北京航空航天大学 一种适用于自动驾驶车辆掉头的路径规划方法

Citations (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3998412A (en) * 1975-05-29 1976-12-21 Sperry Rand Corporation Helical vertical path control apparatus for aircraft area navigation system
IT1219032B (it) * 1987-02-23 1990-04-24 Usc Kk Metodo di controllo dell'interpolazione di un luogo di punti
EP0398704A2 (en) * 1989-05-17 1990-11-22 Fujitsu Limited Profile control system for robots
WO2000038949A2 (en) * 1998-12-31 2000-07-06 Automotive Technologies International, Inc. Methods for determining the identification and position of and monitoring objects in a vehicle
WO2007065923A1 (de) * 2005-12-09 2007-06-14 Hella Kgaa Hueck & Co. Bahnplanung
US20090265053A1 (en) * 2007-03-02 2009-10-22 Dix Peter J Method for creating spiral swath patterns for convex polygon shaped field boundaries
US20120221237A1 (en) * 2011-02-25 2012-08-30 Dongguk University Industry-Academic Cooperation Foundation Apparatus and method of cell-based path planning for mobile body
CN103970139A (zh) * 2014-05-09 2014-08-06 上海交通大学 一种机器人连续点位运动规划方法及其运动控制器
CN105466429A (zh) * 2015-12-29 2016-04-06 江苏大学 一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法
CN106019338A (zh) * 2016-05-06 2016-10-12 上海海事大学 一种船舶轨迹的实时化简方法
CN106882185A (zh) * 2017-03-10 2017-06-23 南京林业大学 一种含驾驶员焦点预瞄模型的车辆自主转向控制方法
CN107300919A (zh) * 2017-06-22 2017-10-27 中国科学院深圳先进技术研究院 一种机器人及其行进控制方法
CN107390691A (zh) * 2017-07-28 2017-11-24 广东嘉腾机器人自动化有限公司 一种agv路径跟踪方法
CN108333931A (zh) * 2018-01-25 2018-07-27 北京理工大学 一种面向崎岖地形的四足机器人双层结构步态规划方法
CN108622104A (zh) * 2018-05-07 2018-10-09 湖北汽车工业学院 一种用于无人驾驶车辆的轨迹跟踪控制方法
CN108640040A (zh) * 2018-03-28 2018-10-12 华南农业大学 一种智能叉车的位姿调整路径规划方法
CN108646747A (zh) * 2018-06-05 2018-10-12 上海交通大学 农用车辆路径跟踪控制方法
CN109407658A (zh) * 2017-08-18 2019-03-01 厦门雅迅网络股份有限公司 无人车的行车轨迹规划方法及计算机可读存储介质
CN109839953A (zh) * 2019-02-19 2019-06-04 上海交通大学 基于贝塞尔曲线转接平滑的轨迹规划与速度规划方法
CN109883419A (zh) * 2019-01-21 2019-06-14 深圳市普渡科技有限公司 机器人导航方法及系统
CN109900490A (zh) * 2017-12-11 2019-06-18 上海交通大学 基于自主式和协同式传感器的车辆运动状态检测方法及系统
CN109945882A (zh) * 2019-03-27 2019-06-28 上海交通大学 一种无人驾驶车辆路径规划与控制系统及方法
CN110001637A (zh) * 2019-04-10 2019-07-12 吉林大学 一种基于多点跟踪的无人驾驶汽车路径跟踪控制装置及控制方法
CN110187712A (zh) * 2019-07-12 2019-08-30 彭少华 无人驾驶控制方法、装置和设备

Patent Citations (24)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3998412A (en) * 1975-05-29 1976-12-21 Sperry Rand Corporation Helical vertical path control apparatus for aircraft area navigation system
IT1219032B (it) * 1987-02-23 1990-04-24 Usc Kk Metodo di controllo dell'interpolazione di un luogo di punti
EP0398704A2 (en) * 1989-05-17 1990-11-22 Fujitsu Limited Profile control system for robots
WO2000038949A2 (en) * 1998-12-31 2000-07-06 Automotive Technologies International, Inc. Methods for determining the identification and position of and monitoring objects in a vehicle
WO2007065923A1 (de) * 2005-12-09 2007-06-14 Hella Kgaa Hueck & Co. Bahnplanung
US20090265053A1 (en) * 2007-03-02 2009-10-22 Dix Peter J Method for creating spiral swath patterns for convex polygon shaped field boundaries
US20120221237A1 (en) * 2011-02-25 2012-08-30 Dongguk University Industry-Academic Cooperation Foundation Apparatus and method of cell-based path planning for mobile body
CN103970139A (zh) * 2014-05-09 2014-08-06 上海交通大学 一种机器人连续点位运动规划方法及其运动控制器
CN105466429A (zh) * 2015-12-29 2016-04-06 江苏大学 一种水产养殖池塘全覆盖自动均匀投饲轨迹规划方法
CN106019338A (zh) * 2016-05-06 2016-10-12 上海海事大学 一种船舶轨迹的实时化简方法
CN106882185A (zh) * 2017-03-10 2017-06-23 南京林业大学 一种含驾驶员焦点预瞄模型的车辆自主转向控制方法
CN107300919A (zh) * 2017-06-22 2017-10-27 中国科学院深圳先进技术研究院 一种机器人及其行进控制方法
CN107390691A (zh) * 2017-07-28 2017-11-24 广东嘉腾机器人自动化有限公司 一种agv路径跟踪方法
CN109407658A (zh) * 2017-08-18 2019-03-01 厦门雅迅网络股份有限公司 无人车的行车轨迹规划方法及计算机可读存储介质
CN109900490A (zh) * 2017-12-11 2019-06-18 上海交通大学 基于自主式和协同式传感器的车辆运动状态检测方法及系统
CN108333931A (zh) * 2018-01-25 2018-07-27 北京理工大学 一种面向崎岖地形的四足机器人双层结构步态规划方法
CN108640040A (zh) * 2018-03-28 2018-10-12 华南农业大学 一种智能叉车的位姿调整路径规划方法
CN108622104A (zh) * 2018-05-07 2018-10-09 湖北汽车工业学院 一种用于无人驾驶车辆的轨迹跟踪控制方法
CN108646747A (zh) * 2018-06-05 2018-10-12 上海交通大学 农用车辆路径跟踪控制方法
CN109883419A (zh) * 2019-01-21 2019-06-14 深圳市普渡科技有限公司 机器人导航方法及系统
CN109839953A (zh) * 2019-02-19 2019-06-04 上海交通大学 基于贝塞尔曲线转接平滑的轨迹规划与速度规划方法
CN109945882A (zh) * 2019-03-27 2019-06-28 上海交通大学 一种无人驾驶车辆路径规划与控制系统及方法
CN110001637A (zh) * 2019-04-10 2019-07-12 吉林大学 一种基于多点跟踪的无人驾驶汽车路径跟踪控制装置及控制方法
CN110187712A (zh) * 2019-07-12 2019-08-30 彭少华 无人驾驶控制方法、装置和设备

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
PEIZHI, ZHANG, CHENGLIANG, YIN, JIANWU, ZHANG: "Sliding Mode Control with Sensor Fault Tolerant for Electronic Throttle", 《IEEE》 *
ZIHUI ZHANG AND YUESHAN XIONG: "A Real-Time Path Tracking Approach for a Wheeled Mobile Robot", 《IEEE》 *
张建龙,张建武,袁明,殷承良: "混合动力汽车操纵稳定性模糊控制仿真研究", 《系统仿真学报》 *
罗建豪: "三轮全向足球机器人轨迹规划与跟踪的研究", 《中国优秀硕士学位沦为全文数据库 信息科技辑》 *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113895463A (zh) * 2021-11-25 2022-01-07 北京航空航天大学 一种适用于自动驾驶车辆掉头的路径规划方法

Also Published As

Publication number Publication date
CN110703783B (zh) 2021-07-27

Similar Documents

Publication Publication Date Title
CN108151751B (zh) 一种基于高精度地图和传统地图结合的路径规划方法及装置
Urmson et al. Autonomous driving in urban environments: Boss and the urban challenge
CN107608344B (zh) 基于轨迹规划的车辆运动控制方法、装置及相关设备
CN104949679B (zh) 导航信息确定方法及装置
US11391579B2 (en) Method for forming a local navigation path for an autonomous vehicle
CN110361028B (zh) 一种基于自动驾驶循迹的路径规划结果生成方法及系统
CN105277203A (zh) 一种导航动作的生成方法、导航方法和设备
CN102707299A (zh) 浮动车数据地图匹配的方法和装置
CN111142530B (zh) 一种机器人运行轨迹的确定方法、机器人和存储介质
CN110703783B (zh) 一种无人驾驶轨迹跟踪中实时判别当前参考轨迹点的算法
CN109579848B (zh) 一种保持全局路径下机器人的中间规划方法
CN111896004A (zh) 一种狭窄通道车辆轨迹规划方法及系统
CN112487128A (zh) 一种路口引导线生成方法、系统、电子设备及存储介质
CN111368409A (zh) 车辆流的模拟处理方法、装置、设备和存储介质
CN111243330B (zh) 一种车道级引导线的生成方法、装置和相关设备
CN112764415A (zh) 一种生成自动驾驶规划轨迹的方法、装置及汽车
CN108345306A (zh) 路径规划方法、道路信息的更新方法、设备及存储介质
CN113593238A (zh) 一种面向自动驾驶导航的路口虚拟车道建模方法
CN109297502A (zh) 基于图像处理与gps导航技术的激光投影指向方法及装置
CN113415274B (zh) 自动驾驶的跟车轨迹规划系统、方法、车辆及存储介质
CN113670632B (zh) 碰撞检测方法及装置
CN117664157A (zh) 高精度导航路径的确定方法、装置、设备、介质及车辆
CN112406869B (zh) 一种车辆换道控制方法及装置
CN111176275B (zh) 一种auv避碰功能验证方法
CN112644487A (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