SNSLCT/S(ROOTSN1_0)
$$$$$$$$$$$$$$$$$$$求四个点中心点的宏$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$
M(Step_Step) = MACRO/'MID_P',CAL_TEMP_X,CAL_TEMP_Y,CAL_TEMP_Z
MODE/MAN
DECL/COMMON, INTGR, I, J
DECL/COMMON, CHAR, 20, K ,LABEL_TEMP
DECL/COMMON, DOUBLE, CORD_TEMP[3,4],CAL_TEMP_X,CAL_TEMP_Y,CAL_TEMP_Z
DO/I,1,4
K = ASSIGN/STR(I)
LABEL_TEMP = ASSIGN/CONCAT('PIONT_', K)
F(LABEL_TEMP) = FEAT/POINT, CART, 0, 0, 0, 0, -1, 0
MEAS/POINT, F(LABEL_TEMP), 1
ENDMES
DO/J, 1, 3
CORD_TEMP[J,I] = OBTAIN/FA(LABEL_TEMP), J+2
ENDDO
ENDDO
CAL_TEMP_X = ASSIGN/(CORD_TEMP[1,1]+CORD_TEMP[1,2]+CORD_TEMP[1,3]+CORD_TEMP[1,4])/4
CAL_TEMP_Y = ASSIGN/(CORD_TEMP[2,1]+CORD_TEMP[2,2]+CORD_TEMP[2,3]+CORD_TEMP[2,4])/4
CAL_TEMP_Z = ASSIGN/(CORD_TEMP[3,1]+CORD_TEMP[3,2]+CORD_TEMP[3,3]+CORD_TEMP[3,4])/4
F( ) = FEAT/POINT,CART,CAL_TEMP_X,CAL_TEMP_Y,CAL_TEMP_Z,0,-1,0
ENDMAC
$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$
$$$$$$$$$$$$$$$$$$$$$$$$$$$测量步骤$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$
DECL/COMMON,REAL,X_P,Y_P,Z_P
CALL/M(Step_Step),(PT), X_P, Y_P, Z_P
MODE/PROG,MAN
MEAS/POINT,F(PT),1
PTMEAS/CART,X_P,Y_P,Z_P,0,-1,0
ENDMES
$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$定距采点$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$
DECL/COMMON,DOUBLE,STEP_LEN
DECL/COMMON,INTGR,I,STEP_NUM
DECL/COMMON,CHAR,20,K,LABEL_P,PROMPT_CHAR
SNSLCT/S(ROOTSN1_1)
TEMP_CHAR = PROMPT/TEXT,'请输入步长',EDIT,STEP_LEN,$
TEXT,'请输入采点数量',EDIT,STEP_NUM
I = ASSIGN/1
DO/I,1,STEP_NUM
K = ASSIGN/STR(I)
LABEL_P = ASSIGN/CONCAT('F_PT',K)
F( ) = FEAT/POINT,CART,X_P, Y_P, Z_P+STEP_LEN*I, 0,-1,0
MEAS/POINT,F( ),1
PTMEAS/CART,X_P, Y_P, Z_P+STEP_LEN*I,0,-1,0
ENDMES
ENDDO
TEMP_CHAR = PROMPT/TEXT,'请转换测头角度,点击继续'
SNSLCT/S(ROOTSN1_2)
DO/I,1,STEP_NUM
K = ASSIGN/STR(I)
LABEL_P = ASSIGN/CONCAT('S_PT',K)
F( ) = FEAT/POINT,CART,X_P, Y_P, Z_P+STEP_LEN*I, 0,-1,0
MEAS/POINT,F( ),1
PTMEAS/CART,X_P, Y_P, Z_P+STEP_LEN*I,0,-1,0
ENDMES
ENDDO
$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$
$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$
$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$计算部分$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$
DECL/COMMON,DOUBLE,DX_L,DX_R,DL,DH[STEP_NUM],Z_1,Z_2,Y_OFF[STEP_NUM],Y_STAT
DECL/COMMON,CHAR,20,LLL_LABEL,RRR_LABEL
DX_L = OBTAIN/SA(ROOTSN1_1),2
DX_R = OBTAIN/SA(ROOTSN1_2),2
DL = ASSIGN/ABS(DX_L - DX_R)
WRITE/DID(DEFAULTSCREEN),'Z轴的自转补偿'
DO/I,1,STEP_NUM
K = ASSIGN/STR(I)
LLL_LABEL = ASSIGN/CONCAT('F_PT',K)
RRR_LABEL = ASSIGN/CONCAT('S_PT',K)
Z_1 = OBTAIN/FA( ),4
Z_2 = OBTAIN/FA( ),4
DH[I] = ASSIGN/Z_1 - Z_2
Y_OFF[I] = ASSIGN/ DH[I]/(10*DL*0.00000484)
Y_STAT = ASSIGN/X_P + (I-1)*STEP_LEN
WRITE/DID(DEFAULTSCREEN),Y_STAT:2,Y_OFF[I]:20
ENDDO
$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$
$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$$