Программа PICBASIC

Программа PICBASIC

‘Шестиногий шагающий робот

‘Соединения

‘Левый сервомотор Pin RB1

‘Правый сервомотор Pin RB2

‘Сервомотор наклона Pin RB0

‘Движение только вперед

start:

for B0 = 1 to 60

pulsout 0, 155 ‘Наклон по часовой стрелке, подъем правой стороны

pulsout 1, 145 ‘Левые ноги на месте

pulsout 2, 145 ‘Правые ноги движутся вперед

pause 18

next B0

for B0 = 1 to 60

pulsout 0, 190 ‘Наклон против часовой стрелки, подъем левой стороны

pulsout 1, 200 ‘Левые ноги движутся вперед

pulsout 2, 145 ‘Правые ноги сохраняют положение вперед

pause 18

next B0

for B0 = 1 to 15

pulsout 0, 172 ‘Среднее положение, отсутствие наклона

pulsout 1, 200 ‘Левые ноги сохраняют положение вперед

pulsout 2,145 ‘Правые ноги сохраняют положение вперед

pause 18

next B0

for B0 = 1 to 60

pulsout 0, 172 ‘Среднее положение, отсутствие наклона

pulsout 1, 145 ‘Движение левых ног назад

pulsout 2, 200 ‘Движение правых ног назад

pause 18

next B0

goto start

На команду pulsout не все сервомоторы реагируют одинаковым образом. Возможно, что для создания робота вы приобретете сервомоторы, характеристики которых будут слегка отличаться от тех, которые были использованы мной. В этом случае обратите внимание на то, что параметры команды pulsout, которая определяет положение ротора сервомотора, должны быть подстроены. В этом случае необходимо подобрать численные значения параметров pulsout, которые бы соответствовали тому типу сервомотора, который использован в вашей конструкции шестиногого робота.

Данная программа на PICBASIC позволяет роботу двигаться только в прямом направлении, однако, немного изменив программу, конструктор может заставить робота двигаться назад и совершать повороты вправо и влево. Установка нескольких сенсорных датчиков может информировать робота о наличии препятствий.