Движение манипулятора. Программа автоматического управления манипулятором

Подготовка
Открыть программу написанную ранее
Робота не включать
Робота не подключать
Напишем автоматическое управление манипулятором
У тебя в тетради записаны углы движения каждого серво
Так же записано среднее состояние манипулятора

Начальное состояние программы

Программа управления
Начальное состояние манипулятора
Захват открыт, поворот направо, положение назад и вниз
//начальное состояние
zahv.write(70); //захват открыт
povorot.write(0);//поворот направо
vpered.write(40);// положение назад
vverh.write(60);//положение вниз

Программа
Записать сюда

Положение конечное
Конечное положение
Захват закрыт, поворот налево, положение вперед и вверх
//конечное состояние
zahv.write(110); //захват закрыт
povorot.write(180);//поворот налево
vpered.write(130);// положение вперед
vverh.write(120);//положение вверх

Программа
Запись сюда

Проверка
Сделаем чтоб из начального состояния манипулятор устанавливался в конечное и назад в начальное и так каждые 3с
Проверим как все работает

Программирование робота
Теперь подключи робота к ПК
Проверь порт и плату
Запрограммируй робота
Отключи робота от пк
Установи робота на стол
Моторы должны быть отключены
Теперь включи питание и посмотри как работает манипулятор
Манипулятор проверен
Теперь изменяя углы серво и время работы серво можно заставить манипулятор выполнить любую операцию самостоятельно
Например кидать сахар в чай