Шрифт:
После достижения исходного положения мы можем заново запустить программу, записанную в script-файле, исходя из предположения, что ошибка позиционирования во время выполнения каждого цикла будет накапливаться достаточно медленно, что не будет приводить к слишком большим отклонениям положения манипулятора от желаемого. После выполнения script-файла рука выставляется в исходное положение, и цикл работы script-файла повторяется.
В некоторых последовательностях знание только исходного положения оказывается недостаточным, например при поднятии яйца без риска раздавить его скорлупу. В подобных случаях необходима более сложная и точная система позиционной обратной связи. Сигналы с датчиков могут быть обработаны с помощью АЦП. Полученные сигналы могут быть использованы для определения значений таких параметров, как положение, давление, скорость и вращающий момент. В качестве иллюстрации можно привести следующий простой пример. Представьте, что вы прикрепили небольшой линейный переменный резистор к узлу захвата. Переменный резистор установлен таким образом, что перемещение его движка вперед и назад связано с открытием и закрытием захвата. Таким образом, в зависимости от степени открывания захвата меняется сопротивление переменного резистора. После проведения калибровки, с помощью измерения текущего сопротивления переменного резистора можно точно установить угол раскрытия зажимов захвата.
Создание подобной системы обратной связи вводит еще один уровень сложности в устройство и, соответственно, приводит к его удорожанию. Поэтому более простым вариантом является введение системы ручного управления для корректировки положения и движений руки-манипулятора в процессе выполнения script-программы.
Система ручного управления интерфейсом
После того как вы убедитесь, что интерфейс работает правильным образом, вы можете с помощью 8-контактного плоского разъема подключить к нему блок ручного управления. Проверьте положение подключения 8-контактного разъема Molex к головке разъема на плате интерфейса, как показано на рис. 15.10. Аккуратно вставьте разъем до его надежного соединения. После этого рукой-манипулятором можно управлять с ручного пульта в любой момент времени. Не имеет значения, соединен ли интерфейс с компьютером или нет.
Рис. 15.10. Подключение ручного управления
Программа DOS управления с клавиатуры
Имеется DOS программа, позволяющая управлять работой руки-манипулятора с клавиатуры компьютера в интерактивном режиме. Список клавиш, соответствующих выполнению той или иной функции, приведен в таблице.
Голосовое управление рукой-манипулятором
B голосовом управлении рукой-манипулятором используется набор распознавания речи (УРР), который был описан в гл. 7. В этой главе мы изготовим интерфейс, связывающий УРР с рукой-манипулятором. Этот интерфейс также предлагается в виде набора компанией Images SI, Inc.
Схема интерфейса для УРР показана на рис. 15.11. В интерфейсе использован микроконтроллер 16F84. Программа для микроконтроллера выглядит следующим образом:
‘Программа интерфейса УРР
Symbol PortA = 5
Symbol TRISA = 133
Symbol PortB = 6
Symbol TRISB = 134
Poke TRISA, 255
Poke TRISB, 240
Start:
Peek PortB, B0
If bit4 = 0 then trigger ‘Если запись в триггер разрешена, читать схе
му УРР
Goto start ‘Повторение
trigger:
pause 500 ‘Ожидание 0,5 с
Peek PortB, B0 ‘Чтение кода BCD
If bit5 = 1 then send ‘Выходной код
goto start ‘Повторение
send:
peek PortA, b0 ‘Чтение порта А
if bit4 = 1 then eleven ‘Число есть 11?
poke PortB, b0 ‘Выходной код
goto start ‘Повторение
eleven:
if bit0 = 0 then ten
poke portb, 11
goto start ‘Повторение
ten:
poke portb,10
goto start ‘Повторение
end
Рис. 15.11. Схема контроллера УРР для руки-робота
Обновление программы под 16F84 можно бесплатно загрузить из http://www.imagesco.com
Программирование интерфейса УРР
Программирование интерфейса УРР аналогично процедуре программирования УРР из набора, описанного в гл. 7. Для правильной работы руки-манипулятора вы должны запрограммировать командные слова соответственно номерам, соответствующим определенному движению манипулятора. В табл. 15.1 приведены примеры командных слов, управляющих работой руки-манипулятора. Вы можете выбрать командные слова по вашему вкусу.
Список деталей для интерфейса PC
• (5) Транзистор NPN TIP120
• (5) Транзистор PNP TIP 125
• (1) ИС 74164 преобразователь кода
• (1) ИС 74LS373 восемь ключей
• (1) Светодиод красный
• (5) Диод 1N914
• (1) Гнездо разъема Molex на 8 контактов
• (1) Кабель Molex 8-жильный длиной 75 мм
• (1) Двухпозиционный переключатель
• (1) Разъем уголковый типа DB25
• (1) Кабель DB 25 1,8 м с двумя разъемами М – типа.