Конфигурация LCNC для простого автомата с MYGUI
Часто возникает необходимость создания конфигурации простого автомата на LinuxCNC. (обсуждение статьи на форуме Создание конфигурации простого автомата от чайника)
Статья написана с актуальной версией linuxcnc 2.6
Содержание
Постановка задачи.
Сконфигурировать простой автомат "Планшетный широкоформатный сканер" на базе LinuxCNC со своей панелью управления и встроенной перепрограммируемой программой обработки заготовки.
Необходимые направления работы:
1. Описание логики работы сканера
2. Создание файла INI
3. Создание визуальной панели
4. Создание связей между HAL, визуальной панелью и программами/подпрограммами
5. Создание HAL
6. Написание программы сканирования
7. Способы проверки и тестирования конфигурации
В задачу данной темы не входят вопросы конструкции, электроники, программ обработки графической информации!
Логика работы автомата
1. Включение автомата и начальные установки:
- при включении автомата загружается визуальная панель, программа сканирования;
- перевести автомат в рабочий режим нажатием кнопки "ВКЛ" визуальной панели, проверка состояния E-STOP, концевых датчиков (если сработал один из датчиков крайнего положения - автомат выходит из крайнего положения самостоятельно; если сработали сразу два противоположных датчика положения - авария)
2. Вывести сканирующую головку в начальную точку сканирования, пользуясь соответствующими кнопками визуальной панели и задать начальную точку сканирования нажатием кнопки "Уст-ка нуля" визуальной панели.
3. Вывести сканирующую головку в крайнюю точку сканирования и задать крайние координаты сканирования нажатием кнопки "Уст-ка MAX".
4. Установить необходимое фокусное расстояние вручную.
5. Установить необходимое разрешение сканирования выбором соответствующего режима сканирования кнопками визуальной панели.
6. Включить лампу освещения зоны сканирования нажатием соответствующей кнопки визуальной панели.
7. Запустить процесс сканирования нажатием кнопки "ПУСК" визуальной панели.
8. После работы выключить автомат нажатием кнопки "ВЫКЛ" визуальной панели.
INI-файл
Так как установка фокусного расстояния осуществляется вручную, то мы должны сконфигурировать двухкоординатный автомат.
Итак, файл skaner.ini :
[EMC] MACHINE = skaner DEBUG = 0 [DISPLAY] DISPLAY = mygui
... говорит о том, что мы будем использовать собственную визуальную панель для управления автоматом.
Если хотим положить файл в саму папку с конфигурацией, то строка должна выглядеть так:
DISPLAY = ./mygui
Далее:
POSITION_OFFSET = RELATIVE POSITION_FEEDBACK = ACTUAL MAX_FEED_OVERRIDE = 1.2 PROGRAM_PREFIX = /home/sun/linuxcnc/configs/skaner
(указали адрес, по которому находятся исполняемые файлы и программы)
OPEN_FILE = /home/sun/linuxcnc/configs/skaner/skan1.ngc
(указали адрес и имя загружаемой по умолчанию программы сканирования)
[FILTER] PROGRAM_EXTENSION = .png,.gif,.jpg Greyscale Depth Image PROGRAM_EXTENSION = .py Python Script png = image-to-gcode gif = image-to-gcode jpg = image-to-gcode py = python [TASK] TASK = milltask CYCLE_TIME = 0.005 [RS274NGC] PARAMETER_FILE = emc.var [EMCMOT] EMCMOT = motmod COMM_TIMEOUT = 1.0 COMM_WAIT = 0.010 BASE_PERIOD = 50000 SERVO_PERIOD = 1000000 [HAL] HALFILE = skaner.hal HALUI = halui [HALUI] [TRAJ] AXES = 2 COORDINATES = X Y MAX_ANGULAR_VELOCITY = 0.10 DEFAULT_ANGULAR_VELOCITY = 0.01 LINEAR_UNITS = mm ANGULAR_UNITS = degree CYCLE_TIME = 0.010 DEFAULT_VELOCITY = 50.00 MAX_LINEAR_VELOCITY = 200.00 NO_FORCE_HOMING = 1
(последняя строка отменяет поиск датчиков ДОМ при включении станка)
[EMCIO] EMCIO = io CYCLE_TIME = 0.100 TOOL_TABLE = tool.tbl [AXIS_0] TYPE = LINEAR MAX_VELOCITY = 250.0 MAX_ACCELERATION = 600.0 STEPGEN_MAXACCEL = 650.0 SCALE = 67.86 FERROR = 1 MIN_FERROR = 0.25 [AXIS_1] TYPE = LINEAR MAX_VELOCITY = 150.0 MAX_ACCELERATION = 200.0 STEPGEN_MAXACCEL = 250.0 SCALE = 67.86 FERROR = 1 MIN_FERROR = 0.25
(тут нет ничего особенного - просто следуй LinuxCNC Integrators Manual Глава IV - Файл INI )
Визуальная панель
Из раздела "Логика работы автомата" ясен состав кнопок визуальной панели:
Кнопки без фиксации: ВКЛ, СТОП, ВЫКЛ, Уст-ка нуля, Уст-ка MAX, Кнопки движения по координатам (4 штуки).
Кнопки с фиксацией: Три кнопки режима сканирования, кнопка включения освещения зоны сканирования.
Для удобства управления автоматом и загрузки сканируемых объектов можно добавить четыре кнопки без фиксации для перемещения автомата в крайние положения.
Нарисуем панель в Glade, используя, по возможности, элементы HAL Python . Получилась вот такая панель:
Таблица соответствия названия кнопок и их имен:
ВКЛ - hal_button1 СТОП - hal_button2 ВЫКЛ - hal_button3 Уст-ка нуля - hal_button4 Уст-ка MAX - hal_button5 назад до конца - hal_button6 ^ - назад - hal_button7 влево до конца - hal_button8 < - влево - hal_button9 > - направо - hal_button10 направо до конца - hal_button11 v - вперед - hal_button12 вперед до конца - hal_button13 ПУСК - hal_button14 Режим 1 - hal_togglebutton1 Режим 2 - hal_togglebutton2 Режим 3 - hal_togglebutton3 Освещение - hal_togglebutton4
(по мере необходимости будем убирать или добавлять элементы визуальной панели)
HAL-файл
Файл skaner.hal в первой своей части ничего уникального не представляет - обычный набор необходимых конструкций и нужные пины LPT-порта.
(для совсем "молодых" чпу-шников посоветую сначала почитать LinuxCNC для чайников )
Во второй части файла skaner.hal пропишем следующие функции:
Движение по осям X и Y от кнопок визуальной панели;
Начальная блокировка сигналов от датчиков положения;
Анализатор состояний датчиков автомата.
Движение по осям X и Y от кнопок визуальной панели
Рассмотрим движение по оси X (вправо-влево). Движение по оси Y выполнено аналогично.
Имеем:
кнопки визуальной панели: Влево до конца, Влево, Вправо, Вправо до конца;
датчики: левый край, правый край.
Управление движением будем осуществлять через halui.jog.0.analog
halui.jog.<n>.analog (float, in) - ввод для аналогового задания скорости ручного перемещения (полезно при использовании джойстиков или других аналоговых устройств)
Также следует заметить, что кнопки перемещений нужно блокировать при выполнении сканирования.
Блок схема движения по оси X:
Движение по оси намеренно выполнено с плавным (линейным) нарастание скорости для того, чтобы можно было более точно подвести сканирующую головку к точкам начала и конца сканирования.
Параметры движения должны быть изменены для конкретной конструкции автомата. На схеме вывод mux8.in2 - скорость движения в крайнее левое положение (в данном примере = 25), выводы mux8.in4...7 - скорость выхода из зоны датчика крайнего левого положения (в данном примере = -25), вывод mux4.in1 скорость движения в крайнее правое положение (в данном примере = -25), выводы mux4.in2 и mux4.in3 - скорость выхода из зоны датчика крайнего правого положения (в данном примере = 25).
Начальная блокировка сигналов от датчиков положения
Если при включении конфигурации LinuxCNC один из датчиков уже будет включен, то реакции на этот датчик возможно и не последует (по наблюдениям реальной конфигурации широкоформатного планшетного принтера). Поэтому во избежание таких ситуаций в конфигурацию введена схема начальной блокировки входных сигналов. Её задача: задержать подключение входных датчиков крайних положений на одну секунду после включения автомата.
Для этого был написан пользовательский компонент enrun (файл enrun.py)
#!/usr/bin/python
import hal
h=hal.component("enrun")
h.newpin("in1", hal.HAL_BIT, hal.HAL_IN)
h.newpin("in2", hal.HAL_BIT, hal.HAL_IN)
h.newpin("in3", hal.HAL_BIT, hal.HAL_IN)
h.newpin("in4", hal.HAL_BIT, hal.HAL_IN)
h.newpin("out1", hal.HAL_BIT, hal.HAL_OUT)
h.newpin("out2", hal.HAL_BIT, hal.HAL_OUT)
h.newpin("out3", hal.HAL_BIT, hal.HAL_OUT)
h.newpin("out4", hal.HAL_BIT, hal.HAL_OUT)
h.newpin("enable", hal.HAL_BIT, hal.HAL_IN)
h.ready()
try:
while 1:
if h['enable']==0:
h['out1']=0
h['out2']=0
h['out3']=0
h['out4']=0
else:
h['out1']=h['in1']
h['out2']=h['in2']
h['out3']=h['in3']
h['out4']=h['in4']
except KeyboardInterrupt:
raise SystemExit
Схема блокировки входных датчиков:
Осталось добавить, что необходимо обязательно прописать в файле skaner.hal следующую процедуру:
loadusr -Wn enrun python enrun.py
, а сам файл enrun.py положить в папку с конфигурацией автомата.
Анализатор состояний датчиков автомата
Нельзя обойти вниманием ситуацию возникновения непредсказуемых ситуаций при неисправности входных датчиков либо при обрыве сигнальных цепей или целей питания датчиков.
Это может проявиться в ситуации, когда мы получаем одновременно два сигнала: либо Датчик ЛЕВЫЙ КРАЙ и Датчик ПРАВЫЙ КРАЙ, либо Датчик БЛИЖНИЙ КРАЙ и Датчик ДАЛЬНИЙ КРАЙ.
В этих ситуациях нужно блокировать движение автомата до устранения неисправности. О неисправности необходимо оповестить оператора либо индикатором, либо звуковым сигналом, либо и тем, и другим.
Подобная схема не представляет особого интереса, потому не приводится.
Связи между HAL, визуальной панелью и программами/подпрограммами
Сначала свяжем кнопки визуальной панели.
ВКЛ - hal_button1 - halui.machine.on СТОП - hal_button2 - halui.estop.activate ПУСК - hal_button14 - halui.program.run
- тут всем, обратившимся к описанию HAL, всё должно быть понятно.
Нажал на кнопку ВКЛ - послали сигнал на пин halui.machine.on для запроса включения станка.
Нажал на кнопку СТОП - сигнал на пин halui.estop.activate для запроса E-Stop.
Кнопки управления движением мы рассмотрели выше. Их связываем с соответствующими пинами компонентов реального времени HAL.
Освещение - hal_togglebutton4 - parport.0.pin-14-out
Так мы связали кнопку с фиксацией с пином LP-порта, отвечающего за включение освещения (конечно в нашем случае).
Кнопка ВЫКЛ должна при нажатии вызывать процедуру выключения компьютера автомата.
Сделаем это при помощи mdi-команды:
ВЫКЛ - hal_button3 - halui.mdi-command-00
Как подготовить конфигурацию к использованию MDI-команды написано в Организация MyGUI
Сама М-программа (мы будем использовать М102) такого содержания:
#!/bin/sh sudo shutdown -h now
Уст-ка нуля - hal_button4 - halui.mdi-command-01
При нажатии этой кнопки нам нужно присвоить переменным #123 и #124 значения начальных координат по осям X и Y в момент нажатия. Сделаем это при помощи подпрограммы, вызываемой mdi-командой.
Аналогично, сделаем и для кнопки Уст-ка MAX. Только при нажатии будем присваивать значение координат осей соответственно переменным #125 и #126.
Уст-ка MAX - hal_button5 - halui.mdi-command-02
Для этого дополним раздел [HALUI] файла skaner.ini двумя строками:
[HALUI] MDI_COMMAND = M102 MDI_COMMAND = o<ust0>call MDI_COMMAND = o<ustmax>call
В папку, указанную в файле skaner.ini
[DISPLAY] PROGRAM_PREFIX = /home/sun/linuxcnc/configs/skaner
поместим файлы подпрограмм ust0.ngc и ustmax.ngc с таким содержанием: Файл ust0.ngc:
o<ust0> sub M66 E0 L0 #123 = #5399 M66 E1 L0 #124 = #5399 o<ust0> endsub
Файл ustmax.ngc:
o<ustmax> sub M66 E0 L0 #125 = #5399 M66 E1 L0 #126 = #5399 o<ustmax> endsub
Таким образом введенные переменные используются для хранения координат
#123 - X0 #124 - Y0 #125 - Xmax #126 - Ymax
Возникает вопрос:
Откуда берутся значения координат?
Значения координат мы можем взять с halui.axis.0.pos-commanded для X и с halui.axis.1.pos-commanded для Y
Но ведь в подпрограммах ust0.ngc и ustmax.ngc прописан опрос motion.analog-in-00 и motion.analog-in-01
Пропишем в skaner.hal следующие связи:
net x-pol halui.axis.0.pos-commanded motion.analog-in-00 net x-pol halui.axis.1.pos-commanded motion.analog-in-01
Теперь мы действительно присваиваем переменным координаты положения по осям в момент нажатия соответствующих кнопок.
Кнопки режимов пока оставим в покое - они будут опрашиваться графической программой и использоваться при формировании выходного графического файла...
Режим 1 - hal_togglebutton1 Режим 2 - hal_togglebutton2 Режим 3 - hal_togglebutton3
Все эти связи прописываются в файле mode.hal:
net on mygui.hal_button1 halui.machine.on net stop mygui.hal_button2 halui.estop.activate net mdi1 mygui.hal_button3 halui.mdi-command-00 net mdi2 mygui.hal_button4 halui.mdi-command-01 net mdi3 mygui.hal_button5 halui.mdi-command-02 net godk mygui.hal_button6 net go mygui.hal_button7 net levdk mygui.hal_button8 net lev mygui.hal_button9 net prav mygui.hal_button10 net pravdk mygui.hal_button11 net zad mygui.hal_button12 net zaddk mygui.hal_button13 net start mygui.hal_button14 halui.program.run net dpi1 mygui.hal_togglebutton1 net dpi2 mygui.hal_togglebutton2 net dpi3 mygui.hal_togglebutton3 net osv mygui.hal_togglebutton4 parport.0.pin-14-out
Осталось заметить, что связи файла mode.hal соотвествуют связям файла skaner.hal
Т.е. строку
net osv mygui.hal_togglebutton4 parport.0.pin-14-out
можно было прописать (и чаще всего так и делают) так:
в файле mode.hal прописывают только:
net osv mygui.hal_togglebutton4
, а в файле skaner.hal :
net osv parport.0.pin-14-out
Тут видно, что пин mygui.hal_togglebutton связан с пином parport.0.pin-14-out посредством связи osv
Теперь можно перейти к основной программе - программе сканирования.
Программа работы автомата
Алгоритм работы сканера
1. По команде ПУСК переместить сканерную головку в начальную точку с координатами X#<_X0> Y#<_Y0> .
Снять пин КОНЕЦ СКАНИРОВАНИЯ, по снятию которого запускается графическая программа.
2. Выставить пин СНИМОК для графической программы.
Ожидание пина СНИМОК СДЕЛАН от графической программы.
Снять пин СНИМОК
3. Переместиться во вторую точку строки сканирования (шаг по X - #<STEP_X> ) и т.д. до конца строки сканирования (координата >= X#<_X_MAX> Y#<_Y0> ).
4. Выставить пин СТРОКА для графической программы.
Ожидание пина СТРОКА ЗАВЕРШЕНА от графической программы.
Снять пин СТРОКА.
5. Переместиться в начало второй строки (шаг по Y - #<STEP_Y> ) и т.п. до конца последней строки (координата >= X#<_X_MAX> Y#<_Y_MAX> ).
6. Выставить пин КОНЕЦ СКАНИРОВАНИЯ.
Ожидание пина ИЗОБРАЖЕНИЕ СФОРМИРОВАНО.
7. Окончание программы.
Для реализации программы будем использовать два вложенных цикла. Также будем использовать М-команды для установки и опроса пинов (сигналов) связи программы сканирования с графической программой:
пин СНИМОК - motion.digital-out-00 пин СТРОКА - motion.digital-out-01 пин КОНЕЦ СКАНИРОВАНИЯ - motion.digital-out-02
(эти пины устанавливаются и снимаются программой сканирования skan.ngc по M62...65);
пин СНИМОК СДЕЛАН - motion.digital-in-00 пин СТРОКА ЗАВЕРШЕНА - motion.digital-in-01 пин ИЗОБРАЖЕНИЕ СФОРМИРОВАНО - motion.digital-in-02
(эти пины устанавливает графическая программа и опрашиваются программой skan.ngc по М66).
Программа skan.ngc
G21
(все размеры в милиметрах)
#<Current_X> = #123 #<Current_Y> = #124 #<Step_X> = 100 #<Step_Y> = 70
(присваиваем значения переменным)
M65 P2
(снимаем сигнал КОНЕЦ СКАНИРОВАНИЯ)
G0 X#<Current_X> Y#<Current_Y> O100 repeat [[[#126 - #124] / #<Step_Y>] + 1]
(организуем первый цикл по строкам, высчитывая количество полных шагов плюс 1)
#<Current_X> = #123
(возвращаем значение переменной X в начальное значение)
o101 repeat [[[#124 - #123] / #<Step_X>] + 1]
(организуем внутренний цикл по X для движения по строке)
G0 X#<Current_X> Y#<Current_Y>
(перемещаемся в точку для снимка)
M64 P0
(устанавливаем пин СНИМОК)
M66 P0 L3 Q1
(опрос пина СНИМОК СДЕЛАН в пределах 1 сек для тестирования без графической программы)
M65 P0
(снимаем пин СНИМОК)
#<Current_X> = [#<Current_X> + #<Step_X>]
(делаем шаг по X)
o101 end repeat
(закончили цикл по X)
M64 P1
(устанавливаем СТРОКА)
M66 P1 L3 Q1
(опрос СТРОКА ЗАВЕРШЕНА в пределах 1 сек для тестирования)
M65 P1
(снимаем СТРОКА)
#<Current_Y> = [#<Current_Y> + #<Step_Y>] o100 end repeat
(закончили цикл по строкам)
M64 P2
(устанавливаем КОНЕЦ СКАНИРОВАНИЯ)
M66 P2 L3 Q1
(опрос ИЗОБРАЖЕНИЕ СФОРМИРОВАНО в пределах 1 сек для тестирования)
G0 X#123 Y#124
(вышли в начальную точку сканирования)
M2
(программа выполнена и остановлена)
Диалог с графической программой сделан при помощи M66 с параметром Pxx L3 Q1, которая ждет появления на motion.digital-in-xx появления высокого уровня 1 секунду для тестирования без графической програмы. Если высокий уровень уже есть, то команда выполняется, т.е. мы переходим к следующей команде программы.
А начальные значения переменных #123, #124, #125 и #126 пропишем в файле emc.var
123 0.000000 124 0.000000 125 0.000000 126 0.000000 ...
Также пропишем в файле skaner.ini
[RS274NGC] PARAMETR_FILE = emc.var
Теперь значения переменных будут определены при начальной загрузке и сохраняться при выключении автомата.
