一种双绳缠绕式超深立井提升系统提升容器位姿控制方法技术方案

本发明专利技术公开了一种双绳缠绕式超深立井提升系统提升容器位姿控制方法，包括以下步骤：步骤1：建立双绳缠绕式超深立井提升子系统数学模型；步骤2：建立电液伺服子系统位置闭环的数学模型；步骤3：非线性系统平整度特性输出；步骤4：设计双绳缠绕式超深矿井提升子系统位姿调平平整度控制器；步骤5：设计电液伺服子系统位置闭环平整度控制器。本发明专利技术省略了系统状态变量的求导过程，大大简化了控制器的设计过程，使控制器能够缩短响应时间，使提升容器可以快速达到调平状态；且在系统应用过程中，由于状态变量求导会放大传感器测量噪声和系统未建模特性，因此平整度控制器的设计可以减少跟踪误差，使控制过程更加精确，保证其良好的控制性能。

A Position and Posture Control Method for Lifting Vessel of Double-rope Winding Ultra-deep Vertical Shaft Lifting System

【技术实现步骤摘要】
一种双绳缠绕式超深立井提升系统提升容器位姿控制方法
本专利技术涉及一种立井提升系统，具体涉及一种双绳缠绕式超深立井提升系统提升容器位姿控制方法，属于矿山提升

技术介绍
超深立井提升系统是一种开采深度大于1500m的立井提升系统，由于其开采深度深，常用的刚性提升容器罐道在提升容器高速、重载运行情况下容易出现井筒内罐道变形、罐道梁破坏、梁窝松动和运行失稳等损坏现象，因此无法用于超深立井提升；但当采用柔性罐道提升时，由于卷筒直径制造差异、两根钢丝绳安装差异、两根钢丝绳弹性模量不一致等因素，军会造成提升系统两根钢丝绳末端运动不同步，从而引起提升容器倾斜，进而造成两根钢丝绳的张力不一致，长期在此条件下运行时，容易导致其中一根钢丝绳的应力超过它的安全使用应力，造成断绳的重大恶性事故。为避免这类事故发生，需要主动调节提升容器角度，使提升容器保持平衡状态，从而使两根钢丝绳张力保持一致。现有技术中常用的是一种反步控制器设计方法，但是这种控制方法需要对系统状态变量进行变量求导，且控制器的设计过程复杂；且该控制器在超深立井实际系统中应用时，由于超深立井提升系统是一种复杂多结构的机电液系统，即便建模过程中考虑了很多实际因素，但也很难和实际系统一致，因此在控制器的设计过程中，对系统状态变量的求导无疑会放大传感器测量噪声和系统未建模特性，造成较大的跟踪误差，以及较长的调平响应时间。
技术实现思路
为了克服现有技术存在的各种不足，本专利技术提供一种双绳缠绕式超深立井提升系统提升容器位姿控制方法，设计过程简单，控制性能良好，能够快速响应调平提升系统，跟踪误差小。为了实现上述专利技术目的，本专利技术一种双绳缠绕式超深立井提升系统提升容器位姿控制方法，包括以下步骤：步骤1：建立双绳缠绕式超深立井提升子系统数学模型；步骤2：建立电液伺服子系统位置闭环的数学模型；步骤3：非线性系统平整度特性；步骤4：设计双绳缠绕式超深矿井提升子系统平整度控制器；步骤5：设计电液伺服子系统位置闭环平整度控制器。进一步的，步骤1中所述的双绳缠绕式超深立井提升子系统数学模型如下：1)、定义建模过程中应用到的参数：lri(i＝1,2)为双联卷筒的卷动长度；lci(i＝1,2)为提升或下放提升容器过程中两根弦绳的长度；lhi(i＝1,2)为提升或下放提升容器过程中两根垂直段钢丝绳的长度；ui(i＝1,2)为两个浮动天轮的位移；为两根弦绳与水平面的夹角；ai(i＝1,2)为两垂直段钢丝绳在提升容器上的连接点与提升容器重心的水平距离；bi(i＝1,2)为提升容器上下表面与提升容器重心的垂直距离；ksi(i＝1,2,3,4)为四对弹簧-阻尼模型的横向等效刚度；csi(i＝1,2,3,4)为四对弹簧-阻尼模型的横向等效阻尼系数；2)、定义提升过程为正方向，提升或下放提升容器过程中两根垂直段钢丝绳5的长度如lh10，lh20为两根垂直段钢丝绳的初始长度；3)、定义提升子系统广义向量q＝[xc,yc,θ]，xc和yc分别为提升容器6重心的垂直位移和水平位移，θ为提升容器6的逆时针旋转角度；提升子系统的拉格朗日动力学方程如下：T、U、D分别为提升系统的动能、势能和瑞利耗散函数，Q为不包括阻尼的提升子系统非有势广义力；4)、浮动天轮与左弦绳之间的切线点位移为浮动天轮与左垂直段钢丝绳之间切线点位移为左弦绳在s单位长度距离处的位移表示如下：同样地，左垂直段绳在y单位长度距离处的位移表示如下：5)、依据式(4)和(5)，左弦绳和左垂直段钢丝绳的动能公式分别如下：式中，ρ钢丝绳的单位质量；6)、浮动天轮与右弦绳之间的切线点位移为右弦绳在s单位长度距离处的位移表示如下：浮动天轮与右垂直段钢丝绳之间切线点位移为右垂直段绳在y单位长度距离处的位移表示如下：7)、依据式(8)和(9)，右弦绳和右垂直段钢丝绳的动能分别公式如下：8)、左右浮动天轮的动能公式如下：式中，m1和m2分别为左右浮动天轮的质量，r1和r2分别为左右浮动天轮的半径，I1和I2分别为左右浮动天轮的转动惯量；提升容器的动能公式如下：式中，mc为提升容器的质量，Ic是提升容器的转动惯量；9)、左钢丝绳的势能公式如下：右钢丝绳的势能公式如下：式中，kc1和kh1分别为左弦绳和左垂直段钢丝绳的刚度，kc2和kh2分别为右弦绳和右垂直段钢丝绳的刚度；左、右浮动天轮的势能公式分别如下：Uh1＝m1gu1(17)Uh2＝m2gu2(18)提升容器系统的势能，包括提升容器的势能和柔性罐道的势能，公式如下：10)、左、右绳的瑞丽耗散能公式分别如下：式中，cc1和cc2分别为左弦绳和左垂直段钢丝绳的阻尼系数，cc2和ch2分别为右弦绳和右垂直段钢丝绳的阻尼系数；提升容器系统的瑞丽耗散能公式如下：综上，提升子系统的动能、势能和瑞丽耗散能分别表示如下：U＝Ul1+Ul2+Uh1+Uh2+Uc(24)D＝Dl1+Dl2+Dc(25)11)、将上述公式带入通用方程：式中，和q分别为广义加速度、速度和位移，M、C、K和F分别为质量矩阵、阻尼矩阵、刚度矩阵和提升子系统的非有势力；从而得到：12)、简化系统方程，在提升子系统建模过程中，假设没有偏移载荷条件，即a1＝a2，进一步地，当提升容器的逆时针旋转角度为0，两根钢丝绳的张力一致；因此，式(30)可以简化为式中，Mij、Cij、Kij和Fij分别为质量矩阵、阻尼矩阵、刚度矩阵和非有势力的元素，i＝1,2,3和j＝1,2,3。提升容器的位姿调平是由两个液压执行器调节的，因此，u1＝u＝-u2，提升容器倾角θ为控制量，式(31)可进一步简化为：式中，由于kh1和kh2远大于ch1和ch2，式(32)可进一步化简为：对于提升子系统，选取状态变量为因而提升子系统动力学模型可以转化为状态空间形式y1＝x1式中，h1＝B/A，h2＝C/A，h3＝R/A，f＝F0/A。上述模型建立的前提假设：对于提升子系统，θ和都是有界的。进一步的，步骤2所述的电液伺服子系统数学模型如下：电液伺服子系统包括浮动天轮系统中比例伺服阀和双出杆液压缸，假设对于电液伺服子系统，液压缸的位移参考信号xp、速度加速度和加加速度均是有界的；双出杆液压缸流量连续性方程如下：式中，Ap为液压缸活塞的有效作用面积，Ctl为液压缸总泄漏系数，xp为液压缸活塞杆的位移，Vt为液压缸进油腔和回油腔的总体积，βe为液压缸油液的有效体积弹性模量；PL＝p1-p2为液压缸的负载压降，p1为流入液压缸的压力，p2为流出液压缸的压力，QL＝Q1-Q2为负载流量，Q1为流入液压缸的流量，Q2为流出液压缸的流量。根据牛顿第二定律，电液伺服系统的负载力平衡方程如下：其中，FL为双杆液压缸作用在浮动天轮的力，m为浮动天轮总质量，Bp为液压缸粘性阻尼系数。对于电液伺服子系统，选取状态变量为因而电液伺服子系统动力学模型可以转化为状态空间形式：y2＝x3式中，a1＝Ap/m，a2＝Bp/m，a3＝1/m，a4＝4βeAp/Vt，a5＝4βeCtl/Vt，a6＝4βe/Vt；从而得到式(33)中控制输入u。进一步的，步骤3中非线性系统平整度特性输出的具体设计如下：考虑如下非线性系统式中，x是系统状态变量，u是与系统输出y具有相同维数的系统控制输入；如果存在如下系统输出y那么系统状态变量本文档来自技高网...

【技术保护点】
1.一种双绳缠绕式超深立井提升系统提升容器位姿控制方法，其特征在于，包括以下步骤：步骤1：建立双绳缠绕式超深立井提升子系统数学模型；步骤2：建立电液伺服子系统位置闭环的数学模型；步骤3：非线性系统平整度特性；步骤4：设计双绳缠绕式超深矿井提升子系统平整度控制器；步骤5：设计电液伺服子系统位置闭环平整度控制器。

【技术特征摘要】
1.一种双绳缠绕式超深立井提升系统提升容器位姿控制方法，其特征在于，包括以下步骤：步骤1：建立双绳缠绕式超深立井提升子系统数学模型；步骤2：建立电液伺服子系统位置闭环的数学模型；步骤3：非线性系统平整度特性；步骤4：设计双绳缠绕式超深矿井提升子系统平整度控制器；步骤5：设计电液伺服子系统位置闭环平整度控制器。2.根据权利要求1所述的双绳缠绕式超深立井提升系统提升容器位姿控制方法，其特征在于，步骤1中所述的双绳缠绕式超深立井提升子系统数学模型如下：式中，和q分别为广义加速度、速度和位移，q＝[xc,yc,θ]，xc和yc分别为提升容器重心的垂直和水平位移，θc为提升容器的逆时针旋转角度，M、C、K和F分别为质量矩阵、阻尼矩阵、刚度矩阵和提升子系统的非有势力；其中：3.根据权利要求2所述的双绳缠绕式超深立井提升系统提升容器位姿控制方法，其特征在于，在提升子系统建模过程中，假设没有偏移载荷条件，即a1＝a2，且当提升容器的逆时针旋转角度为0，两根钢丝绳的张力一致；因此，双绳缠绕式超深立井提升子系统数学模型简化为：式中，Mij、Cij、Kij和Fij分别为质量矩阵、阻尼矩阵、刚度矩阵和非有势力的元素，i＝1,2,3和j＝1,2,3。4.根据权利要求3所述的双绳缠绕式超深立井提升系统提升容器位姿控制方法，其特征在于，提升容器的位姿调平是由两个液压执行器调节的，因此，u1＝u＝-u2，提升容器倾角θ为控制量，因此，双绳缠绕式超深立井提升子系统数学模型进一步简化为：式中，由于kh1和kh2远大于ch1和ch2，上述公式再进一步化简为：5.根据权利要求3所述的双绳缠绕式超深立井提升系统提升容器位姿控制方法，其特征在于，...

【专利技术属性】
技术研发人员：沈刚，朱真才，臧万顺，李翔，汤裕，曹国华，周公博，刘送永，彭玉兴，卢昊，
申请(专利权)人：中国矿业大学，
类型：发明
国别省市：江苏,32