In particular the question how you test, and if you test really test this or if you under approximate the situations when you could dig a hole by the situations where you can dig a hole and it is EASY to determine that the position can be filled, sounds to me like an integral part of your project.