1.一种凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,控制外环包括至少两个位置环,控制内环包括至少两个速度环,每个位置环输出至少两个油缸运动速度,相应地油缸运动速度进行叠加计算,分别得到叠加后的设定运动速度,将设定运动速度作为速度环的输入,根据速度环的输出得到控制大臂油缸运动的比例阀开度值。
2.根据权利要求1所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,其步骤如下:
步骤一:根据需要的大臂左右摆动和上下俯仰的目标角度,分别计算大臂的左右摆动和上下俯仰的关节角度误差;
步骤二:将大臂的左右摆动和上下俯仰的关节角度误差输入相应的位置环pid,位置环pid均输出油缸运动速度;
步骤三:将油缸运动速度进行相应的叠加分别得到油缸的设定运动速度;
步骤四:根据油缸的设定运动速度,计算油缸的速度误差,将速度误差输入相应的速度环pid得到控制大臂的油缸的比例阀开度增量;
步骤五:根据比例阀开度增量计算油缸的比例阀开度,利用比例阀开度控制油缸的多个方向的运动速度,从而控制大臂的关节的耦合转动。
3.根据权利要求2所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述位置环的数量设有两个,速度环的数量设有两个,每个位置环的位置环pid均输出两个油缸运动速度;两个速度环的速度环pid分别输出两个油缸的比例阀开度增量。
4.根据权利要求3所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述两个油缸为并联连接的左油缸(4)和右油缸(5),左油缸(4)和右油缸(5)均可单独控制大臂左右摆动关节或大臂上下俯仰关节;左油缸(4)和右油缸(5)均可以让大臂左右摆动关节和大臂上下俯仰关节同时运动,从而实现大臂的耦合运动。
5.根据权利要求1或3所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述步骤一中计算关节角度误差时,位置环pid的反馈角度值为编码器检测大臂的左右摆动关节或上下俯仰关节的角度;所述步骤四中计算油缸的速度误差时,速度环pid的反馈运动速度为利用编码器检测的角度和油缸结构三角函数计算的油缸反馈速度。
6.根据权利要求5所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述大臂的左右摆动关节为左右摆动转动副(2),大臂的上下俯仰关节为上下俯仰转动副(7),所述编码器包括左右摆动编码器(3)和上下俯仰编码器(8),左右摆动编码器(3)与左右摆动转动副(2)同轴连接,上下俯仰编码器(8)与上下俯仰转动副(7)同轴连接,左右摆动编码器(3)用于实时记录大左右摆动转动副(2)的当前角度,上下俯仰编码器(8)用于实时记录上下俯仰转动副(7)的当前角度;所述左油缸(4)和右油缸(5)对称布置在大臂(6)的两侧。
7.根据权利要求3、4或6所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述两个位置环pid为系数相同的位置式pid,所述两个速度环pid为系数相同的增量式pid。
8.根据权利要求7所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述两个位置环pid为左右摆动位置环pid和上下俯仰位置环pid,且左右摆动位置环pid输出的左油缸运动速度vl1(k)和右油缸运动速度vr1(k)相反,上下俯仰位置环pid输出的左油缸运动速度vl2(k)和右油缸运动速度vr2(k)相等。
9.根据权利要求8所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述大臂的左右摆动和上下俯仰的关节角度误差的计算方法为:
其中,θ1为第k次大臂的左右摆动目标角度,θ2为第k次大臂的上下俯仰目标角度,θ3为左右摆动编码器(3)检测的角度,θ4为上下俯仰编码器(8)检测的角度,eθ1(k)为第k次左右摆动的关节角度误差,eθ2(k)为第k次上下俯仰的关节角度误差;
当关节角度误差eθ1(k)输入左右摆动位置环pid得到的左油缸运动速度和右油缸运动速度分别为:
vr1(k)=-vl1(k)
当关节角度误差eθ2(k)输入上下俯仰位置环pid得到的左油缸运动速度和右油缸运动速度分别为:
vr2(k)=vl2(k)
其中,vl1(k)和vr1(k)为第k次左右摆动位置环pid输出的左油缸运动速度和右油缸运动速度;vl2(k)和vr2(k)为第k次上下俯仰位置环pid输出的左油缸运动速度和右油缸运动速度;eθ1(k-1)为第k-1次左右摆动的关节角度误差,eθ2(k-1)为第k-1次上下俯仰的关节角度误差;eθ1(i)为第i次左右摆动的关节角度误差,eθ2(i)为第i次上下俯仰的关节角度误差,i=0,1,,...,k;kp1、ki1、kd1分别为位置环pid的比例调节系数、积分调节系数和微分调节系数。
10.根据权利要求6、8或9述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述油缸结构三角函数计算油缸反馈速度的方法为:
v'l=k'(θ3-θ3last)/δt,
v'r=k'(θ4-θ4last)/δt;
其中,k'为三角关系计算系数,θ3为第k次大臂左右摆动编码器检测的数值,θ4为第k次大臂上下俯仰编码器检测的数值,θ3last为第k-1次大臂左右摆动编码器检测的数值,θ4last为第k-1次大臂上下俯仰编码器检测的数值,δt为第k次与第k-1次大臂运动的时间差值。
11.根据权利要求10所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述油缸的设定运动速度通过调节系数k1和k2调节位置环pid输出的两个油缸运动速度,即
其中,vl为大臂的左油缸设定运动速度,vr为大臂的右油缸设定运动速度,vl1(k)和vr1(k)分别为左右摆动位置环pid第k次输出的左油缸运动速度和右油缸运动速度,vl2(k)和vr2(k)分别为上下俯仰位置环pid第k次输出的左油缸运动速度和右油缸运动速度。
12.根据权利要求11所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述步骤四中速度误差的计算方法为:
其中,evl(k)为第k次左油缸的速度误差,evr(k)为第k次右油缸的速度误差。
13.根据权利要求12所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述两个速度环pid计算比例阀开度增量的方法为:
δdl(k)=kp2[evl(k)-evl(k-1)]+ki2evl(k)+kd2[evl(k)-2evl(k-1)+evl(k-2)]
δdr(k)=kp2[evr(k)-evr(k-1)]+ki2evr(k)+kd2[evr(k)-2evr(k-1)+evr(k-2)]
其中,δdl(k)为第k次左油缸的速度环pid输出的左油缸控制比例阀开度增量,δdr(k)为第k次右油缸的速度环pid输出的右油缸控制比例阀开度增量;evl(k-1)为第k-1次的左油缸的速度误差,evl(k-2)为第k-2次的左油缸的速度误差;evr(k)为第k次右油缸的速度误差,evr(k-1)为第k-1次的右油缸的速度误差,evr(k-2)为第k-2次的右油缸的速度误差;kp2、ki2、kd2分别为两个速度环pid的比例调节系数、积分调节系数和微分调节系数。
14.根据权利要求13所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,所述计算油缸的比例阀开度的方法为:
其中,dl(k)和dr(k)分别为第k次控制大臂的左油缸和右油缸的比例阀开度;dl(k-1)和dr(k-1)分别为第k-1次控制大臂的左油缸和右油缸的比例阀开度。
15.根据权利要求6、8、9、11-14中任意一项所述的凿岩台车大臂耦合运动串级复合pid控制方法,其特征在于,当左油缸(4)缩短长度l,同时右油缸(5)伸长长度l时,大臂(6)只绕左右摆动转动副(2)向左转动;反之,当左油缸(4)伸长长度l,同时右油缸(5)缩短长度l时,大臂(6)只绕左右摆动转动副(2)向右转动;
当左油缸(4)和右油缸(5)都伸长长度l时,大臂(6)只绕上下俯仰转动副(7)向上转动;反之,当左油缸(4)和右油缸(5)同时都缩短长度l时,大臂(6)只绕上下俯仰转动副(7)向下转动;
若左油缸(4)的比例阀开度大于右油缸(5)的比例阀开度,则左油缸(4)运动速度大于右油缸(5),大臂(6)在绕左右摆动转动副(2)向右转动的同时也绕上下俯仰转动副(7)向上转动,从而实现大臂的耦合运动。