Better wall following + GPIO Int