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

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

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

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

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

所述步骤S3中协同编队阻抗控制器的控制函数为：

；（20）

；（21）

其中， 为第 架带机械臂无人机的期望惯量矩阵， 为第 架带机械臂无人机的期望阻尼矩阵， 为第 架带机械臂无人机的期望刚度矩阵， 为第 架带机械臂无人机的机械臂末端与环境接触力矩阵； 为第 架带机械臂无人机的机械臂末端期望位姿； 为第 架带机械臂无人机的机械臂末端实际位姿， 为第 架带机械臂无人机的机械臂末端期望位姿速度， 为第 架带机械臂无人机的机械臂末端实际位姿速度，为第 架带机械臂无人机的机械臂末端期望位姿加速度， 为第 架带机械臂无人机的机械臂末端实际位姿加速度；

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

式中， 为第 架带机械臂无人机的机械臂末端位姿映射到第 架带机械臂无人机的机械臂末端位姿， 为第 架带机械臂无人机的机械臂末端位姿映射到第 架带机械臂无人机的机械臂末端位姿， 为第 架和第 架带机械臂无人机的机械臂末端映射到物体的位姿， 为第 架带机械臂无人机的机械臂末端到第 架带机械臂无人机的机械臂末端映射矩阵， 为第 架带机械臂无人机的机械臂末端到第 架带机械臂无人机的机械臂末端映射矩阵， 为第 架带机械臂无人机的机械臂末端到物体 的映射矩阵， 为第架带机械臂无人机的机械臂末端到物体 的映射矩阵；

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

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

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

；（2）

；（3）

；（4）

其中， 为第 架带机械臂无人机的机械臂末端位置矩阵； 为第 架带机械臂无人机位置矩阵； 为第 架带机械臂无人机的旋转矩阵， 为转置； 为第 架带机械臂无人机的机械臂末端相对于该无人机的位置矩阵； 为第 架带机械臂无人机的机械臂末端的角速度矩阵； 为第 架带机械臂无人机的角速度矩阵； 为第 架带机械臂无人机的机械臂末端相对于该无人机的角速度矩阵；

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

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

；（6）

；（7）

其中 为第 架带机械臂无人机的 方向期望速度，为第 架带臂无人机的 方向期望速度，为第 架带机械臂无人机的期望俯仰角速度， 为第 架带机械臂无人机的机械臂第1个关节的期望角速度， 为第 架带机械臂无人机的机械臂第2个关节的期望角速度， 为第 架带机械臂无人机的机械臂末端 方向的速度， 为第 架带机械臂无人机的机械臂末端 方向的速度， 为第 架带机械臂无人机的机械臂末端俯仰角速度。

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

；（9）

由上式得：

；（10）

；（11）

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

设 ， ，由上式变换得：

；（12）

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

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

；（14）

；（15）

；（16）

；（17）

；（18）

其中 为带机械臂无人机 方向上的位置，为带机械臂无人机 方向上的位置， 为带机械臂无人机的俯仰角， 、 分别为第 架带机械臂无人机的机械臂第1个、第2个关节的角度； 为第 架带机械臂无人机的惯性矩阵； 为第 架带机械臂无人机的离心力和哥氏力构成的矩阵； 为第 架带机械臂无人机的重力项构成的矩阵；

， ， ， 、 分别为带

机械臂无人机在 、方向的力， 为带机械臂无人机的俯仰角力矩， 、 分别带机械臂无人机的第1个、第2个机械臂转角力矩；

；（19）

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

6.根据权利要求1所述的一种带机械臂的无人机协同编队阻抗控制方法，其特征在于，所述步骤S4中带机械臂无人机的同步阻抗控制的实际位姿输出如下：；（24）

；（25）

；（26）

；（27）

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

7.根据权利要求1所述的一种带机械臂的无人机协同编队阻抗控制方法，其特征在于，物体的运动轨迹与第 架和第 架带机械臂无人机的机械臂之间互相通过映射连接，其表达式为：；（28）

式中， 为物体位姿， 为第 架带机械臂无人机的机械臂末端期望位姿， 为第架带机械臂无人机的机械臂末端期望位姿， 和 为物体与第 架和第 架带机械臂无人机的机械臂末端映射矩阵；根据上述公式可以得到物体的运动轨迹映射到第 架和第架带机械臂无人机的机械臂上，进而实现第 架和第 架带机械臂无人机的机械臂的运动轨迹规划。