LiDAR и ToF сканеры — Трехмерное зрение лазером

LiDAR (Light Detection and Ranging) — это технология измерения расстояний с помощью света. В отличие от ультразвука, который дает одно “среднее” расстояние до объектов в секторе, лазерный луч — это узкий направленный пучок, позволяющий строить точные 3D-карты окружения или измерять дистанцию до конкретной точки с миллиметровой точностью.

Принцип: Измерение времени, за которое свет проходит до объекта и обратно.

Математика: \[ D = \frac{c \cdot \Delta t}{2} \]

где:

• \(D\) — расстояние до объекта
• \(c\) — скорость света (~299 792 458 м/с)
• \(\Delta t\) — время между отправкой импульса и приемом отражения

Сложность: Свет чрезвычайно быстр. Для измерения дистанции в 1 см (0.01 м) требуется зафиксировать время прохождения луча туда и обратно:

\[ \Delta t = \frac{2 \cdot 0.01}{3 \cdot 10^8} \approx 66.7 \cdot 10^{-12} \text{ с} = 66.7 \text{ пс} \]

Вывод: Требуются пикосекундные таймеры и сверхбыстрые детекторы, так как за 1 наносекунду свет успевает пролететь 30 см.

Реализация в чипах:

• Прямое измерение: Быстрые таймеры (дорого)
• Косвенное измерение: Измерение заряда конденсатора, который заряжается, пока фотоны не вернутся

Принцип: Излучается модулированный сигнал (синусоида), измеряется сдвиг фазы отраженного сигнала.

Математика: \[ D = \frac{c \cdot \Delta \phi}{4\pi f_{\text{mod}}} \] где:

• \(\Delta \phi\) — разность фаз (в радианах)
• \(f_{\text{mod}}\) — частота модуляции (обычно 10-100 МГц)

Преимущество: Выше точность на коротких дистанциях, дешевле в реализации.

Принцип: Источник света и приемник (камера) разнесены на известное расстояние (базис). Положение светового пятна на матрице приемника определяет расстояние.

Математика: \[ D = \frac{B \cdot f}{x} \] где:

• \(B\) — база (расстояние между лазером и камерой)
• \(f\) — фокусное расстояние камеры
• \(x\) — смещение пятна на матрице от оптической оси

Плюсы: Простая электроника, точность на коротких дистанциях.

Минусы: Точность падает с расстоянием, большие габариты.

Примеры: VL53L0X, VL53L1X, TF-Luna

Принцип: Измеряют расстояние до одной точки прямо перед собой.

Применение:

• Контроль высоты у дронов
• Бесконтактные выключатели
• Простая одометрия (измерение скорости по отражению от пола)

Примеры: RPLIDAR A1/A2, Slamtec RPLIDAR, YDLIDAR

Принцип: Лазерный дальномер быстро вращается (5-15 Гц), создавая “срез” окружения на плоскости.

Применение:

• SLAM для роботов-пылесосов и сервисных роботов
• Обнаружение препятствий на плоскости движения
• Одометрия (сравнение последовательных сканов)

Примеры: Velodyne VLP-16, Ouster OS1, Livox Mid-70

Принцик: Несколько (16, 32, 64, 128) лазерных лучей, вращающихся вместе, создают полное 3D-облако точек.

Применение:

• Автономные автомобили
• Строительная съемка
• Сложная навигация в 3D-пространстве

Примеры: InnovizOne, AEye

Принцип: Нет вращающихся частей. Луч сканирует пространство с помощью MEMS-зеркал или оптических фазированных решеток.

Плюсы: Высокая надежность, компактность, дешевизна в массовом производстве.

Минусы: Ограниченное поле обзора.

Лазерный луч отражается по-разному в зависимости от материала:

• Высокий коэффициент: Белая бумага, металл → хороший сигнал
• Низкий коэффициент: Черный бархат, асфальт → слабый сигнал
• Прозрачные материалы: Стекло, вода → частичное прохождение или отражение

Проблема: Несколько лидаров в одном помещении могут мешать друг другу. Решение: Модуляция на разных частотах, временное разделение.

• Туман/дождь: Рассеивание луча, уменьшение дальности
• Солнечный свет: Фоновая ИК-засветка (особенно для 850 нм датчиков)

При скользящем угле падения луч может:

• Проскальзывать вдоль поверхности
• Давать ложное отражение
• Не возвращаться к приемнику

VL53L1X → ESP32
  VIN   → 3.3V
  GND   → GND
  SDA   → GPIO21
  SCL   → GPIO22
  GPIO1 → (опционально, прерывание)

#include <Wire.h>
#include <VL53L1X.h>

VL53L1X sensor;

void setup() {
  Serial.begin(115200);
  Wire.begin();
  Wire.setClock(400000); // Fast I2C
  
  sensor.setTimeout(500);
  if (!sensor.init()) {
    Serial.println("Failed to detect VL53L1X!");
    while (1);
  }
  
  sensor.setDistanceMode(VL53L1X::Long);
  sensor.setMeasurementTimingBudget(50000); // 50 ms
  sensor.startContinuous(50); // измерение каждые 50 мс
}

void loop() {
  int distance = sensor.read();
  if (sensor.timeoutOccurred()) {
    Serial.print(" TIMEOUT");
  } else {
    Serial.print("Distance: ");
    Serial.print(distance);
    Serial.println(" mm");
  }
  delay(100);
}

RPLIDAR A1 → RPi
  5V      → 5V
  GND     → GND
  RX      → TX (GPIO14)
  TX      → RX (GPIO15)
  MOTOR+  → ШИМ-пин для управления мотором

1. Сбор сканов: Получение облака точек за один оборот
2. Сопоставление сканов: ICP (Iterative Closest Point) алгоритм находит преобразование между последовательными сканами
3. Построение карты: Накопление и усреднение точек в единой системе координат
4. Локализация: Сравнение текущего скана с построенной картой

# Установка драйвера
sudo apt install ros-humble-rplidar-ros

# Запуск
ros2 launch rplidar_ros rplidar.launch.py

# Запуск SLAM (например, Cartographer)
ros2 launch slam_toolbox online_async_launch.py

• Плотность точек: > 1000 точек на скане
• Частота сканирования: > 5 Гц
• Согласованность: Разброс между последовательными сканами < 5 см

Принцип: Измерение допплеровского сдвига частоты для определения скорости объекта и расстояния. Преимущество: Одновременное измерение расстояния и скорости, нечувствительность к помехам от других лидаров.

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

Принцип: Массивы вертикально-излучающих лазеров для одновременного освещения всей сцены. Преимущество: Простота конструкции, низкая стоимость в массовом производстве.

Цель: Понять принцип работы вращающегося лидара.

Что нужно: Точечный ToF-датчик (TF-Luna), сервопривод на 360°, Arduino, компьютер.

Схема:

1. Закрепите датчик на сервоприводе
2. Запрограммируйте медленное вращение (1 оборот за 30 секунд)
3. На каждом шаге (например, 1°) считывайте расстояние
4. Передавайте данные на компьютер в формате: угол,расстояние
5. Визуализируйте в Python (matplotlib) как полярный график

Вывод: Вы получите грубую, но работающую 2D-карту помещения, аналогичную тому, как работает настоящий 2D-лидар.

Освоив LiDAR, вы открываете путь к автономной навигации:

1. SLAM-алгоритмы — как превращать облака точек в карты и определять свое положение на них
2. Фильтрация облаков точек — как убирать шум и выбросы из данных лидара
3. Интеграция с камерой — как объединять точные расстояния с цветовой информацией (RGB-D)
4. Автономная навигация — как планировать путь по карте, построенной лидаром

Ключевой совет: Начинайте с точечного датчика (VL53L1X) для понимания принципов. Для навигации робота по помещению берите 2D-лидар (RPLIDAR). Для серьезных проектов (автономный автомобиль, дрон) смотрите в сторону 3D-лидаров. И помните: LiDAR — это один из сенсоров в системе. Настоящая магия начинается при его слиянии с камерами, IMU и одометрией.