1.一种带机械臂的无人机协同编队阻抗控制方法，其特征在于，包括以下步骤：步骤S1，根据齐次方程及雅克比矩阵构建带机械臂无人机的运动学模型；

步骤S2，根据步骤S1中建立的运动学模型并基于拉格朗日‑欧拉方程建立带机械臂无人机的动力学模型；

步骤S3，参考带机械臂多无人机的抓取运动情况及受力和力矩情况，构建协同编队阻抗控制器；

步骤S4，根据任务需求，设计参考物体轨迹，结合所述运动学模型的正运动控制及协同编队阻抗控制器的误差关系构建同步误差补偿控制器；

步骤S5：采用同步误差补偿控制器对带机械臂无人机的运动学模型进行修正补偿。

2.根据权利要求1所述的一种带机械臂的无人机协同编队阻抗控制方法，其特征在于，所述步骤S1中带机械臂无人机的运动学模型具体如下：其中，PEK为第K架带机械臂无人机的机械臂末端位置矩阵；PBK为第K架带机械臂无人机位置矩阵；RBK为第K架带机械臂无人机的旋转矩阵，T为转置； 为第K架带机械臂无人机的机械臂末端相对于该无人机的位置矩阵；ωEK为第K架带机械臂无人机的机械臂末端的角速度矩阵；ωBK为第K架带机械臂无人机的角速度矩阵； 为第K架带机械臂无人机的机械臂末端相对于该无人机的角速度矩阵；

VEK为第K架带机械臂无人机的机械臂末端速度矩阵；JBK为第K架带机械臂无人机的雅克比矩阵；JEKBK为第K架带机械臂无人机的机械臂的雅克比矩阵； 为第K架带机械臂无人机的位姿速度矩阵； 为第K架带机械臂无人机的机械臂角度矩阵。

3.根据权利要求2所述的一种带机械臂的无人机协同编队阻抗控制方法，其特征在于，其中：T

VEK＝[νEX νEZ νEθ]；     (7)

其中 为第K架带机械臂无人机的x方向期望速度，为第K架带臂无人机的z方向期望速度，为第K架带机械臂无人机的期望俯仰角速度， 为第K架带机械臂无人机的机械臂第1个关节的期望角速度， 为第K架带机械臂无人机的机械臂第2个关节的期望角速度，νEX为第K架带机械臂无人机的机械臂末端x方向的速度，νEZ为第K架带机械臂无人机的机械臂末端z方向的速度，νEθ为第K架带机械臂无人机的机械臂末端俯仰角速度。

4.根据权利要求3所述的一种带机械臂的无人机协同编队阻抗控制方法，其特征在于，还包括以下步骤：设

由上式得：

式中，JζK为第K架带机械臂无人机的雅克比矩阵JBK的第1到第3行和第1第2列数值，JσK为第K架带机械臂无人机的雅克比矩阵JBK的第1到第3行和第3列数值；

设 JηK＝[JζK JEKBK]，由上式变换得：

式中， χK为第K架带机械臂无人机的对称增益矩阵；eK为第K架带机械臂无人机的机械臂末端位姿误差；而第K架带机械臂无人机的机械臂末端的位置yEK和偏航角ψEK为无人机的位置yBK和偏航角ψBK。

5.根据权利要求1所述的一种带机械臂的无人机协同编队阻抗控制方法，其特征在于，所述步骤S2中带机械臂无人机的动力学模型具体如下：T

XB1＝[x z θ]；    (15)

T

Q1＝[q1 q2]；    (16)

T

XB2＝[x z θ]；   (17)

T

Q2＝[q1 q2]；   (18)

其中x为带机械臂无人机x方向上的位置，z为带机械臂无人机z方向上的位置，θ为带机械臂无人机的俯仰角，q1、q2分别为第K架带机械臂无人机的机械臂第1个、第2个关节的角度； 为第K架带机械臂无人机的惯性矩阵； 为第K架带机械臂无人机的离心T

力和哥氏力构成的矩阵； 为第K架带机械臂无人机的重力项构成的矩阵；u＝[u1 u2] ，T Tu1＝[fx fz τθ τq1 τq2] ，u2＝[fx fz τθ τq1 τq2] ，fx、fz分别为带机械臂无人机在x、z方向的力，τθ为带机械臂无人机的俯仰角力矩，τq1、τq2分别带机械臂无人机的第1个、第2个机械臂转角力矩；

式中JBK为第K架带机械臂无人机的雅克比矩阵，JEKBK为第K架带机械臂无人机的机械臂的雅克比矩阵，FEK为第K架带机械臂无人机的机械臂末端与环境接触时的接触力矩阵。

6.根据权利要求1所述的一种带机械臂的无人机协同编队阻抗控制方法，其特征在于，所述步骤S3中协同编队阻抗控制器的控制函数为：其中，MSK为第K架带机械臂无人机的期望惯量矩阵，BSK为第K架带机械臂无人机的期望阻尼矩阵，GSK为第K架带机械臂无人机的期望刚度矩阵，FPK为第K架带机械臂无人机的机械臂末端与环境接触力矩阵；xPK为第K架带机械臂无人机的机械臂末端期望位姿；xSK为第K架带机械臂无人机的机械臂末端实际位姿， 为第K架带机械臂无人机的机械臂末端期望位姿速度， 为第K架带机械臂无人机的机械臂末端实际位姿速度， 为第K架带机械臂无人机的机械臂末端期望位姿加速度， 为第K架带机械臂无人机的机械臂末端实际位姿加速度；

根据映射关系，将带机械臂多无人机的机械臂末端位置和姿态互相映射和映射到物体上，其方程为下式：

式中，xP1‑2为第1架带机械臂无人机的机械臂末端位姿映射到第2架带机械臂无人机的机械臂末端位姿，xP2‑1为第2架带机械臂无人机的机械臂末端位姿映射到第1架带机械臂无人机的机械臂末端位姿，x12O为第1架和第2架带机械臂无人机的机械臂末端映射到物体O的位姿，T12为第1架带机械臂无人机的机械臂末端到第2架带机械臂无人机的机械臂末端映射矩阵，T21为第2架带机械臂无人机的机械臂末端到第1架带机械臂无人机的机械臂末端映射矩阵，T1O为第1架带机械臂无人机的机械臂末端到物体O的映射矩阵，T2O为第2架带机械臂无人机的机械臂末端到物体O的映射矩阵；

对于机械臂与被抓物体可得同步期望输入位姿为下式：

式中，xPO为物体的期望位姿， 为第1架带机械臂无人机的阻抗控制映射关系输出值，为第2架带机械臂无人机的阻抗控制映射关系输出值， 为物体映射关系输出值。

7.根据权利要求1所述的一种带机械臂的无人机协同编队阻抗控制方法，其特征在于，所述步骤S4中带机械臂无人机的同步阻抗控制的实际位姿输出如下：式中，kE1为第1架带机械臂无人机的机械臂的实际位姿与阻抗控制同步输入位姿的误差补偿参数；kA1为第1架与第2架带机械臂无人机的机械臂同步位姿误差补偿参数；kQ1为第

1架与第2架带机械臂无人机的机械臂末端互相映射误差补偿参数；kE2为第2架带机械臂无人机的机械臂的实际位姿与阻抗控制同步输入位姿的误差补偿参数；kA2为第1架与第2架带机械臂无人机的机械臂同步位姿误差补偿参数；kQ2为第2架带机械臂无人机的机械臂末端的误差补偿参数； 为带机械臂无人机的机械臂末端物体位姿，XC1为第1架带机械臂无人机的同步阻抗控制的实际位姿输出；XC2为第2架带机械臂无人机的同步阻抗控制的实际位姿输出；X1为第1架带机械臂无人机的机械臂末端实际输出位姿；X2为第2架带机械臂无人机的机械臂末端实际输出位姿。

8.根据权利要求1所述的一种带机械臂的无人机协同编队阻抗控制方法，其特征在于，物体的运动轨迹与第1架和第2架带机械臂无人机的机械臂之间互相通过映射连接，其表达式为：式中， 为物体位姿， 为第1架带机械臂无人机的机械臂末端期望位姿， 为第2架带机械臂无人机的机械臂末端期望位姿，TO1和TO2为物体与第1架和第2架带机械臂无人机的机械臂末端映射矩阵；根据上述公式可以得到物体的运动轨迹映射到第1架和第2架带机械臂无人机的机械臂上，进而实现第1架和第2架带机械臂无人机的机械臂的运动轨迹规划。