Fixxing error in angle calculation

Signed-off-by: Xavier Roche <xavier.roche@open.eurogiciel.org>