halcon拓展系列—计算任意矩形的四个角点坐标算子

 

 

 

 

 

 

 

* ****************************************
* * 求rectangle2的四个直角点
* * 0********|*********2
* * *********|**********
* * *********|**********
* * *********|**********
* * *********|**********
* * *********|**********
* * 1********|*********3
* *注：以与水平方向所成角度较大的边中线为轴线
* ****************************************
pi := acos(0)*2
if (phi >= 0 and phi < pi/4)
phi := phi - pi/2
Tem := length1
length1 := length2
length2 := Tem
elseif (phi > -pi/4 and phi < 0)
phi := phi + pi/2
Tem := length1
length1 := length2
length2 := Tem
endif
*
if (phi >= 0)
la := phi ///63
lb := la - pi/2 -26
tuple_tan (la, tem1)
tuple_tan (lb, tem2)
tuple_sqrt ((length1 * length1) / (1 + tem1 * tem1), xLength1)
tuple_sqrt ((length2 * length2) / (1 + tem2 * tem2), xLength2)
tuple_sqrt ((tem1*tem1*length1*length1) / (1 + tem1 * tem1), yLength1)
tuple_sqrt ((tem2 * tem2 * length2 * length2) / (1 + tem2 * tem2), yLength2)
* 左上
gen_cross_contour_xld (Cross, 1, columnCenter + xLength1- xLength2, 6, 0.785398)
mColumnUpLeft := columnCenter + xLength1 - xLength2
nRowUpLeft := rowCenter - yLength1 - yLength2
* 左下
mColumnDownLeft := columnCenter - xLength1 - xLength2
nRowDownLeft := rowCenter + yLength1 - yLength2
* 右上
mColumnUpRight := columnCenter + xLength1 + xLength2
nRowUpRight := rowCenter - yLength1 + yLength2
* 右下
mColumnDownRight := columnCenter - xLength1 + xLength2
nRowDownRight := rowCenter + yLength1 + yLength2
else
la := phi
lb := la - pi/2
tuple_tan (la, tem1)
tuple_tan (lb, tem2)
tuple_sqrt ((length1 * length1) / (1 + tem1 * tem1), xLength1)
tuple_sqrt ((length2 * length2) / (1 + tem2 * tem2), xLength2)
tuple_sqrt ((tem1*tem1*length1*length1) / (1 + tem1 * tem1), yLength1)
tuple_sqrt ((tem2 * tem2 * length2 * length2) / (1 + tem2 * tem2), yLength2)
* 左上
mColumnUpLeft := columnCenter - xLength1 - xLength2
nRowUpLeft := rowCenter - yLength1 + yLength2
* disp_cross (3600, nRowUpLeft, mColumnUpLeft, 16, 0)
* 左下
mColumnDownLeft := columnCenter + xLength1 - xLength2
nRowDownLeft := rowCenter + yLength1 + yLength2
* disp_cross (3600, nRowDownLeft, mColumnDownLeft, 16, 0)
* 右上
mColumnUpRight := columnCenter - xLength1 + xLength2
nRowUpRight := rowCenter - yLength1 - yLength2
* 右下
mColumnDownRight := columnCenter + xLength1 + xLength2
nRowDownRight := rowCenter + yLength1 - yLength2
endif
row := []
column := []
row[0] := nRowUpLeft
column[0] := mColumnUpLeft
row[1] := nRowDownLeft
column[1] := mColumnDownLeft
row[2] := nRowUpRight
column[2] := mColumnUpRight
row[3] := nRowDownRight
column[3] := mColumnDownRight
return ()