欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2021116230728
申请人: 吉林大学
专利类型:发明专利
专利状态:已下证
专利领域: 信号装置
更新日期:2026-11-16
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种自主代客泊车运动规划与运动控制方法,其特征在于,包括以下步骤:步骤S1:当车辆驶入停车场的入口下客点时,车主下车后通过移动终端发送停车指令,指令同时发送至停车场端和车辆;停车场端获取指令后,通过停车场监测单元监测停车场内的车位占用情况,通过停车场定位单元监测车辆的实时位置,并将停车场的地图发送至车辆;车辆获取指令后与停车场端建立通讯,获取车位的位置、车辆的实时位置和停车场端的地图;

步骤S2:车辆根据移动终端的指令规划泊车路径和行车路径;当车辆接收到停车指令时,停车场端提供目标车位信息;车辆接收到召车指令时,停车场端提供当前车位信息和出口上客点位置信息;

步骤S3:对前方一段行驶路径进行处理,生成具有时间信息、路径信息、航向信息、曲率信息和速度信息的轨迹序列;

步骤S4:根据生成的具有时间信息的轨迹进行横纵向解耦控制;

所述步骤S3中,车辆对路径进行处理,重新计算采样点,计算路径航向和曲率,利用二次规划优化方法规划车速,并根据车速与路径信息生成时间序列;

所述步骤S3中,路径处理方法包括以下步骤:

步骤S31:选取车辆前方固定长度的路径,重新计算采样点,生成具有固定间隔的路径序列;

步骤S32:根据路径序列,基于反正切函数计算路径航向;

步骤S33:根据路径点序列,基于三点圆方法计算路径曲率;

步骤S34:根据路径点序列,基于二次规划生成期望车速;

步骤S35:根据路径序列和速度信息,生成时间序列;

在步骤S34中,通过构造优化问题求解各个路径点对应的期望车速,给定目标巡航车速为 ,令 代表期望车速,其中 为给定路径点序列点的个数,跟随性能指标写成二次规划问题代价函数形式:,其中 , ,为保证舒适度,对车辆的侧向加速度限制为,对急动度的限制为 ,通过求解二次规划问题得到满足跟随性和舒适性要求的期望车速;

在步骤S35中,根据路径点序列和速度信息,计算每个路径点由车辆当前位置以期望车速到达时所需的时间,生成时间序列;

所述步骤S4中,根据具有时间信息的轨迹信息,利用自适应MPC横向控制器控制车辆跟随目标路径,利用纵向控制器控制车辆跟随目标车速;

自适应MPC横向控制器实现包括以下步骤:

步骤S41,建立考虑预瞄点处误差的预测模型,MPC控制器中的预测时域 相当于人类驾驶员在驾驶过程中的预瞄时间,预瞄时间与当前车速以及道路曲率相关;设车辆与参考点处的横向偏差为 、航向角偏差为 :;

式中, 是车辆当前位置, 是车辆当前航向, 是参考点位置, 是参考点航向;

为使MPC控制器能具有超出预测时域之外的预瞄能力,假定预瞄时间内车辆横向误差变化率为 、航向角误差变化率为 ,且保持不变,计算车辆在预瞄点处的横向误差与航向角偏差 ;

;

其中 和 分别是预瞄点 相对于参考点的横向位移偏差和航向角偏差, 为预瞄时间;

将预瞄点误差的预测模型整理为下式:

;

式中:

;

步骤S42,对MPC优化问题进行转化及求解;预测模型的输出方程中存在控制输入的馈通,将上一时刻的控制输入 作为额外的状态引入状态向量,通过使用状态向量中的代替输出方程中的 ,以消除状态观测器和MPC控制器之间的循环依赖,将状态向量中的 加入预测模型的输出中,将参考控制输入以参考输出分量的形式引入代价函数;

消除MPC控制器与状态观测器之间的循环依赖后,将预测模型变为如下形式:;

其中 表示增广后的状态向量, 表示增广后的输出向量, 表示在时刻 的可测量扰动输入 , 表示在时刻 的控制输入增量;其中, 代表预测模型的状态个数; 代表预测模型的控制输入个数; 表示预测模型的可测量扰动输入个数;

将预测时域内每个时刻的预测输出与参考输出之间的跟踪误差,以及控制增量的大小构造为如下代价函数:;

其中, 表示在时刻预测的 时刻的状态 ; 表示在时刻预瞄的 时刻的参考输出 ; 表示在时刻 预瞄的 时刻的可测量扰动输入 ; 表示在时刻 计算得到的 时刻的控制输入增量 ,是跟踪误差权重矩阵, 是终端跟踪误差权重矩阵,是控制输入增量权重矩阵, 和 为半正定阵,为正定阵,选取对角线元素为相应的权重参数的对角阵;在对代价函数求解过程中,考虑车辆前轮转角的物理极限,将控制量和控制增量限制在合理范围内:;

为降低优化问题的求解复杂度,通过引入如下约束条件,减少决策变量的个数,达到降低计算量的目的:;

上述约束条件使得只有控制时域内的控制输入序列通过优化求解得出,而其余控制输入保持不变;

最终,上述问题被转换为带有线性约束条件的凸二次规划问题;;

在每个控制周期,通过求解上述优化问题,得到最优的控制输入增量序列 ,采用的第一个分量,得到最优控制输入为 。

2.根据权利要求1所述的自主代客泊车运动规划与运动控制方法,其特征在于,所述步骤S1中,当车主发送停车指令时,停车场端服务器获取指令后,通过停车场监测单元监测车位占用状况,为车辆分配距离最近的车位;当车主发送召车指令时,停车场端服务器获取指令后,通过停车场监测单元监测车辆当前所在车位,并为车辆分配距离最近的出口上客点。

3.根据权利要求2所述的自主代客泊车运动规划与运动控制方法,其特征在于,所述停车场监测单元包括布置在停车场端的摄像头,所述停车场定位单元包括若干个布置在停车场端的UWB,所述车辆具有V2X通讯功能,所述车辆配备有毫米波雷达、超声波雷达、激光雷达和环视摄像头传感器,所述车辆配备有工控机,且所述车辆配备有用于对目标转角和目标车速实现跟踪的线控底盘。

4.根据权利要求1所述的自主代客泊车运动规划与运动控制方法,其特征在于,所述步骤S2中,当车辆收到停车指令时,车辆当前位置为入口下客点,车辆目标位置为车位;当车辆收到召车指令时,车辆当前位置为车位,车辆目标位置为出口上客点;当车位位置与指令需要位置不符时,车辆对移动终端的指令不作响应。

5.根据权利要求4所述的自主代客泊车运动规划与运动控制方法,其特征在于,所述步骤S2中,泊车路径和行车路径的生成包括以下步骤:步骤S21,车辆根据车位信息和泊车规划方法生成泊车路径;

步骤S22,当车辆收到移动终端停车指令时,车辆生成当前位置至泊车起始点的行车路径;当车辆收到移动终端召车指令时,将泊车路径逆序,生成出库路径,规划由出库路径末点至出口上客点的行车路径。