本发明提供了一种基于零空间避障的机械臂末端轨迹跟踪算法。采用具有解析式形式的最小伪距离代替传统欧式距离作为避障的接近度指标，结合梯度投影法完成机械臂的零空间避障任务。设计一种自适应正定系数矩阵K和速度误差饱和函数将实时末端轨迹运行结果反馈给冗余机械臂运动学反解，根据反馈结果自适应调节关节角速度以减小末端轨迹跟踪误差。本发明不仅解决了冗余机械臂末端轨迹跟踪问题，同时完成了零空间避障任务。采用伪距离可以提前采取避障动作，保证机械臂关节空间运行平稳，末端轨迹跟踪算法可以显著提高轨迹跟踪精度，最大限度完成末端主任务。冗余机械臂的仿真实验结果验证了算法的有效性和优越性。