передать ошибку координаты в функции

Question

Я пытаюсь передать координаты точек на новую систему, генерируемых координаты

исходных точек в исходной системе находится в верхнем левом углу ....

я написал следующую функцию для передачи координат
Я использую формальный, что я получил от этого вопроса pre_question этот вопрос имеет 2 фотографии, которые показывают, что я имею в виду и знак для каждой части

Проблема в том, что я получаю отрицательное значение для w! может кто-нибудь пожалуйста, проверьте эту функцию и дайте мне знать, где проблема

Благодаря

{

CvPoint transfer_coordinate (CvPoint pt1 , CvPoint pt2 , CvPoint pt3 , CvPoint pt4 , CvPoint origin , CvPoint current) 
{ 
// pt1 , pt2 ==> points in line Z 
// pt3 , pt4 ==> points in line W 
double a1 , a2 , b1 , b2 , d1 , d2; 

d1= sqrt(pow((pt1.x - pt2.x),2.0)+ pow((pt1.y - pt2.y),2.0)); 
d2= sqrt(pow((pt3.x - pt4.x),2.0)+ pow((pt3.y - pt4.y),2.0)); 

a1 =(pt1.y-pt2.y)/d1; 
b1 =(pt2.x-pt1.x)/d1; 

a2 =(pt3.y-pt4.y)/d2; 
b2 =(pt4.x-pt3.x)/d2; 

CvPoint new_point; 
//z = -sqrt(a1^2+b1^2)*(a2*(x-x0)+b2*(y-y0))/(a2*b1-a1*b2) 
//w = sqrt(a2^2+b2^2)*(a1*(x-x0)+b1*(y-y0))/(a1*b2-a2*b1) 
//z 
new_point.x = -round(sqrt(pow(a1,2.0)+ pow(b1,2.0)) * (a2 * (current.x - origin.x) + b2 * (current.y - origin.y))/(a2 * b1 - a1 * b2)); 
// w 
new_point.y = round(sqrt(pow(a2,2.0)+ pow(b2,2.0)) * (a1 * (current.x - origin.x) + b1 * (current.y - origin.y))/(a1 * b2 - a2 * b1)); 

CvPoint reverse_point; 
//x = x0 - b1*z/sqrt(a1^2+b1^2) + b2*w/sqrt(a2^2+b2^2) 
//y = y0 + a1*z/sqrt(a1^2+b1^2) - a2*w/sqrt(a2^2+b2^2) 
//x 
reverse_point.x = round (origin.x - b1 * new_point.x/sqrt(pow(a1,2.0) + pow(b1,2.0)) + b2 * new_point.y /sqrt(pow(a2,2)+ pow(b2,2))); 
//y 
reverse_point.y = round (origin.y + a1 * new_point.x/sqrt(pow(a1,2.0) + pow(b1,2.0)) - a2 * new_point.y /sqrt(pow(a2,2)+ pow(b2,2))); 

//printf("\n points in Z line (%d,%d),(%d,%d) , points in W line (%d,%d),(%d,%d) , origin (%d,%d)",pt1.x,pt1.y,pt2.x,pt2.y,pt3.x,pt3.y,pt4.x,pt4.y,origin.x,origin.y); 
//printf("\n current point = (%d,%d) , new point = (%d,%d) , reverse point = (%d,%d)" , current.x,current.y,new_point.x,new_point.y,reverse_point.x,reverse_point.y); 

return new_point ; 

}

}

Answer 1

Если W-ось соответствует X -аксис, то матрица аффинного преобразования равна M = [R] * [T], где R - матрица вращения по углу Phi, а T - матрица трансляции на x0, y0

R = Cos(phi) -Sin(phi) 0 
    Sin(phi) Cos(phi) 0 
    0   0  1 

и

T = 1 0 0 
    0 1 0 
    dx dy 1 

Вы должны умножить эти матрицы, чтобы получить матрицу M и получить обратную матрицу MR = Inverse (M). Затем вы можете использовать M и MR для преобразования координат XY в системе WZ и наоборот [Xnew, Ynew, 1] = [xold, yold, 1] * [M]

More information here