Переинициализация приводов

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

Для того, чтобы проделать инициализацию заново, необходимо совершить следующие действия:

  1. Включите робота, используя инструкцию из раздела Quick Start Guide

  2. Подключитесь к бортовому компьютеру любым удобным для вас сопособ

  3. Расположите робота на плоской поверхности, как показано на фотографии. Убедитесь, что бедра и ступни плотно упираются в пол.

  1. Переименуйти файл с текущей конфигурацией энкодеров:

mv motor_offsets.cfg motor_offsets_old.cfg
  1. Запустите скрипт инициализации приводов с помощью команды:

python3 ~/act_init_angles.py
  1. Если всё прошло корректно, то в программе RoboGUI вы можете наблюдать показания датчиков, как на изображении.

  1. Теперь проверим, правильно ли прошла инициализация. Сначала установите робота на подставку

  2. В RoboGUI выберите режим Joints

  3. Отметьте галочку Same KpKd

  4. В поле Joint 1 kd введите значение 0.1 и нажмите Enter, а в поле Joint 1 kp введите 0.2 и снова Enter. Ноги робота должны слегка выпрямиться.

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

Если после выполнения пункта 10, положение ног робота сильно отличается от того, что изображено на фотографии, то ни в коем случае не переходите к выполнению следующих пунктов! Обратитесь к разделу Устранение неполадок. Если это не поможет, то свяжитесь с поддержкой.

  1. Теперь вы можете увеличить коэффициенты. Установите Kd=0.3 и Kp=4. Ноги полностью выпрямятся и примут положение, как на фотографиях. Значение Kp можно постепенно довести до 24, чтобы точно убедиться, что ноги стоят прямо. При этом, значения углов в RoboGUI будут близкими к нулю.

Поздравляем! У вас успешно получилось провести инициализацию приводов робота. Теперь вы можете обнулить Kp и Kd.

Last updated