[forhaxed]

и что в итоге делать?

Добавлено через 2 минуты
Сори за мултипостинг,
ошибка крылась в "(ypos1-ypos)*(ypos1-ypos)"
другая проблемма, как узнать angle если есть x1,y1,x2,y2, адекватной формулы я еще не встречал