Outdoor LIDAR SLAM and Graph Optimization