Programming Example - Siemens SINUMERIK 840D sl Programming Manual

_TNVL
Limit angle, distortion of triangle when calculating kinematics [degrees].
Parameter _TNVL is used to monitor the distortion of the measurement triangle. Suitable
values for parameter _TNVL are 20 to 45 degrees.
If the distortion of the triangle is outside of parameter _TNVL, error 61430 "Calculation of the
kinematics vectors not performed -> Error code: %4" is displayed.

Programming example

_CHBIT[25]=0 _CHBIT[26]=1 _STA1=45 _TNVL=20
...
CYCLE996(...)
5.10.9 Programming example
%_N_HEAD_BC_MPF
;$PATH=/_N_WKS_DIR/_N_ HEAD_BC_WPD
;Measure kinematics
;Starting positions for HEAD_BC (swivel head)
;Calibration ball D = 25mm
;P1...P3 rotary axis 1
;P4...P6 rotary axis 2
;P1,P4 kinematics initial state
DEF REAL _P1[5]=SET(27.5,-184.5,22.5,0,0)
DEF REAL _P2[5]=SET(83,-108,22.5,45,0)
DEF REAL _P3[5]=SET(-65,-200,22.5,-45,0)
DEF REAL _P4[5]=SET(27.5,-184.5,22.5,0,0)
DEF REAL _P5[5]=SET(124,-184.5,-17,0,45)
DEF REAL _P6[5]=SET(-68.8,-184.5,-17,0,-45)
T99 D1
G500
CYCLE800()
TRAFOOF
IF (NOT $P_SEARCH)
_OVR[40]=0
ENDIF
;--------------------- 1. measurement of rotary axis 1
G0 Z100
BB=_P1[3] CC=_P1[4]
X=_P1[0] Y=_P1[1] Z=_P1[2]
_MVAR=10010091 _TNUM=1 _SETVAL=25.000 _FA=3.000 _TSA=6.000 _VMS=500.000 _PRNUM=1
_SETV[3]=0.000 _SETV[4]=0.000
CYCLE996
M0
Measuring cycles
Programming Manual, 03/2009 Edition, 6FC5398-4BP10-2BA0
Measuring Cycles for Milling and Machining Centers
5.10 CYCLE996 workpiece: Measure kinematics
;P1 xyz 1.RA 2.RA
;P2 xyz 1.RA 2.RA
;P3 xyz 1.RA 2.RA
;P4 xyz 1.RA 2.RA
;P5 xyz 1.RA 2.RA
;P6 xyz 1.RA 2.RA
;3D probe
;If no block search
;reset measurement counter to
zero
;Safely retract axis Z
;kinematics initial state
259