Road to the DARPA Robotics Finals