Mapping Forests Using An Unmanned Ground Vehicle With 3d Lidar And Graph Slam