多任务空中飞行灵巧臂轨迹规划方法、系统及存储介质

1.一种多任务空中飞行灵巧臂轨迹规划方法，其特征在于，包括：综合考虑空中飞行灵巧臂在任务执行中的位置变化量和姿态变化量，建立位姿变化函数；以所述位姿变化函数的值最小为目标，采用复合粒子群优化算法确定各个任务的执行顺序；确定所述执行顺序中相邻两个任务之间的空中飞行灵巧臂的运动轨迹；所述位姿变化函数为：其中， F 表示位姿变化值， m 表示任务点数量， 和 分别表示空中飞行灵巧臂的末端执行器由第 i 个任务点至第 i +1个任务点的位置变化量和姿态变化量， 和 表示加权因子；采用复合粒子群优化算法确定所述执行顺序的方法为：初始化粒子群的粒子数、迭代停止条件、每个粒子位置、适应度值、全局最优位置、局部最优位置；判断是否满足迭代停止条件，若满足，则输出最优解，即所述执行顺序，否则继续循环；基于粒子群的全局最优解和每个粒子的局部最优解，自调节学习因子和惯性因子数值，并更新每个粒子的速度和位置；对粒子群执行交叉、变异操作；计算每个粒子的适应度值、全局最优位置、局部最优位置，并继续判断是否满足迭代停止条件；所述确定所述执行顺序中相邻两个任务之间的空中飞行灵巧臂的运动轨迹，包括：根据空中飞行灵巧臂的运动学模型确定多旋翼无人机和灵巧臂的关节运动轨迹，所述运动学模型为：其中， 为空中飞行灵巧臂的运动状态， 和 分别表示灵巧机械臂的末端执行器线速度和角速度， 和 分别表示多旋翼无人机的线速度和角速度， 表示灵巧机械臂的关节构型向量， 和 分别表示多旋翼无人机和灵巧机械臂的雅可比矩阵， 表示广义雅可比矩阵。 2.应用权利要求1所述的多任务空中飞行灵巧臂轨迹规划方法的系统，其特征在于，包括：函数建立模块，用于综合考虑空中飞行灵巧臂在任务执行中的位置变化量和姿态变化量，建立位姿变化函数；顺序确定模块，用于以所述位姿变化函数的值最小为目标，采用复合粒子群优化算法确定各个任务的执行顺序；轨迹规划模块，用于确定所述执行顺序中相邻两个任务之间的空中飞行灵巧臂的运动轨迹。 3.一种计算机存储介质，其特征在于，所述计算机存储介质中存储有多条计算机指令，所述多条计算机指令用于使计算机执行权利要求1所述的方法。