水平泊车控制方法及控制系统技术方案

本发明专利技术公开了一种水平泊车控制方法包括：定义坐标系，划分泊车阶段，规划泊车轨迹，计算泊车轨迹各曲线参数，确定泊车目标位置，计算泊车起始位置，规划几何路径，计算车辆转动角度，计算得到泊车轨迹上各点的曲率换算得到方向盘转向角度。本发明专利技术还公开了一种采用上述水平泊车控制方法的水平泊车控制系统。采用本发明专利技术泊车轨迹特性参数和轨迹上各点的方向盘目标转角均可直接实时在线计算得到，极大地减少了自动泊车控制算法对于ECU标定数据存放空间的需求量，可有效降低系统成本。并且，泊车轨迹特性参数和轨迹上各点的方向盘目标转角均采用实时在线计算能更加有效地实时修正泊车轨迹，避免碰撞发生，并获得更好的转向连续性。

Horizontal parking control method and control system

The invention discloses a horizontal parking control method including: defining coordinate system, dividing parking stage, planning parking track, calculating curve parameters of parking track, determining parking target position, calculating parking starting position, planning geometric path, calculating vehicle rotation angle, calculating curvature of each point on parking track. The steering angle of the steering wheel is converted. The invention also discloses a horizontal parking control system adopting the above horizontal parking control method. The parking track characteristic parameters and the steering wheel target angle of each point on the track can be directly calculated on-line in real time, which greatly reduces the requirement of the automatic parking control algorithm for ECU calibration data storage space and effectively reduces the system cost. Furthermore, real-time on-line calculation of parking trajectory characteristic parameters and steering wheel target angles at each point on the trajectory can more effectively correct the parking trajectory in real-time, avoid collision, and obtain better steering continuity.

【技术实现步骤摘要】
水平泊车控制方法及控制系统
本专利技术涉及汽车领域，特别是涉及一种水平泊车控制方法。本专利技术还涉及一种采用所述水平泊车控制方法的水平泊车控制系统。
技术介绍
随着城市内汽车保有量的不断增加，泊车位紧张、泊车空间狭窄、泊车环境复杂的现象愈专利技术显，这对驾驶员的泊车技术提出了更高的要求。自动泊车系统通过对车辆横向和纵向运动的实时控制，完成自动泊车入位的功能，其可以有效地降低驾驶员的操作难度，并提高泊车安全性，目前已在越来越多的量产车型上得到运用。自动泊车控制算法包括泊车车位识别、车辆位姿计算、泊车轨迹规划和泊车轨迹跟踪等多个功能模块，泊车轨迹规划作为其中的一项核心算法，是决定泊车成败和最终泊车姿态的关键。泊车轨迹规划算法需要实现的功能为：根据车位尺寸和被泊车辆停车位置，确定泊车的起始和目标位置；考虑碰撞避免、车辆运动学以及部分非定量化的约束条件，规划一条连接泊车起始和目标位置的可行驶轨迹。目前，国内外针对泊车轨迹规划问题研究了多种方法，采用了包括B样条、五次多项式曲线、极样条、螺旋线等曲线拟合方法，以保证整条泊车轨迹曲率连续，从而同时满足泊车过程中系统对于车辆碰撞避免和转向连续的要求。上述方法主要存在以下不足：由于用于曲线拟合的函数形式较为复杂，且需要根据各项约束条件进行函数最优化，因此不利于嵌入式系统对于泊车轨迹的实时在线计算。轨迹上各点坐标往往以离线计算的方式预先获得，再以标定数据的形式存入ECU，因而上述方法对ECU标定空间的容量要求较高，增加了系统成本和工程实现难度。
技术实现思路
本专利技术要解决的技术问题是提供一种既满足泊车约束条件能实现实时在线泊车轨迹规划，避免车辆的水平泊车控制方法。本专利技术还提供了一种采用所述水平泊车控制方法的水平泊车控制系统。泊车约束条件，为本领域现有文献常用词语，包括：车辆碰撞避免约束条件、车辆转向运动学约束条件以及泊车路程最短、泊车终点车辆保持水平等部分非定量化的约束等。为解决上述技术问题，本专利技术提供的水平泊车控制方法，包括以下步骤：步骤1、根据车位识别的结果，以车位前方障碍物右后方顶点为坐标原点，以与路肩平行的方向为X轴方向，与路肩垂直方向为Y轴方向建立车位坐标系；车位识别的结果包括：车位长度、车位宽度、车辆与车位侧向间隔距离、车位前方障碍物位置和车位后方障碍物位置。步骤2、将水平泊车过程划分为第一泊车阶段和第二泊车阶段；所述第一泊车阶段是指车辆从转向起始位置，方向盘转至第一方向极限位置，此时保持最小转向半径行驶，使车身转向第一预设角度后方向盘回打直至方向盘回正；所述第二泊车阶段是指方向盘转至第二方向极限位置，此时保持该最小转向半径使车身左转一定角度，使车身转向第二预设角度后方向盘回打，直至车辆达到泊车目标位置，且同时保证车身和方向盘回正；步骤3、将第一泊车阶段的泊车轨迹几何路径规划为至少包括顺序连接的第一回旋曲线、第一圆弧和第二回旋曲线；将第二泊车阶段的泊车轨迹几何路径规划为至少包括顺序连接的第三回旋曲线、第二圆弧和第四回旋曲线；第一泊车阶段、第二泊车阶段并不仅限于规划为三段曲线(两回旋曲线和一圆弧)，本申请的原理下本领域的技术人员还可做出许多变形和改进，将第一泊车阶段、第二泊车阶段规划为更多的曲线组合。比如：多段两回旋曲线和两端圆弧，甚至多段两回旋曲线和多段圆弧。步骤4、根据车位长度和宽度选定泊车速度V和方向盘转速ω，0＜V＜Vb,0＜ω＜ωb；其中,Vb为允许泊车车速的最大值，ωb允许泊车方向盘转动速度的最大值；步骤5、根据选定的泊车速度V、方向盘转速ω以及所泊车辆的第一类固有参数计算各回旋曲线的曲率变化系数σ、曲率达到最大值时对应点的车辆航向角θCCEnd、几何路径转向半径RGeo和回旋曲线与几何路径间的夹角μ；步骤6、根据所泊车辆的第二类固有参数确定泊车目标位置；步骤7、根据泊车目标位置，计算泊车轨迹起始位置坐标，计算第一泊车阶段泊车轨迹第一圆弧的圆心坐标和第二泊车阶段泊车轨迹第二圆弧的圆心坐标，第一泊车阶段泊车轨迹几何路径对应的圆心角和第二泊车阶段泊车轨迹几何路径对应的圆心；步骤8、确定第一圆弧、第二圆弧所对应的车辆转动角度；步骤9、计算得到泊车轨迹上各点的曲率，换算得到对应的方向盘转向角度。实施步骤5时，所述所泊车辆的第一类固有参数包括：车辆轴距、车辆后轴中心点的最大转向曲率、车辆后轴中心点的最大转向曲率对应点X轴坐标和Y轴坐标，以及车辆后轴中心点的最小转向半径。实施步骤5时，采用以下公式计算；b为车辆轴距，KMax为车辆后轴中心点的最大转向曲率，θCCEnd、XCCEnd和YCCEnd分别为曲率达到最大值时对应点的车身航向角、X轴坐标和Y轴坐标，RGeo为泊车轨迹几何路径的转向半径，RMin为车辆后轴中心点的最小转向半径，RMin与KMax呈倒数关系，μ则为回旋曲线与几何路径间的夹角。实施步骤6时，所述所泊车辆的第二类固有参数包括：车位的长度和宽度，车辆后悬长度，X轴方向设定的安全值，车位的宽度，车辆宽度，Y轴方向设定的安全值。X轴方向设定的安全值是指最终泊车位置车辆与车位后方障碍物的安全距离。Y轴方向设定的安全值是指最终泊车位置车辆距离路肩的安全距离。实施步骤6时，确定泊车目标位置采用以下公式计算；XFinish＝-(LPrkSlt-LRO-XSV)其中：LPrkSlt为车位的长度，WPrkSlt为车位的宽度，LRO为车辆后悬长度，WVeh为车辆宽度，XSV为X轴方向设定的安全值，YSV为Y轴方向设定的安全值。实施步骤7时，第二圆弧圆心坐标采用以下公式计算；XC2＝XFinish+RGeo×sin(μ)YC2＝YFinish+RGeo×cos(μ)然后，根据三角关系方程组求解得到泊车轨迹起始位置坐标、第一阶段泊车轨迹几何路径第一圆弧的圆心坐标、第一泊车阶段泊车轨迹几何路径对应的圆心角和第二泊车阶段泊车轨迹几何路径对应的圆心角。实施步骤8时，第一圆弧、第二圆弧所对应的车辆转动角度采用以下公式计算；β1＝αtot1-2×(8CCEnd+μ)β2＝αtot2-2×(θCCEnd+μ)β1是第一圆弧车辆转动角度，β2是第一圆弧车辆转动角度。实施步骤9时，方向盘转向角度根据Ackerman转向原理由下述公式；计算得到车辆前轮中心点处对应的Ackerman转向角根据Ackerman转向角和方向盘转角的对应关系曲线，查表获得所需的实时方向盘目标转角。一种采用上述任意一项所述水平泊车控制方法的水平泊车控制系统，包括：ECU、超声波传感器、轮速传感器、方向盘转角传感器、电控转向单元、电控油门、刹车系统和电控换挡系统；ECU，预存水平泊车控制方法和该被泊车辆的固有参数(车辆固有参数是指车辆客观存在的车辆参数，固定具有的车辆参数；比如：车辆尺寸参数，车辆动力参数、车辆速度参数等每种车辆客观存在固定具有的参数)，根据水平泊车控制方法控制该被泊车辆执行泊车；ECU通过超声波传感器获取车位尺寸信息及被泊车辆与车位障碍物的间隔距离，利用轮速传感器和方向盘转角传感器计算车辆实时位置，通过电控转向单元实时控制方向盘转速和方向盘转角，通过电控油门和刹车系统实时控制车速，通过电控换挡系统控制车辆行驶方向。在这种控制模式下(自动模式)由ECU控制泊车方法及车辆各功能模块自动执行，驾驶员仅输本文档来自技高网...

【技术保护点】
1.一种水平泊车控制方法，其特征在于，包括以下步骤：步骤1、根据车位识别的结果，以车位前方障碍物右后方顶点为坐标原点，以与路肩平行的方向为X轴方向，与路肩垂直方向为Y轴方向建立车位坐标系；步骤2、将水平泊车过程划分为第一泊车阶段和第二泊车阶段；所述第一泊车阶段是指车辆从转向起始位置，方向盘转至第一方向极限位置使车身转向第一预设角度后方向盘回打直至方向盘回正；所述第二泊车阶段是指方向盘转至第二方向极限位置，使车身转向第二预设角度后方向盘回打，直至车辆达到泊车目标位置；步骤3、将第一泊车阶段的泊车轨迹几何路径规划为至少包括顺序连接的第一回旋曲线、第一圆弧和第二回旋曲线；将第二泊车阶段的泊车轨迹几何路径规划为至少包括顺序连接的第三回旋曲线、第二圆弧和第四回旋曲线；步骤4、根据车位长度和宽度选定泊车速度V和方向盘转速ω，0＜V＜Vb,0＜ω＜ωb；其中,Vb为允许泊车车速的最大值，ωb为允许泊车方向盘转动速度的最大值；步骤5、根据选定的泊车速度V、方向盘转速ω以及所泊车辆的第一类固有参数计算各回旋曲线的曲率变化系数σ、曲率达到最大值时对应点的车辆航向角θCCEnd、几何路径转向半径RGeo和回旋曲线与几何路径间的夹角μ；步骤6、根据所泊车辆的第二类固有参数确定泊车目标位置；步骤7、根据泊车目标位置，计算泊车轨迹起始位置坐标，计算第一泊车阶段泊车轨迹第一圆弧的圆心坐标和第二泊车阶段泊车轨迹第二圆弧的圆心坐标，第一泊车阶段泊车轨迹几何路径对应的圆心角和第二泊车阶段泊车轨迹几何路径对应的圆心；步骤8、确定第一圆弧、第二圆弧所对应的车辆转动角度；步骤9、计算得到泊车轨迹上各点的曲率，换算得到对应的方向盘转向角度。...

【技术特征摘要】
1.一种水平泊车控制方法，其特征在于，包括以下步骤：步骤1、根据车位识别的结果，以车位前方障碍物右后方顶点为坐标原点，以与路肩平行的方向为X轴方向，与路肩垂直方向为Y轴方向建立车位坐标系；步骤2、将水平泊车过程划分为第一泊车阶段和第二泊车阶段；所述第一泊车阶段是指车辆从转向起始位置，方向盘转至第一方向极限位置使车身转向第一预设角度后方向盘回打直至方向盘回正；所述第二泊车阶段是指方向盘转至第二方向极限位置，使车身转向第二预设角度后方向盘回打，直至车辆达到泊车目标位置；步骤3、将第一泊车阶段的泊车轨迹几何路径规划为至少包括顺序连接的第一回旋曲线、第一圆弧和第二回旋曲线；将第二泊车阶段的泊车轨迹几何路径规划为至少包括顺序连接的第三回旋曲线、第二圆弧和第四回旋曲线；步骤4、根据车位长度和宽度选定泊车速度V和方向盘转速ω，0＜V＜Vb,0＜ω＜ωb；其中,Vb为允许泊车车速的最大值，ωb为允许泊车方向盘转动速度的最大值；步骤5、根据选定的泊车速度V、方向盘转速ω以及所泊车辆的第一类固有参数计算各回旋曲线的曲率变化系数σ、曲率达到最大值时对应点的车辆航向角θCCEnd、几何路径转向半径RGeo和回旋曲线与几何路径间的夹角μ；步骤6、根据所泊车辆的第二类固有参数确定泊车目标位置；步骤7、根据泊车目标位置，计算泊车轨迹起始位置坐标，计算第一泊车阶段泊车轨迹第一圆弧的圆心坐标和第二泊车阶段泊车轨迹第二圆弧的圆心坐标，第一泊车阶段泊车轨迹几何路径对应的圆心角和第二泊车阶段泊车轨迹几何路径对应的圆心；步骤8、确定第一圆弧、第二圆弧所对应的车辆转动角度；步骤9、计算得到泊车轨迹上各点的曲率，换算得到对应的方向盘转向角度。2.如权利要求1所述的水平泊车控制方法，其特征在于：步骤5中所述所泊车辆的第一类固有参数包括：车辆轴距、车辆后轴中心点的最大转向曲率、车辆后轴中心点的最大转向曲率对应点X轴坐标和Y轴坐标，以及车辆后轴中心点的最小转向半径。3.如权利要求2所述的水平泊车控制方法，其特征在于：步骤5中采用以下公式计算；b为车辆轴距，KMax为车辆后轴中心点的最大转向曲率，θCCEnd、XCCEnd和YCCEnd分别为曲率达到最大值时对应点的车身航向角、X轴坐标和Y轴坐标，RGeo为泊车轨迹几何路径的转向半径，RMin为车辆后轴中心点的最小转向半径，RMin与KMax呈倒数关系，μ则为回旋曲线与几何路径间的夹角。4.如权利要求3所述的水平泊车控制方法，其特征在于：步骤6中所述所泊车辆的第二类固有参数包括：车位的长度，车位的宽度，车辆后悬长度，X轴方向设定的安全值，Y轴方向设定的安全值。5.如权利要求4所述的水平泊车控制方法，其特征在于：步骤6中确定泊车目标位置采用以下公式计算；XFinish＝-(LPrkSlt-LRO-XSV)其中：LPrkSlt为车位的长度，WPrkSlt为车位宽度，LRO为车辆后悬长度，X...

【专利技术属性】
技术研发人员：许朕，
申请(专利权)人：联创汽车电子有限公司，
类型：发明
国别省市：上海,31