% load the Toro 2D dataset and build pose graph