Skip to content

Периферийные модули: настройка ID и Baud Rate ​

Введение ​

Периферийные модули — датчики и другие устройства, подключённые к той же шине DXL, что и сервоприводы, — настраиваются похожим образом: у каждого модуля есть свой ID и скорость обмена данными (Baud Rate), которые можно менять. Определять и менять эти параметры будем с помощью Arduino IDE и библиотеки DynamixelWorkbench.

Что потребуется ​

  • периферийный модуль;

  • контроллер;

  • кабель DXL;

  • компьютер с установленными Arduino IDE и библиотекой DynamixelWorkbench.

image1

Определение ID и скорости обмена данными ​

Прежде чем менять параметры модуля, нужно узнать его текущие ID и скорость обмена данными — заводские значения нам неизвестны. Воспользуемся кодом, который перебирает возможные скорости (9600, 57600, 115200 и 1 000 000 бод) и все допустимые ID — от 1 до 252. Как только на очередной комбинации модуль отзовётся, в мониторе порта появятся его скорость и ID.

Подключаем библиотеку DynamixelWorkbench и указываем порт, к которому подключена шина DXL (для OpenCM9.04 это порт "3"):

cpp
#include <DynamixelWorkbench.h>

#define DEVICE_NAME "3"

DynamixelWorkbench dxl_wb;

Задаём массив из возможных скоростей обмена данными:

cpp
uint32_t baudrates[] = {9600, 57600, 115200, 1000000};

В функции setup() открываем монитор порта и последовательно перебираем каждую скорость из массива и каждый ID от 1 до 252. Если модуль отвечает на чтение регистра, выводим найденные скорость и ID:

cpp
void setup()
{
  Serial.begin(57600);

  uint32_t val = 0;
  Serial.println("Сканирование");
  for (uint8_t b = 0; b < 4; b++)
  {
    if (!dxl_wb.init(DEVICE_NAME, baudrates[b])) continue;
    dxl_wb.setPacketHandler(1);
    for (uint8_t id = 1; id <= 252; id++)
    {
      if (dxl_wb.readRegister(id, 3, 1, &val))
      {
        Serial.print("Baud: ");
        Serial.print(baudrates[b]);
        Serial.print(" | ID: ");
        Serial.print(id);
      }
      delay(10);
    }
  }
}

void loop()
{
}

Полный код программы:

cpp
#include <DynamixelWorkbench.h>

#define DEVICE_NAME "3"

DynamixelWorkbench dxl_wb;

uint32_t baudrates[] = {9600, 57600, 115200, 1000000};

void setup()
{
  Serial.begin(57600);

  uint32_t val = 0;
  Serial.println("Сканирование");
  for (uint8_t b = 0; b < 4; b++)
  {
    if (!dxl_wb.init(DEVICE_NAME, baudrates[b])) continue;
    dxl_wb.setPacketHandler(1);
    for (uint8_t id = 1; id <= 252; id++)
    {
      if (dxl_wb.readRegister(id, 3, 1, &val))
      {
        Serial.print("Baud: ");
        Serial.print(baudrates[b]);
        Serial.print(" | ID: ");
        Serial.print(id);
      }
      delay(10);
    }
  }
}

void loop()
{
}

Изменение ID модуля ​

Когда текущие параметры известны, можно задать модулю нужный ID. Для этого используем следующий код: указываем текущую скорость обмена данными модуля, его текущий ID (old_id) и новый ID (new_id):

cpp
#include <DynamixelWorkbench.h>

#define DEVICE_NAME "3"
#define BAUDRATE    57600 //указываем текущую скорость обмена данными

DynamixelWorkbench dxl_wb;

uint8_t old_id = 1; //текущий ID
uint8_t new_id = 2; //новый ID

void setup()
{
  while (!dxl_wb.init(DEVICE_NAME, BAUDRATE)) {}

  dxl_wb.setPacketHandler(1);
  uint32_t val = 0;
  delay(1000);
  dxl_wb.writeRegister(old_id, 3, 1, &new_id);
}

void loop()
{
}

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

Изменение скорости обмена данными ​

Похожим образом меняется и скорость обмена данными: указываем ID модуля, текущую скорость (old_baudrate) и новую (new_baudrate):

cpp
#include <DynamixelWorkbench.h>

#define DEVICE_NAME "3"

DynamixelWorkbench dxl_wb;

uint8_t id = 35;  //указываем ID модуля
uint32_t old_baudrate = 1000000;  //текущая скорость обмена данными
uint32_t new_baudrate = 57600;    //новая скорость обмена данными

void setup()
{
  while (!dxl_wb.init(DEVICE_NAME, old_baudrate)) {}

  dxl_wb.setPacketHandler(1);
  uint32_t val = 0;
  delay(1000);
  dxl_wb.writeRegister(id, 4, 4, (uint8_t*)&new_baudrate);
}

void loop()
{
}

Как и при смене ID, после загрузки кода модуль нужно на время отключить от питания, чтобы новая скорость обмена данными сохранилась.