连续迭代投影多任务优先级方法

针对任务优先级层次中进行任务插入和移除过程中引起的关节速度不连续现象,基于连续迭代投影原理,提出连续迭代投影多任务优先级方法。并基于李雅普诺夫稳定性理论,当迭代次数趋于无穷大时,证明了所提出方法的稳定性。以避障任务为首要任务,轨迹跟踪任务为次要任务,仿真分析了连续迭代投影多任务优先级方法的性能,并与传统增广投影多任务优先级方法进行对比。结果表明,在靠近障碍物时,避障任务插入优先级层次中,连续迭代投影多任务优先级方法能够保证关节速度的连续性,并在冗余度范围内尽可能地执行末端轨迹跟踪任务,保证跟踪误差的收敛性。