(Store Current Machine Position - into given Parking Position registers)
(#100 - number of Parking point)
(#5021...#5026 Current Machine position registers)
(#5541...#5546 Parking 1 Postion registers)
(#5551...#5556 Parking 2 Postion registers)
(#5561...#5566 Parking 3 Postion registers)
(#5571...#5576 Parking 4 Postion registers)


IF [ #100 NE 1 ] 20
G10 L81 P5541 Q5021 (store current position X in #5541)
G10 L81 P5542 Q5022 (store current position Y in #5542)
G10 L81 P5543 Q5023 (store current position Z in #5543)
G10 L81 P5544 Q5024 (store current position A in #5544)
G10 L81 P5545 Q5025 (store current position B in #5545)
G10 L81 P5546 Q5026 (store current position C in #5546)
JUMP 100
N20

IF [ #100 NE 2 ] 40
G10 L81 P5551 Q5021 (store current position X in #5551)
G10 L81 P5552 Q5022 (store current position Y in #5552)
G10 L81 P5553 Q5023 (store current position Z in #5553)
G10 L81 P5554 Q5024 (store current position A in #5554)
G10 L81 P5555 Q5025 (store current position B in #5554)
G10 L81 P5556 Q5026 (store current position C in #5554)
JUMP 100
N40

IF [ #100 NE 3 ] 60
G10 L81 P5561 Q5021 (store current position X in #5561)
G10 L81 P5562 Q5022 (store current position Y in #5562)
G10 L81 P5563 Q5023 (store current position Z in #5563)
G10 L81 P5564 Q5024 (store current position A in #5564)
G10 L81 P5565 Q5025 (store current position B in #5565)
G10 L81 P5566 Q5026 (store current position C in #5566)
JUMP 100
N60

IF [ #100 NE 4 ] 80
G10 L81 P5571 Q5021 (store current position X in #5571)
G10 L81 P5572 Q5022 (store current position Y in #5572)
G10 L81 P5573 Q5023 (store current position Z in #5576)
G10 L81 P5574 Q5024 (store current position A in #5574)
G10 L81 P5575 Q5025 (store current position B in #5575)
G10 L81 P5576 Q5026 (store current position C in #5576)
JUMP 100
N80

N100
M02


