Лазерные датчики (LIDAR, ToF) — Прецизионное измерение расстояния

Лазерные дальномеры используют когерентный свет для прецизионного измерения расстояний. В отличие от ультразвука, лазерный луч остается узким на больших расстояниях, что позволяет точно определять направление и положение объектов.

Принцип: Измерение времени прохождения светового импульса до цели и обратно.

\[ d = \frac{c \cdot \Delta t}{2} \] где:

• \(d\) — расстояние до объекта (м)
• \(c = 299792458\ \text{м/с}\) — скорость света
• \(\Delta t\) — время пролета (с)

Точность измерения времени: Для 1 мм точности: \[ \Delta t_{\text{min}} = \frac{2 \cdot 0.001}{3 \times 10^8} \approx 6.67 \times 10^{-12}\ \text{с} = 6.67\ \text{пс} \]

Принцип: Измерение сдвига фазы модулированного сигнала.

\[ d = \frac{c \cdot \Delta \phi}{4\pi f_m} \] где:

• \(\Delta \phi\) — разность фаз (рад)
• \(f_m\) — частота модуляции (Гц)

Пример: При \(f_m = 100 \text{ МГц}\):

\[ d_{\text{max\_unamb}} = \frac{c}{2f_m} = \frac{3 \times 10^8}{2 \times 10^8} = 1.5 \text{ м} \]

(максимальная однозначная дальность фазового лидара)

Этот расчет критичен для фазовых ToF-камер. Если объект находится дальше 1.5 метров, фаза «перескакивает» через цикл, и датчик начинает ошибочно показывать близкое расстояние (алиасинг). Для робототехники это одна из главных проблем при выборе частоты модуляции.

Принцип: Измерение разности хода лучей. \[ d = \frac{N \cdot \lambda}{2} \] где \(N\) — число интерференционных полос, \(\lambda\) — длина волны лазера.

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

Применение: Точечное измерение, контроль высоты, бесконтактные выключатели.

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

Применение: SLAM для роботов-пылесосов, 2D картографирование.

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

Применение: Автономные автомобили, 3D сканирование.

Примеры: InnovizOne, Aeva Aeries

Применение: Серийные автономные системы (без движущихся частей).

\[ \lambda = \frac{c}{f} \] где:

• \(\lambda\) — длина волны (нм)
• \(f\) — частота излучения

Распространенные значения:

• 850 нм: Бюджетные датчики, но чувствительны к солнечному свету
• 905 нм: Промышленные системы (менее поглощается атмосферой)
• 1550 нм: Eye-safe, для автомобильных лидаров

Классы лазерной безопасности (IEC 60825):

• Класс 1: Безопасен при любых условиях (ToF сенсоры)
• Класс 3R/3B: Требует мер предосторожности (мощные лидары)

Плотность мощности: \[ E = \frac{P}{A} \ \text{[Вт/м²]} \] где \(P\) — мощность лазера, \(A\) — площадь пятна.

Статистическая ошибка (shot noise limit): \[ \sigma_d = \frac{c}{2} \cdot \frac{\sigma_t}{\sqrt{N_{\text{photons}}}} \] где \(N_{\text{photons}}\) — количество регистрируемых фотонов.

TF-Luna → Arduino
  VCC   → 5V
  GND   → GND
  TX    → RX (D0)
  RX    → TX (D1)
  SCL   → (опционально для I2C)
  SDA   → (опционально для I2C)

#include <SoftwareSerial.h>

class TFLuna {
private:
    SoftwareSerial* serial_;
    float distance_;
    float strength_;
    
public:
    TFLuna(int rx_pin, int tx_pin) {
        serial_ = new SoftwareSerial(rx_pin, tx_pin);
        serial_->begin(115200);
    }
    
    bool readData() {
        uint8_t buffer[9];
        int bytes_read = 0;
        
        // Ожидание заголовка 0x59 0x59
        while (serial_->available() >= 9) {
            if (serial_->read() == 0x59) {
                if (serial_->peek() == 0x59) {
                    serial_->read(); // Второй 0x59
                    serial_->readBytes(buffer, 7);
                    
                    // Проверка контрольной суммы
                    uint8_t checksum = 0x59 + 0x59;
                    for (int i = 0; i < 7; i++) checksum += buffer[i];
                    
                    if (checksum == buffer[6]) {
                        distance_ = (buffer[1] << 8) | buffer[0]; // см
                        strength_ = (buffer[3] << 8) | buffer[2];
                        return true;
                    }
                }
            }
        }
        return false;
    }
    
    float getDistance() { return distance_ / 100.0; } // метры
    float getSignalStrength() { return strength_; }
};

VL53L0X → ESP32
  VIN   → 3.3V
  GND   → GND
  SDA   → GPIO21
  SCL   → GPIO22
  XSHUT → GPIO23 (опционально, для смены адреса)

#include <Wire.h>
#include <VL53L0X.h>

VL53L0X sensor;

void setup() {
    Serial.begin(115200);
    Wire.begin();
    
    sensor.setTimeout(500);
    if (!sensor.init()) {
        Serial.println("Failed to detect VL53L0X!");
        while (1);
    }
    
    // Настройка режимов
    sensor.setMeasurementTimingBudget(200000); // 200 ms
    sensor.startContinuous();
}

void loop() {
    int distance_mm = sensor.readRangeContinuousMillimeters();
    
    if (sensor.timeoutOccurred()) {
        Serial.println(" TIMEOUT");
    } else {
        Serial.print("Distance: ");
        Serial.print(distance_mm);
        Serial.println(" mm");
        
        // Сигнал качества (меньше = лучше)
        float signal_rate = sensor.signalRate();
        Serial.print("Signal rate: ");
        Serial.print(signal_rate);
        Serial.println(" MCPS");
    }
    
    delay(100);
}

Решение: Узкополосные фильтры, модуляция: \[ \Delta \lambda_{\text{filter}} < 10\ \text{нм} \] Код фильтрации:

float filtered_distance = alpha * current + (1-alpha) * previous;
// alpha ~ 0.1-0.3 для подавления шума

Физика: Коэффициент отражения Френеля: \[ R = \left( \frac{n_1 - n_2}{n_1 + n_2} \right)^2 \] Для стекла: \(R \approx 0.04\) (4% отражения)

Решение: Использование нескольких длин волн или временное разделение.

// ПИД-регулятор для высоты
float controlHeight(float target_alt, float current_alt) {
    static float integral = 0;
    static float prev_error = 0;
    
    float error = target_alt - current_alt;
    integral += error * dt;
    float derivative = (error - prev_error) / dt;
    
    float output = Kp * error + Ki * integral + Kd * derivative;
    prev_error = error;
    
    return constrain(output, -1.0, 1.0);
}

Требования: Точность < 5 см на расстоянии 10 м. Решение: Использование двухчастотного ToF или фазового метода.

Пример: Провода, ветки деревьев. Проблема: Малая отражающая поверхность. Решение: Увеличение мощности, уменьшение диаметра луча.

\[ d_{\text{corrected}} = d_{\text{raw}} - d_{\text{offset}} \] где \(d_{\text{offset}}\) определяется измерением до эталонной поверхности.

\[ d_{\text{true}} = \frac{d_{\text{measured}}}{\cos \theta} \] где \(\theta\) — угол между лучом и нормалью к поверхности.

Коэффициент отражения: \[ \rho = \frac{\text{Отраженная мощность}}{\text{Падающая мощность}} \] Стандартные мишени:

• Kodak White: \(\rho \approx 0.90\)
• Black velvet: \(\rho \approx 0.01\)

Принцип: Частотная модуляция непрерывной волны. Преимущества: Одновременное измерение расстояния и скорости. \[ v = \frac{\Delta f \cdot c}{2f_0} \] где \(\Delta f\) — доплеровский сдвиг.

Принцип: Single Photon Avalanche Diode массивы. Чувствительность: Один фотон! Применение: Низкая освещенность, большие расстояния.

Принцип: Квантовая запутанность фотонов. Точность: Преодоление классического предела.

Цель: Измерить зависимость точности от коэффициента отражения.

Оборудование: Лазерный дальномер, набор материалов (белая бумага, алюминий, черная ткань, стекло), линейка.

Протокол:

1. Установите эталонное расстояние (например, 1 м)
2. Измерьте расстояние до каждого материала 100 раз
3. Рассчитайте среднее и стандартное отклонение
4. Постройте график: Коэффициент отражения → Стандартное отклонение

Ожидаемый результат: Чем ниже коэффициент отражения, тем выше разброс измерений.

Лазерные датчики открывают путь к высокоточной навигации:

1. Лидарные SLAM системы — построение точных 3D карт
2. Сенсорная fusion с камерами — объединение глубины и текстуры
3. Автономная навигация — точное позиционирование в пространстве
4. Калибровка систем — поддержание точности измерений

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