Task-constrained motion planning with moving obstacles

We consider the problem of planning the motion of redundant robotic systems subject to geometric task constraints in the presence of obstacles moving along known trajectories. Building on our previous results on task-constrained motion planning, we propose a control-based motion planner that works directly in the task-constrained configuration space extended with the time dimension. The generated trajectories are collision-free and satisfy the task constraint with arbitrary accuracy. Bounds on the achievable generalized velocities may also be taken into account. The proposed approach is validated through planning experiments on a 7-dof articulated robot and an 8-dof mobile manipulator.