Осязание вместо глаз: как шагающие роботы научились строить карту рельефа вслепую и не терять высоту
Ногие роботы в средах с ухудшенным зрением должны полагаться исключительно на проприоцептивное восприятие, при котором глобальное положение и рысканье невозможно наблюдать. Вертикальный дрейф особенно вреден, поскольку он нарушает привязку высоты, необходимую для траекторий поворота ног, и может дестабилизировать робота. Мы рассматриваем саму местность как постоянный проприоцептивный ориентир: каждый шаг обеспечивает измерение высоты, которое закрепляет вертикальную ось. Мы предлагаем одновременную оценку базы и высоты (SBEE), среду с открытым исходным кодом в реальном времени, в которой левоинвариантный расширенный фильтр Калмана (LI-EKF) для оценки с плавающей базой и карта высот на основе сетки объединены в двунаправленный цикл, отражающий SLAM с высотой местности вместо ориентиров. Стабильные ножные контакты вставляют в карту образцы высот с учетом неопределенности, а ранее нанесенные на карту ячейки возвращаются обратно как взвешенные по неопределенности вертикальные псевдоизмерения, которые действуют аналогично замыканиям цикла. В отличие от инвариантных фильтров с контактным управлением, LI-EKF использует измерение кинематической скорости вместо дополнения состояния контактной моделью для каждой ветви, поэтому размерность его состояния не зависит от количества ног. Мы оцениваем SBEE в MuJoCo на четвероногих и двуногих платформах, а также на наборе данных ANYmal-D GrandTour на протяжении 296 м передвижения, уменьшая абсолютную ошибку траектории на 22.1% по сравнению с лучшим из трех современных проприоцептивных оценщиков.
## В чем суть открытия Шагающая робототехника десятилетиями упиралась в неразрешимый парадокс восприятия. Чтобы четвероногие или двуногие аппараты удерживали равновесие на сложном рельефе, контроллерам движения требуются непрерывные высокочастотные данные о положении корпуса. В идеальных условиях лаборатории робот полагается на лидары и оптические камеры. Однако в реальном мире — в густом дыму пожара, неосвещенной шахте или пылевой буре — оптические сенсоры мгновенно слепнут. Оставаясь без внешнего зрения, робот вынужден ориентироваться исключительно по внутренним датчикам (IMU) и датчикам суставов. Здесь вступает в силу неумолимая физика: вычисление координат через двойное интегрирование ускорений порождает квадратичный дрейф ошибок. Наиболее разрушителен дрейф по вертикальной оси Z: малейшая погрешность компенсации земной гравитации быстро уводит расчетную высоту корпуса. Робот начинает ошибаться в оценке уровня пола на десятки сантиметров. В итоге опускающаяся нога либо сокрушительно бьет в препятствие, либо зависает в пустоте, провоцируя потерю баланса и падение. Архитектура SBEE разрешает этот тупик, превращая каждый шаг робота в строительный блок динамической тактильной карты рельефа. ## Как это устроено: принцип работы Вместо того чтобы забывать тактильные отпечатки шагов сразу после отрыва лапы от земли, система сохраняет их в вероятностной карте высот. Математическое ядро объединяет левоинвариантный расширенный фильтр Калмана (LI-EKF) на группе Ли SE2(3) и двумерную сетку рельефа. Благодаря свойствам симметрии групп Ли, эволюция ошибок оценивания распространяется независимо от траектории робота, опираясь строго на измерения инерциального блока. Сетка высот перемещается вместе с роботом через тороидальную буферизацию, что обеспечивает сдвиг центра карты за O(1) операций без перемещения данных в памяти. При каждом шаге непрерывная оценка уверенности контакта взвешивает кинематику касания, а касательная плоскость стопы экстраполирует локальный наклон на соседние ячейки. Главный прорыв происходит в контуре обратной связи. Когда опора повторно наступает на уже исследованный участок, низкая дисперсия ячейки превращает сохраненную высоту в абсолютный пространственный якорь. Модифицированное обновление Шмидта–Калмана передает эту коррекцию строго на вертикальную координату Z корпуса. В результате скорость, углы ориентации и калибровки сенсоров гарантированно защищены от искажений карты. ## Результаты и доказательства Эффективность архитектуры подт