Test stake driving the last stake in sand box

[Piphi5]

Note, that we should move ATRV around to make sure that it can still drive stakes that get jostled around and test battery consumption.