A general trajectory planner for optimal control problems is presented and applied to a robot 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.