system. The approach is based on timed elastic bands and nonlinear model predictive
control. By exploiting the sparsity in the underlying optimization problems the computational
effort can be significantly reduced, resulting in a real-time capable planner. In addition, a
localization based switching strategy is employed to enforce convergence and stability. The
planning procedure is illustrated in a robotics application using a realistic SCARA type robot.