Введение. В настоящее время развитие мобильной робототехники смещается от создания узкоспециализированных машин к разработке многофункциональных адаптивных систем. Такие роботы востребованы в задачах поисково-спасательных операций, инспекции промышленных объектов и мониторинга труднодоступных территорий [1, 2]. Ключевой проблемой при этом остается обеспечение проходимости. Традиционные колесные платформы обладают высокой энергоэффективностью, но ограничены в преодолении вертикальных препятствий (порогов, ступеней, завалов). Гусеничные шасси обеспечивают высокое сцепление с грунтом, но проигрывают в скорости и маневренности на твердых покрытиях.Традиционные колесные платформы обладают высоким КПД и скоростью на ровных поверхностях, но их проходимость ограничена диаметром колеса. Они не способны преодолевать вертикальные препятствия (пороги, ступени), высота которых превышает радиус движителя. Гусеничные шасси обеспечивают высокое сцепление с грунтом и проходимость, но проигрывают в скорости, маневренности на твердых покрытиях и энергопотреблении.Решением данного противоречия является применение гибридных реконфигурируемых схем, сочетающих преимущества колесного и гусеничного хода [3]. Современные исследования [4, 5] подтверждают, что способность изменять геометрию шасси (клиренс, угол атаки гусениц, длину колесной базы) позволяет роботу адаптироваться под текущий рельеф. Однако реализация такой адаптивности сопряжена со сложными задачами управления. В отличие от жестких конструкций, реконфигурируемые системы требуют точной координации множества приводов. Динамика таких роботов на пересеченной местности осложняется нелинейными эффектами взаимодействия движителя с грунтом [6, 7].Критически важным режимом для таких роботов является «геометрическое замыкание»—состояние, при котором робот фиксирует свою форму для механического зацепления за препятствие, снимая нагрузку с электроприводов [8]. Однако вход в такое состояние требует высокой точности позиционирования механических узлов, что сложно реализовать на практике из-за двух фундаментальных факторов.Во-первых, это ограничения сенсорной системы бюджетного класса. Использование лидаров или стереокамер в массовых сервисных роботах часто экономически нецелесообразно. Стандартные ультразвуковые сенсоры являются доступной альтернативой, но имеют широкую диаграмму направленности (порядка 15–30°) и подвержены переотражениям сигнала [9]. Существующие методы комплексирования датчиков [10, 11] повышают качество восприятия, но для задач точной стыковки с препятствием требуется специализированный алгоритм, исключающий «слепые зоны».Во-вторых, это ярко выраженная нелинейность исполнительных механизмов. Бюджетные актуаторы, особенно линейные приводы с червячной передачей, характеризуются существенным сухим трением и зоной нечувствительности [12]. Традиционные методы линейного ПИД-регулирования в таких условиях оказываются неэффективными: малые управляющие сигналы не могут преодолеть порог страгивания, что приводит к накапливанию статической ошибки позиционирования [13]. Для компенсации нелинейностей наиболее перспективными выглядят стратегии управления с переменной структурой и насыщением [14, 15].Целью данной работы является разработка и верификация комплексной системы управления мобильным роботом, объединяющей метод активного сканирования среды для точного детектирования препятствий и стратегию управления с насыщением для компенсации нелинейностей приводов.Аппаратная архитектура системы. Функциональная схема аппаратной реализации системы управления мобильного трансформируемого робота приведена на рис. 1. Центральным элементом является микроконтроллер Arduino Mega 2560, который выполняет сбор измерительной информации, формирование оценок состояния, а также генерацию управляющих ШИМ-сигналов для исполнительных приводов.Система управления включает оптические энкодеры VEX Optical Shaft Encoder, формирующие квадратурные импульсы, пропорциональные угловому перемещению валов приводов/механизма трансформации, а также ультразвуковой дальномер HC-SR04, установленный на направляющих и обеспечивающий измерение расстояния до препятствий/поверхности в направлении сканирования.Сигналы энкодеров поступают на входы Arduino и обрабатываются с использованием аппаратных прерываний, что обеспечивает устойчивый подсчёт импульсов при параллельной работе нескольких датчиков. Дальномер HC-SR04 подключён к контроллеру по цифровым входам, измеренная дальность используется в контуре оценки внешней обстановки и при движении.Рис. 1. Схема аппаратной реализации системы управления Исполнительный уровень представлен двумя группами приводов:1.  Тяговые приводы на базе двигателей VEX 393, управляемые через драйверы Motor Controller 29. Arduino формирует ШИМ-сигналы, задающие режимы скорости и направления вращения двигателей для колесного и гусеничного блоков, а также для приводов механизма подъёма и шатунного устройства.2.  Линейные актуаторы телескопического устройства, управляемые через двухканальные драйверы L298N. Они обеспечивают реверс и динамическое торможение для позиционирования штока и фиксации заданного положения.Обратная связь в системе реализована по измерениям энкодеров и по данным дальномера. Эти измерения используются в вычислительных алгоритмах на Arduino для замыкания дискретных контуров управления (PID-регуляторы) и логики режимов.Питание организовано раздельно для снижения взаимных помех и просадок напряжения. На схеме отдельно обозначены линии питания, ШИМ-управления и механических связей.Метод активного сканирования «Stop-and-Scan». Традиционные методы ультразвуковой локации [9, 16] предполагают измерение дистанции при движении робота или стационарном положении датчика. Однако из-за широкого конуса распространения волны (≈15°) измерение высоты ступенчатого препятствия с одной точки дает большую погрешность.Для решения этой проблемы разработан метод активного вертикального сканирования. Суть метода заключается в физическом перемещении сенсора вдоль вертикальной оси при неподвижном шасси. Алгоритм работы системы (рис. 2) включает следующие этапы:Рис. 2. Блок-схема алгоритма активного сканирования и реконфигурации Алгоритм работы системы управления разделен на три последовательных этапа: восприятие среды, принятие решений и исполнение.Этап 1. Восприятие и принятие решений.1. Обнаружение препятствия и остановка.Робот движется по заданному маршруту и непрерывно контролирует пространство впереди ультразвуковым дальномером. Когда датчик обнаруживает препятствие впереди, срабатывает прерывание, робот немедленно прекращает движение и переходит в режим «Stop-and-Scan».2. Вертикальное сканирование и определение высоты Hobs .Поскольку ультразвуковой дальномер обладает широким углом направленности (≈15°), что приводит к неоднозначности отражений и снижению точности при фиксированном положении датчика, в системе реализовано активное управление вертикальным перемещением кронштейна с датчиком.Текущая высота сенсора hsens(t)  получается путем интегрирования вертикальной скорости vz :hsens(t)=hinit+0tvzτⅆτ ,где hinit  – начальная высота, vz  – скорость вертикального перемещения сенсора.Система не использует показания дальности напрямую, а вычисляет пространственный градиент расстояния D  относительно изменения высоты ∇D(h)  для идентификации верхней кромки препятствия:∇D(h)≈Dt-D(t-Δt)vz⋅Δt Логика принятия решения: когда абсолютное значение градиента превышает адаптивный порог Δthr(т.е ∇D(h)>Δthr ), фиксируется обнаружение края препятствия, и текущая высота принимается за высоту препятствия Hobs . Этот метод позволяет удерживать ошибку измерения в пределах 1,5%.3. Расчет целевых параметров (угла θtarget  и хода штоков Ltarget )На основе измеренной высоты препятствия Hobs  система решает уравнения обратной кинематики и рассчитывает целевую конфигурацию, в которую должен трансформироваться робот.Управление реализуется по двум взаимосвязанным каналам: первый канал задаёт целевой угол наклона передних рычагов (соответствует θtarget  на блок-схеме в тексте), второй канал задаёт целевую длина телескопических штоков Ltarget .Этап 2. Реконфигурация и нелинейное управление.4. Синхронный подъем рычагов.Это ключевой этап алгоритма. Для обеспечения точного достижения расчетного угла наклона θtarget , необходимо компенсировать влияние существенных нелинейных факторов, таких как сухое трение и люфты в механических передачах. В качестве альтернативы классическому линейному ПИД-регулятору в работе предлагается закон управления с насыщением и высоким коэффициентом усиления. Использование режима насыщения позволяет временно разомкнуть контур обратной связи, фиксируя управляющее воздействие на предельном уровне (по знаку и величине).Уравнение управления в дискретной форме имеет вид:uk=sat(Kpek+KI∑ej+KDek-ek-1Ts) ,где ek  – текущая ошибка положения,sat(Kpek+KI∑ej+KDek-ek-1Ts)  — функция насыщения, ограничивающая напряжение в допустимом для драйвера диапазоне.Пропорциональный коэффициент Kp  устанавливается большого значения (в работе принято Kp=45 ). Это приводит к тому, что даже при очень малой ошибке ek  контроллер выдает максимальное напряжение Umax . Такой высокий коэффициент усиления мгновенно создает момент, достаточный для преодоления силы трения покоя, устраняя «мертвую зону» и статическую ошибку, характерные для обычного управления (снижение с 8,0 мм до 0,2 мм).5. Выдвижение телескопических опор.Одновременно с подъемом передних рычагов, линейные приводы выдвигают телескопический механизм на целевую длину Ltarget . Здесь также применяется вышеописанная стратегия управления с насыщением для обеспечения точности.6. Синхронное опускание и тяга.Робот опирает передние рычаги на препятствие и, используя тяговое усилие гусениц и колес, поднимает все шасси.Этап 3. Завершение и сброс.7. Подтверждение преодоления и сброс.На этом этапе производится проверка, полностью ли корпус робота преодолел препятствие.Если условие выполнено, происходит втягивание штоков, возврат рычагов и сенсора в исходное положение, робот возвращается в исходную конфигурацию, завершает текущий цикл и продолжает движение. Если условие не выполнено или возникла ошибка, активизируется диагностическая программа для восстановления движения или формируется сообщение об ошибке.Структура двухканальной системы управления. Для реализации точной реконфигурации на основе данных сканирования (Hobs ) система управления была декомпозирована на два независимых канала.На рисунке 3 представлена структурная схема системы, декомпозированная на два независимых контура управления. Элемент сравнения (обозначенный как «-») выполняет алгебраическое суммирование задающего воздействия gt  и сигнала отрицательной обратной связи, формируя сигнал ошибки ϵt . Регулятор Wcs , реализованный программно на микроконтроллере, преобразует ошибку в управляющее напряжение ut  в соответствии с синтезированным законом управления с насыщением. Объект управления Wos  представляет собой динамическую модель электропривода и механической передачи, выходной величиной которой является кинематический параметр y(t)  (высота или скорость). Звено Wfbs  описывает передаточную функцию датчиков (энкодеров), замыкающих контур управления. Таблица 1Соответствия математических символов и их физического смысла в роботеСимволНазвание (Теория управления)Физический смысл в системеgt Задающее воздействиеЦель.Для Канала 1: Целевая высота подъема href  или угол рычагов.Для Канала 2: Целевая скорость Vref  или дистанция перемещения.ϵt Ошибка рассогласованияРазница. Отклонение текущего положения робота от заданного. Это значение поступает на вход ПИД-регулятора.Wcs Передаточная функция регулятораПрограмма (Arduino). Алгоритм (ПИД + Насыщение), который вычисляет, какую мощность нужно подать на мотор, чтобы устранить ошибку ϵ .ut Управляющее воздействиеНапряжение/PWM. Сигнал широтно-импульсной модуляции (0–255), который микроконтроллер посылает на драйвер мотора (L298N или MC-29).Wos Передаточная функция объектаЖелезо. Совокупность драйвера, электродвигателя, редуктора и механической нагрузки (рычаги, колеса). Преобразует напряжение в движение.y(t) Выходная величинаРезультат. Реальная текущая высота робота ht  или реальная скорость Vt .Wfbs Передаточная функция обратной связиДатчик. Энкодер или потенциометр. Он измеряет физический выходyt  и преобразует его в цифровой сигнал для сравнения с целью gt . Рис. 3. Архитектура системы управления с вычислительными блоками Синтез двухканальной системы управления реконфигурацией. Проектирование системы управления базируется на методах мехатронного подхода [17, 18]. Система декомпозирована на два канала: управление углом наклона (α ) и длиной вылета рычагов (L ). Для исследования динамики разработана модель в MATLAB/Simulink (рис. 4), учитывающая ограничения напряжения драйверов (±12 В ).  Рис. 4.  Структурная схема нелинейной модели управления приводом Схема состоит из следующих ключевых блоков:1. ПИД-регулятор формирует управляющее воздействие ut  на основе ошибки рассогласования ⅇt=qref-qactual . В рамках предложенного подхода реализован алгоритм с высоким коэффициентом пропорционального усиления (Kp=45 ) для обеспечения быстродействия.2. Блок насыщения моделирует аппаратные ограничения драйвера двигателя L298N. Этот блок ограничивает выходное напряжение регулятора диапазоном -12B,+12B , что соответствует напряжению бортовой сети робота. Это позволяет анализировать поведение системы в нелинейном режиме, когда регулятор «упирается» в потолок питания.3. Динамика исполнительного механизма (актуатора) описывается передаточной функцией второго порядка Ws=KsTs+1 , отражающей электромеханические свойства ротора.4. Блок сухого трения является критически важным элементом модели, имитирующим зону нечувствительности редуктора. Он вводит в систему возмущение, препятствующее началу движения при малых напряжениях (U<Udead≈3B ), что и вызывает появление статической ошибки в классических системах, которую устраняет предложенный метод высокого усиления.Анализ переходных процессов в линейной зоне (без учета сухого трения) показывает, что система с подобранными коэффициентами (Kp=9, Kd=3 ) обладает апериодическим характером переходного процесса без перерегулирования, как показано на рис. 5, что критически важно для предотвращения механических ударов.Рис. 5. Переходная характеристика системы позиционирования в линейной зонеНа рис. 5 представлена реакция системы на единичное ступенчатое воздействие в идеализированных условиях, когда моментом сухого трения можно пренебречь. Моделирование выполнено с настроечными коэффициентами ПИД-регулятора Kp=9 и Kd=3 . Анализ кривой на рис. 5 показывает, что процесс установления происходит монотонно, без колебаний и перерегулирования (выход за уровень 1.0 отсутствует). Это является критическим требованием для механизма реконфигурации, так как любое перерегулирование могло бы привести к жесткому механическому удару рычагов об ограничители. Время нарастания (tr ) составляет менее 0.1 с, что свидетельствует о высокой динамике системы в линейной зоне. Исследование нелинейной динамики и обоснование стратегии насыщения. В реальных условиях стандартные приводы обладают зоной нечувствительности, вызванной сухим трением. Применение линейного управления в таких системах ограничено физическими пределами привода [12]. Для оценки влияния нелинейностей проведено моделирование с консервативными настройками линейного регулятора (Kp=1 ). Как видно из рис. 6, система останавливается с недопустимой статической ошибкой δst≈8,0 мм , так как управляющее напряжение не может преодолеть порог страгивания. Рис. 6. Возникновение статической ошибкипри линейном управлении с малым коэффициентом усиленияСледует отметить, что даже использование номинальных коэффициентов линейного регулятора (Kp=9 ), хотя и уменьшает ошибку, не позволяет достичь требуемой субмиллиметровой точности из-за физической природы трения.Для полного устранения ошибки применена стратегия управления с использованием высокого коэффициента усиления в условиях ограничений на управление.Суть метода заключается в намеренном введении привода в режим отсечки. Насыщение сигнала — это состояние, когда обратная связь оказывается фактически разомкнутой, т.е. сигнал ошибки (в пределах зоны насыщения) не влияет на управляющее воздействие и остается неизменным по величине (максимальное напряжение Umax ), меняясь лишь по знаку.Увеличение коэффициента до Kp=45  приводит к тому, что даже при минимальном рассогласовании регулятор выдает максимальное напряжение, мгновенно преодолевая момент трения покоя. Результаты моделирования (рис. 7) показывают снижение расчетной статической ошибки до 0,2 мм, что гарантировало надежное геометрическое замыкание механизма в ходе натурных испытаний.  Рис. 7. Динамика системы с высоким коэффициентом усиления (Kp=45 ) под нагрузкой.(Сверху: позиция; снизу: управляющее напряжение) Частотный анализ устойчивости. Для оценки динамических свойств синтезированной системы проведен частотный анализ. На рисунке 8 представлены логарифмические амплитудная (верхний график) и фазовая (нижний график) частотные характеристики (ЛАЧХ и ЛФЧХ) замкнутого контура управления.  Рис. 8. Логарифмические частотные характеристики (диаграмма Боде) замкнутой системыреконфигурации Из графиков видно, что полоса пропускания системы (частота, при которой амплитуда падает на -3 дБ) составляет порядка 60 рад/с (≈10 Гц). Это подтверждает, что привод способен своевременно отрабатывать команды реконфигурации без существенных задержек.Фазовая характеристика в рабочем диапазоне частот не пересекает критическую отметку -180°. Запас по фазе составляет более 45°, что гарантирует абсолютную устойчивость системы даже при наличии нелинейностей и вариации параметров нагрузки. Отсутствие резонансных пиков на ЛАЧХ свидетельствует об апериодическом характере переходных процессов без перерегулирования.Полоса пропускания системы составляет ωb≈60 рад/с  (около 10 Гц), что обеспечивает достаточное быстродействие для задач реконфигурации. Выводы.1. Разработана архитектура системы управления, которая, в отличие от аналогов, использует иерархическую структуру с разделением на каналы реконфигурации и движения. Это упрощает масштабирование системы.2. Предложен метод активного сканирования «Stop-and-Scan», который устраняет главный недостаток ультразвуковых сенсоров — низкую угловую точность. Использование градиентного анализа при вертикальном перемещении датчика позволило снизить погрешность измерения высоты препятствий до 1,5%.3. Обоснована стратегия управления с насыщением. Доказано, что для электроприводов, характеризующихся существенными нелинейностями (высоким сухим трением, зоной нечувствительности), классические линейные законы управления неэффективны. Введение высокого коэффициента усиления в сочетании с ограничением сигнала позволило уменьшить ошибку позиционирования с 8 мм до 0,2 мм, что обеспечивает надежное геометрическое замыкание механизмов робота независимо от класса используемых приводов.