编了个矩形平面加工小程序,请朋友指教

谢池春

编了个矩形平面加工小程序,请朋友指教
;释意：SHANGMIAN=加工前工件上面最高点坐标(应去除)
;XIAMIAN=加工后工件上面坐标(加工所得)
工件坐标系原点在矩形左下角
PROC PINGMIAN(REAL CHANG,REAL KUAN,REAL FANHUI,REAL ANJU_Y,REAL ANJU_Z,REAL SHANGMIAN,REAL XIAMIAN,REAL YULIANG，REAL CHISHEN,REAL CHIKUAN,REAL JINGEI_SHEN,REAL JINGEI_PING,REAL YICHUZ,REAL YICHUY,REAL YI_X,REAL YI_Y,REAL ZHUANJIAO)
DEF REAL QUCHU
DEF INT DAOSHU_SHEN
DEF INT DAOSHU_PING
DEF REAL QIDAO_X
DEF REAL ZHUDAO_X
DEF REAL T_R
DEF REAL KUAN_
DEF INT JISHU_SHEN,JISHU_PING
DEF FRAME FRA_
DEF INT _G6,_G14,_G15,_G10
DEF REAL ZHONG
IF $P_S==0 GOTOF AL1
IF $P_TOOL==0 GOTOF AL2
;-----------------------------------------------------
T_R=$TC_DP6[$P_TOOLNO,$P_TOOL]
;------------------------------------------------------
CHANG=ABS(CHANG)
KUAN=ABS(KUAN)
FANHUI=ABS(FANHUI)
ANJU_Y=ABS(ANJU_Y)
ANJU_Z=ABS(ANJU_Z)
YULIANG=ABS(YULIANG)
CHISHEN=ABS(CHISHEN)
CHIKUAN=ABS(CHIKUAN)
YICHUZ=ABS(YICHUZ)
YICHUY=ABS(YICHUY)
STOPRE
;------------------------------------------------------
QUCHU=SHANGMIAN-XIAMIAN-YULIANG
IF (SHANGMIAN-XIAMIAN)1 GOTOF AL4
;-----------------------------------------------------
_G10=$P_GG[10]
_G14=$P_GG[14]
_G15=$PGG[15]
FRA_=$P_PFRAME
;-----------------------------------------------------
G64
G90 G94
$P_PFRAME=FRA_:CTRANS(X,YI_X,Y,YI_Y):CROT(Z,ZHUANJIAO)
;-----------------------------------------------------
STOPRE
FOR JISHU_SHEN=1 TO DAOSHU_SHEN
G0 Z=SHANGMIAN+FANHUI-CHISHEN*(JISHU_SHEN-1)
X=QIDAO_X Y=-ANJU_Y-T_R
Z=SHANGMIAN+ANJU_Z-CHISHEN*(JISHU_SHEN-1)
G1 F=JINGEI_SHEN Z=SHANGMIAN-CHISHEN*JISHU_SHEN
FOR JISHU_PING=1 TO DAOSHU_PING
F=JINGEI_PING Y=JISHU_PING*CHIKUAN-ANJu_Y-T_R
IF $AA_IW[AX1]<ZHONG
X=ZHUDAO_X
ELSE
X=QIDAO_X
ENDIF
ENDFOR
ENDFOR
G0 Z=SHANGMIAN+FANHUI
STOPRE
;----------------------------------------------------
G[10]=_G10
G[14]=_G14
G[15]=_G15
$P_PFRAME=FRA_
STOPRE
M17
AL1:MSG("S=0!")
M0
M17
AL2:MSG("D CUO WU")
M0
M17
AL3:MSG("SHU JU CUO WU")
M0
M17
AL4:MSG("XUAN ZE G17")
M0
M17

谢池春

西门子840D系统