Autonomous Soil Collection in Environments With Heterogeneous Terrain