法律状态公告日
法律状态信息
法律状态
2022-08-26
实质审查的生效 IPC(主分类):G05D 1/02 专利申请号:2022104677720 申请日:20220429
实质审查的生效
2022-08-09
公开
发明专利申请公布
技术领域
本发明涉及矿车自动驾驶技术领域,特别涉及一种基于增广LQR的矿车横向控制方法。
背景技术
面对日益增长的采矿需求,各大矿企一方面在增加运输设备的数量和单车运能,另一方面增加作业时长,但是长时间工作在矿山折衷恶劣环境下对工人的身体是一大挑战,并且很多运输设备非常高大,存在较大视野盲区,很容易出安全事故。基于上述各种原因,矿山自动驾驶是解决上述问题的一个可行手段。
目前,针对乘用车的自动驾驶算法相对成熟,矿车的自动驾驶算法正在不断完善中。矿车的自动驾驶的一大难关是对矿车的精确控制,因为矿车存在比较大的执行器响应延迟,这缘于矿车本身巨大的自重和载重。矿车工作在曲率不断变化的矿山道路中,控制精度的高低直接影响矿车自动驾驶最终是否能够批量运行。
现有技术的不足之处,目前的矿车本身宽度较大,道路宽度有限,稍大的横向误差就有可能导致辆车碰撞或掉入碰触道路两侧基础设施。现有的基于LQR的控制方法,未将执行器响应延迟特性直接以状态变量的形式考虑在状态空间表达中,往往需要通过增加超前环节等手段解决控制响应延迟的问题,但该手段只能从系统外部解决问题,控制效果有限。
发明内容
本发明的目的克服现有技术存在的不足,为实现以上目的,采用一种基于增广LQR的矿车横向控制方法,以解决上述背景技术中提出的问题。
一种基于增广LQR的矿车横向控制方法,具体步骤包括:
通过转向系统下发控制指令,以及对实际转角反馈的分析,获取系统的响应特性;
根据系统的响应特性建立矿车二自由度动力学模型;
根据矿车二自由度动力学模型的状态变量的状态空间方程中进行运算,形成基于增广形式的状态控制表达;
再通过里卡提方程迭代求解得到最佳反馈控制率,得到最优控制量。
作为本发明的进一步的方案:所述建立矿车二自由度动力学模型的具体步骤包括:
基于数学模型将矿车车辆的动力学特性和系统的响应特性进行表达;
定义状态变量为
其中,σ
作为本发明的进一步的方案:所述根据矿车二自由度动力学模型的状态变量的状态空间方程中进行运算,形成基于增广形式的状态控制表达的具体步骤包括:
根据矿车二自由度动力学模型的状态空间方程,在状态变量中引入实时转角反馈
联立状态空间方程,得到:
再将上述状态空间方程按照固定时间步长Δt转化为离散系统,得到:
x(k+1)=Ax(k)+Bδ(k)+Dc
其中,A,B,D分别为系统的系数矩阵,k表示步数。
同时根据上述公式,得到代价函数:
s.t.X(k+1)=AX(k)+Bδ(k)
其中,Q,R分别为正定的权重矩阵,τ表示转向系统的响应延迟时间。
作为本发明的进一步的方案:所述通过里卡提方程迭代求解得到最佳反馈控制率,得到最优控制量的具体步骤包括:
首先基于增广LQR求解矿车二自由度动力学模型,得到最优状态反馈控制增益矩阵K;
再采用里卡提方程迭代求解;
令P=Q,当err>tolerance,且iteration_num 迭代执行: 如果iteration_num 由于控制量δ=-Kx,需要考虑道路曲率影响,引入前馈量; 所述引入的前馈量的表达为:
其中,L为轴距, 得到总的转角控制量为:δ=-Kx+δ 与现有技术相比,本发明存在以下技术效果: 采用上述的技术方案,通过对转向系统下发控制指令,以及对实际转角反馈的分析,采用系统辨识的方法,获得该系统的响应特性;建立矿车二自由度动力学模型,并将其中四个状态变量的状态空间方程中予以考虑,形成了增广形式的状态控制表达,通过里卡提方程迭代求解得到最佳反馈控制率,得到最优控制量,省略了通过外部补偿手段解决执行器响应延迟的过程,节省了相关参数标定的工作,并且能够保证控制量最优。 附图说明 下面结合附图,对本发明的具体实施方式进行详细描述: 图1为本申请公开的一些实施例的矿车横向控制方法的步骤示意图; 图2为本申请公开的一些实施例的矿车二自由度模型的示意图; 图3为本申请公开的一些实施例的矿车横向控制方法的流程框图。 具体实施方式 下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。 请参考图1,本发明实施例中,一种基于增广LQR的矿车横向控制方法,具体步骤包括: S1、通过转向系统下发控制指令,以及对实际转角反馈的分析,获取系统的响应特性; S2、根据系统的响应特性建立矿车二自由度动力学模型; 建立矿车二自由度模型的目的是为了以数学方式对车辆的动力学特性进行表达,将车辆的表现与施加的控制量以数学形式进行表达; 如图2所示,图示为矿车二自由度模型的示意图; 具体实施例中,建立矿车二自由度模型具体步骤包括: 基于数学模型将矿车车辆的动力学特性和系统的响应特性进行表达; 定义状态变量为
其中,σ 具体实施方式中,由于矿车车辆的执行器是存在延迟的,通过对液压转向系统的响应特性进行分析,发现下发的转向角度与实际的转角响应存在一个类似于一阶延时的环节,故而在实际的转角响应与下发的转角响应之间以一阶延迟环节来表示。 S3、根据矿车二自由度动力学模型的状态变量的状态空间方程中进行运算,形成基于增广形式的状态控制表达,具体步骤包括: 根据矿车二自由度动力学模型的状态空间方程,在状态变量中引入实时转角反馈
联立状态空间方程,得到:
再将上述状态空间方程按照固定时间步长Δt转化为离散系统,得到: x(k+1)=Ax(k)+Bδ(k)+Dc 其中,A,B,D分别为系统的系数矩阵,k表示步数。 同时根据上述公式,得到代价函数:
s.t.X(k+1)=AX(k)+Bδ(k) 其中,Q,R分别为正定的权重矩阵,τ表示转向系统的响应延迟时间。 S4、再通过里卡提方程迭代求解得到最佳反馈控制率,得到最优控制量,具体步骤包括: 如图3所示,图示为方案求解的流程图; 首先基于增广LQR求解矿车二自由度动力学模型,得到最优状态反馈控制增益矩阵K; 再采用里卡提方程迭代求解,具体步骤如下: 令P=Q,当err>tolerance,且iteration_num 迭代执行: 如果iteration_num 由于控制量δ=-Kx,且上述求解未考虑道路曲率影响,为此还需要引入前馈,以消除道路曲率对控制带来的无法收敛的问题,引入前馈量; 所述引入的前馈量的表达为:
其中,L为轴距, 得到总的转角控制量为:δ=-Kx+δ 尽管已经示出和描述了本发明的实施例,对于本领域的普通技术人员而言,可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型,本发明的范围由所附权利要求及其等同物限定,均应包含在本发明的保护范围之内。
机译: 基于LQR的防摇摆控制方法和升降系统系统
机译: 用于基于估计的虚拟道路确定在实际轨道上行驶的车辆的横向偏差并基于横向偏差确定驾驶员的横向控制能力的方法,系统和计算机
机译: 机动车行驶动力学控制方法,涉及基于传感器数据确定作用于横向动力学的动态干扰变量,并基于干扰变量控制横向动力学。