1.一种绳索牵引飞行机器人抗扰动控制方法,其特征在于,包括:S1、根据环境信息规划扫描范围,推算移行机构期望轨迹和机械臂关节角、无人机平台中心期望轨迹和移行机构初始位置;
S2、移行机构由初始位置沿着移行机构期望轨迹行进,在此运动状态下根据机械臂关节角计算机械臂运动对无人机平台带来的扰动力和扰动力矩,并计算绳索引起的扰动力和扰动力矩,得到总扰动方程;
S3、建立飞行机器人系统的动力学方程,并考虑估计误差进行解耦设计,得到解耦后的动力学方程;
S4、根据解耦后的动力学方程、总扰动方程和无人机平台中心期望轨迹构建系统状态误差动力学方程,并解算出飞行机器人旋翼升力和旋翼力矩;
S5、设计旋翼转速分配矩阵,根据旋翼升力、旋翼力矩以及旋翼转速分配矩阵计算旋翼转速,实现飞行机器人系统在机械臂和移行机构运动时抗扰动运行。
2.根据权利要求1所述的绳索牵引飞行机器人抗扰动控制方法,其特征在于,所述S1具体包括如下步骤:S11、首先定义北东地惯性坐标系S12、根据环境信息规划扫描范围以及被测件扫描范围在北东地惯性坐标系S13、并根据移行机构期望轨迹S14、设置无人机平台中心的期望偏航角
3.根据权利要求2所述的绳索牵引飞行机器人抗扰动控制方法,其特征在于,所述S12具体包括如下步骤:S121、利用相机获取被测件及被测件附近的环境信息,规划所需扫描的范围及扫描范围在北东地惯性坐标系S122、根据所述扫描范围及扫描范围的投影确定无人机平台中心的高度,使得机械臂在其工作空间可以使扫描仪的扫描范围包含S1中规划的扫描范围;
S123、根据环境信息规划扫描范围以及被测件扫描范围在北东地惯性坐标系其中,
S124、根据所述移行机构期望轨迹
4.根据权利要求3所述的绳索牵引飞行机器人抗扰动控制方法,其特征在于,所述S13中推算无人机平台中心的期望轨迹根据所述无人机平台中心的高度设计无人机平台中心在坐标轴其中,坐标轴
5.根据权利要求4所述的绳索牵引飞行机器人抗扰动控制方法,其特征在于,所述S2具体包括如下步骤:S21、移行机构沿着所述移行机构期望轨迹S22、根据机械臂关节角
其中,
其中,c和s分别为三角函数cos和sin;
其中,
此外,根据质心的定义可以求得飞行机器人系统的质心变化量及其导数,具体公式如下:其中,
S23、计算绳索引起的扰动力和扰动力矩,具体公式如下:其中,
机械臂运动对无人机平台带来的扰动力和扰动力矩、以及绳索引起的扰动力和扰动力矩构成总扰动方程。
6.根据权利要求5所述的绳索牵引飞行机器人抗扰动控制方法,其特征在于,所述S3具体包括如下步骤:S31、构建飞行机器人控制系统,根据质点系的动量和动量矩定理建立飞行机器人系统初始的动力学方程,初始的动力学方程具体如下:其中,
考虑到估计误差,可以得到更新的动力学方程:其中,
S32、根据更新的动力学方程看出,更新的动力学方程由位置控制子系统和姿态控制子系统两个子系统构成,两个子系统通过旋转矩阵其中,
并构建得到旋翼升力、旋翼力矩、俯仰角和横滚角的期望值计算公式。
7.根据权利要求6所述的绳索牵引飞行机器人抗扰动控制方法,其特征在于,所述S32具体包括如下步骤:S321、定义位置环虚拟输入其中,
将位置环虚拟输入
可以解得旋翼升力
S322、定义姿态环虚拟输入输入在不考虑扰动项的情况下,姿态控制子系统在S323、将位置环虚拟输入
8.根据权利要求7所述的绳索牵引飞行机器人抗扰动控制方法,其特征在于,所述S4具体包括如下步骤:S41、飞行机器人系统的输出量为3轴的绝对位置其中,
S42、考虑扰动项,可以得到系统状态误差动力学方程:其中,A、B、C、D、E表示系统状态误差动力学方程的系数;
其中,
其中,
S43、根据系统状态误差动力学方程,求解出其中,
S44、根据系统状态误差动力学方程,求解出旋翼升力
9.根据权利要求8所述的绳索牵引飞行机器人抗扰动控制方法,其特征在于,所述S5具体包括如下步骤:S51、根据飞机机器人的旋翼安装方法设计旋翼转速分配矩阵;
S52、根据旋翼升力
10.根据权利要求9所述的绳索牵引飞行机器人抗扰动控制方法,其特征在于,所述无人机平台上的旋翼选用十字型八旋翼;
所述S52中的旋翼转速分配矩阵具体如下:其中,