Code:
O<sys.matheight_abs> sub
G17 G21 G40 G49 G90 G92.1 G94
(-------------------------------------------------------------------------)
(Linuxcnc не любит, когда вызывается код g5x переключающий на УЖЕ активную координатную систеу)
O<matheight_if110> if [#5220 EQ 1]
(DEBUG, исходная система G54 )
G59.3
O<matheight_if110> endif
(Совмещение по Z первой системы координат с машинной и переход в неё)
G10 L2 P1 Z0
G54
(-------------------------------------------------------------------------)
(Если для замера используется специальный инструмет, то делается проверка того что он выбран)
(O<matheight_120> if [ #<_current_tool> NE #<_ini[MATERIAL_HEIGHT_PROBE]SENSOR_TOOL_NUM>])
(D EBUG,Incorect tool, plase insert tool correct number T = [MATERIAL_HEIGHT_PROBE]SENSOR_TOOL_NUM)
(G54)
(M02)
(O<matheight_120> endif)
(-------------------------------------------------------------------------)
(DEBUG,Грубый поиск на "большой скорости")
F[#<_ini[MATERIAL_HEIGHT_PROBE]COARSE_FEED_SEARCH>]
G38.2 Z[#<_ini[AXIS_2]MIN_LIMIT>]
#<probe_bottom> = #5063
G38.4 Z[#<_ini[AXIS_2]MAX_LIMIT>]
#<probe_top> = #5063
(DEBUG,<c.probe_top> = #<probe_top> )
(DEBUG,<c.probe_bottom> = #<probe_bottom>)
#<probe_result> = [[#<probe_bottom>+#<probe_top>]/2]
(DEBUG,<c.probe_result> = #<probe_result>)
(-------------------------------------------------------------------------)
(DEBUG,Точный поиск на маленькой скорости)
F[#<_ini[MATERIAL_HEIGHT_PROBE]ACCURATE_FEED_SEARCH>]
G38.2 Z[#<_ini[AXIS_2]MIN_LIMIT>]
#<probe_bottom> = #5063
F[#<_ini[MATERIAL_HEIGHT_PROBE]ACCURATE_FEED_LATCH>]
G38.4 Z[#<_ini[AXIS_2]MAX_LIMIT>]
#<probe_top> = #5063
(DEBUG,<a.probe_top> = #<probe_top> )
(DEBUG,<a.probe_bottom> = #<probe_bottom>)
#<probe_result> = [[#<probe_bottom>+#<probe_top>]/2]
(DEBUG,<a.probe_result> = #<probe_result>)
(-------------------------------------------------------------------------)
(Пока находимся в машинной системе координат поднимаемся на самый верх)
G0 Z[#<_ini[AXIS_2]MAX_LIMIT>]
(-------------------------------------------------------------------------)
(Временный выход из G54 перед выполнением её настройки)
G59.3
(-------------------------------------------------------------------------)
(DEBUG,Вычитание из результата толщины инструмента)
#<coord_offset_z> = [#<probe_result> - #<_ini[MATERIAL_HEIGHT_PROBE]SENSOR_HEIGHT>]
(DEBUG,<_ini[MATERIAL_HEIGHT_PROBE]SENSOR_HEIGHT> = #<_ini[MATERIAL_HEIGHT_PROBE]SENSOR_HEIGHT>)
(DEBUG,<coord_offset_z> = #<coord_offset_z>)
(-------------------------------------------------------------------------)
(DEBUGE,Присвоение соответствующего офсета G54)
G10 L2 P1 Z[#<coord_offset_z>]
(-------------------------------------------------------------------------)
(возвращение в систему G54)
G54
(-------------------------------------------------------------------------)
(Опускание к ближайшему целому значению для удобства ручной корректировки результата)
G0 Z[FIX[#<_z>]]
O<sys.matheight_abs> endsub
M02
ini
