CN102529961B - 自动泊车***的初始寻库偏差校正方法 - Google Patents
自动泊车***的初始寻库偏差校正方法 Download PDFInfo
- Publication number
- CN102529961B CN102529961B CN201210081017.5A CN201210081017A CN102529961B CN 102529961 B CN102529961 B CN 102529961B CN 201210081017 A CN201210081017 A CN 201210081017A CN 102529961 B CN102529961 B CN 102529961B
- Authority
- CN
- China
- Prior art keywords
- data
- parking
- target vehicle
- vehicle
- distance
- 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.)
- Expired - Fee Related
Links
Landscapes
- Traffic Control Systems (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及用于自动泊车***寻找车库过程中根据侧方路边已停车辆与目标车辆的动态间距,确定一条与侧方停车界限(L2)平行的虚拟直线(L5)的方法,该直线是路径规划的重要参照。具体而言提出了一种用于辅助车辆在自动泊车的过程中,当目标车位前方车辆出现与侧方停车界限不平行现象时,对目标泊车位重新定位,通过超声波传感器动态捕捉目标车辆和已停车辆的相对距离,然后根据具体算法对采集到的数据进行处理,并将处理后的数据用于制定合理的泊车路径来完成自动泊车。
Description
技术领域
本发明涉及自动泊车***,具体提供一种分析并纠正初始寻库时由于前后已停泊车辆与侧方停车界限的不平行偏差带来的目标车位出现路径规划不准确问题的方法。
背景技术
自动泊车***是指在***启动并寻找到有效车位后,驾驶员无需操作方向盘车辆自动停车入位的***。其工作过程:信息采集***通过传感器采集泊车位大小及车辆自身坐标等相关信息,并生成数据作为***的输入;信息处理***根据这些数据信息,通过计算判断车辆能否泊入该车位所提供的空间,并生成合适的泊车参考路径和相应的控制指令,执行机构根据控制指令使车辆泊入车位。
现有自动泊车***有如下的不足之处:借助于目标泊车位前方已停车辆A3的车辆侧方轮廓线作为参照来设定目标车辆最终停放位置,此轮廓线近似于车辆A3的纵向轴线L3平行。因此如果目标车位前方已停车辆A3的纵向轴线L3与侧方停车界限L2不平行,在目前自动泊车***的引导下会使得目标车辆出现和前方已停车辆A3类似的停放位置偏差,即目标车辆的纵向轴线L4与侧方停车界限L2不平行。最终车辆停靠在目标泊车位处的情况见图1。
发明内容
针对现有的在目标车位前方已停车辆A3出现偏差即车辆纵向轴线L3与侧方停车界限L2不平行的情况下,目标车辆也会出现类似情况的问题,本发明专利提供一种分析校正的方法,使目标车辆A0准确的停靠在目标车位处。
本发明专利所采用的技术方案是:提出了一种用于辅助车辆在进行自动泊车的过程中,当目标车位前方车辆出现与侧方停车界限L2不平行现象时,对目标泊车位重新定位的方法,主要是通过超声波传感器动态捕捉目标车辆侧方已停车辆侧方轮廓线的相对距离,然后通过具体算法对采集到的数据进行处理。
具体包括如下步骤。
a) 驾驶员首先通过打开开关接通车载蓄电池12V直流电源,使自动泊车***上电启动。
b) 软件按照配置对控制端口初始化,使超声波传感器接通12V直流电源,并启动控制器端口1捕获功能;捕获功能是指能识别外部输入方波信号的上升和下降沿,并通过中断内部启动的计时器获得方波脉冲的宽度。
c) 在保证目标车辆平行行驶的情况下,即目标车辆纵向轴线L4与侧方停车界限L2始终平行,超声波传感器自动每隔40ms发射一次48KHz超声波,并接收从障碍物反射回来的回波信号,在超声波传感器内部处理成数字信号后通过连接导线传到(b)所述控制器端口1,该端口已经在初始化时被配置为捕获功能。
d) 经端口1的捕获功能处理后的数据即为目标车辆与侧方已停车辆的相对间距,即目标车辆上超声波发出点到已停车辆上相对应的超声波反射点的距离;然后控制软件对该距离值进行判断,判断是否大于2m,如果大于2m则判定该数据不是有效数据,予以丢弃,反之则将该次探测获得的距离值写入预先定义的数组data[200],并存储到控制器内部的Flash存储器内;该数组具有200个元素(0~199),如果在寻找到有效车位前采集到的有效数据个数超过200个,则按照先进先出原则丢弃最先采集的数据,即始终丢弃data数组中的第0个元素,并将1~199元素前移,将新的数据写入第199元素;反之,如果在寻找到有效车位前采集到的有效数据个数不大于200,则以所采集到的所有有效数据为处理对象进行如下处理,此时data数组中有效的元素个数为30~k,30≤k≤200,由于自动泊车使用条件要求在侧方已有停放车辆的前提下才能工作,且寻找车库时车速要求不高于10km/h;因此根据采集数据周期为40ms计算出所能采集到的有效数据大于等于30个。上面所说有效车位是指经超声波连续探测的横向距离始终大于车辆宽度的时间乘以车速而获得的目标车辆侧方一片能够满足停车需求的区域。
e) 对数组data[200]中的k个元素进行排序,按照升序的方式进行排列,即data[0]< data[1]< … <data[k-2] <data[k-1],其中30≤k≤200;然后舍去前10%和后10%的数据,即舍去第0个到第 个和第个到第个元素之间的数据,其中根据四舍五入原则取整。
f) 对剩余的个元素进行算术平均值计算得到均值,则可以作出一条与目标车辆纵向轴线平行的且距离目标车侧方距离为的虚拟直线L5;该虚拟直线L5将用于路径规划中最终停车位置的参照,以此保证目标车辆的停放位置准确姿态与侧方停车界限L2平行。
具体算法是指:经端口1的捕获功能处理后的数据即为目标车辆与侧方已停车辆的相对距离,即超声波发出点到已停车辆上相对应的超声波反射点的距离。然后控制软件对该距离值进行判断,将数据过大或过小的数据予以丢弃,反之则将该次探测获得的距离值写入预先定义的数组data[200],并存储到控制器内部的Flash存储器内。根据自动泊车***寻址时的车速要求,确定超声波传感器的发射周期。然后对数组data[200]中的k个元素进行排序,按照升序的方式进行排列,即data[0]< data[1]< … <data[k-2] <data[k-1],其中30≤k≤200。然后舍去前10%和后10%的数据,如图4所示,对剩余的元素进行算术平均值计算得到均值,制定合适的泊车路径来完成自动泊车。
其有益效果是:在路边已停车辆停放出现偏差的情况下即车辆纵向轴线L3与侧方停车界限L2不平行,仍然能保证目标车辆A0准确的泊车,即车辆纵向轴线L0与侧方停车界限L2平行,降低由于车辆的停泊姿态的不准确给消费者带来的困扰。
附图说明
图1 为背景技术泊车示意图。
图2为车辆初始寻找有效停车位时的示意图。
图3为车辆寻库过后通过超声波传感器获得到的信息示意图。
图4为所得到虚拟线及将虚拟线平移的示意图。
图5为具体计算时所需数据的采集示意图。
图6为目标车辆停泊车位最终效果示意图。
具体实施方案
如图2所示,驾驶员首先通过打开开关接通车载蓄电池12V直流电源,使自动泊车***上电启动,开始初始寻库,软件按照配置对控制端口初始化,使超声波传感器接通12V直流电源,并启动控制器端口1捕获功能。捕获功能是指能识别外部输入方波信号的上升和下降沿,并通过中断内部启动的计时器获得方波脉冲的宽度。如图2所示,超声波传感器自动每隔40ms发射一次48KHz超声波,并接收从障碍物反射回来的回波信号,在超声波传感器内部处理成数字信号后通过连接导线传到所述控制器端口1,该端口已经在初始化时被配置为捕获功能。经端口1的捕获功能处理后的数据即为目标车辆与侧方已停车辆的相对距离,即超声波发出点到已停车辆上相对应的超声波反射点的距离。然后控制软件对该距离值进行判断,判断是否大于2m,如果大于2m则判定为非侧方已停车辆反射超声波测得的数据,予以丢弃,反之则将该次探测获得的距离值写入预先定义的数组data[200],并存储到控制器内部的Flash存储器内。该数组具有200个元素(0~199),如果在寻找到有效车位前采集到的有效数据个数超过200个,则按照先进先出原则丢弃最先采集的数据,即始终丢弃data数组中的第0个元素,并将1~198元素前移,将新的数据写入第199元素;反之,以所采集到的数据为对象进入下一步处理,即data数组中有效的元素个数为30~k,30≤k≤200,由于自动泊车使用条件要求在侧方已有停放车辆,即A1,A2,A3,A4,A5,的前提下才能工作,且寻找车库时车速要求不高于10Km/h,因此根据采集数据周期为40ms计算出所能采集到的有效数据大于等于30个。上面所说有效车位是指通过超声波传感器探测的横向距离结合车辆行进的距离,综合判断侧方空间能够满足车辆停放要求的一片区域。对数组data[200]中的k个元素进行排序,按照升序的方式进行排列,即data[0]< data[1]< … <data[k-2] <data[k-1],其中30≤k≤200。然后舍去前10%和后10%的数据,即舍去第0个到第个和第个到第个元素之间的数据,其中根据四舍五入原则取整。如图4所示,对剩余的个元素进行算术平均值计算得到均值,
其中m指扫描过的车辆数,是采集到的第一辆车到目标车的一系列距离值,是到目标车的一系列距离值,以此类推。便可以作出一条与目标车辆纵向轴线L4平行的且距离目标车侧方距离为的虚拟直线L5,如图3所示。该直线将用于路径规划中最终停车位置的参照。以此保证目标车辆的停放位置准确姿态与侧方停车界限L2平行。
Claims (2)
1.自动泊车***的初始寻库的偏差校正方法,其特征在于,包括如下步骤:
a)驾驶员首先通过打开开关接通车载蓄电池12V直流电源,使自动泊车***上电启动;
b)软件按照配置对控制器端口初始化,使超声波传感器接通12V直流电源,并启动控制器端口捕获功能;
c)在保证目标车辆平行行驶的情况下,即目标车辆纵向轴线(L4)与侧方停车界限(L2)始终平行,超声波传感器自动每隔40ms发射一次48KHz超声波,并接收从障碍物反射回来的回波信号,在超声波传感器内部处理成数字信号后通过连接导线传到b)所述控制器端口,该控制器端口已经在初始化时被配置为捕获功能;
d)经控制器端口的捕获功能处理后的数据即为目标车辆与侧方已停车辆的相对间距,即目标车辆上超声波发出点到已停车辆上相对应的超声波反射点的距离;然后控制软件对该距离值进行判断,判断是否大于2m,如果大于2m则判定该数据不是有效数据,予以丢弃,反之则将该次探测获得的距离值写入预先定义的数组data[200],并存储到控制器内部的Flash存储器内;该数组具有200个元素0~199,如果在寻找到有效车位前采集到的有效数据个数超过200个,则按照先进先出原则丢弃最先采集的数据,即始终丢弃data[200]数组中的第0个元素,并将1~199元素前移,将新的数据写入第199元素;反之,如果在寻找到有效车位前采集到的有效数据个数不大于200,则以所采集到的所有有效数据为处理对象进行如下处理,此时data[200]数组中有效的元素个数为30~k,30≤k≤200,由于自动泊车使用条件要求在侧方已有停放车辆的前提下才能工作,且寻找车库时车速要求不高于10km/h;
e)对数组data[200]中的k个元素进行排序,按照升序的方式进行排列,即data[0]<data[1]<…<data[k-2]<data[k-1],其中30≤k≤200;然后舍去前10%和后10%的数据,即舍去第0个到第个和第个到第k-1个元素之间的数据,其中根据四舍五入原则取整;
f)对剩余的个元素进行算术平均值计算得到均值则可以作出一条与目标车辆纵向轴线平行的且距离目标车侧方距离为的虚拟直线(L5);该虚拟直线(L5)将用于路径规划中最终停车位置的参照,以此保证目标车辆的停放位置准确姿态与侧方停车界限(L2)平行。
2.根据权利要求1所述的自动泊车***的初始寻库的偏差校正方法,其特征在于,所述有效车位是指经超声波连续探测的横向距离始终大于车辆宽度的时间乘以车速而获得的目标车辆侧方一片能够满足停车需求的区域。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210081017.5A CN102529961B (zh) | 2012-03-26 | 2012-03-26 | 自动泊车***的初始寻库偏差校正方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210081017.5A CN102529961B (zh) | 2012-03-26 | 2012-03-26 | 自动泊车***的初始寻库偏差校正方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102529961A CN102529961A (zh) | 2012-07-04 |
CN102529961B true CN102529961B (zh) | 2015-06-10 |
Family
ID=46338341
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210081017.5A Expired - Fee Related CN102529961B (zh) | 2012-03-26 | 2012-03-26 | 自动泊车***的初始寻库偏差校正方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102529961B (zh) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102012025317A1 (de) * | 2012-12-22 | 2014-06-26 | Audi Ag | Fahrerassistenzsystem und Verfahren zum Freigeben eines autonomen oder pilotierten Garagenparkens |
US8957786B2 (en) * | 2013-05-21 | 2015-02-17 | Ford Global Technologies, Llc | Enhanced alignment method for park assist |
KR20140144470A (ko) * | 2013-06-11 | 2014-12-19 | 주식회사 만도 | 주차제어방법, 장치 및 시스템 |
DE102013212318A1 (de) | 2013-06-26 | 2014-12-31 | Bayerische Motoren Werke Aktiengesellschaft | Automatisierter Einparkvorgang mit zusätzlichem Korrekturzug |
CN104401324B (zh) * | 2014-11-05 | 2017-06-27 | 江苏大学 | 一种基于多目标优化的辅助泊车***及方法 |
CN104554257B (zh) * | 2014-12-29 | 2017-01-18 | 江苏大学 | 一种用于自动泊车初始寻库阶段泊车场景识别方法 |
CN104637342B (zh) * | 2015-01-22 | 2017-01-04 | 江苏大学 | 一种狭小垂直车位场景智能识别与泊车路径规划***及方法 |
US9542845B1 (en) * | 2015-09-11 | 2017-01-10 | Robert Bosch Gmbh | Method for ascertaining a parking area of a street section |
CN105527963B (zh) * | 2015-12-23 | 2019-01-25 | 奇瑞汽车股份有限公司 | 侧方位停车方法及*** |
CN105857306B (zh) * | 2016-04-14 | 2018-07-10 | 中国科学院合肥物质科学研究院 | 一种用于多种泊车场景的车辆自主泊车路径规划方法 |
KR20180091313A (ko) * | 2017-02-06 | 2018-08-16 | 현대자동차주식회사 | 센서 기반의 주차공간 탐색 시스템 및 그 방법 |
DE102017210112A1 (de) * | 2017-06-16 | 2018-12-20 | Robert Bosch Gmbh | Verfahren und System zur Durchführung einer Kalibrierung eines Sensors |
CN110838244B (zh) * | 2019-10-17 | 2021-02-02 | 惠州市德赛西威智能交通技术研究院有限公司 | 一种基于超声波的垂直泊车位的车位航向调整方法 |
CN110803157A (zh) * | 2019-11-26 | 2020-02-18 | 奇瑞汽车股份有限公司 | 一种基于自动泊车的车位识别方法和*** |
CN113911110A (zh) * | 2021-10-13 | 2022-01-11 | 武汉光庭信息技术股份有限公司 | 一种泊车轨迹修正方法、***、电子设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6102147A (en) * | 1997-04-15 | 2000-08-15 | Honda Giken Kogyo Kabushiki Kaisha | Automatic steering system for vehicle |
CN1846149A (zh) * | 2003-08-28 | 2006-10-11 | 罗伯特·博世有限公司 | 停车空位的尺寸和位置的确定方法和装置 |
DE102007002262A1 (de) * | 2007-01-16 | 2008-08-21 | GM Global Technology Operations, Inc., Detroit | Verfahren und Vorrichtung zur Unterstützung des Fahrers eines Kraftfahrzeugs beim Einparken |
JP2008201178A (ja) * | 2007-02-16 | 2008-09-04 | Toyota Motor Corp | 駐車支援装置 |
KR20100049789A (ko) * | 2008-11-04 | 2010-05-13 | 주식회사 만도 | 주차 공간의 곡률을 반영한 주차 위치 결정 방법 및 주차 보조 장치 |
WO2011000483A1 (de) * | 2009-07-02 | 2011-01-06 | Valeo Schalter Und Sensoren Gmbh | Verfahren zur erkennung und korrektur einer fehlstellung eines abstandssensors eines fahrassistenzsystems für fahrzeuge |
-
2012
- 2012-03-26 CN CN201210081017.5A patent/CN102529961B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6102147A (en) * | 1997-04-15 | 2000-08-15 | Honda Giken Kogyo Kabushiki Kaisha | Automatic steering system for vehicle |
CN1846149A (zh) * | 2003-08-28 | 2006-10-11 | 罗伯特·博世有限公司 | 停车空位的尺寸和位置的确定方法和装置 |
DE102007002262A1 (de) * | 2007-01-16 | 2008-08-21 | GM Global Technology Operations, Inc., Detroit | Verfahren und Vorrichtung zur Unterstützung des Fahrers eines Kraftfahrzeugs beim Einparken |
JP2008201178A (ja) * | 2007-02-16 | 2008-09-04 | Toyota Motor Corp | 駐車支援装置 |
KR20100049789A (ko) * | 2008-11-04 | 2010-05-13 | 주식회사 만도 | 주차 공간의 곡률을 반영한 주차 위치 결정 방법 및 주차 보조 장치 |
WO2011000483A1 (de) * | 2009-07-02 | 2011-01-06 | Valeo Schalter Und Sensoren Gmbh | Verfahren zur erkennung und korrektur einer fehlstellung eines abstandssensors eines fahrassistenzsystems für fahrzeuge |
Non-Patent Citations (1)
Title |
---|
一种应用于自动泊车***的车位检测方法;何峰;《技术与应用》;20090331;第24页-第27页 * |
Also Published As
Publication number | Publication date |
---|---|
CN102529961A (zh) | 2012-07-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102529961B (zh) | 自动泊车***的初始寻库偏差校正方法 | |
CN203422765U (zh) | 一种车辆车型自动识别*** | |
CN102431551B (zh) | 一种泊车车位探测方法以及泊车车位探测*** | |
US7936283B2 (en) | Method for detecting parking area by using range sensor | |
CN104064030B (zh) | 一种车型识别方法及*** | |
CN103143509B (zh) | 一种垃圾分类机器人及其垃圾识别与分类方法 | |
CN105404844A (zh) | 一种基于多线激光雷达的道路边界检测方法 | |
CN104176051B (zh) | 自动泊车***测试装置及测试方法 | |
CN107650906B (zh) | 智能泊车***及其控制方法 | |
CN108297861A (zh) | 车辆在垂直停车位中的自主泊车 | |
CN103754219A (zh) | 一种多传感器信息融合的自动泊车*** | |
CN105774655B (zh) | 一种倾斜车位探测装置及方法 | |
CN104627068B (zh) | 一种自动泊车过程中车身航向角的计算方法 | |
CN207311425U (zh) | 一种提高自动泊车成功率的控制*** | |
CN107618505A (zh) | 一种提高自动泊车成功率的控制***及方法 | |
CN105620409A (zh) | 车辆底部碰撞避免 | |
CN103050021A (zh) | 一种车位检测方法及检测装置 | |
CN110095769B (zh) | 一种车位检测方法、装置及电子设备 | |
CN105584480A (zh) | 用于自动选择停车操作的停车辅助方法和*** | |
CN104851301A (zh) | 一种基于减速带声音分析的车辆参数识别方法 | |
CN109017354A (zh) | 一种新能源汽车无人充电方法及*** | |
CN105865566B (zh) | 显示汽车燃油的方法及装置 | |
CN203149852U (zh) | 一种车位检测装置 | |
CN110979390B (zh) | 一种轨道交通车辆车轮多边形修复方法及*** | |
CN102812326A (zh) | 用于控制测量***的方法和用于实施所述方法的测量*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C53 | Correction of patent for invention or patent application | ||
CB03 | Change of inventor or designer information |
Inventor after: Jiang Haobin Inventor after: Hua Yiding Inventor after: Xu Xing Inventor after: Ma Shidian Inventor before: Jiang Haobin |
|
COR | Change of bibliographic data |
Free format text: CORRECT: INVENTOR; FROM: JIANG HAOBIN TO: JIANG HAOBIN HUA YIDING XU XING MA SHIDIAN |
|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20150610 Termination date: 20190326 |