normalize angles
normalize expected angles
normalize setpoint
fix coding style : variable name
allow value to cross max/min
make MIN/MAX_ANGLE public
use MIN/MAX_ANGLE constants
use constant to define cross window