SLAM implementation for autonomous ground vehicle