Latest version of the wallfollower

Has all the logic for basic wallfollowing