CN113561969B - 一种倒车辅助方法及装置 - Google Patents
一种倒车辅助方法及装置 Download PDFInfo
- Publication number
- CN113561969B CN113561969B CN202111013661.4A CN202111013661A CN113561969B CN 113561969 B CN113561969 B CN 113561969B CN 202111013661 A CN202111013661 A CN 202111013661A CN 113561969 B CN113561969 B CN 113561969B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- track
- distance
- yaw rate
- speed
- 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
- 238000000034 method Methods 0.000 title claims abstract description 31
- 238000007405 data analysis Methods 0.000 claims abstract description 8
- 230000003068 static effect Effects 0.000 claims description 3
- 238000013500 data storage Methods 0.000 description 5
- 238000004364 calculation method Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 238000001514 detection method Methods 0.000 description 2
- 208000031481 Pathologic Constriction Diseases 0.000 description 1
- WYTGDNHDOZPMIW-RCBQFDQVSA-N alstonine Natural products C1=CC2=C3C=CC=CC3=NC2=C2N1C[C@H]1[C@H](C)OC=C(C(=O)OC)[C@H]1C2 WYTGDNHDOZPMIW-RCBQFDQVSA-N 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000003203 everyday effect Effects 0.000 description 1
- 230000003993 interaction Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000036262 stenosis Effects 0.000 description 1
- 208000037804 stenosis Diseases 0.000 description 1
- 238000004804 winding Methods 0.000 description 1
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
- B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
- B60W30/06—Automatic manoeuvring for parking
-
- 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
- B60W2520/00—Input parameters relating to overall vehicle dynamics
- B60W2520/10—Longitudinal speed
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/60—Other road transportation technologies with climate change mitigation effect
- Y02T10/72—Electric energy management in electromobility
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明涉及辅助驾驶技术领域,具体涉及一种倒车辅助方法及装置。该方法包括以下步骤:连续记录车辆的车速和横摆角速度;根据车速和横摆角速度,确定车辆的行驶轨迹;根据行驶轨迹,控制车辆沿行驶轨迹倒车。该装置包括:数据采集模块、数据分析模块和控制模块。数据采集模块用于连续记录车辆的车速和横摆角速度;数据分析模块用于根据车速和横摆角速度,确定车辆的行驶轨迹;控制模块用于根据行驶轨迹,控制车辆沿行驶轨迹倒车。能够解决现有技术中,采用前置摄像头、环视摄像头和后雷达共同作用来规划倒车轨迹,导致数据记录和存储量大,易出现误识别、漏识别的情况,并且倒车轨迹规划质量差的问题。
Description
技术领域
本发明涉及辅助驾驶技术领域,具体涉及一种倒车辅助方法及装置。
背景技术
近年来,交通环境日趋复杂,驾车出行时,在陌生环境下容易将车行驶入较为狭窄路段,致使车辆前行、转弯和掉头都很困难。例如车辆驶进蜿蜒狭窄的死胡同、无法通行的直线型坡道地下车库入口和曲线型坡道地下车库入口,或者其他日常生活中经常遇见的类似场景(具体使用场景参考下文典型场景)。
典型场景是狭窄的难以掉头的路况,典型场景表述如下:车辆在地下车库寻找停车位,在车辆行驶至尽头时仍未发现停车位,道路狭窄,无法掉头。车辆行驶至曲线型坡道的地下停车库,地下停车库入口暂停对外开放。行驶刚进狭窄蜿蜒的巷子,发现对面来车,无法避让,或开进死胡。车辆刚从斜坡上预留通道较为狭窄的水平车位驶出,行驶方向上有来车,无法避让。车辆刚从预留通道较为狭窄的路边垂直车位驶出到斜坡上,行驶方向上有来车,无法避让。车辆绕圆形花坛行驶,错过出口,且前方道路被障碍区阻挡。车辆行驶到狭窄断头路,用户尝试掉头或者原地打方向来调整车辆姿态但无果。夜晚无路灯情况,车辆行至前往需要退回原位置,此时驾驶员自行倒车无法看清后方。
新手司机由于驾驶操作不熟练,遇到上述典型的场景,需要长距离的在较窄的道路进行倒车,则会更加容易处于进退两难的窘迫情况。现有技术中,前置摄像头、环视摄像头和后雷达共同作用来规划倒车轨迹方案,其数据记录和存储量大,易出现误识别、漏识别的情况,并且倒车轨迹规划质量差。
发明内容
针对现有技术中存在的缺陷,本发明的目的在于提供一种倒车辅助方法及装置,能够解决现有技术中,采用前置摄像头、环视摄像头和后雷达共同作用来规划倒车轨迹,导致数据记录和存储量大,易出现误识别、漏识别的情况,并且倒车轨迹规划质量差的问题。
为达到以上目的,本发明采取的技术方案是:
一方面,本发明提供一种倒车辅助方法,包括以下步骤:
连续记录车辆的车速和横摆角速度;
根据车速和横摆角速度,确定车辆的行驶轨迹;
根据行驶轨迹,控制车辆沿行驶轨迹倒车。
在一些可选的方案中,所述的根据车速和横摆角速度,确定车辆的行驶轨迹,具体包括:
通过对横摆角速度进行积分,获取车辆的航向角;
将车速沿所述航向角的方向进行分解得到X向速度分量和Y向速度分量;
X向速度分量和Y向速度分量进行积分,得到车辆的行驶轨迹。
在一些可选的方案中,在连续记录车辆的车速和横摆角速度时,间隔设定时间记录行驶轨迹的轨迹坐标,同时在所述轨迹坐标处,记录车辆设定部位到最近静止物体的距离;
在使车辆沿行驶轨迹倒车时,在所述轨迹坐标处再次检测车辆设定部位到最近静止物体的距离;
根据相同所述轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,辅助修正当前倒车轨迹。
在一些可选的方案中,所述的间隔设定时间记录行驶轨迹的轨迹坐标,同时在所述轨迹坐标处,记录车辆设定部位到最近静止物体的距离,具体包括:
间隔设定时间,获取所述轨迹坐标处车辆设定部位到初选最近物体的距离;
根据连续获取的车辆设定部位到初选最近物体之间的距离差值,以及轨迹坐标之间的坐标差值,判断距离差值与坐标差值之间的差是否大于设定值;
若是,则初选最近物体不是静止物体,不做记录;
若否,则初选最近物体为最近静止物体,将所述初选最近物体到车辆设定部位的距离记录为车辆设定部位到最近静止物体的距离。
在一些可选的方案中,在连续记录车辆的车速和横摆角速度时,同时记录方向盘转角;
在使车辆沿行驶轨迹倒车时,根据方向盘转角和行驶轨迹控制车辆沿行驶轨迹倒车。
在一些可选的方案中,在根据车速和横摆角速度,确定车辆的行驶轨迹至设定距离后,再记录的车速和横摆角速度,将设定距离之前的车速和横摆角速度覆盖,再确定的行驶轨迹,将设定距离之前的行驶轨迹覆盖。
在一些可选的方案中,当车辆停止行驶时,停止记录的车速和横摆角速度,当车速超过第一阀值时,将记录的车速和横摆角速度,以及将确定的行驶轨迹清零,当车速低于第二阀值时,记录的车速和横摆角速度,并确定的行驶轨迹。
另一方面本,发明还提供一种倒车辅助装置,包括:
数据采集模块,其用于连续记录车辆的车速和横摆角速度;
数据分析模块,其用于根据车速和横摆角速度,确定车辆的行驶轨迹;
控制模块,其用于根据行驶轨迹,控制车辆沿行驶轨迹倒车。
在一些可选的方案中,还包括设置在车尾两侧的雷达,其用于在连续记录车辆的车速和横摆角速度时,同时记录所述轨迹坐标处车辆设定部位到最近静止物体的距离;以及在使车辆沿行驶轨迹倒车时,在所述轨迹坐标处再次检测车辆设定部位到最近静止物体的距离,并将采集的数据传输至控制模块,使控制模块根据相同所述轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,辅助修正当前倒车轨迹。
在一些可选的方案中,还包括静止物体判断模块,其用于间隔设定时间记录所述轨迹坐标处车辆设定部位到初选最近物体的距离,并根据连续记录的车辆设定部位到初选最近物体之间的距离差值,以及轨迹坐标之间的坐标差值,判断距离差值与坐标差值之间的差是否大于设定值,以判断初选最近物体是否为静止物体,将所述初选最近物体到车辆设定部位的距离记录为车辆设定部位到最近静止物体的距离,并传输至控制模块。
与现有技术相比,本发明的优点在于:该方法仅仅根据陀螺仪获取车辆实时的横摆角速度,以及通过ESC获取车辆的车速,即可计算得到车辆的行驶轨迹,能够解决现有技术中需采用前置摄像头、环视摄像头和后雷达共同作用来规划倒车轨迹,会导致数据记录和存储量大,易出现误识别、漏识别的情况,并且倒车轨迹规划质量差的问题。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本发明实施例中倒车辅助方法的流程图;
图2为本发明实施例中确定行驶轨迹的示意图。
实施方式
为使本申请实施例的目的、技术方案和优点更加清楚,下面将结合本申请实施例中的附图,对本申请实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请的一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动的前提下所获得的所有其他实施例,都属于本申请保护的范围。
以下结合附图对本发明的实施例作进一步详细说明。
如图1所示,一方面,本发明提供一种倒车辅助方法,包括以下步骤:
S1:连续记录车辆的车速和横摆角速度。
在本实施例中,车辆上电后即开始记录车辆前进的车速和横摆角速度数据,通过ESC(电子稳定控制系统)获取车辆的车速,另外,还可以获取轮速信号对车速进行修正;通过陀螺仪获取车辆的横摆角速度。当然,也可以记录倒车的速度和横摆角速度,以获取倒车的倒车轨迹。
S2:根据车速和横摆角速度,确定车辆的行驶轨迹。
在一些可选的实施例中,步骤S2具体包括:
S21:通过对横摆角速度进行积分,获取车辆的航向角。
通过陀螺仪获取车辆实时的横摆角速度w,对实时的横摆角速度w进行积分得到航向角sita=w*dt,t为时间。
参见图2,S22:将车速沿所述航向角的方向进行分解得到X向速度分量和Y向速度分量。
在本实施例中,将车速v沿此航向角sita方向进行分解得到X向速度分量v x 和Y向速度分量v y 。
S22:X向速度分量和Y向速度分量进行积分,得到车辆的行驶轨迹。
在本实施例中,根据公式Xt=X0+v*cos(sita)*dt,得到各个时刻行驶轨迹中坐标点的X轴坐标,根据公式Yt=Y0+v*sin(sita1)*dt,得到各个时刻行驶轨迹中坐标点的Y轴坐标,根据各个时刻行驶轨迹中坐标点的X轴坐标以及各个时刻行驶轨迹中坐标点的Y轴坐标即可得到车辆的行驶轨迹。
S3:根据行驶轨迹,控制车辆沿行驶轨迹倒车。
在本实施例中,车辆根据HMI(Human Machine Interface,人机交互接口)的请求信号和档位信号,例如将车辆的档位换至倒车档位,并且驾驶员给出启动自动倒车的指令,则自动循迹倒车功能就可以启动,根据行驶轨迹,控制车辆沿行驶轨迹倒车。
另外,可通过EPS扭矩信号和VCU档位信号判断车辆是否被用户接管,及其他关联传感器信号的状态信号用以判断整车状态是否良好。
所以,该方法可通过陀螺仪获取车辆实时的横摆角速度经过积分的到航向角,通过ESC(电子稳定控制系统)获取车辆的车速,根据车速和横摆角速度,确定车辆的行驶轨迹,倒车时根据行驶轨迹,控制车辆沿行驶轨迹自动倒车。该方法仅仅根据陀螺仪获取车辆实时的横摆角速度,以及通过ESC获取车辆的车速,即可计算得到车辆的行驶轨迹,能够解决现有技术中需采用前置摄像头、环视摄像头和后雷达共同作用来规划倒车轨迹,会导致数据记录和存储量大,易出现误识别、漏识别的情况,并且倒车轨迹规划质量差的问题。
在一些可选的实施例中,在连续记录车辆的车速和横摆角速度时,间隔设定时间记录行驶轨迹的轨迹坐标,同时在所述轨迹坐标处,记录车辆设定部位到最近静止物体的距离。
在使车辆沿行驶轨迹倒车时,在所述轨迹坐标处,再次检测车辆设定部位到最近静止物体的距离。
根据相同所述轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,辅助修正当前倒车轨迹。
在本实施例中,通过设置在车尾两侧的雷达,雷达采用毫米波角雷达。在连续记录车辆的车速和横摆角速度,通过车速和横摆角速度计算形式轨迹的同时,间隔设定时间记录行驶轨迹的轨迹坐标,本例中为每隔20ms记录一次车辆的坐标,还在记录轨迹坐标的同时通过在车尾两侧的雷达记录车辆设定部位到最近静止物体的距离,采用毫米波角雷达检测,则记录车辆的毫米波累到到最近静止物体的距离。
在倒车时,在所述轨迹坐标处,再次检测车辆设定部位到最近静止物体的距离,根据相同所述轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,辅助修正当前倒车轨迹。
由于轮速信号、转角信号、陀螺仪信号存在一定公差,仅通过车辆轮速信号和陀螺仪信号确定行驶轨迹,行驶轨迹可能会出现偏差过大的情况,另外,倒车时通过转角信号控制倒车,也会出现控制不精确的情况,通过相同轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,即行进和倒车时在相同位置相对于相同物体的距离差,辅助修正当前倒车轨迹,使车辆向行进时的轨迹靠拢。避免了在倒车时,车辆远离行进轨迹的问题。
此外,当发现相同轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差大于设定的差值时,将该次修正控制指令屏蔽,认定为此时选择的参照物(最近静止物体)为移动物体,不具有参照价值。
在一些可选的实施例中,间隔设定时间记录行驶轨迹的轨迹坐标,同时在所述轨迹坐标处,记录车辆设定部位到最近静止物体的距离,具体包括:
间隔设定时间获取所述轨迹坐标处车辆设定部位到初选最近物体的距离;根据连续获取的车辆设定部位到初选最近物体之间的距离差值,以及轨迹坐标之间的坐标差值,判断距离差值与坐标差值之间的差是否大于设定值;若是,则初选最近物体不是静止物体,不做记录;若否,则初选最近物体为最近静止物体,将所述初选最近物体到车辆设定部位的距离记录为车辆设定部位到最近静止物体的距离。
在本实施例中,每隔20ms记录一次车辆的轨迹坐标,并记录该轨迹坐标处,车辆设定部位到初选最近物体的距离。由于车辆在继续行驶,两次记录时间的轨迹坐标之间存在坐标差值,坐标差值包括横坐标差值,两次记录时间对应的轨迹坐标处,两次记录的车辆设定部位到初选最近物体之间的距离也存在距离差值,又由于传感器存在一定的公差,测得数据可能存在一定的误差,当距离差值与坐标差值之间的差大于设定值,就判定为此时选中的物体为一个在移动的物体,不用该物体作为倒车时的修正参考,当距离差值与坐标差值之间的差小于等于设定值时,就判定为此时选中的物体为一个静止不动的物体,将初选最近物体到车辆设定部位的距离记录为车辆设定部位到最近静止物体的距离。这样可以避免选定一个移动的物体作为倒车时的修正参考,影响修正结果的问题。
在一些可选的实施例中,在连续记录车辆的车速和横摆角速度时,同时记录方向盘转角;在使车辆沿行驶轨迹倒车时,根据方向盘转角和行驶轨迹控制车辆沿行驶轨迹倒车。
在本实施例中,每次记录车辆的车速和横摆角速度时,同时记录方向盘转角,这样就可以知道行驶轨迹、航向角和方向盘转角之间的关系,从而在倒车时,利用方向盘转角、航向角和行驶轨迹之间的关系,修正倒车的控制信息,控制车辆沿行驶轨迹倒车。
在一些可选的实施例中,在根据车速和横摆角速度,确定车辆的行驶轨迹至设定距离后,再记录的车速和横摆角速度,将设定距离之前的车速和横摆角速度覆盖,再确定的行驶轨迹,将设定距离之前的行驶轨迹覆盖。
在本实施例中,在长距离的行驶过程中,通过设定循环记录数据,通过将后面记录的数据覆盖设定距离以前的数据,可以减小装置对数据储存的需求,提高处理速度。一般情况下,设置的设定距离为50米,即始终记录最后50米的行驶数据。
在一些可选的实施例中,当车辆停止行驶时,停止记录的车速和横摆角速度,当车速超过第一阀值时,将记录的车速和横摆角速度,以及将确定的行驶轨迹清零,当车速低于第二阀值时,记录的车速和横摆角速度,并确定的行驶轨迹。
在本实施例中,当车辆停止行驶时,停止记录的车速和横摆角速度,并且停止计算行驶轨迹,当车辆下电或者下电设定时长后,就该次行驶的轨迹数据清除,避免占用存储空间;当识别到倒挡信号和自动倒车信号时,就可控制车辆沿着行驶轨迹自动倒车。
当车速超过第一阀值时,此时判定车辆不是行驶在窄道内,无需使用自动倒车功能,所以此时即可将记录的车速和横摆角速度,以及将确定的行驶轨迹清零,从而避免不必要的数据储存和计算;当车速低于第二阀值时,此时判定车辆可能是行驶在窄道内,可能需使用自动倒车功能,所以此时即开始记录的车速和横摆角速度,以及确定的行驶轨迹,以备需要使用自动循迹倒车功能。
另一方面,本发明还提供一种倒车辅助装置,包括:数据采集模块、数据分析模块和控制模块。
数据采集模块用于连续记录车辆的车速和横摆角速度;数据分析模块用于根据车速和横摆角速度,确定车辆的行驶轨迹;控制模块用于根据行驶轨迹,控制车辆沿行驶轨迹倒车。
在使用该倒车辅助装置时,数据采集模块通过陀螺仪获取车辆实时的横摆角速度经过积分的到航向角,通过ESC获取车辆的车速,数据分析模块根据ESC获取的实时车速和陀螺仪实时获取的横摆角速度,确定车辆的行驶轨迹;倒车时,控制模块根据行驶轨迹,控制车辆沿行驶轨迹自动倒车。该方法仅仅根据陀螺仪获取车辆实时的横摆角速度,以及通过ESC获取车辆的车速,即可计算得到车辆的行驶轨迹,能够解决现有技术中需采用前置摄像头、环视摄像头和后雷达共同作用来规划倒车轨迹,会导致数据记录和存储量大,易出现误识别、漏识别的情况,并且倒车轨迹规划质量差的问题。同时也避免了新手司机由于驾驶操作不熟练,遇到长窄的断头路,需要长距离的在较窄的道路进行倒车,容易处于进退两难的问题。
控制模块还包括控制请求输出匹配单元,控制请求输出匹配单元用于根据行驶轨迹将倒车规划转化成EPS(Electric Power Steering,电子助力转向)可识别的信号,从而控制车辆实现倒车循迹。
在本例中,数据采集模块还用于接收获取车辆的轮速和方向盘转角,在自动倒车阶段,控制模块通过实时车速与实时轮速和方向盘转角的对应值,修正倒车的控制参数,控制车辆向行驶轨迹校正。
该倒车辅助装置还包括自动循迹启动控制模块,用于根据HMI(Human MachineInterface,人机交互接口)的请求信号和档位信号,控制自动循迹倒车功能的开启和关闭。例如将车辆的档位换至倒车档位,并且驾驶员给出启动自动倒车的指令,则自动循迹倒车功能就可以启动,根据行驶轨迹,控制车辆沿行驶轨迹倒车。
该自动循迹启动控制模块还用于控制自动开启或者关闭记录行驶轨迹。例如,当车辆停止行驶时,停止记录的车速和横摆角速度,并且停止计算行驶轨迹,当车辆下电或者下电设定时长后,就该次行驶的轨迹数据清除,避免占用存储空间。当车速超过第一阀值时,此时判定车辆不是行驶在窄道内,无需使用自动倒车功能,所以此时即可将记录的车速和横摆角速度,以及将确定的行驶轨迹清零,从而避免不必要的数据储存和计算;当车速低于第二阀值时,此时判定车辆可能是行驶在窄道内,可能需使用自动倒车功能,所以此时即开始记录的车速和横摆角速度,以及确定的行驶轨迹,以备需要使用自动循迹倒车功能。
在一些可选的实施例中,该倒车辅助装置还包括设置在车尾两侧的雷达,其用于在连续记录车辆的车速和横摆角速度时,同时记录所述轨迹坐标处车辆设定部位到最近静止物体的距离;以及在使车辆沿行驶轨迹倒车时,在所述轨迹坐标处再次检测车辆设定部位到最近静止物体的距离,并将采集的数据传输至控制模块,使控制模块根据相同所述轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,辅助修正当前倒车轨迹。
在本实施例中,通过设置在车尾两侧的雷达,雷达采用毫米波角雷达。在连续记录车辆的车速和横摆角速度,通过车速和横摆角速度计算形式轨迹的同时,间隔设定时间记录行驶轨迹的轨迹坐标,本例中为每隔20ms记录一次车辆的坐标,还在记录轨迹坐标的同时通过在车尾两侧的雷达记录车辆设定部位到最近静止物体的距离,采用毫米波角雷达检测,则记录车辆的毫米波累到最近静止物体的距离。
在倒车时,在所述轨迹坐标处,再次检测车辆设定部位到最近静止物体的距离,根据相同所述轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,辅助修正当前倒车轨迹。
由于轮速信号、转角信号、陀螺仪信号存在一定公差,仅通过车辆轮速信号和陀螺仪信号确定行驶轨迹,行驶轨迹可能会出现偏差过大的情况,另外,倒车时通过转角信号控制倒车,也会出现控制不精确的情况,通过相同轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,即行进和倒车时在相同位置相对于相同物体的距离差,辅助修正当前倒车轨迹,使车辆向行进时的轨迹靠拢。避免了在倒车时,车辆远离行进轨迹的问题。
在一些可选的实施例中,该倒车辅助装置还包括静止物体判断模块,其用于间隔设定时间记录所述轨迹坐标处车辆设定部位到初选最近物体的距离,并根据连续记录的车辆设定部位到初选最近物体之间的距离差值,以及轨迹坐标之间的坐标差值,判断距离差值与坐标差值之间的差是否大于设定值,以判断初选最近物体是否为静止物体,将所述初选最近物体到车辆设定部位的距离记录为车辆设定部位到最近静止物体的距离,并传输至控制模块。
在本实施例中,设定部位即为设置在车尾两侧的雷达,每隔20ms记录一次车辆的轨迹坐标,并记录该轨迹坐标处,车辆设定部位到初选最近物体的距离。由于车辆在继续行驶,两次记录时间的轨迹坐标之间存在坐标差值,坐标差值包括横坐标差值,两次记录时间对应的轨迹坐标处,两次记录的雷达到初选最近物体之间的距离也存在距离差值,又由于传感器存在一定的公差,测得数据可能存在一定的误差,当距离差值与坐标差值之间的差大于设定值,就判定为此时选中的物体为一个在移动的物体,不选择使用该物体作为倒车时的修正参考,当距离差值与坐标差值之间的差小于等于设定值时,就判定为此时选中的物体为一个静止不动的物体,将初选最近物体到车辆设定部位的距离记录为车辆设定部位到最近静止物体的距离。这样可以避免选定一个移动的物体作为倒车时的修正参考,影响修正结果的问题。
该倒车辅助装置还包括数据存储模块,其用于存储车辆的实时车速和横摆角速度,还用来存储确定的行驶轨迹数据。此外,还用来存储检测的各个间隔时刻对应的车辆设定部位到最近静止物体的距离。在长距离的行驶过程中,通过设定循环记录数据,通过将后面记录的数据覆盖设定距离以前的数据,可以减小装置对数据储存的需求,提高处理速度。一般情况下,设置的设定距离为50米,即始终记录最后50米的行驶数据。
综上所述,数据采集模块通过陀螺仪获取车辆实时的横摆角速度经过积分的到航向角,通过ESC获取车辆的车速,数据分析模块根据ESC获取的实时车速和陀螺仪实时获取的横摆角速度,确定车辆的行驶轨迹;倒车时,控制模块根据行驶轨迹,控制车辆沿行驶轨迹自动倒车。该方法仅仅根据陀螺仪获取车辆实时的横摆角速度,以及通过ESC获取车辆的车速,即可计算得到车辆的行驶轨迹,能够解决现有技术中需采用前置摄像头、环视摄像头和后雷达共同作用来规划倒车轨迹,会导致数据记录和存储量大,易出现误识别、漏识别的情况,并且倒车轨迹规划质量差的问题。
在记录轨迹坐标的同时通过在车尾两侧的雷达记录车辆设定部位到最近静止物体的距离,在倒车时,在所述轨迹坐标处,再次检测车辆设定部位到最近静止物体的距离,根据相同所述轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,辅助修正当前倒车轨迹。
在本申请的描述中,需要说明的是,在本申请中,诸如“第一”和“第二”等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来,而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
以上所述仅是本申请的具体实施方式,使本领域技术人员能够理解或实现本申请。对这些实施例的多种修改对本领域的技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本申请的精神或范围的情况下,在其它实施例中实现。因此,本申请将不会被限制于本文所示的这些实施例,而是要符合与本文所申请的原理和新颖特点相一致的最宽的范围。
Claims (7)
1.一种倒车辅助方法,其特征在于,包括以下步骤:
连续记录车辆的车速和横摆角速度;
根据车速和横摆角速度,确定车辆的行驶轨迹,具体包括:
通过对横摆角速度进行积分,获取车辆的航向角;
将车速沿所述航向角的方向进行分解得到X向速度分量和Y向速度分量;
X向速度分量和Y向速度分量进行积分,得到车辆的行驶轨迹;
根据行驶轨迹,控制车辆沿行驶轨迹倒车;
在连续记录车辆的车速和横摆角速度时,间隔设定时间记录行驶轨迹的轨迹坐标,同时在所述轨迹坐标处,记录车辆设定部位到最近静止物体的距离;
在使车辆沿行驶轨迹倒车时,在所述轨迹坐标处再次检测车辆设定部位到最近静止物体的距离;
根据相同所述轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,辅助修正当前倒车轨迹。
2.如权利要求1所述的倒车辅助方法,其特征在于,所述的间隔设定时间记录行驶轨迹的轨迹坐标,同时在所述轨迹坐标处,记录车辆设定部位到最近静止物体的距离,具体包括:
间隔设定时间,获取所述轨迹坐标处车辆设定部位到初选最近物体的距离;
根据连续获取的车辆设定部位到初选最近物体之间的距离差值,以及轨迹坐标之间的坐标差值,判断距离差值与坐标差值之间的差是否大于设定值;
若是,则初选最近物体不是静止物体,不做记录;
若否,则初选最近物体为最近静止物体,将所述初选最近物体到车辆设定部位的距离记录为车辆设定部位到最近静止物体的距离。
3.如权利要求1所述的倒车辅助方法,其特征在于,
在连续记录车辆的车速和横摆角速度时,同时记录方向盘转角;
在使车辆沿行驶轨迹倒车时,根据方向盘转角和行驶轨迹控制车辆沿行驶轨迹倒车。
4.如权利要求1所述的倒车辅助方法,其特征在于,在根据车速和横摆角速度,确定车辆的行驶轨迹至设定距离后,再记录的车速和横摆角速度,将设定距离之前的车速和横摆角速度覆盖,再确定的行驶轨迹,将设定距离之前的行驶轨迹覆盖。
5.如权利要求1所述的倒车辅助方法,其特征在于,当车辆停止行驶时,停止记录的车速和横摆角速度,当车速超过第一阀值时,将记录的车速和横摆角速度,以及将确定的行驶轨迹清零,当车速低于第二阀值时,记录的车速和横摆角速度,并确定的行驶轨迹。
6.一种倒车辅助装置,其特征在于,包括:
数据采集模块,其用于连续记录车辆的车速和横摆角速度;
数据分析模块,其用于根据车速和横摆角速度,确定车辆的行驶轨迹;
控制模块,其用于根据行驶轨迹,控制车辆沿行驶轨迹倒车;
设置在车尾两侧的雷达,其用于在连续记录车辆的车速和横摆角速度时,同时记录轨迹坐标处车辆设定部位到最近静止物体的距离;以及在使车辆沿行驶轨迹倒车时,在所述轨迹坐标处再次检测车辆设定部位到最近静止物体的距离,并将采集的数据传输至控制模块,使控制模块根据相同所述轨迹坐标处检测车辆行进和倒车时车辆设定部位到最近静止物体距离差,辅助修正当前倒车轨迹。
7.如权利要求6所述的倒车辅助装置,其特征在于,还包括静止物体判断模块,其用于间隔设定时间记录所述轨迹坐标处车辆设定部位到初选最近物体的距离,并根据连续记录的车辆设定部位到初选最近物体之间的距离差值,以及轨迹坐标之间的坐标差值,判断距离差值与坐标差值之间的差是否大于设定值,以判断初选最近物体是否为静止物体,将所述初选最近物体到车辆设定部位的距离记录为车辆设定部位到最近静止物体的距离,并传输至控制模块。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111013661.4A CN113561969B (zh) | 2021-08-31 | 2021-08-31 | 一种倒车辅助方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111013661.4A CN113561969B (zh) | 2021-08-31 | 2021-08-31 | 一种倒车辅助方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113561969A CN113561969A (zh) | 2021-10-29 |
CN113561969B true CN113561969B (zh) | 2023-07-28 |
Family
ID=78173296
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111013661.4A Active CN113561969B (zh) | 2021-08-31 | 2021-08-31 | 一种倒车辅助方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113561969B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114274960B (zh) * | 2021-11-22 | 2023-10-20 | 岚图汽车科技有限公司 | 挪车控制系统、方法、装置、电子设备及存储介质 |
CN114103934B (zh) * | 2021-12-23 | 2023-06-16 | 岚图汽车科技有限公司 | 自动泊车路径规划方法、装置、设备及可读存储介质 |
CN114407877B (zh) * | 2022-02-25 | 2023-03-24 | 北京流马锐驰科技有限公司 | 一种基于轮速脉冲和imu的自动泊车定位方法 |
CN115214717B (zh) * | 2022-04-08 | 2024-04-16 | 广州汽车集团股份有限公司 | 一种路径记录方法和循迹倒车的方法、装置及设备 |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108437981A (zh) * | 2018-03-01 | 2018-08-24 | 东软集团股份有限公司 | 一种自动倒车方法及装置 |
Family Cites Families (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4606638B2 (ja) * | 2001-04-20 | 2011-01-05 | 本田技研工業株式会社 | 車両の軌跡推定装置及びこれを用いた車両の走行安全装置 |
US9290202B2 (en) * | 2011-04-19 | 2016-03-22 | Ford Global Technologies, Llc | System and method of calibrating a trailer backup assist system |
JP5965251B2 (ja) * | 2012-08-24 | 2016-08-03 | 東京計器株式会社 | 軌道位置データ付与システム及び軌道位置データ付与方法 |
KR101417456B1 (ko) * | 2012-12-07 | 2014-07-08 | 현대자동차주식회사 | 차량 요레이트센서의 바이어스 획득방법 |
CN107672589B (zh) * | 2017-09-26 | 2019-05-28 | 畅加风行(苏州)智能科技有限公司 | 一种基于雷达探测数据的车辆轨迹实时预测方法和装置 |
CN112519882B (zh) * | 2019-09-17 | 2022-02-22 | 广州汽车集团股份有限公司 | 一种车辆参考轨迹跟踪方法及系统 |
KR20210066063A (ko) * | 2019-11-27 | 2021-06-07 | 현대모비스 주식회사 | 차량의 후진 주행 제어 장치 및 방법 |
CN110920616A (zh) * | 2019-12-24 | 2020-03-27 | 吉林大学 | 一种智能车换道轨迹及换道轨迹跟随控制方法 |
CN112298179B (zh) * | 2020-10-16 | 2022-04-08 | 华人运通(上海)自动驾驶科技有限公司 | 一种四轮驱动车辆自动跟车的控制方法及系统 |
-
2021
- 2021-08-31 CN CN202111013661.4A patent/CN113561969B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108437981A (zh) * | 2018-03-01 | 2018-08-24 | 东软集团股份有限公司 | 一种自动倒车方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN113561969A (zh) | 2021-10-29 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113561969B (zh) | 一种倒车辅助方法及装置 | |
US11338798B2 (en) | Full-automatic parking method and system | |
CN110962843B (zh) | 一种自动泊车控制决策方法及系统 | |
US9193387B2 (en) | Automatic forward parking in perpendicular parking spaces | |
CN108928343A (zh) | 一种全景融合自动泊车系统及方法 | |
CN105163994B (zh) | 驾驶支持装置和驾驶支持方法 | |
CN111231944B (zh) | 一种自动泊车方法 | |
CN102034366B (zh) | 停车引导方法及装置 | |
CN109501797B (zh) | 一种自动泊车的控制方法及自动泊车系统 | |
CN109843703B (zh) | 用于确定用于倒车辅助系统的轨迹的控制单元和方法 | |
CN111055838A (zh) | 一种基于传感器融合的全自动泊车控制系统及其控制方法 | |
CN101460353A (zh) | 行驶辅助装置 | |
CN103661599A (zh) | 一种车辆转弯轨迹预测系统和方法 | |
CN103625474B (zh) | 车辆横向控制装置及其方法 | |
JP2007237930A (ja) | 運転支援装置 | |
GB2493446A (en) | Driving assistance for exiting parking space | |
JP2006099409A (ja) | 接触脱輪回避ナビゲーションシステム | |
JP2020111310A (ja) | 車両およびその制御方法 | |
JP2006311299A (ja) | 駐車区画監視装置 | |
CN114274952B (zh) | 垂直车位自主泊车方法、系统、存储介质及电子设备 | |
CN114516322B (zh) | 一种车辆泊出的系统、方法、车辆及计算机存储介质 | |
CN116022126A (zh) | 自主学习泊车方法、电子设备及存储介质 | |
CN114312760B (zh) | 带路沿车位的辅助泊车方法、电子设备和汽车 | |
CN116215577A (zh) | 一种低速自动领航方法、系统、电子设备及存储介质 | |
CN113879289A (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 |