自动泊车控制装置及方法
【专利摘要】本发明涉及自动泊车控制装置及方法，计算障碍的斜率，根据所算斜率重新设定，以更加稳定地实施自动泊车的自动泊车控制装置及方法。本发明的自动泊车控制装置包括：信息接收部，接收车辆超声波传感器和转向角传感器采集的信息；斜率计算部，利用所述信息接收部接收的信息和应用递归最小二乘法（RLS,RecursiveLeastSquare）的反馈控制计算所述障碍物的斜率；泊车空间识别部，利用所述计算的障碍物斜率识别泊车空间；泊车控制部，基于所述识别的泊车空间，控制所述车辆的自动泊车。
【专利说明】自动泊车控制装置及方法
【技术领域】
[0001]本发明涉及自动泊车控制装置及方法。具体是准确计算障碍物的斜率，根据所算斜率重新设定可更加稳定地实施自动泊车的自动泊车控制装置及方法。
【背景技术】
[0002]随着车辆需求的增加，泊车问题也逐渐显现。尤其在狭窄空间的泊车难度更大。即使驾车技术再高，想在狭窄空间泊车，也需要反复前进和倒退几次车辆才能泊车，或者需由他人来引导才能准确泊车，由此对自动泊车系统的需求日益增多。
[0003]一般自动泊车系统是接收车辆的各种传感器传送的信息，利用所接收信息判断泊车空间，运算车辆的泊车目标点计算出轨迹后控制车辆进行泊车。若想利用现有的这种方式准确实施自动泊车，需准确检测泊车空间，需利用泊车空间周边障碍物的信息来进行检测。如果当前用于检测泊车空间的传感器数据为小数，因检测障碍物的数据量小而无法准确检测障碍物的位置。检测的障碍物位置不准确，则所检测的泊车空间也会不准确，进而在自动泊车时容易碰撞障碍物。
【发明内容】
[0004]为解决所述问题，本发明提供一种准确计算障碍物斜率，利用所算斜率准确检测泊车空间，从而稳定地实施自动泊车的自动泊车控制装置及方法。
[0005]为解决所述问题，本发明的自动泊车控制装置包括:信息接收部，接收车辆超声波传感器和转向角传感器采集的信息；斜率计算部，利用所述信息接收部接收的信息计算障碍物的斜率；泊车空间识别部，利用所述计算的障碍物斜率识别泊车空间；泊车控制部，基于所述识别的泊车空间，控制所述车辆的自动泊车。
[0006]优选地，所述斜率计算是，通过利用递归最小二乘法(RLS, Recursive LeastSquare)的反馈控制计算所述障碍物的斜率。
[0007]优选地，所述自动泊车控制装置还包括:边缘点决定部，利用所述信息接收部接收的信息决定障碍物的边缘点。
[0008]优选地，所述自动泊车控制装置还包括:距离计算部，利用所述决定的边缘点计算所述障碍物之间距离；所述泊车空间识别部是利用所述计算的障碍物斜率和所述计算的障碍物之间距离识别泊车空间。
[0009]为解决所述问题，本发明的自动泊车控制方法包括以下步骤:接收信息，接收车辆的超声波传感器和转向角传感器采集的信息；计算斜率，利用所述信息接收步骤接收的信息算所述障碍物的斜率；识别泊车空间，利用所述计算的障碍物斜率识别泊车空间；控制自动泊车，基于所述识别的泊车空间控制所述车辆的自动泊车。
[0010]优选地，所述斜率计算是，通过利用递归最小二乘法(RLS, Recursive LeastSquare)的反馈控制算出所述障碍物的斜率。
[0011]优选地，所述自动泊车控制方法还包括:利用所述信息接收步骤接收的信息决定障碍物边缘点的边缘点决定步骤。
[0012]优选地，所述自动泊车控制方法还包括:利用所述决定的边缘点计算所述障碍物之间距离的距离计算步骤；所述泊车空间识别步骤是利用所述计算的障碍物斜率和所述计算的障碍物之间距离识别泊车空间。
[0013]本发明具有的优点在于:
[0014]本发明准确地计算出障碍物的斜率准确识别泊车空间，从而更加精确地实施自动泊车。
【专利附图】
【附图说明】
[0015]图1是本发明优选实施例的自动泊车控制装置的结构图。
[0016]图2是显示超声波传感器在车辆上的装配位置的例示图。
[0017]图3是说明本发明的自动泊车控制装置的泊车空间检测部的边缘点、障碍物间距以及斜率的计算方法的图示。
[0018]图4是本发明优选实施例的自动泊车控制方法的流程图。
【具体实施方式】
[0019]下面参照附图，对发明优选实施例详细进行描述。说明内容和附图中的实际同一个构件是用同一个符号表示，不再重复说明。而且说明本发明时，若对有关的公知功能或者结构的具体说明使本发明宗旨变得模糊则省略该说明。
[0020]描述某一个构件“连接于”或“联接于”其它构件，有可能直接连接于或联接于该其它构件，但应被理解成中间有可能存在其它构件。相反，描述某一个构件“直接连接于”或“直接联接于”其它构件，应被理解成中间不存在其它构件。
[0021]本说明书中的单数形式，在文句中没有特别提示的前提下，也包含复数形式。说明书中使用的“包括(comprises)”或者“包括的(comprising) ”不排除所涉及的构件、步骤、动作以及/或元件以外的一个以上的其它构件、步骤、动作以及/或元件的存在或者补充。
[0022]图1是本发明优选实施例的自动泊车控制装置的结构图。根据图1，自动泊车控制装置100包括信息接收部110、泊车空间检测部120、泊车控制部130。
[0023]信息接收部100接收车辆的各传感器采集的信息。接收的信息可以用来检测泊车空间。具体是，信息接收部110包括超声波传感器接收部112和转向角传感器接收部114。
[0024]超声波接收部112接收车辆的超声波传感器采集的信息。车辆上具备一个以上的超声波传感器。
[0025]图2是超声波传感器装配于车辆上的位置例示图。根据图2，一个实施例中，超声波传感器在车辆前方被设置四个，侧方设置两个，后方设置四个。
[0026]超声波传感器可以检测前方、侧方和后方的障碍物位置，也可以测量障碍物和车辆之间距离。超声波传感器接收部112接收由超声波传感器采集的障碍物的位置、障碍物和车辆之间的距离等信息。
[0027]转向角传感器接收部114接收检测车辆的转向方向和转向角的转向角传感器采集的信息。可以利用转向角传感器接收部114接收的信息获得车辆的位置信息。
[0028]泊车空间检测部120是利用信息接收部110接收的信息检测可自动泊车的空间。具体是，泊车空间检测部120包括边缘点决定部121、距离计算部123、斜率计算部125以及泊车空间识别部127。
[0029]图3是说明本发明的自动泊车控制装置的泊车空间检测部计算边缘点、障碍物间距和斜率的方法的图示。根据图3，边缘点决定部121是利用超声波传感器接收部112接收的信息决定障碍物的边缘点。具体是，边缘点决定部121可以把障碍物和车辆之间的距离发生突变的地点定为边缘点。图Smp1(U1)表示第一个障碍物的X轴位置和y轴位置，P1' (Xl’，yi’)可以成为第一障碍物的边缘点。P2(x2，y2)表示第二个障碍物的X轴位置和y轴位置，P； U2’，y；)可以成为第二个障碍物的边缘点。
[0030]距离计算部123是利用边缘点决定部121决定的障碍物的边缘点计算障碍物之间的距离。图3中障碍物之间的距离可以用P2’(x2’，y2’)与P1' (x/，y/ )之差计算。
[0031]斜率计算部125计算障碍物的斜率。而且计算斜率时对泊车空间周边车辆、摩托车、自行车等物体乃至边石或墙壁也视为障碍物。计算障碍物的斜率而使泊车空间检测部准确地检测出泊车空间。
[0032]具体是，斜率计算部125是通过利用递归最小二乘法(RLS, Recursive LeastSquare)的反馈控制算出障碍物的斜率。斜率计算部125是通过应用递归最小二乘法的反馈控制减少误差而更加准确地算出斜率。
[0033]下面结合数学式I至6，对斜率计算部125通过利用递归最小二乘法的反馈控制计算障碍物斜率的过程进行说明。
[0034]关系式(y=f (X))中X选择各种值测量与此相对应的y值。就是第i次的X值的实际测量值为yi。
[0035]因此,测量误差ε i是!F(Xi)Iit5关系式y=f (X)是可以利用多项式、样条(Spline)函数或者插值函数的其它不同形态的插值法获得。
[0036]鉴于试验上的误差ε i，可以用如下数学式I表达f (X)。
[0037]【数学式I】
[0038]f (X) = mx+b
[0039]M和b是常数。假设数学式I合理，则f (X)的决定问题就是常数m和b的决定问题。为决定m和b的疑似值，需对误差Si进行假设。假设的一个例子是，可以把误差ei假设成从正态概率分布(Normal Probability Distribution)中选择的随机变量(RandomVariable)。满足所述假设的误差ε i其性质如下。
[0040]如果无数次地反复X=Xi的试验，误差ε i的平均为O。X=Xi是ε j变大则减少产生同一个ε 可能性。所谓误差Si的所述假设成立就是对正常误差的假设(Normal ErrorAssumption)。
[0041]下面为帮助理解，将I < i < η中的Si假设成同一个正态概率分布函数中的随机变量，不管^的大小。假设函数f (X)在已知的函数组C，并假设成线性函数，则C中的所有函数f (X)中与f几乎一致的函数f’是会最小化如数学式2。
[0042]【数学式2】
[0043]
【权利要求】
1.一种自动泊车控制装置，其特征在于，包括: 信息接收部，接收车辆超声波传感器和转向角传感器采集的信息； 斜率计算部，利用所述信息接收部接收的信息和应用递归最小二乘法的反馈控制计算所述障碍物的斜率； 泊车空间识别部，利用所述计算的障碍物斜率识别泊车空间； 泊车控制部，基于所述识别的泊车空间，控制所述车辆的自动泊车。
2.根据权利要求1所述的自动泊车控制装置，其特征在于，所述自动泊车控制装置还包括:边缘点决定部，利用所述信息接收部接收的信息决定障碍物的边缘点。
3.根据权利要求2所述的自动泊车控制装置，其特征在于，所述自动泊车控制装置还包括: 距离计算部，利用所述决定的边缘点计算所述障碍物之间距离； 所述泊车空间识别部利用所述计算的障碍物斜率和所述计算的障碍物之间距离识别泊车空间。
4.一种自动泊车控制方法，其特征在于，该控制方法包括以下步骤: 接收信息，接收车辆的超声波传感器和转向角传感器采集的信息； 计算斜率，利用所述信息接收步骤接收的信息和应用递归最小二乘法的反馈控制计算所述障碍物的斜率； 识别泊车空间，利用所述计算的障碍物斜率识别泊车空间； 控制自动泊车，基于所述识别的泊车空间控制所述车辆的自动泊车。
5.根据权利要求4所述的自动泊车控制方法，其特征在于，所述自动泊车控制方法还包括以下步骤: 决定边缘点，利用所述信息接收步骤接收的信息决定障碍物的边缘点。
6.根据权利要求5所述的自动泊车控制方法，其特征在于，所述自动泊车控制方法还包括以下步骤: 利用所述决定的边缘点计算所述障碍物之间距离的距离计算步骤； 所述泊车空间识别步骤是利用所述计算的障碍物斜率和所述计算的障碍物之间距离识别泊车空间。
【文档编号】B60W40/02GK103448717SQ201210589671
【公开日】2013年12月18日 申请日期:2012年12月28日 优先权日:2012年6月4日
【发明者】金昭演 申请人:现代摩比斯株式会社