Fixed follow wall code. It should now work, but needs to be tested.