Added AngleDiff

Calculates signed angle difference
Improved surface checking, added input, wallmode

Surface and overlap checks look at difference between sensor angles
(threshold constants), surface detection is now based on wall mode
Added test data

woo