Модуль GPS NEO-6M

Что это такое

Приёмник GNSS — микросхема, принимающая сигналы времени от группировки спутников и определяющая собственное положение по разности времени их прихода. NEO-6M — модуль, с которым большинство хобби-роботов сталкивается первым: приёмник u-blox, керамическая планчатая антенна и последовательный порт.

Это единственный датчик робота, сообщающий абсолютное положение. Все остальные устройства на сайте — энкодеры, IMU, массив датчиков отражения — измеряют изменение или локальную особенность. GPS ограничивает накопление погрешности одометрии, поэтому уличному роботу можно задать цель за километр.

Как это работает

С модулем не нужно вести диалог: он сам передаёт данные со скоростью 9600 baud в виде предложений NMEA 0183 — по одной строке через запятую на сообщение, несколько раз в секунду.

Два из них содержат всё необходимое роботу:

$GPGGA,123519,4807.038,N,01131.000,E,1,08,0.9,545.4,M,...   fix quality, sats, HDOP
$GPRMC,123519,A,4807.038,N,01131.000,E,022.4,084.4,...      validity, position, speed, course

Считайте координаты, затем проверяйте их пригодность. Поле состояния RMC содержит A для активного решения или V для недействительного, а качество решения в GGA равно 0 при его отсутствии: в обоих случаях строка всё равно содержит правдоподобные координаты. Поле HDOP выявляет более тонкий отказ: оно описывает геометрию спутников, и при плохой геометрии уверенный ответ может отличаться на десятки метров.

Широта приходит в градусах и десятичных минутах (4807.038 — это 48° 07.038′), а не в градусах. Преобразуйте один раз, а затем ещё раз в метры относительно фиксированного начала отсчёта — расчёт приведён здесь — и весь последующий код будет работать в единицах, понятных контроллеру.

Когда его следует использовать

Используйте модуль, когда робот работает на улице на расстояниях больше, чем допускает накопление ошибки одометрии: робот с опорными точками, газонокосилка, геодезическая платформа, сельскохозяйственный робот. Грубо говоря, после тридцати m пути только счисление уже накапливает больше ошибки, чем содержит решение GPS.

Не используйте его в помещении. И не используйте для точности: 2.5 m — большое расстояние для робота шириной 30 cm. GPS сообщает, в какой части поля вы находитесь; энкодер колеса — где находитесь вы в пределах метра от неё. Используйте оба источника с объединением данных.

Путь улучшения по соотношению ценности: сначала более высокая частота обновления (5 или 10 Hz устраняет большую часть устаревания), затем мультиконстелляционный модуль (GPS вместе с GLONASS или Galileo улучшает геометрию, а значит HDOP), и только потом RTK, обеспечивающий сантиметровую точность, но требующий базовой станции, канала данных и другого бюджета.

Распространённые ошибки

• Холодный старт занимает минуты, а не секунды. Без альманаха приёмник загружает его со спутников со скоростью 50 бит в секунду. Робот, который при первом включении на улице выглядит неработающим, обычно просто ждёт.
• У него нет курса. Только положение. Сочетайте его с магнитометром или гироскопом; курс по земле не имеет смысла примерно ниже 1 m/s.
• 5 V на RX убивает модули 3.3 V. Проверьте, преобразует ли уровни ваша плата расширения. TX модуля на плату 5 V подходит.
• Антенне нужно не просто поле зрения, а небо. Металл над ней, включая собственную платформу робота, ухудшает видимость спутников. Установите её сверху, горизонтально, направленной вверх.
• Никогда не следуйте непосредственно по сырым решениям. Считайте путь между ними и корректируйте по каждому; прямое следование увеличивает ошибку отслеживания на порядок и учетверяет усилие рулевого управления.
• Шесть знаков после запятой соответствуют 11 cm — и это больше, чем может хранить float. Преобразуйте координаты в метры относительно начала задания, а не выполняйте арифметику над сырыми градусами.

Расположение выводов и подключение

Вывод RX можно полностью оставить неподключённым. В состоянии по умолчанию GPS-модуль сам передаёт NMEA со скоростью 9600 baud, и роботу, который читает только положение, этого достаточно. Подключайте RX, лишь когда требуется повысить частоту обновления или отключить неиспользуемые сообщения.

Чтение без библиотеки

#include <SoftwareSerial.h>

SoftwareSerial gps(4, 3);          // RX from module TX, TX to module RX

char line[100];
uint8_t len = 0;

void setup() {
  Serial.begin(115200);
  gps.begin(9600);
}

void loop() {
  while (gps.available()) {
    char c = gps.read();
    if (c == '\n') {
      line[len] = '\0';
      if (strncmp(line, "$GPRMC", 6) == 0) handleRmc(line);
      len = 0;
    } else if (len < sizeof(line) - 1) {
      line[len++] = c;
    }
  }
}

void handleRmc(char *s) {
  // $GPRMC,time,status,lat,N/S,lon,E/W,speed,course,date,...
  char *field[13] = {nullptr};
  uint8_t n = 0;
  for (char *tok = strtok(s, ","); tok && n < 13; tok = strtok(nullptr, ",")) field[n++] = tok;

  if (n < 7 || field[2][0] != 'A') return;      // 'V' = void. Coordinates are still present
                                                 // and still meaningless. Gate on this.
  Serial.print(toDegrees(field[3], field[4][0]), 6);
  Serial.print(' ');
  Serial.println(toDegrees(field[5], field[6][0]), 6);
}

// NMEA gives ddmm.mmmm — degrees and DECIMAL MINUTES, not decimal degrees.
double toDegrees(const char *ddmm, char hemisphere) {
  double raw = atof(ddmm);
  int deg = (int)(raw / 100);
  double minutes = raw - deg * 100;
  double result = deg + minutes / 60.0;
  return (hemisphere == 'S' || hemisphere == 'W') ? -result : result;
}

Две важнейшие строки — те, которые обычно пропускают.

field[2][0] != 'A' проверяет пригодность решения. Приёмник без решения продолжает выдавать полностью сформированные строки RMC с координатами — обычно последнее известное положение или нули. Код без проверки флага уверенно направит робот в середину Атлантики, то есть в точку 0°N 0°E.

toDegrees существует потому, что 4807.038 — это не 4807.038 градуса и даже не 48.07038 градуса. Это 48° 07.038′, то есть 48.1173°. Обработка координат NMEA как десятичных градусов — самая распространённая ошибка GPS; она настолько велика, что её сразу видно, и это единственное её преимущество.

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

Точность: что на самом деле означают числа

CEP — медиана, а не верхняя граница. Половина решений хуже 2.5 m, а возле зданий длинный хвост распределения. Для робота шириной 30 cm «где-то в пределах нескольких m» — это не положение, а район.

HDOP — поле, за которым стоит следить. Оно описывает геометрию спутников, а не качество сигнала, и именно оно даёт уверенный ответ с ошибкой в десятки метров:

Проверяйте HDOP так же, как флаг пригодности. Решение с HDOP 12 не является решением; это догадка с десятичной точкой.

Статический дрейф и почему он важен

Оставьте GPS-модуль неподвижным на десять минут и записывайте каждое решение. Получится облако размером в несколько m, хотя ничего не двигалось.

Это самое важное, что стоит увидеть самостоятельно до написания кода навигации, потому что это объясняет, почему следование непосредственно по сырым решениям бесполезно. Регулятор, получающий такое облако, пытается его догнать, и робот непрерывно колеблется, почти не продвигаясь. Если счислять путь по энкодерам между решениями, а каждое решение использовать только для коррекции медленного дрейфа, тот же регулятор ведёт ровно — числа приведены в руководстве по навигации по опорным точкам.

Настройка модуля

Повышение частоты обновления — самое полезное изменение, и его стоит выполнить до всего остального. Модули u-blox принимают двоичные команды UBX:

// UBX-CFG-RATE: 200 ms measurement period -> 5 Hz
const uint8_t setRate5Hz[] = {
  0xB5, 0x62, 0x06, 0x08, 0x06, 0x00,
  0xC8, 0x00,          // 200 ms
  0x01, 0x00,          // one measurement per solution
  0x01, 0x00,          // align to GPS time
  0xDE, 0x6A           // checksum
};

void setup() {
  gps.begin(9600);
  delay(100);
  gps.write(setRate5Hz, sizeof(setRate5Hz));
}

При 5 Hz ограничением становится 9600 baud: полный набор предложений NMEA не помещается в 200 ms. Либо повысьте baud до 38400, либо отключите неиспользуемые сообщения, особенно GSV, которое наиболее объёмно и сообщает детали спутников, не нужные роботу.

Обратите внимание: на NEO-6M конфигурация не сохраняется без резервного питания модуля. Отправляйте её при каждом запуске.

Диагностика

Выбор модуля

Путь улучшения стоит проходить по порядку. Более высокая частота обновления устраняет большую часть устаревания и ничего не стоит. Мультиконстелляционный приёмник видит больше спутников, улучшая геометрию и, следовательно, HDOP; это большее реальное улучшение, чем предполагает значение точности, особенно возле зданий. RTK обеспечивает сантиметровую точность и меняет возможности робота, который должен следовать по линии в поле, но требует базовой станции, канала поправок и примерно в десять раз большего бюджета.

Одна вещь недоступна GPS-модулю по любой цене: курс в неподвижном состоянии. Курс по земле выводится из последовательных положений, поэтому примерно ниже 1 m/s он является шумом, а при нулевой скорости лишён смысла. Роботу, которому нужно знать направление взгляда, нужен магнитометр или гироскоп независимо от качества GPS.