( Procedure for Moving to Parking position )
( Parking number is placed in #100 )
( Destination point is placed in Parameters: )
( #5541...#5546 - Parking 1 )
( #5551...#5556 - Parking 2 )
( #5561...#5566 - Parking 3 )
( #5571...#5576 - Parking 4 )
( #5581...#5586 - Parking 5 )
( #5591...#5596 - Parking 6 )

( Parameter 101 (#101) contains axis configuration )
( XY    -  #101=1)
( XYZ   -  #101=2  move up; goto xy;)
( XYZ   -  #101=3  move up; goto parking xy; goto parking z)


( #5431...#5436 - Working Area in Machine coordinates )

if [ #101 le 2 ] GOTO 50    (XY configuration, no needs to move tool up )

( move tool up to safe position)
G53 G90 G0 Z [ #5433 - 0.5 ]

N50

( move to toolpath XY position )
#100 = [ #100 -1 ] *10 + 5540
G53 G90 G0 X #[#100+1] Y#[#100+2] ( F2000 )


if [ #101 le 3 ] GOTO 70    (XY configuration, no needs to move tool up )

( move down to toolpath Z position )
G53 G90 G0 Z #[#100+3] F200

N70

( debug [#100+1] )
( debug #[#100+1] )

( reset unused axes to zero machine & work coordinates )
( G90 G10 L70 P0 A0 B0 C0 )
( G90 G10 L70 P1 A0 B0 C0 )




