Создаем робота-андроида своими руками.

Программа для тестовой схемы управления.

После того как тестовая схема управления изготовлена, необходимо запрограммировать PIC-микроконтроллер с помощью следующей программы на языке BASIC. Программа является очень простой и короткой, чтобы показать, насколько просто обеспечить вращение ШД. В таблице 10.3 показано, как на каждом шаге включается соответствующий транзистор. Используйте таблицу 10.3 для слежения за логикой BASIC программы. Когда вы достигаете до конца таблицы, то последовательность повторяется, начиная с начала.

Таблица 10.3. Логика переключений транзисторов для полного шага.
Таблица 10.3. Логика переключений транзисторов для полного шага. Программа для тестовой схемы управления. Использование микроконтроллера для управления ШД. Глава 10. Передвижные платформы. Джон Ловин. Создаем робота-андроида своими руками.

‘Контроллер шагового двигателя

Symbol TRISB = 134 ‘Инициализировать TRISB как 134

Symbol PortB = 6 ‘Инициализировать PortB как 6

Symbol ti = b6 ‘Инициализировать ti как задержку

ti = 25 ‘Задержка 25 мс

poke TRISB,0 ‘Установить шины PORTB на выход

start: ‘Последовательность движения вперед

poke portb,1 ‘Шаг 1

pause ti ‘Задержка

poke portb,2 ‘Шаг 2

pause ti ‘Задержка

poke portb,4 ‘Шаг 3

pause ti ‘Задержка

poke portb,8 ‘Шаг 4

pause ti ‘Задержка

goto start ‘Повторение

Полный оборот.

При полном шаге для завершения полного оборота ШД требуется 200 импульсов (360° /1,8° на шаг). Подсчет количества импульсов позволяет PIC-микроконтроллеру управлять и позиционировать ротор ШД.