Remap M6 with subroutines - help needed to sort out errors

o<tool_change> sub

M73 (auto-restore modal settings on return)

(MSG, Tool_change: loaded tool=#<_current_tool> current pocket: #<_current_pocket>;)
(MSG, Tool_change: selected tool=#<_selected_tool> selected pocket: #<_selected_pocket>;)

M64 P01 (raise spindle2 up)
G04 P01
M65 P01
M64 P02 (lower spindle1 down in case it is not down)
G04 P01
M65 P02
M66 P02 L3 (make sure that spindle1 is down)

M66 P10 L3 (make sure that all slots are down)

M64 P03 (open the cover of tool slots)
G04 P0.5
M65 P03
M66 P03 L3 (make sure that the cover is open)


(unload previous tool)
o100 if [#<_current_pocket> = 1]
M66 P05 L0 (check, if slot1 is empty)
o101 if [#5399 = 0]
o<tool1_out> call
o101 else (MSG, Pocket 1 is not empty)
o101 endif

o100 elif [#<_current_pocket> = 2]
M66 P06 L0 (check, if slot2 is empty)
o102 if [#5399 = 0]
o<tool2_out> call
o102 else (MSG, Pocket 2 is not empty)
o102 endif

o100 elif [#<_current_pocket> = 3]
M66 P07 L0 (check, if slot3 is empty)
o103 if [#5399 = 0]
o<tool3_out> call
o103 else (MSG, Pocket 3 is not empty)
o103 endif

o100 elif [#<_current_pocket> = 4]
M66 P08 L0 (check, if slot4 is empty)
o104 if [#5399 = 0]
o<tool4_out> call
o104 else (MSG, Pocket 4 is not empty)
o104 endif

o100 elif [#<_current_pocket> = 5]
M66 P09 L0 (check, if slot3 is empty)
o105 if [#5399 = 0]
o<tool5_out> call
o105 else (MSG, Pocket 3 is not empty)
o105 endif

o100 endif

(go to new tool)
o200 if [#<_selected_pocket> = 1]
M66 P14 L0 (check, if spindle1 is empty)
o201 if [#5399 = 0]
o<tool1_in> call
o201 else (MSG, Spindle is not empty)
o201 endif

o200 elif [#<_selected_pocket> = 2]
M66 P14 L0 (check, if spindle1 is empty)
o202 if [#5399 = 0]
o<tool2_in> call
o202 else (MSG, Spindle is not empty)
o202 endif

o200 elif [#<_selected_pocket> = 3]
M66 P14 L0 (check, if spindle1 is empty)
o203 if [#5399 = 0]
o<tool3_in> call
o203 else (MSG, Spindle is not empty)
o203 endif

o200 elif [#<_selected_pocket> = 4]
M66 P14 L0 (check, if spindle1 is empty)
o204 if [#5399 = 0]
o<tool4_in> call
o204 else (MSG, Spindle is not empty)
o204 endif

o200 elif [#<_selected_pocket> = 5]
M66 P14 L0 (check, if spindle1 is empty)
o205 if [#5399 = 0]
o<tool5_in> call
o205 else (MSG, Spindle is not empty)
o205 endif

o200 endif

M66 P10 L3 (make sure all slots are down before closing the cover)
M64 P04 (close the cover)
G04 P0.5
M65 P05
M66 P04 (make sure that cover is closed)

o<tool_change> endsub
M2

Near line 0 of /usr/share/axis/images/axis.ngc:
Zero timeout with wait type != immediate return

Near line 0 of /usr/share/axis/images/axis.ngc:
Unknown operation

o100 if [#5220 = 1]
o<tool1_out> call
endif