Implemented active snake algorithm for ground finding (still alpha,
though!)