Fast and Safe Scheduling of Robots