Xp = X
A
+l*cos(A
AB
)+H*cos(A
k
)
Yp= Y
A
+l*sin(A
AB
)+H*sin(A
k
)