Lokalizacja na płaszczyźnie

Witam,

Nie wiem za bardzo jak rozwiązać w jakiś taki w miare mądry problem odczytywania kąta pomiędzy trzema punktami. Przykład:

-------------


* //gdzie gwiazdki to punkty, mamy wszystkie współrzędne
potrzebne jest określeneie kąta w pełnym zakresie. Konkretnie potrzebne mi to do identyfikacji położenia, powiedzmy w układzie biegunowym czyli odległość od punktu i kąt. Z teoretycznego/geometrycznego punktu widzenia sprawa nie jest skomplikowana ale nie wiem za bardzo jak to zaprogramowac. Barzdo dziekuje za pomoc.
pozdrawiam
juris

zerknij na http://tutorial.math.lamar.edu/pdf/Trig_Cheat_Sheet.pdf

Tan(alpha)
= tan(P2 O X - P1 O X)
= (tan(P2 O X) - tan(P1 O X))/(1 + tan(P2 O X)tan( P1 O X))
=(y1/x1 - y2/x2)/(1 + (y1/x1)(y2/x2))
=(y1x2 - y2x1)/(y1y2 + x1x2)

Hence alpha = atan(y1x2 - y2x1)/(y1y2 + x1x2))