CN113085886B - 一种自动驾驶系统中基于方向盘转角的轨迹显示方法 - Google Patents
一种自动驾驶系统中基于方向盘转角的轨迹显示方法 Download PDFInfo
- Publication number
- CN113085886B CN113085886B CN201911380113.8A CN201911380113A CN113085886B CN 113085886 B CN113085886 B CN 113085886B CN 201911380113 A CN201911380113 A CN 201911380113A CN 113085886 B CN113085886 B CN 113085886B
- Authority
- CN
- China
- Prior art keywords
- steering wheel
- track
- point
- curve
- control point
- 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.)
- Active
Links
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60W—CONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W50/08—Interaction between the driver and the control system
- B60W50/14—Means for informing the driver, warning the driver or prompting a driver intervention
- B60W2050/146—Display means
Abstract
本发明公开了一种自动驾驶系统中基于方向盘转角的轨迹显示方法,通过获取方向盘转角信息,并生成样条曲线,再通过所述样条曲线生成轨迹,并显示出。
Description
技术领域
本发明涉及自动驾驶显示领域,具体涉及一种自动驾驶系统中基于方向盘转角的轨迹显示方法。
背景技术
目前的轨迹显示方法主要有平面箭头法和轨迹投影法。平面箭头法是在像素平面中画一个二维的方向箭头,该方法的缺点是只能表达转向、直行、掉头等基本信息,或者通过折线表达自动驾驶系统的行进轨迹,两者表达方式都比较单调,界面不友好。
轨迹投影法是基于自动驾驶系统中输出的预设轨迹,在相机坐标系中反投影出该轨迹,该方法能够直接表达接收到的轨迹信息,缺点是该系统的稳定表达依赖准确稳定的轨迹信息。
发明内容
为了解决上述轨迹显示方法比较单调、依赖轨迹信息等缺陷,本发明提供了一种自动驾驶系统中基于方向盘转角的轨迹显示方法,
获取方向盘转角信息,通过所述方向盘转角信息生成样条曲线,通过所述样条曲线生成轨迹,并显示出来。
优选地,样条曲线是贝塞尔曲线。通过采用贝塞尔曲线,使得生成轨迹的显示效果更接近真实的行使路线轨迹,同时,通过设置贝塞尔曲线上的控制点可以调节贝塞尔曲线的弯曲程度和光滑性,便于控制和调节。
优选地,贝塞尔曲线上的第一个控制点、第二个控制点和第三个控制点位于同一直线上。
优选地,贝塞尔曲线上的第四个控制点的横坐标的取值范围与方向盘转角范围成一一对应的关系。
优选地,样条曲线是通过三次样条插值获得。通过采用偏置三次样条插值的方法,同样使得生成轨迹的显示效果更接近真实的行使路线轨迹。
优选地,通过三次样条插值获得样条曲线的第二个控制点的y坐标的绝对值大于第一个控制点的y坐标的绝对值,同时小于第三个控制点的y坐标的绝对值。
优选地,通过三次样条插值获得样条曲线的第二个控制点的y坐标的绝对值等于第四个控制点的y坐标的绝对值的0.2倍,同时第三个控制点的y坐标的绝对值等于第四个控制点的y坐标的绝对值的0.5倍。
优选地,样条曲线生成轨迹的步骤,还包括:轨迹通过设置纹理坐标随时间变化而变化的方式实现动态显示效果。通过使用纹理坐标实现动态效果以及贴地的方向箭头显示行使轨迹,使得显示效果更加友好。
优选地,轨迹显示出来的效果是连续的方向箭头。
优选地,轨迹的方向箭头是紧贴地显示的。
与现有技术相比,本发明的有益效果包括:
在自动驾驶系统无法提供或者很难提供准确和/或稳定的轨迹信息时,根据方向盘信息可以提供准确和/或稳定的可视化的方案。通过获取方向盘转角信息的方式,直接生成轨迹,显示效果友好。
附图说明
通过结合附图进行阅读,将会更好地了解以上概述以及以下详细描述。为了便于说明,附图中示出本公开的某些实施例。但是,应当理解,本发明并不局限于所示的准确布置和工具。结合到本说明书中并且构成其部分的附图示出按照本发明的系统和设备的实现,并且连同本描述一起用来说明按照本发明的优点和原理。
其中,
图1是本发明一种自动驾驶系统中基于方向盘转角的轨迹显示方法的一个实施例的流程示意图。
图2是本发明一种自动驾驶系统中基于方向盘转角的轨迹显示方法的另外一个实施例的流程示意图。
具体实施方式
在详细说明本发明的至少一个实施例之前,要理解,本发明并不局限于它在以下描述中提出或者在附图中示出的构造的细节以及组件的布置的应用。提供附图和书面描述,以指导本领域的技术人员进行和使用对其寻求专利保护的本发明。本发明适用于其他实施例并且能够按照各种方式来实施和执行。本领域的技术人员将会理解,为了清楚起见和便于了解,并非示出一商业实施例的所有特征。本领域的技术人员还将会理解,结合本发明的方面的实际商业实施例的开发将要求许多实现特定判定来取得开发人员的商业实施例的最终目标。虽然这些工作会是复杂和费时的,但是这些工作是获益于本公开的领域的技术人员例行任务。
另外,要理解,本文所采用的用语和术语是为了便于描述,而不应当被视作限制。例如,单数术语、例如“一”、“一个”的使用不是意在限制项的数量。另外,非限制性地诸如“顶部”、“底部”、“左”、“右”、“上”、“下”、“向下”、“向上”、“侧”之类的关系术语的使用为了清楚起见而具体参照附图用于本描述中,而不是意在限制本发明或者所附权利要求书的范围。此外,应当理解,本发明的特征的任一个可单独地或者与其他特征结合使用。通过阅读附图和详细描述,本领域的技术人员将会清楚地知道本发明的其他系统、方法、特征和优点。预计所有这类其他系统、方法、特征和优点都包含在本描述之内,包含在本发明的范围之内,并且受到所附权利要求书保护。
结合图1所示,其示意性地根据本发明示出了自动驾驶系统中基于方向盘转角的轨迹显示方法的实施方式。
具体步骤如下:
步骤S101:获取方向盘转角
通过方向信号获取自动驾驶车辆方向盘的转角θ。
在一些实施例中,方向信号可以通过角度传感器获取车辆的方向盘的转向角度。
在一些实施例中,方向信号同步将信号发送给自动驾驶系统和显示系统,这就使得与自动驾驶车辆方向盘形成转角的时间相比较,通过方向信号生成的轨迹早于或者同步于方向盘形成转角的时间。
在一些实施例中,可以通过获取其他类型的陆上运输工具和/或水上交通工具和/或空中飞行器的转角,如自行车,摩托车、三轮车、游艇、轮船、游览船等。
步骤S102:生成贝塞尔曲线
通过四个控制点作为贝塞尔曲线的四个控制点,生成贝塞尔曲线,即自动驾驶车辆轨迹的轮廓。具体方法如下:
四个控制点分别记为P0(0,0),P1(0,y1),P2(0,y2),P3(x3,y_max)。其中点P0为自动驾驶车辆坐标系原点;点P1和点P2为y轴上的两个控制点,其中,y1决定了贝塞尔曲线的拐点位置,y2决定了贝塞尔曲线的光滑性;点P3的横坐标x3的值决定了贝塞尔曲线最大横向距离,其中,y_max的值决定了贝塞尔曲线的最大纵向距离。
在一些实施例中,自动驾驶车辆轨迹的轮廓可以是其他的样条曲线。
点P3的横坐标x3由自动驾驶车辆方向盘转角θ换算得到,具体如下:
将自动驾驶车辆方向盘的转角θ映射到[-x_max,x_max]区间,
其中,x_max的值设为3,
在一些实施例中,x_max的值可以设置为其他数值。
顺时针方向为方向盘转角θ的正方向,范围从0到180,当转角的值超过180时,按180处理;定义逆时针方向为方向盘转角θ的负方向,范围从-180到0,当转角的值小于-180时,按-180处理。
在一些实施例中,方向盘的转角范围区间直接为-180到+180,如赛道赛车的方向盘转角范围。
将曲线中任意一点表示为P(t),t∈[0,1],通过三阶贝塞尔函数计算出完整的曲线,
步骤S103:由曲线生成轨迹并被显示
曲线转化成一定宽度和长度的条状轨迹,通过引入图片素材,带有图片素材的轨迹被显示出来。
其在一些实施例中,显示出的轨迹的长度设置为步骤S102中的贝塞尔曲线长度的1/3或1/4。
为了使显示效果更佳,设置轨迹贴地显示。
在一些实施例中,通过设置图片素材的中心点在曲线上,即可得到一定宽度的轨迹。
在一些实施例中,为了显示效果更佳,可以将轨迹引入动态效果。比如通过设置纹理坐标随时间的变化而变化的方式实现动态效果,具体如下:
将曲线整体向两侧方向平移一定的距离,得到两条平行的曲线,即轨迹的边界线,其中,两条平行的曲线之间的距离就是轨迹的宽度;
通过设置纹理坐标随时间变化而变化的方式,实现动态效果。在一些实施例中,将曲线整体向一侧方向平移一定的距离,得到一条与原曲线平行的新曲线,两条曲线即轨迹的边界线,其中,两条平行的曲线之间的距离就是轨迹的宽度;
通过设置纹理坐标随时间变化而变化的方式,实现动态效果。
在一些实施例中,通过引入动态图片实现动态效果,如GIF格式的图片。
在一些实施例中,图片素材可以是单个方向箭头或者是两个同方向的箭头。
在上述实施方式的基础上,结合图2所示,其示意性地根据本发明示出了自动驾驶系统中基于方向盘转角的轨迹显示方法的另一种实施方式。
具体步骤如下:
步骤S201:获取方向盘转角
通过方向信号获取自动驾驶车辆方向盘的转角。
在一些实施例中,方向信号可以通过角度传感器获取车辆的方向盘的转向角度。
在一些实施例中,方向信号同步将信号发送给自动驾驶系统和显示系统,这就使得与自动驾驶车辆方向盘形成转角的时间相比较,通过方向信号生成的轨迹早于或者同步于方向盘形成转角的时间。
在一些实施例中,可以通过获取其他类型的陆上运输工具和/或水上交通工具和/或空中飞行器的转角,如自行车,摩托车、三轮车、游艇、轮船、游览船等。
步骤S202:通过三次样条插值(Cubic Spline Interpolation)的方法,生成样条曲线
将四个控制点用三次样条插值(Cubic Spline Interpolation)生成样条曲线,即自动驾驶车辆轨迹的轮廓。具体方法如下:
四个控制点分别记为P0(0,0),P1(x1,y1),P2(x2,y2),P3(x3,y_max)。其中点P0为自动驾驶车辆坐标系原点;设置点P1的横坐标x1为点P3的横坐标x3的0.2倍,即x1=0.2*x3;设置点P2的横坐标x2为点P3的横坐标x3的0.5倍,即x2=0.5*x3;通过对点P1的横坐标x1和点P2的横坐标x2进行如上设置,使得样条曲线更贴近自动驾驶车辆轨道的实际效果。
点P3的横坐标x3的值决定了样条曲线最大横向距离,其中,y_max的值决定了样条曲线的最大纵向距离。
在一些实施例中,设置点P1的横坐标x1为点P3的横坐标x3的0.3倍,即x1=0.3*x3;设置点P2的横坐标x2为点P3的横坐标x3的0.6倍,即x2=0.6*x3。同样,可以设置点P3的横坐标x3的0.25倍,即x1=0.25*x3;设置点P2的横坐标x2为点P3的横坐标x3的0.55倍,即x2=0.55*x3。
在一些实施例中,设置点P1的横坐标x1为点P3的横坐标x3的倍数区间为(0,1),设置点P2的横坐标x2为点P3的横坐标x3的倍数区间为(0,1),且同时满足x1的绝对值小于x2的绝对值。
步骤S103:由曲线生成轨迹并被显示
曲线转化成一定宽度和长度的条状轨迹,通过引入图片素材,带有图片素材的轨迹被显示出来。
在一些实施例中,显示出的轨迹的长度设置为步骤S102中的贝塞尔曲线长度的1/3或1/4。
为了使显示效果更佳,设置轨迹贴地显示。
在一些实施例中,通过设置图片素材的中心点在曲线上,即可得到一定宽度的轨迹。
在一些实施例中,为了显示效果更佳,可以将轨迹引入动态效果。比如通过设置纹理坐标随时间的变化而变化的方式实现动态效果,具体如下:
将曲线整体向两侧方向平移一定的距离,得到两条平行的曲线,即轨迹的边界线,其中,两条平行的曲线之间的距离就是轨迹的宽度;
通过设置纹理坐标随时间变化而变化的方式,实现动态效果。
在一些实施例中,将曲线整体向一侧方向平移一定的距离,得到一条与原曲线平行的新曲线,两条曲线即轨迹的边界线,其中,两条平行的曲线之间的距离就是轨迹的宽度;
通过设置纹理坐标随时间变化而变化的方式,实现动态效果。
在一些实施例中,通过引入动态图片实现动态效果,如GIF格式的图片。
在一些实施例中,图片素材可以是单个方向箭头或者是两个同方向的箭头。
本领域的技术人员将会理解,可对上述实施例进行变更,而没有背离其广义的发明概述。因此要理解,本文所公开的本发明并不局限于所公开的具体实施例,而是意在涵盖如所附权利要求书所限定的本发明的精神和范围之内的修改。
Claims (4)
1.一种自动驾驶系统中基于方向盘转角的轨迹显示方法,其特征在于,包括:
获取方向盘转角信息,
通过所述方向盘转角信息生成样条曲线,
通过所述样条曲线生成轨迹,并显示出来;
所述样条曲线是贝塞尔曲线;
所述贝塞尔曲线上的第一个控制点、第二个控制点和第三个控制点位于同一直线上;所述贝塞尔曲线上的第四个控制点的横坐标的取值范围与所述方向盘转角范围成一一对应的关系;
四个控制点分别记为P0(0,0),P 1(0,y1),P 2(0,y2),P 3(x3,y_max);其中点P 0为自动驾驶车辆坐标系原点;点P1和点P2为y轴上的两个控制点,其中,y1决定了贝塞尔曲线的拐点位置,y2决定了贝塞尔曲线的光滑性;点P3的横坐标x3的值决定了贝塞尔曲线最大横向距离,其中,y_max的值决定了贝塞尔曲线的最大纵向距离;点P3的横坐标x3由自动驾驶车辆方向盘转角θ换算得到,具体如下:
将自动驾驶车辆方向盘的转角θ映射到[-x_max,x_max]区间,
顺时针方向为方向盘转角θ的正方向,范围从0到180,当转角的值超过180时,按180处理;定义逆时针方向为方向盘转角θ的负方向,范围从-180到0,当转角的值小于-180时,按-180处理;
所述样条曲线是通过三次样条插值获得;
所述通过三次样条插值获得样条曲线的第二个控制点的y坐标的绝对值大于第一个控制点的y坐标的绝对值,同时所述第二个控制点的y坐标的绝对值小于第三个控制点的y坐标的绝对值;
所述通过三次样条插值获得样条曲线的第二个控制点的y坐标的绝对值等于第四个控制点的y坐标的绝对值的0.2倍,同时第三个控制点的y坐标的绝对值等于第四个控制点的y坐标的绝对值的0.5倍。
2.根据权利要求1中任一项所述的显示方法,其特征在于,所述样条曲线生成轨迹的步骤,还包括:
所述轨迹通过设置纹理坐标随时间变化而变化的方式实现动态显示效果。
3.根据权利要求1所述的显示方法,其特征在于,所述轨迹显示出来的效果是连续的方向箭头。
4.根据权利要求3所述的显示方法,其特征在于,所述轨迹的方向箭头是紧贴地显示的。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2019113309374 | 2019-12-20 | ||
CN201911330937 | 2019-12-20 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113085886A CN113085886A (zh) | 2021-07-09 |
CN113085886B true CN113085886B (zh) | 2023-08-29 |
Family
ID=76663949
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911380113.8A Active CN113085886B (zh) | 2019-12-20 | 2019-12-27 | 一种自动驾驶系统中基于方向盘转角的轨迹显示方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113085886B (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102008060770A1 (de) * | 2008-12-05 | 2009-09-17 | Daimler Ag | Verfahren zur Unterstützung eines Fahrers eines Fahrzeuges |
EP2091803B1 (de) * | 2006-12-19 | 2010-03-24 | Valeo Schalter und Sensoren GmbH | Verfahren zum rückwärtigen einparken eines fahrzeugs und einparkhilfesystem hierfür |
CN101987597A (zh) * | 2009-08-03 | 2011-03-23 | 袁克虹 | 基于角度信息的可视化倒车轨迹线形成系统及方法 |
CN201872661U (zh) * | 2010-10-26 | 2011-06-22 | 浙江科技学院 | 一种汽车行进轨迹预显示系统 |
CN103158703A (zh) * | 2013-03-26 | 2013-06-19 | 北京经纬恒润科技有限公司 | 一种平行泊车的控制方法 |
CN108335341A (zh) * | 2017-12-08 | 2018-07-27 | 佛吉亚好帮手电子科技有限公司 | 动态倒车轨迹显示及校准方法 |
CN109375632A (zh) * | 2018-12-17 | 2019-02-22 | 清华大学 | 自动驾驶车辆实时轨迹规划方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8725474B2 (en) * | 2008-10-01 | 2014-05-13 | Navteq B.V. | Bezier curves for advanced driver assistance system applications |
KR100939761B1 (ko) * | 2008-10-02 | 2010-01-29 | 삼성전기주식회사 | 차량 장착용 카메라 유닛, 차량 외부 디스플레이 방법 및 드라이빙 코리더 마커 생성 시스템 |
-
2019
- 2019-12-27 CN CN201911380113.8A patent/CN113085886B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2091803B1 (de) * | 2006-12-19 | 2010-03-24 | Valeo Schalter und Sensoren GmbH | Verfahren zum rückwärtigen einparken eines fahrzeugs und einparkhilfesystem hierfür |
DE102008060770A1 (de) * | 2008-12-05 | 2009-09-17 | Daimler Ag | Verfahren zur Unterstützung eines Fahrers eines Fahrzeuges |
CN101987597A (zh) * | 2009-08-03 | 2011-03-23 | 袁克虹 | 基于角度信息的可视化倒车轨迹线形成系统及方法 |
CN201872661U (zh) * | 2010-10-26 | 2011-06-22 | 浙江科技学院 | 一种汽车行进轨迹预显示系统 |
CN103158703A (zh) * | 2013-03-26 | 2013-06-19 | 北京经纬恒润科技有限公司 | 一种平行泊车的控制方法 |
CN108335341A (zh) * | 2017-12-08 | 2018-07-27 | 佛吉亚好帮手电子科技有限公司 | 动态倒车轨迹显示及校准方法 |
CN109375632A (zh) * | 2018-12-17 | 2019-02-22 | 清华大学 | 自动驾驶车辆实时轨迹规划方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113085886A (zh) | 2021-07-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105333883B (zh) | 一种用于抬头显示器的导航路径轨迹显示方法和装置 | |
CN107544520B (zh) | 一种用于四轮载具自动驾驶的控制方法 | |
CN105867377B (zh) | 一种农业机械自动导航控制方法 | |
WO2019202397A2 (en) | Vehicle environment modeling with a camera | |
CN110203210A (zh) | 一种车道偏离预警方法、终端设备及存储介质 | |
US8626365B2 (en) | Automatic steering control apparatus and autopilot | |
CN108805956B (zh) | 实时倒车轨迹显示系统及等宽轨迹线绘制方法 | |
CN111220143B (zh) | 一种成像设备的位置和姿态确定方法及装置 | |
JP2017151764A (ja) | 走行制御装置 | |
CN105427361B (zh) | 一种三维场景中动目标轨迹的显示方法 | |
JPH02270005A (ja) | 自律走行車両 | |
JPH10206175A (ja) | 道路曲率推定装置 | |
CN108759854A (zh) | 导航信息处理方法及装置、虚拟现实抬头显示装置 | |
CN114265411B (zh) | 一种解决车辆预测模型性能受限于感知数据性能的方法 | |
CN114764782A (zh) | 多视图汽车和机器人系统中的图像合成 | |
CN111123950A (zh) | 行车控制方法、装置及车辆 | |
JP2011148369A (ja) | 運転支援装置 | |
JP2018509799A (ja) | 車両の車両周辺部の歪無い表示のための方法、並びに、装置 | |
CN113085886B (zh) | 一种自动驾驶系统中基于方向盘转角的轨迹显示方法 | |
CN111930126A (zh) | 一种基于差速轮组agv的导航纠偏方法 | |
Yang et al. | An algorithm of curved path tracking with prediction model for autonomous vehicle | |
JP2015087149A (ja) | 移動体位置姿勢角推定装置及び移動体位置姿勢角推定方法 | |
CN105865480B (zh) | 导航图像显示参数的调整方法及装置 | |
CN105911990B (zh) | 用于船舶航行转弯阶段的航迹偏差测定方法 | |
WO2024001554A1 (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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20220728 Address after: Room 618, 6 / F, building 5, courtyard 15, Kechuang 10th Street, Beijing Economic and Technological Development Zone, Daxing District, Beijing 100176 Applicant after: Xiaomi Automobile Technology Co.,Ltd. Address before: 1219, floor 11, SOHO, Zhongguancun, No. 8, Haidian North Second Street, Haidian District, Beijing 100089 Applicant before: SHENDONG TECHNOLOGY (BEIJING) Co.,Ltd. |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |