Mich irritieren die "180" in deinem Code.
Normalerweise wird sowas im Bogenmaß gerechnet.

EDIT: Ich mach in solchen Fällen eigentlich immer zwei Rechenwege: ist DiffX < DiffY geh' ich über den Cosinus. Bei großen Winkeln verschwindet ja der Tanges im Nirwana, und der Rechner muß zu lange rechnen.