Fixed 'if .. else if .. else' statements.
Added parameter for sensing markers.
Merge branch 'master' of github.com:mathijsb/afp-ants