Робототехника для школы. Часть 2
В предыдущих частях:
Часть 1 — конструкция манипуляционного робота
Программа управления для манипуляционного робота
В предыдущей статье мы собрали манипуляционного робота, который предназначен для выполнения тяжелой и монотонной работы — переворачивания бочек с клубничным джемом. А теперь давайте составим программу, которая будет управлять нашим роботом. Для разработки управляющей программы будем использовать программное обеспечение ROBO Pro.
ROBO Pro – это инструментарий для разработки управляющих программ для программируемых контроллеров ROBO TX, которые используются в конструкторских наборах fischertechnik для управления движением роботов.
Визуальный язык программирования, входящий в состав ROBO Pro, позволяет писать простые программы школьникам и начинающим энтузиастам. Режим симуляции облегчает тестирование и отладку, если по каким-либо причинам использовать настоящего робота нельзя.
Готовые управляющие программы можно загрузить во FLASH- или RAM-память контроллеров через интерфейс USB или Bluetooth. Поддерживаются два типа контроллеров — ROBO TX и ROBO INTERFACE. Более подробную информацию о контроллере ROBO TX можно получить из обзорной статьи в нашем блоге.
Описание программы
На рис. 1 представлена главная программа управления (Main program). Она состоит из нескольких подпрограмм, каждая из которых отвечает за определенное движение манипулятора.
После запуска главной программы управление переходит в подпрограмму M2-open (рис. 2), которая отвечает за максимальное раскрытие губок захватного устройства манипулятора. В подпрограмме осуществляется запуск двигателя M2, а также инициируется проверка сигнала с концевого датчика S3. Как только сигнал с датчика перестаёт поступать на контроллер, вызывается команда к останову двигателя M2. Подпрограмма M2-open завершает своё выполнение, и передаёт управление главной программе. Читать дальше→