Localization and mapping for agricultural robotics