Distributed Scheduling Using Constraint Optimization and Multiagent Path Planning