Reactive mobile manipulation based on dynamic dual-trajectory tracking

Abstract

The letter presents an online obstacle avoidance strategy for a nonholonomic mobile manipulator, including dual-trajectory generation for the mobile base(MB) and end effector(EE), as well as whole-body reactive obstacle avoidance. The feasible region of the manipulator’s workspace is generated by traversing the path of the MB, and the spatio-temporal trajectory of the EE is generated by quadratically constrained quadratic programming(QCQP) planning, satisfying the physical constraints and obstacle avoidance constraints. The reactive obstacle avoidance strategy is based on quadratic programming(QP), using singularity avoidance and EE trajectory tracking tasks as soft constraints with different priorities. Considering the nonholonomic constraints and motion differences of MB, we employ a dynamic tracking approach to avoid obstacles of MB. Additionally, an adaptive weight method is utilized to adjust the priority of MB path tracking task, effectively preventing joint velocity jitter during the insertion process. Our strategy has been proven to generate obstacle avoidance trajectories for EE in real-time and ensure safe joint velocities for MB and the manipulator through simulation and real-world scenarios.