Hybrid systems for robot planning