Towards Autonomous Excavation Planning