CN113085886A - 一种自动驾驶***中基于方向盘转角的轨迹显示方法 - Google Patents

一种自动驾驶***中基于方向盘转角的轨迹显示方法 Download PDF

Info

Publication number
CN113085886A
CN113085886A CN201911380113.8A CN201911380113A CN113085886A CN 113085886 A CN113085886 A CN 113085886A CN 201911380113 A CN201911380113 A CN 201911380113A CN 113085886 A CN113085886 A CN 113085886A
Authority
CN
China
Prior art keywords
control point
track
display method
steering wheel
coordinate
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
CN201911380113.8A
Other languages
English (en)
Other versions
CN113085886B (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.)
Xiaomi Automobile Technology Co Ltd
Original Assignee
Shendong Technology Beijing 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 Shendong Technology Beijing Co ltd filed Critical Shendong Technology Beijing Co ltd
Publication of CN113085886A publication Critical patent/CN113085886A/zh
Application granted granted Critical
Publication of CN113085886B publication Critical patent/CN113085886B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Human Computer Interaction (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

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]区间，
Figure BDA0002342065040000051
其中，x_max的值设为3，
在一些实施例中，x_max的值可以设置为其他数值。
顺时针方向为方向盘转角θ的正方向，范围从0到180，当转角的值超过180时，按180处理；定义逆时针方向为方向盘转角θ的负方向，范围从-180到0，当转角的值小于-180时，按-180处理。
在一些实施例中，方向盘的转角范围区间直接为-180到+180，如赛道赛车的方向盘转角范围。
将曲线中任意一点表示为P(t)，t∈[0，1]，通过三阶贝塞尔函数计算出完整的曲线，
Figure BDA0002342065040000052
步骤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 (10)

1.一种自动驾驶***中基于方向盘转角的轨迹显示方法，其特征在于，包括：
获取方向盘转角信息，
通过所述方向盘转角信息生成样条曲线，
通过所述样条曲线生成轨迹，并显示出来。
2.根据权利要求1所述的显示方法，其特征在于，所述样条曲线是贝塞尔曲线。
3.根据权利要求2所述的显示方法，其特征在于，所述贝塞尔曲线上的第一个控制点、第二个控制点和第三个控制点位于同一直线上。
4.根据权利要求2所述的显示方法，其特征在于，所述贝塞尔曲线上的第四个控制点的横坐标的取值范围与所述方向盘转角范围成一一对应的关系。
5.根据权利要求1所述的显示方法，其特征在于，所述样条曲线是通过三次样条插值获得。
6.根据权利要求5所述的显示方法，其特征在于，所述通过三次样条插值获得样条曲线的第二个控制点的y坐标的绝对值大于第一个控制点的y坐标的绝对值，同时所述第二个控制点的y坐标的绝对值小于第三个控制点的y坐标的绝对值。
7.根据权利要求5所述的显示方法，其特征在于，所述通过三次样条插值获得样条曲线的第二个控制点的y坐标的绝对值等于第四个控制点的y坐标的绝对值的0.2倍，同时第三个控制点的y坐标的绝对值等于第四个控制点的y坐标的绝对值的0.5倍。
8.根据权利要求1-7中任一项所述的显示方法，其特征在于，所述样条曲线生成轨迹的步骤，还包括：
所述轨迹通过设置纹理坐标随时间变化而变化的方式实现动态显示效果。
9.根据权利要求1所述的显示方法，其特征在于，所述轨迹显示出来的效果是连续的方向箭头。
10.根据权利要求9所述的显示方法，其特征在于，所述轨迹的方向箭头是紧贴地显示的。
CN201911380113.8A 2019-12-20 2019-12-27 一种自动驾驶***中基于方向盘转角的轨迹显示方法 Active CN113085886B (zh)

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 true CN113085886A (zh) 2021-07-09
CN113085886B 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 (9)

* Cited by examiner, † Cited by third party
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
US20100082307A1 (en) * 2008-10-01 2010-04-01 Navteq North America, Llc Bezier Curves for Advanced Driver Assistance System Applications
US20100085170A1 (en) * 2008-10-02 2010-04-08 Samsung Electro-Mechanics Co., Ltd. Camera unit with driving corridor display functionality for a vehicle, method for displaying anticipated trajectory of a vehicle, and system for generating driving corridor markers
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 清华大学 自动驾驶车辆实时轨迹规划方法

Patent Citations (9)

* Cited by examiner, † Cited by third party
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
US20100082307A1 (en) * 2008-10-01 2010-04-01 Navteq North America, Llc Bezier Curves for Advanced Driver Assistance System Applications
US20100085170A1 (en) * 2008-10-02 2010-04-08 Samsung Electro-Mechanics Co., Ltd. Camera unit with driving corridor display functionality for a vehicle, method for displaying anticipated trajectory of a vehicle, and system for generating driving corridor markers
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
CN113085886B (zh) 2023-08-29

Similar Documents

Publication Publication Date Title
CN105333883B (zh) 一种用于抬头显示器的导航路径轨迹显示方法和装置
JP5369465B2 (ja) 車両用画像処理装置、車両用画像処理方法、車両用画像処理プログラム
CN107610199B (zh) 实时倒车轨迹显示方法
JP5681569B2 (ja) 情報処理システム、サーバ装置、および、車載装置
CN110203210A (zh) 一种车道偏离预警方法、终端设备及存储介质
US11948315B2 (en) Image composition in multiview automotive and robotics systems
JP3568357B2 (ja) ナビゲーション装置における地図情報表示装置及び地図情報表示方法並びにナビゲーション装置における地図情報表示制御プログラムが記録されたコンピュータ読み取り可能な記録媒体
CN105427361B (zh) 一种三维场景中动目标轨迹的显示方法
CN107310475A (zh) 一种智能汽车预警功能的显示方法及***
JP2016206776A (ja) 路面検出装置
JP2011148369A (ja) 運転支援装置
CN111220143A (zh) 一种成像设备的位置和姿态确定方法及装置
US20230316772A1 (en) Under vehicle reconstruction for vehicle environment visualization
CN103786662B (zh) 倒车辅助线的生成方法及装置
CN113085886B (zh) 一种自动驾驶***中基于方向盘转角的轨迹显示方法
CN105865480B (zh) 导航图像显示参数的调整方法及装置
WO2024001554A1 (zh) 车辆导航方法、装置、设备、存储介质和计算机程序产品
CN105911990B (zh) 用于船舶航行转弯阶段的航迹偏差测定方法
WO2023192754A1 (en) Image stitching with an adaptive three-dimensional bowl model of the surrounding environment for surround view visualization
JP2021030917A (ja) 表示装置
US10474337B2 (en) Vehicular information display apparatus
GB2580400A (en) A control system, system and method for providing assistance to an occupant of a vehicle
JPH09325692A (ja) ナビゲーション用地図表示方法
US11919513B2 (en) Control system, system and method for providing assistance to an occupant of a vehicle
CN117537841A (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