Still having some issues. I'm tying to use G61.1 Xxxx Yxxx Zxxx Bxxx Dxxx Rxxx Fxxx
The code is running but the NC is not passing all the variables.
I copied all the passed vales for debugging.
I'm not getting X Y Z D R values.
Here is my code:
//--------------------G61.1----------------
; G61.1
N61100
@SET_ON(VS_GGROUP20_1_M,2)
READ(B,F,X,Y,Z,D,R)
VS_GGROUP9_1_M == 81
; check for X,Z,D,F is passed
;
;IF(Q100 & $2 > 0 AND Q100 & $8 >0 AND Q100 & $20 > 0 AND Q100 & $1000000 > 0 AND Q100 & $800000 > 0 AND Q100 & $2000000 > 0)
Bcalc = B_ARG_Q +90
Btemp = B_ARG_Q
Xtemp = X_ARG_Q
Ytemp = Y_ARG_Q
Ztemp = Z_ARG_Q
Rtemp = R_ARG_Q
Dtemp = D_ARG_Q
X_POS = X_ARG_Q - (SIN(Bcalc) * D_ARG_Q)
Z_POS = Z_ARG_Q - (D_ARG_Q - (COS(Bcalc) * D_ARG_Q))
IF(Q100 & $20000 > 0) ; R word passed a offset is used
P1722 = R_ARG_Q
X_POS = X_POS - ((SIN(Bcalc) * R_ARG_Q))
Z_POS = Z_POS + (COS(Bcalc) * R_ARG_Q)
ENDIF
F(F_ARG_Q)
GOSUB 1000
X(X_POS) Y(Y_POS) Z(Z_POS) B(B_POS)
;ENDIF
@SET_OFF(VS_GGROUP20_1_M,2)
RETURN