Better wall following + GPIO Int
Stuff
Merge pull request #10 from RC93/master

Stuff for tom