一种凿岩台车大臂耦合运动串级复合PID控制方法与流程

本发明涉及隧道施工装备的技术领域，尤其涉及一种凿岩台车大臂耦合运动串级复合pid控制方法。

背景技术：

在三臂凿岩台车机械臂运动控制系统中，通过两个并联油缸共同控制大臂左右摆动和大臂上下俯仰关节的运动。大臂左右摆动和大臂上下俯仰两个关节可以同时运动，也可以单独运动。在传统的手动模式下，操作手只能通过手柄分别控制大臂左右摆动或大臂上下俯仰运动；而在自动模式下，为了让大臂尽快到达目标位置，需要寻求一种控制方法，实现自动控制大臂左右摆动和大臂上下俯仰的同时运动。因为大臂耦合运动，常规的单级pid已经达不到大臂耦合运动控制需求，需要采用一种凿岩台车大臂耦合运动串级复合pid控制方法。

专利申请号为202010585584.9为的中国发明，公开了了基于模糊神经网络pid控制器的阀位串级控制方法，解决了阀位控制过程复杂多变，难以建立精确数学模型，致使传统pid控制控制效果不佳以及单回路控制难以消除外界扰动的难题，能够对阀位控制过程进行动态实时控制，提升了控制过程的快速性、准确性和鲁棒性，利于调节阀稳定连续地工作。但是，此方法是单环串级pid，并没有涉及到两个串级pid的复合控制，不能直接应用到大臂左右摆动和大臂上下俯仰的油缸控制中。

技术实现要素：

针对现有常规的pid控制方法达不到大臂耦合运动控制需求的技术问题，本发明提出一种凿岩台车大臂耦合运动串级复合pid控制方法，让大臂左右摆动和大臂上下俯仰关节同时运动，分别达到目标角度，减少大臂耦合运动时间，提高了运动控制精度和工作效率。

为了达到上述目的，本发明的技术方案是这样实现的：一种凿岩台车大臂耦合运动串级复合pid控制方法，控制外环包括至少两个位置环，控制内环包括至少两个速度环，每个位置环输出至少两个油缸运动速度，相应地油缸运动速度进行叠加计算，分别得到叠加后的设定运动速度，将设定运动速度作为速度环的输入，根据速度环的输出得到控制大臂油缸运动的比例阀开度值。

本发明的步骤如下：

步骤一：根据需要的大臂左右摆动和上下俯仰的目标角度，分别计算大臂的左右摆动和上下俯仰的关节角度误差；

步骤二：将大臂的左右摆动和上下俯仰的关节角度误差输入相应的位置环pid，位置环pid均输出油缸运动速度；

步骤三：将油缸运动速度进行相应的叠加分别得到油缸的设定运动速度；

步骤四：根据油缸的设定运动速度，计算油缸的速度误差，将速度误差输入相应的速度环pid得到控制大臂的油缸的比例阀开度增量；

步骤五：根据比例阀开度增量计算油缸的比例阀开度，利用比例阀开度控制油缸的多个方向的运动速度，从而控制大臂的关节的耦合转动。

优选地，所述位置环的数量设有两个，速度环的数量设有两个，每个位置环的位置环pid均输出两个油缸运动速度；两个速度环的速度环pid分别输出两个油缸的比例阀开度增量。

优选地，所述两个油缸为并联连接的左油缸和右油缸，左油缸和右油缸均可单独控制大臂左右摆动关节或大臂上下俯仰关节；左油缸和右油缸均可以让大臂左右摆动关节和大臂上下俯仰关节同时运动，从而实现大臂的耦合运动。

优选地，所述步骤一中计算关节角度误差时，位置环pid的反馈角度值为编码器检测大臂的左右摆动关节或上下俯仰关节的角度；所述步骤四中计算油缸的速度误差时，速度环pid的反馈运动速度为利用编码器检测的角度和油缸结构三角函数计算的油缸反馈速度。

优选地，所述大臂的左右摆动关节为左右摆动转动副，大臂的上下俯仰关节为上下俯仰转动副，所述编码器包括左右摆动编码器和上下俯仰编码器，左右摆动编码器与左右摆动转动副同轴连接，上下俯仰编码器与上下俯仰转动副同轴连接，左右摆动编码器用于实时记录大左右摆动转动副的当前角度，上下俯仰编码器用于实时记录上下俯仰转动副的当前角度；所述左油缸和右油缸对称布置在大臂的两侧。

所述两个位置环pid为系数相同的位置式pid，所述两个速度环pid为系数相同的增量式pid。

所述两个位置环pid为左右摆动位置环pid和上下俯仰位置环pid，且左右摆动位置环pid输出的左油缸运动速度vl1(k)和右油缸运动速度vr1(k)相反，上下俯仰位置环pid输出的左油缸运动速度vl2(k)和右油缸运动速度vr2(k)相等。

所述大臂的左右摆动和上下俯仰的关节角度误差的计算方法为：

eθ1(k)＝θ1-θ3

eθ2(k)＝θ2-θ4；

其中，θ1为第k次大臂的左右摆动目标角度，θ2为第k次大臂的上下俯仰目标角度，θ3为左右摆动编码器检测的角度，θ4为上下俯仰编码器检测的角度，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的比例调节系数、积分调节系数和微分调节系数。

所述油缸结构三角函数计算油缸反馈速度的方法为：

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次大臂运动的时间差值。

所述油缸的设定运动速度通过调节系数k1和k2调节位置环pid输出的两个油缸运动速度，即

vl＝k1vl1(k)+k2vl2(k)

vr＝k1vr1(k)+k2vr2(k)；

其中，vl为大臂的左油缸设定运动速度，vr为大臂的右油缸设定运动速度，vl1(k)和vr1(k)分别为左右摆动位置环pid第k次输出的左油缸运动速度和右油缸运动速度，vl2(k)和vr2(k)分别为上下俯仰位置环pid第k次输出的左油缸运动速度和右油缸运动速度。

所述步骤四中速度误差的计算方法为：

evl(k)＝vl-v'l

evr(k)＝vr-v'r；

其中，evl(k)为第k次左油缸的速度误差，evr(k)为第k次右油缸的速度误差。

所述两个速度环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的比例调节系数、积分调节系数和微分调节系数。

所述计算油缸的比例阀开度的方法为：

dl(k)＝δdl(k)+dl(k-1)

dr(k)＝δdr(k)+dr(k-1)；

其中，dl(k)和dr(k)分别为第k次控制大臂的左油缸和右油缸的比例阀开度；dl(k-1)和dr(k-1)分别为第k-1次控制大臂的左油缸和右油缸的比例阀开度。

当左油缸缩短长度l，同时右油缸伸长长度l时，大臂只绕左右摆动转动副向左转动；反之，当左油缸伸长长度l，同时右油缸缩短长度l时，大臂只绕左右摆动转动副向右转动；

当左油缸和右油缸都伸长长度l时，大臂只绕上下俯仰转动副向上转动；反之，当左油缸和右油缸同时都缩短长度l时，大臂只绕上下俯仰转动副向下转动；

若左油缸的比例阀开度大于右油缸的比例阀开度，则左油缸运动速度大于右油缸，大臂在绕左右摆动转动副向右转动的同时也绕上下俯仰转动副向上转动，从而实现大臂的耦合运动。

与现有技术相比，本发明的有益效果：包括两个位置环pid作为控制外环，两个速度环pid作为控制内环；通过每一个位置环可得到两个输出量：大臂左油缸运动速度，大臂右油缸运动速度；然后将位置环pid的速度输出量进行叠加计算，作为两个速度环pid的输入，得到控制大臂左、右油缸运动的比例阀开度值，通过位置环输出速度的叠加可以准确的控制比例阀的设定开度，进而更好的控制油缸运动；本发明位置环pid的反馈角度值为编码器数值，速度环的反馈速度利用编码器角度和油缸结构三角函数关系计算求出油缸的运动反馈速度，这样可以省去测量油缸运动速度的传感器，降低设备生产成本。本发明能够有效解决凿岩机大臂因耦合运动导致大臂左右摆动和上下俯仰两关节无法同时控制的问题，从而使凿岩台车实现大臂双关节联动，降低大臂运动控制时间，提高了工作效率。

附图说明

为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。

图1为本发明的大臂结构的俯视图。

图2为本发明的大臂结构的主视图。

图3为本发明的控制流程示意图。

图中，1为大臂基座，2为大臂左右摆动转动副，3为大臂左右摆动编码器，4为大臂左油缸，5为大臂右油缸，6为大臂，7为大臂上下俯仰转动副，8为大臂上下俯仰编码器。

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有付出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。

实施例1，一种凿岩台车大臂耦合运动串级复合pid控制方法，控制外环包括至少两个位置环，每个位置环中设有一个位置环pid，控制内环包括至少两个速度环，每个速度环中设有一个速度环pid，因为无论是控制大臂上下俯仰，还是控制大臂左右摆动，大臂左油缸和大臂右油缸必须要同时运动才能完成，所以每个位置环都需要输出两个油缸的运动速度，当大臂同时进行左右摆动和上下俯仰复合运动的时候，就需要把相应地油缸运动速度进行叠加计算，分别得到叠加后的设定运动速度，将设定运动速度作为速度环的输入，位置环叠加后得到的大臂的油缸运动速度分别作为速度环pid的输入，根据速度环的输出得到控制大臂油缸运动的比例阀开度值，利用比例阀开度值控制比例阀的开度，从而控制油缸的运动速度。设定运动速度是叠加后的油缸运动速度，设定运动速度作为速度环的输入，速度环的输入就是速度值。通过比例阀开度值控制两个油缸的不同方向的摆动和伸缩的运动速度，从而控制大臂左右和俯仰运动的耦合。

实施例2，一种凿岩台车大臂耦合运动串级复合pid控制方法，具体的步骤如下：

步骤一：根据需要的大臂左右摆动和上下俯仰的目标角度，分别计算大臂的左右摆动和上下俯仰的关节角度误差。

如图3所示，位置环的数量设有两个，速度环的数量设有两个，每个位置环的位置环pid均输出两个油缸运动速度，即大臂的左油缸运动速度和右油缸运动速度；两个速度环的速度环pid分别输出两个油缸的比例阀开度增量，即左油缸的比例阀开度增量和右油缸的比例阀开度增量。

两个位置环pid的输出速度公式如下：

其中，vl1(k)、vr1(k)分别为第k次大臂左右摆动关节的位置环pid输出的左油缸速度和右油缸速度；eθ1(k)为第k次大臂左右摆动关节角度误差，eθ1(k-1)为第k-1次的关节角度误差；vl2(k)、vr2(k)分别为第k次大臂上下俯仰关节的位置环pid输出的左油缸速度和右油缸速度；eθ2(k)为第k次大臂上下俯仰关节角度误差，eθ2(k-1)为第k-1次的关节角度误差；eθ1(i)为第i次大臂上下俯仰关节角度误差，eθ2(i)为第i次的大臂上下俯仰关节角度误差，i＝0,1,,...,k，i＝0时，eθ1(0)＝0,eθ2(0)＝0；kp1、ki1、kd1分别为位置环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)为第k次的左油缸速度误差，evl(k-1)为第k-1次的左油缸速度误差，evl(k-2)为第k-2次的左油缸速度误差；evr(k)为第k次的右油缸速度误差，evr(k-1)为第k-1次的右油缸速度误差，evr(k-2)为第k-2次的右油缸速度误差；当k＝0时，evl(0)＝0，evr(0)＝0；kp2、ki2、kd2分别为速度环pid的比例调节系数、积分调节系数和微分调节系数，三个系数值需要根据实际情况进行整定。

大臂耦合运动由两个并联油缸控制。两个油缸为并联连接的左油缸4和右油缸5，左油缸4和右油缸5均可单独控制大臂左右摆动关节或大臂上下俯仰关节；左油缸4和右油缸5均可以让大臂左右摆动关节和大臂上下俯仰关节同时运动，从而实现大臂的耦合运动。

如图1所示，所述大臂的左右摆动关节为左右摆动转动副2，大臂的上下俯仰关节为上下俯仰转动副7，所述编码器包括左右摆动编码器3和上下俯仰编码器8，左右摆动编码器3与左右摆动转动副2同轴连接，如图2所示，上下俯仰编码器8与上下俯仰转动副7同轴连接，左右摆动编码器3用于实时记录大左右摆动转动副2的当前角度，上下俯仰编码器8用于实时记录上下俯仰转动副7的当前角度；所述左油缸4和右油缸5对称布置在大臂6的两侧，对称布置可以让大臂俯仰时左右油缸运动速度相同，大臂左右摆动时，左右油缸运动速度刚好相反。大臂基座1与大臂左右摆动转动副2铰接在一起，形成一个转动副，大臂基座1与左油缸4、右油缸5通过万向节铰接在一起，使左右油缸可以绕基座上下摆动；大臂6与大臂基座1通过左右摆动转动副2、上下俯仰转动副7组成的万向节铰接在一起，使左右油缸可以绕大臂进行上下摆动。通过左右摆动编码器3、上下俯仰编码器8的编码器数值和油缸结构三角函数关系可分别计算出左油缸4和右油缸5的运动速度。

当左油缸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的比例阀开度，则左油缸4运动速度大于右油缸5，大臂6在绕左右摆动转动副2向右转动的同时也绕上下俯仰转动副7向上转动，从而实现大臂油缸的耦合运动。

所述两个位置环pid为系数相同的位置式pid，所述两个速度环pid为系数相同的增量式pid。

计算关节角度误差时，位置环pid的反馈角度值为编码器检测大臂的左右摆动关节或上下俯仰关节的角度。在大臂自动模式下，第k次同时下发的大臂左右摆动目标角度θ1和大臂上下俯仰目标角度θ2，通过读取大臂的左右摆动编码器3、上下俯仰摆动编码器8检测角度的数值，求出误差值eθ1(k)、eθ2(k)。即大臂的左右摆动和上下俯仰的关节角度误差的计算方法为：

其中，θ1为第k次大臂的左右摆动目标角度，θ2为第k次大臂的上下俯仰目标角度，θ3为左右摆动编码器3检测的角度，θ4为上下俯仰编码器8检测的角度，eθ1(k)为第k次大臂左右摆动即左右摆动转动副2的关节角度误差，eθ2(k)为第k次大臂上下俯仰时上下俯仰转动副7的关节角度误差。

步骤二：将大臂的左右摆动和上下俯仰的关节角度误差输入相应的位置环pid，位置环pid均输出油缸运动速度。

所述两个位置环pid为左右摆动位置环pid和上下俯仰位置环pid，且左右摆动位置环pid输出的左油缸运动速度vl1(k)和右油缸运动速度vr1(k)相反，上下俯仰位置环pid输出的左油缸运动速度vl2(k)和右油缸运动速度vr2(k)相等，是由左右油缸对称布置决定的。

当输入为大臂左右摆动目标角度θ1时，经过左右摆动位置环pid输出为左油缸速度vl1(k)和右油缸速度vr1。当关节角度误差eθ1(k)输入左右摆动位置环pid得到的左油缸运动速度和右油缸运动速度分别为：

当输入为大臂上下俯仰目标角度θ2时，经过位置环pid输出左油缸速度vl2(k)、右油缸速度vr2(k)，左右油缸速度相同。当关节角度误差eθ1(k)输入上下俯仰位置环pid得到的左油缸运动速度和右油缸运动速度分别为：

其中，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次上下俯仰的关节角度误差；kp1、ki1、kd1分别为位置环pid的比例调节系数、积分调节系数和微分调节系数。

步骤三：将油缸运动速度进行相应的叠加分别得到油缸的设定运动速度。

因大臂左右摆动和大臂上下俯仰运动是耦合在一起，所以两个位置环pid输出两组大臂左油缸和右油缸运动速度，需要对输出结果进行速度叠加。其中，左右摆动位置环pid的输出速度对大臂左右摆动关节起作用，上下俯仰位置环pid的输出对大臂上下俯仰关节起作用。

为了调节大臂左右摆动和上下俯仰关节运动速度的快慢程度，位置环pid输出量有调节系数k1和k2，默认情况下设定k1＝k2＝1.0，通过调节系数k1、k2将两个位置环pid输出的4个油缸运动速度进行叠加可以调节大臂左油缸设定速度vl即左油缸4的设定速度和大臂右油缸设定速度vr即右油缸5的设定速度，即调节大臂左右摆动关节相对大臂上下俯仰关节到达目标角度的快慢程度。若设定k1＞1则大臂左右摆动输出的两个速度均按k1比例增大，分别为k1vl1(k)和；同理调节k2也是如此。油缸的设定运动速度通过调节系数k1和k2调节位置环pid输出的两个油缸运动速度，经相应速度叠加后即：

其中，vl为大臂的左油缸设定运动速度，vr为大臂的右油缸设定运动速度，vl1(k)和vr1(k)分别为左右摆动位置环pid第k次输出的左油缸运动速度和右油缸运动速度，vl2(k)和vr2(k)分别为上下俯仰位置环pid第k次输出的左油缸运动速度和右油缸运动速度。

若k1＝1.2，k2＝1.0则对大臂左右摆动关节调节快慢程度大于大臂上下俯仰关节；反之，如果k1＝1.0，k2＝1.2则对大臂左右摆动关节调节快慢程度小于大臂上下俯仰关节，通过调节调节系数k1,k2，从而实现对大臂上下俯仰和左右摆动相对运动速度调节。

步骤四：根据油缸的设定运动速度，计算油缸的速度误差，将速度误差输入相应的速度环pid得到控制大臂的油缸的比例阀开度增量。

速度环pid的反馈速度不是通过传感器直接测量油缸速度，而是通过大臂左右摆动编码器、上下俯仰编码器角度和油缸结构三角函数计算出左油缸、右油缸的运动反馈速度，这样可以省去测量油缸运动速度的传感器，降低设备生产成本。即计算油缸的速度误差时，速度环pid的反馈运动速度为利用编码器检测的角度和油缸结构三角函数计算的油缸反馈速度。

通过读取左右摆动编码器3、上下俯仰摆动编码器8在第k-1次的数值θ3last、θ4last和第k次的数值θ3、θ4，经过油缸结构三角函数计算求出在第k次大臂左油缸和大臂右油缸的速度v'l、v'r。油缸结构三角函数计算油缸反馈速度的方法为：

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次大臂运动的时间差值。

根据左油缸设定速度vl、右油缸设定速度vr可计算出第k次与k-1次大臂运动的速度差值，即速度误差的计算方法为：

evl(k)＝vl-v'l

evr(k)＝vr-v'r；

其中，evl(k)为第k次左油缸的速度误差，evr(k)为第k次右油缸的速度误差。

把evl(k)、evr(k)分别带入两个速度环pid可以计算得到控制左油缸4的比例阀开度增量值δdl(k)、右油缸5的比例阀开度增量值δdr(k)。两个速度环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的比例调节系数、积分调节系数和微分调节系数。

步骤五：根据比例阀开度增量计算油缸的比例阀开度，利用比例阀开度控制油缸的多个方向的运动速度，从而控制大臂的关节的耦合转动。

所述计算油缸的比例阀开度的方法是计算左油缸4和右油缸5的控制比例阀开度计算如下：

其中，dl(k)和dr(k)分别为第k次控制大臂的左油缸和右油缸的比例阀开度；dl(k-1)和dr(k-1)分别为第k-1次控制大臂的左油缸和右油缸的比例阀开度。

通过速度环pid实现对大臂的左油缸4或右油缸5的耦合运动控制，使大臂6可以同时绕左右摆动转动副2和上下俯仰转动副7转动，降低大臂运动控制时间，提高控制系统稳定性和工作效率。在本实施例中，速度环pid控制为内环、位置环pid控制为外环共同构成凿岩台车大臂耦合运动串级复合pid控制。

以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。