Added wallfollow2 method. Works really well at the moment
some sensor tweaks
fix merge conflicts
Merge pull request #12 from jimmyhlee94/sensor-redo

Sensor redo