*-----Save the first origin data for later use
IF_SET (FirstOriginChange _EQ_ YES )
XfirstOrigin = X_ORIGIN ;
YfirstOrigin = Y_ORIGIN ;
ZfirstOrigin = Z_ORIGIN ;
FirstOriginChange = NO ;
END_IF ;
*.....distance between the rotation center and the ORIGIN
TRANS_MATX = X_ORIGIN - XfirstOrigin - X_MACH ;
TRANS_MATY = Y_ORIGIN - YfirstOrigin - Y_MACH ;
TRANS_MATZ = Z_ORIGIN - ZfirstOrigin - Z_MACH ;
*.....check for change in orientation ( 4,5 axis positioining )
FlagError = NO ;
Flagrotmac = no ;