DEBUG: Normalisation of angles

Normalisation of angles did not return the correct value for negative angles. Added some tests.