一种基于滑膜的无人车辆自动泊车力矩控制方法与流程

本发明属于无人车辆自动泊车技术领域，涉及一种基于无人车辆的动力学与运动学特征的力矩控制方法，具体为一种基于滑膜的无人车辆自动泊车力矩控制方法。

背景技术：

当前，随着科学技术的突飞猛进，视觉传感器、激光测距仪、平衡陀螺、超声雷达以及光电编码等传感器和gps等定位控制技术日渐成熟与完善。尤其是这些控制技术与当下的无人驾驶等控制理论深度融合，无人驾驶控制技术(包括自动泊车技术)已成为当前自动化控制理论与科学实践应用的热点问题之一。然而，目前有关无人驾驶控制技术主要是依赖于传统的轨迹跟踪控制策略，而自动化泊车控制技术往往又都过分地依赖于视觉传感器，一旦车辆在行驶过程中出现视觉盲区或者是视觉传感器出现故障，势必造成无法挽回的损失，从而严重影响其应用价值。基于此，有必要发明一种全新的泊车控制技术手段，以解决传统泊车控制技术手段的弊端。

技术实现要素：

本发明的目的在于解决过分依赖于视觉传感器的传统无人车辆泊车技术手段存在视觉盲区等的控制问题，提供了一种基于滑膜的无人车辆自动泊车力矩控制方法，本方法只依赖于外界环境的反馈信息，不需要实时的视觉处理技术，泊车精确度更高。

本发明解决其技术问题的技术方案是：一种基于滑膜的无人车辆自动泊车力矩控制方法，包括以下步骤：

①通过gps对无人车辆、目标泊车区域和目标泊车区域内的障碍物进行识别、定位并测距，得到无人车辆的位置信息x，障碍物的位置信息u0，第i个约束条件下的目标泊车区域的参考点x0i；

②通过数学软件根据步骤①得到的无人车辆、障碍物和目标泊车区域的位置信息以及目标泊车区域的形状进行建模，对目标泊车区域构造区域势函数p，对已识别的障碍物构造避障势函数u，具体为：

其中，ki是可调节的第i个约束条件下的目标泊车区域的增益；n是目标泊车区域约束条件数目；fδi(δxi)是一个具有连续光滑标量函数，fδi(δxi)表示第i个约束条件下的目标泊车区域，δxi＝x-x0i，第i个约束条件下的目标泊车区域的参考点x0i为第i个约束条件下的目标泊车区域的中心点；‖x-u0‖表示无人车辆与障碍物的距离，r是以无人车辆的中心为圆心的最大感知区域的半径，r是无人车辆的中心与障碍物的最小安全距离的半径，r和r均是人为根据实际需求设定的值；

③根据步骤②建立的区域势函数p和避障势函数u设计用于控制无人车辆进入目标泊车区域的力矩控制器，具体如下：

其中，q是线速度和角速度形成的二维平面中的向量；θ为无人车辆的航向角；k是可调的增益矩阵，k根据实际需求设置，为系统参数估计，由系统参数的自适应率推得，其中系统参数的自适应率s是滑膜变量，s＝q-qr，y是已知的与无人车辆动力学相关的回归矩阵，不同类型的动力学结构对应的y的具体表达式是不同的，是已知的输入转换矩阵，不同类型的动力学结构对应的的具体表达式是不同的，是目标泊车区域梯度，是障碍物梯度；其中无人车辆的动力学与动力模型为：

其中

④接着调整第i个约束条件下的目标泊车区域的增益ki和增益矩阵k，对无人车辆的自动化泊车力矩控制器进行稳定性分析。

本方法步骤①中通过gps对无人车辆、目标泊车区域和目标泊车区域内的障碍物进行定位，得到无人车辆的位置信息x，障碍物的位置信息u0，第i个约束条件下的目标泊车区域的参考点x0i，通过gps对目标泊车区域进行识别、分析并且测量无人车辆和障碍物之间的距离；然后步骤②利用数学软件对已识别的障碍物和目标泊车区域进行建模，所述区域势函数p的作用原理是目标泊车区域中的势能最低，目标泊车区域外都处于较高势能，通过人为构造目标泊车区域附近的引力场，无人车辆能够沿着梯度方向从高势能移动到低势能最终进入到目标泊车区域。步骤②中所述避障势函数u的作用原理是障碍物附近的势能最高，障碍物外都处于较低势能，通过人为构造障碍物附近的斥力场，一旦无人车辆进入到斥力场，无人车辆能够沿着梯度方向从高势能移动到低势能最终脱离障碍物环境。避障势函数u中r是以无人车辆的中心为圆心的最大感知区域的半径，r是无人车辆的中心与障碍物的最小安全距离的半径，如果障碍物与无人车辆的距离大于r那么无人车辆不会感知到障碍物，如果无人车辆与障碍物的距离在r与r之间，那么无人车辆就会感知到障碍物，从而进入步骤③无人车辆调整力矩值改变航向避障，r和r均是人为根据实际需求设定的值，这使得本发明所述方法使用起来更加便捷并且人性化，能依据不同的目标泊车区域的情况做不不同的改变，具有较高的实用性。步骤③中所述力矩控制器作用原理为：实际上，无人车辆的动态性能不仅与无人车辆运动学相对位置有关，还与无人车辆的结构形式、质量分布、执行机构的位置、传动装置等因素有关。无人车辆动态性能由动力学方程描述，动力学就是考虑上述因素，研究无人车辆的运动与力矩间的动态关系。由现代控制理论方法，应用稳定性分析理论，由该控制器组成的闭环控制系统是渐进稳定的，也就是无人车辆最终可以进入到目标泊车区域不变集中，目标泊车区域梯度即可实现无人车辆的自动化泊车。步骤③为直接的力矩控制器，即本发明依据力矩控制器调整车辆两轮速的转速比，通过转速比来控制车轮的转向进而控制无人车辆的方向实现自动化避障和泊车。通过步骤③的控制可保证无人车辆与目标泊车区域内的障碍物之间距离大于r。步骤③中的无人车辆的动力学与动力模型为现有技术，是本领域技术人员所公知的，本发明中将不对此做详细介绍。步骤④中，需要不断的调整区域势函数p的第i个约束条件下的目标泊车区域的增益ki和力矩控制器τ的增益矩阵k，保证了区域势函数p和力矩控制器τ的稳定即可保证整个系统的稳定性。本发明所述方法是通过系统建模、利用全局反馈信息进行的力矩控制器设计，首先系统建模，实现了对目标泊车区域以及周围障碍物的描述，进而，依据模型信息进行力矩控制器的设计，由此大幅度减少了对自动泊车视觉传感器的严重依赖。

优选的，经过步骤③中的力矩控制器调节无人车辆进入到目标泊车区域之后，再通过姿态调整器来调整无人车辆在目标泊车区域中的姿态，所述姿态控制器为：ω＝-αtanh(θ-θd)，α是姿态调整率可调参数，θd是无人车辆在目标泊车区域中的一个期望的姿态，θd是人为根据实际需求设定的值。所述姿态控制器的作用原理为由现代控制理论方法，应用稳定性分析理论，由该控制器组成的闭环控制系统也是渐进稳定的，θ-θd＝0，实现任意姿态的调节。

优选的，步骤④中的稳定性分析采用了lyapunov理论和barbalat定理。在稳定性分析过程中同时用到了lyapunov理论和barbalat定理，这两个理论满足了本发明对整个系统稳定性分析的要求。

优选的，步骤①还能通过视觉传感器对目标泊车区域的形状进行识别，步骤①还能通过测距装置测量无人车辆与目标泊车区域的障碍物之间的距离，直接使用视觉传感器和测距装置能更方便且直接得到需要的信息。

与现有技术相比，本发明的有益效果是：本发明所述方法不需要实时的视觉处理技术，大幅度减少了对自动泊车视觉传感器的严重依赖，从而避免了视觉盲区带来的泊车失误，进一步可适用于视觉盲区以及视觉传感器失效情况下的自动泊车，通过本方法提高了泊车精确度，使得自动泊车技术取得更好的适应性与完整性，而且这将推动了自动化泊车技术的深度变革，进而推动了新一代信息技术、高端设备制造发展产业，具有良好的应用价值。

附图说明

图1为本发明自动化泊车的示意图。

具体实施方式

为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对本发明的技术方案进行详细的描述。显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动的前提下所得到的所有其他实施方式，都属于本发明所保护的范围。

参见附图1，现对本发明提供的一种基于滑膜的无人车辆自动泊车力矩控制方法进行说明。

一种基于滑膜的无人车辆自动泊车力矩控制方法，包括以下步骤：

①通过gps对无人车辆、目标泊车区域和目标泊车区域内的障碍物进行识别、定位并测距，得到无人车辆的位置信息x，障碍物的位置信息u0，第i个约束条件下的目标泊车区域的参考点x0i；

②通过数学软件根据步骤①得到的无人车辆、障碍物和目标泊车区域的位置信息以及目标泊车区域的形状进行建模，对目标泊车区域构造区域势函数p，对已识别的障碍物构造避障势函数u，具体为：

其中，ki是可调节的第i个约束条件下的目标泊车区域的增益；n是目标泊车区域约束条件数目，通常目标泊车区域不是规则的形状，而是由多个区域的交集组成的，由区域势函数p可看出，所述目标泊车区域为n个区域的交集，所以n是目标泊车区域约束条件数目；fδi(δxi)是一个具有连续光滑标量函数，fδi(δxi)表示第i个约束条件下的目标泊车区域，δxi＝x-x0i，第i个约束条件下的目标泊车区域的参考点x0i为第i个约束条件下的目标泊车区域的中心点；‖x-u0‖表示无人车辆与障碍物的距离，r是以无人车辆的中心为圆心的最大感知区域的半径，r是无人车辆的中心与障碍物的最小安全距离的半径，r和r均是人为根据实际需求设定的值；例如目标泊车区域仅仅是简单的圆形区域，那么n＝1，即目标泊车区域的约束条件数目为1，此时δx＝x-x0，这里的x0表示单一约束条件下的目标泊车区域的参考点，即为圆形区域的圆心，若该圆形区域的半径为1，则fδ(δx)＝δx²-1＜0，fδ(δx)表示的就是以x0为圆心，半径为1的圆形区域；

③根据步骤②建立的区域势函数p和避障势函数u设计用于控制无人车辆进入目标泊车区域的力矩控制器，具体如下：

其中，q是线速度和角速度形成的二维平面中的向量；θ为无人车辆的航向角；k是可调的增益矩阵，k根据实际需求设置，为系统参数估计，由系统参数的自适应率推得，其中系统参数的自适应率s是滑膜变量，s＝q-qr，y是已知的与无人车辆动力学相关的回归矩阵，不同类型的动力学结构对应的y的具体表达式是不同的，是已知的输入转换矩阵，不同类型的动力学结构对应的的具体表达式是不同的，是目标泊车区域梯度，是障碍物梯度；其中无人车辆的动力学与动力模型为：

其中

④接着调整第i个约束条件下的目标泊车区域的增益ki和增益矩阵k，对无人车辆的自动化泊车力矩控制器进行稳定性分析。

本方法步骤①中通过gps对无人车辆、目标泊车区域和目标泊车区域内的障碍物进行定位，得到无人车辆的位置信息x，障碍物的位置信息u0，第i个约束条件下的目标泊车区域的参考点x0i，通过gps对目标泊车区域进行识别、分析并且测量无人车辆和障碍物之间的距离；然后步骤②利用数学软件对已识别的障碍物和目标泊车区域进行建模，所述区域势函数p的作用原理是目标泊车区域中的势能最低，目标泊车区域外都处于较高势能，通过人为构造目标泊车区域附近的引力场，无人车辆能够沿着梯度方向从高势能移动到低势能最终进入到目标泊车区域。步骤②中所述避障势函数u的作用原理是障碍物附近的势能最高，障碍物外都处于较低势能，通过人为构造障碍物附近的斥力场，一旦无人车辆进入到斥力场，无人车辆能够沿着梯度方向从高势能移动到低势能最终脱离障碍物环境。避障势函数u中r是以无人车辆的中心为圆心的最大感知区域的半径，r是无人车辆的中心与障碍物的最小安全距离的半径，如果障碍物与无人车辆的距离大于r那么无人车辆不会感知到障碍物，如果无人车辆与障碍物的距离在r与r之间，那么无人车辆就会感知到障碍物，从而进入步骤③无人车辆调整力矩值改变航向避障，r和r均是人为根据实际需求设定的值，这使得本发明所述方法使用起来更加便捷并且人性化，能依据不同的目标泊车区域的情况做不不同的改变，具有较高的实用性。步骤③中所述力矩控制器作用原理为：实际上，无人车辆的动态性能不仅与无人车辆运动学相对位置有关，还与无人车辆的结构形式、质量分布、执行机构的位置、传动装置等因素有关。无人车辆动态性能由动力学方程描述，动力学就是考虑上述因素，研究无人车辆的运动与力矩间的动态关系。由现代控制理论方法，应用稳定性分析理论，由该控制器组成的闭环控制系统是渐进稳定的，也就是无人车辆最终可以进入到目标泊车区域不变集中，目标泊车区域梯度即可实现无人车辆的自动化泊车。步骤③为直接的力矩控制器，即本发明依据力矩控制器调整车辆两轮速的转速比，通过转速比来控制车轮的转向进而控制无人车辆的方向实现自动化避障和泊车。通过步骤③的控制可保证无人车辆与目标泊车区域内的障碍物之间距离大于r。步骤③中的无人车辆的动力学与动力模型为现有技术，是本领域技术人员所公知的，本发明中将不对此做详细介绍。步骤④中，需要不断的调整区域势函数p的第i个约束条件下的目标泊车区域的增益ki和力矩控制器τ的增益矩阵k，保证了区域势函数p和力矩控制器τ的稳定即可保证整个系统的稳定性。本发明所述方法是通过系统建模、利用全局反馈信息进行的力矩控制器设计，首先系统建模，实现了对目标泊车区域以及周围障碍物的描述，进而，依据模型信息进行力矩控制器的设计，由此大幅度减少了对自动泊车视觉传感器的严重依赖。

进一步的，作为本发明所述的一种基于滑膜的无人车辆自动泊车力矩控制方法的一种具体实施方式，经过步骤③中的力矩控制器调节无人车辆进入到目标泊车区域之后，再通过姿态调整器来调整无人车辆在目标泊车区域中的姿态，所述姿态控制器为：ω＝-atanh(θ-θd)，α是姿态调整率可调参数，θd是无人车辆在目标泊车区域中的一个期望的姿态，θd是人为根据实际需求设定的值。所述姿态控制器的作用原理为由现代控制理论方法，应用稳定性分析理论，由该控制器组成的闭环控制系统也是渐进稳定的，θ-θd＝0，实现任意姿态的调节。

进一步的，作为本发明所述的一种基于滑膜的无人车辆自动泊车力矩控制方法的一种具体实施方式，步骤④中的稳定性分析采用了lyapunov理论和barbalat定理。在稳定性分析过程中同时用到了lyapunov理论和barbalat定理，这两个理论满足了本发明对整个系统稳定性分析的要求。

进一步的，作为本发明所述的一种基于滑膜的无人车辆自动泊车力矩控制方法的一种具体实施方式，步骤①还能通过视觉传感器对目标泊车区域的形状进行识别，步骤①还能通过测距装置测量无人车辆与目标泊车区域的障碍物之间的距离，直接使用视觉传感器和测距装置能更方便且直接得到需要的信息。

进一步的，作为本发明所述的一种基于滑膜的无人车辆自动泊车力矩控制方法的一种具体实施方式，所述视觉传感器和红外距离传感器安装在无人车辆上。将视觉传感器和红外距离传感器安装在无人车辆上能更加便捷地得到目标泊车区域的形状以及无人车辆与障碍物之间的距离。

进一步的，作为本发明所述的一种基于滑膜的无人车辆自动泊车力矩控制方法的一种具体实施方式，步骤②中的数学软件为matlab、mathematics或python。本方法主要是依靠数学软件进行仿真的方法，上述数学软件均可满足要求。

进一步的，在具体实施方式中，利用matlab对本发明所述方法进行数值仿真，能够实现无人车辆的自动化泊车，具体的，采用matlab中的ode45算法，随机选取初值，对整个系统的模型与力矩控制器进行数值验证。

上面结合附图对本发明的实施方式作了详细说明，但是本发明并不限于上述实施方式，在本领域普通技术人员所具备的知识范围内，还可以在不脱离本发明宗旨的前提下做出各种变化。