大家好,今天编写了一个,校正工件并分中的程序。应用此程序可以不用校正工件,直接压紧后,用此程序找正即可。
具体方法:任意找到第一点后启动程序,找到第二点后再启动程序即可。注意:使用前R表中R20不能等于1。
IF R20==1 GOTOF AA
R20=1
R1=$AA_IM[X]
R2=$AA_IM[Y]
M2
AA: R3=$AA_IM[X]
R4=$AA_IM[Y]
R5=(R1+R3)/2
R6=(R2+R4)/2
R7=(R1-R3)/(R2-R4)
R8=ATAN2 ((R1-R3),(R2-R4))
R9=R1-R3
R10=R2-R4
IF R7>0 GOTOF BB
IF R9R11=180+R8
$P_UIFR[2]=CTRANS(X,R5,Y,R6):CROT(Z,R11)
M2
CC:$P_UIFR[2]=CTRANS(X,R5,Y,R6):CROT(Z,R8)
M2
BB:IF R9R12=180+R8
$P_UIFR[2]=CTRANS(X,R5,Y,R6):CROT(Z,R12)
M2
DD: $P_UIFR[2]=CTRANS(X,R5,Y,R6):CROT(Z,R8)
M2