Способ профилирования дороги автогрейдером Российский патент 2019 года по МПК E02F3/84 E02F1/00 G05D1/10 

Изобретение относится к способу возведения дорожного полотна и может быть использовано при строительстве дорог.

Наиболее близким к заявленному способу по совокупности признаков является способ профилирования дорожного полотна автогрейдером, предусматривающей обеспечение требуемой поверхности полотна, заданной его цифровым проектом, путем регулирования положения средней точки режущей кромки и угла поперечного перекоса рабочего органа автогрейдера, а так же регулирования направления и скорости движения автогрейдера. Один из двух контуров гидропривода рабочего органа замкнут по углу β_PO поперечного перекоса рабочего органа, а второй контур этого гидропривода и два контура ходового устройства автогрейдера замкнуты, соответственно, по координатам Z_PO, Х_РО, Y_PO рабочего органа, измеряемым комплектом датчиков спутниковой навигационной системы /Сокращение сроков земляных работ. URL: http://www.agpmeridian.ru/image_content/preesntation_2013/Kolcov.pdf (дата обращения: 21.03.2018 г.)/. Этот способ принят за прототип.

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

Сущность изобретения заключается в автоматизации процесса профилирования дорожного полотна автогрейдером.

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

Указанный технический результат при осуществлении изобретения достигается тем, что в известном способе профилирования дорожного полотна автогрейдером с ходовым, рулевым устройствами и гидроприводами подъема-опускания и перекоса рабочего органа, включающем в себя формирование, в соответствии с цифровым проектом дорожного полотна, выполненного в виде совокупности плановых координат X, Y и высот Z, и принятой схемой движения автогрейдера, вектора задающих сигналов многомерной системы управления положением Х_РО, Y_PO, Z_PO средней точки режущей кромки и углом β_РО поперечного перекоса рабочего органа автогрейдера в базовой прямоугольной системе координат O_бX_бY_бZ_б при профилировании дорожного полотна, измерение координат Х_РО, Y_PO, Z_PO положения средней точки режущей кромки рабочего органа автогрейдера в базовой системе координат в процессе профилирования дорожного полотна комплектом датчиков спутниковой навигационной системы и формирование на выходе этой системы сигналов Х_ОС.С, Y_OC.C, Z_OC.С, измерение угла β_PO с помощью датчика β, расположенного на автогрейдере и формирование на выходе этого датчика сигнала β_PO.С, определение отклонений ΔХ_РО=Х_ОС.З-X_OC.С, ΔY_PO=Y_OC.З-Y_OC.С, Δβ_РО=β_ОС.З-β_ОС.С положения средней точки режущей кромки и угла перекоса рабочего органа автогрейдера относительно заданного, управление положением средней точки режущей кромки рабочего органа по координатам Х_РО и Y_PO ходовым и рулевым устройствами автогрейдера, по координате β_РО гидроприводом перекоса рабочего органа автогрейдера в функции значении ΔХ_РО, ΔY_PO, Δβ_РО, соответственно, особенность заключается в том, что дополнительно периодически измеряют в системе О_бХ_бY_бZ_б координату Z_PO одним или несколькими альтернативными датчиками и формируют из выходных сигналов этих датчиков альтернативный сигнал Z_PO.А высотного положения рабочего органа, определяют первую разность Z₁=Z_PO.С-Z_PO.А и вторую разность Z_O=Z_PO.З-Z_PO.С задают величины ΔZ₁ и ΔZ_O допустимых значений разностей Z₁ и Z_O при штатном режиме работы системы управления положением Z_PO рабочего органа, вычисляют первый промежуточный сигнал второй промежуточный сигнал преобразуют сигнал Z₃ в корректирующий сигнал Z_K с помощью динамического фильтра, определяют сигнал обратной связи высотного положения рабочего органа Z_OC=Z_PO.С-Z_K, определяют отклонение ΔZ_PO=Z_PO.З-Z_OC, управляют положением рабочего органа по координате Z_PO его гидроприводом подъема-опускания в функции значения ΔZ_PO.

Для достижения более высокой точности геометрических параметров возводимого дорожного полотна, необходимо уменьшить погрешность сигнала Z_OC обратной связи в системе автоматического управления положением рабочего органа по координате Z_PO, путем дополнительного периодического измерения координаты Z_PO одним или несколькими альтернативными датчиками и последующего формирования корректирующего сигнала Z_K и использования его при вычислении сигнала обратной связи. Заявленное изобретение позволяет значительно повысить точность геометрических параметров возводимого дорожного полотна при профилировании его автогрейдером за счет повышения точности системы автоматического управления положением по координате Z_PO рабочего органа автогрейдера путем дополнительной коррекции сигнала обратной связи этой системы управления, для чего осуществляется дополнительное периодическое измерение положения рабочего органа по координате Z_PO с помощью одного или нескольких альтернативных датчиков, которые устанавливаются в зоне работы автогрейдера.

Блок датчиков альтернативного периодического измерения располагают на штанге, закрепленной на рабочем органе, а элементы, формирующие альтернативную плоскость, - например, на струнах, натянутых между опорами, установленными, по крайней мере, на одной из границ профилирования дорожного полотна, определяемых технологией производства работ, на высоте, обеспечивающей безопасное проведение работ.

На фиг. 1 изображена структурная схема автоматического профилирования дороги автогрейдером, где приняты следующие обозначения: задатчик положения рабочего органа 1, рабочий орган автогрейдера 2, первое устройство сравнения 3, спутниковая навигационная система 4, первый регулятор 5, ходовое устройство 6, второе устройства сравнения 7, второй регулятор 8, рулевое устройство 9, третье устройство сравнения 10, арифметическое устройство 11, третий регулятор 12, гидропривод подъема-опускания рабочего органа 13, четвертое устройство сравнения 14, пятое устройство сравнения 15, блок вычисления Z₃ 16, блок датчиков альтернативного измерения Z_PO 17, задатчик ΔZ_O 18, задатчик ΔZ₁ 19, динамический фильтр 20, шестое устройство сравнения 21, датчик β 22, четвертый регулятор 23, гидропривод перекоса рабочего органа 24.

На фиг. 2 изображена упрощенная структурная схема автоматического профилирования дороги автогрейдером, где приняты следующие обозначения: задатчик положения рабочего органа 1, рабочий орган автогрейдера 2, спутниковая навигационная система 4, ходовое устройство 6, рулевое устройство 9, гидропривод подъема-опускания рабочего органа 13, блок датчиков альтернативного измерения Z_PO 17, датчик β 22, гидропривод перекоса рабочего органа 24, элемент, формирующий альтернативную плоскость 27, контроллер 28.

На фиг. 3 изображен один из возможных вариантов расположения датчиков дополнительного периодического альтернативного измерения координаты Z_PO рабочего органа автогрейдера (вид спереди), здесь приняты следующие обозначения: базовая система координат О_Б Z_Б Х_Б X_Б дорожного полотна, рабочий орган автогрейдера 2, спутниковая навигационная система 4, гидропривод подъема-опускания рабочего органа 13, блок датчиков альтернативного измерения Z_PO 17 альтернативного периодического измерения координаты Z_PO, опора 25, струна 26, элемент, формирующий альтернативную плоскость 27.

На фиг. 4 изображен один из возможных вариантов расположения датчиков дополнительного периодического альтернативного измерения координаты Z_PO рабочего органа автогрейдера (вид сверху), здесь приняты следующие обозначения: базовая система координат О_Б Z_Б Х_Б Y_Б дорожного полотна, рабочий орган автогрейдера 2, спутниковая навигационная система 4, ходовое устройство 6, рулевое устройство 9, блок датчиков альтернативного измерения Z_PO 17 альтернативного периодического измерения координаты Z_PO, опора 25, струна 26, элемент, формирующий альтернативную плоскость 27.

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

Для осуществления способа профилирования дорожного полотна используют устройств которое состоит из автогрейдера, оснащенного ходовым устройством 6, рулевым устройством 9 и гидроприводом подъема-опускания рабочего органа 13 и гидроприводом перекоса рабочего органа 24, комплектом датчиков спутниковой навигационной системы 4, которая измеряет положение средней точки режущей кромки рабочего органа Х_РО, Y_PO, Z_PO в базовой системе координат О_б Х_б Y_б Z_б и формирует сигналы обратной связи Х_ОС.С, Y_OC.С, Z_OC.С, используемые в системах управления. Корме того на автогрейдере установлен датчик β 22 измерения угла перекоса рабочего органа β_PO. Задатчик положения рабочего органа 1 с четырьмя выходными координатами Х_РО._З, Y_PO.З, Z_PO.З, β_РО.З, значения которых определяются цифровым проектом дорожного полотна, создаваемого в базовой системе координат О_б Х_б Y_б Z_б, и принятой схемой движения автогрейдера. Для управления автогрейдером имеются четыре устройства сравнения, четыре регулятора для управления ходовым устройством 6, рулевым устройством 9 и гидроприводом подъема-опускания рабочего органа 13 и гидроприводом перекоса рабочего органа 24. Автогрейдер дополнительно снабжен блоком датчиков альтернативного периодического измерения координаты Z_PO - блоком датчиков альтернативного измерения Z_PO 17, который формирует сигнал Z_PO.A. Формирование этого сигнала происходит за счет того, что вдоль рабочей площадки установлены опоры 25 между которыми натянуты струны 26 на которых, в свою очередь, закреплены элементы, формирующие альтернативную плоскость 27. На автогрейдере имеется пятое устройство сравнения 15 для определения разностного сигнала обратной связи по оси, направленной вертикально вверх Z₁=Z_PO._С-Z_PO.А, шестое устройство сравнения 14 для определения разностного сигнала системы управления по оси, направленной вертикально вверх Z_O=Z_PO.З-Z_PO._С, задатчик ΔZ₁ 19 и задатчик ΔZ₀ 18 - задатчики для задания допустимого значения разностного сигнала обратной связи по оси, направленной вертикально вверх ΔZ₁ и допустимого значения разностного сигнала системы управления по оси, направленной вертикально вверх ΔZ_O. Эти сигналы поступают в блок вычисления сигнала обобщенной обратной связи Z₃ (блок вычисления Z₃ 16) по уравнениям где Затем сигнал Z₃ подается через динамический фильтр 20 в арифметическое устройство 11 для определения сигнала обратной связи Z_OC=Z_PO.С-Z_K. Причем первый выход задатчика положения рабочего органа 1 соединен с прямым входом первого устройства сравнения 3, выход которого посредством первого регулятора 5 соединен с входом ходового устройства 6 автогрейдера, выход спутниковой навигационной системы 4 по сигналу положения средней точки режущей кромки по оси, направленной на восток Х_РО.С, полученной с помощью спутниковой навигационной системы 4 соединен с инверсным выходом первого устройства сравнения 3, второй выход задатчика положения рабочего органа 1 соединен с прямым входом второго устройства сравнения 7, выход которого посредством второго регулятора 8 соединен с входом рулевого устройства 9 автогрейдера, выход спутниковой навигационной системы 4 по сигналу положения средней точки режущей кромки по оси, направленной на север Y_PO.C, полученной с помощью спутниковой навигационной системы соединен с инверсным входом второго устройства сравнения 7, третий выход задатчика положения рабочего органа 1 соединен с прямым входом шестого устройства сравнения 21 и с прямым входом третьего устройства сравнения 10, выход третьего устройства сравнения 10 соединен посредством третьего регулятора 12 с входом гидропривода подъема-опускания рабочего органа 13, выход спутниковой навигационной системы 4 по сигналу положения средней точки режущей кромки по оси, направленной вертикально вверх Z_PO.С, полученной с помощью спутниковой навигационной системы соединен с прямым входом пятого устройства сравнения 15, с инверсным входом шестого устройства сравнения 21, с входом арифметического устройства 11, выход арифметического устройства 11 соединен с инверсным входом третьего устройства сравнения 10, четвертый выход задатчика положения рабочего органа 1 соединен с прямым входом четвертого устройства сравнения 14, выход которого посредством четвертого регулятора 23 соединен с входом гидропривода перекоса рабочего органа 24, выход датчика β 22 угла перекоса рабочего органа соединен с инверсным входом четвертого устройства сравнения 14, выход блока датчиков альтернативного измерения Z_PO 17 соединен с инверсным входом пятого устройства сравнения 15, выход шестого устройства сравнения 21 соединен с первым входом блока вычисления Z₃ 16, выход задатчик ΔZ₁ 19 соединен с вторым входом блока вычисления Z₃ 16 связи, выход пятого устройства сравнения 15 соединен с третьим входом блока вычисления Z₃ 16, вход задатчика ΔZ_O 18 соединен с четвертым входом блока вычисления Z₃ 16, выход блока вычисления Z₃ 16 соединён посредством динамического фильтра 20 с вторым входом арифметического устройства 11.

Работа автогрейдера происходит следующим образом.

В соответствии с технологическим заданием профилирования дороги автогрейдером с требуемыми значениями точности геометрических параметров по координатам X, Y и Z, заданных проектом дорожного полотна и принятой схемой движения автогрейдера, формируется с помощью блока задатчика положения рабочего органа 1 вектор задающих сигналов многомерной системы управления положением Х_РО, Y_PO, Z_PO средней точки режущей кромки и углом β_РО рабочего органа автогрейдера 2 при его движении. Значениями элемента вектора задаются требуемые величины координат Х_РО, Y_PO, Z_PO положения средней точки режущей кромки и угла β_PO поперечного перекоса рабочего органа в базовой системе координат O_БZ_БX_БY_Б при профилировании дорожного полотна. Далее требуемое значение координаты Х_РО.З в первом устройстве сравнения 3 сравнивается с сигналом обратной связи Х_РО.С спутниковой навигационной системы 4, приемник которой закреплен на автогрейдере, затем вычисленное значение ΔХ_РО=Х_РО.З-Х_РО.С поступает на первый регулятор 5 координаты Х_РО, с которого сигнал подается на ходовое устройство 6 автогрейдера, в результате чего обеспечивается автоматическое управление положением средней точки режущей кромки рабочего органа по координате Х_РО. Требуемое значение координаты Y_PO.З, сформированное в блоке задатчика 1, сравнивается во втором устройстве сравнения 7 с сигналом обратной связи Y_PO.С спутниковой навигационной системы 4, приемник которой закреплен на автогрейдере, затем вычисленное значение ΔY_PO=Y_PO.З-Y_PO.С поступает на второй регулятор 8 координаты Y_PO, с которого сигнал подается на рулевое устройство 9 автогрейдера. В результате чего обеспечивается автоматическое управление положением средней точки режущей кромки рабочего органа по координате Y_PO.

Требуемое значение координаты Z_PO.З, сформированное в блоке задатчика положения рабочего органа 1, сравнивается в третьем устройстве сравнения 10 сигналом Z_OC, вычисленным в арифметическом устройстве 11, далее вычисленное значение ΔZ_PO-Z_PO.З-Z_PO.С поступает на третий регулятор 12 координаты Z_PO, с которого сигнал подается на гидропривод подъема-опускания рабочего органа 13 автогрейдера, в результате чего обеспечивается автоматическое управление положением Z_PO средней точки режущей кромки.

Сигнал Z_PO.С о положении рабочего органа, измеряемый спутниковой навигационной системой 4, приемник которой закреплен на автогрейдере, подается на первый вход арифметического устройства 11, на инверсный вход четвертого устройства сравнения 14 и на прямой вход пятого устройство сравнения 15. На прямой вход четвертого устройства сравнения подается требуемое значение координаты Z_PO.З, сформированное в задатчике положения рабочего органа 1, затем вычисленный в этом устройстве сравнения сигнал Z_O=Z_PO.З-Z_PO.С подается на первый вход блока вычисления Z₃ 16. На инверсный вход пятого устройства сравнения 15 подается сигнал Z_PO.А с выхода блока датчиков альтернативного измерения Z_PO 17 положения рабочего органа. Далее сигнал Z₁ с выхода пятого устройство сравнения 15 подается на второй вход блока вычисления Z₃ 16, на третий вход этого блока вычисления Z_З поступает сигнал с задатчика ΔZ_O 18, а на четвертый вход блока вычисления Z₃ 16 подается сигнал с задатчика ΔZ₁ 19. Выходной сигнал Z₃ блока вычисления Z₃ 16 вычисляется по формулам: где далее сигнал Z_З подается на вход динамического фильтра 20, где формируется сигнал Z_K, поступающий далее на второй вход арифметического устройства 11.

Требуемое значение угла β_РО._З поперечного перекоса рабочего органа, сформированное в блоке задатчика положения рабочего органа 1, сравнивается в шестом устройстве сравнения 21 с сигналом обратной связи β_РО.С, измеряемым датчик β 22. Далее сигнал Δβ_РО=β_РО.З-β_РО.С, вычисленный в этом устройстве сравнения, поступает на вход четвертого регулятора 23, с которого сигнал подается на вход гидропривода перекоса рабочего органа 24, в результате чего обеспечивается автоматическое управление поперечного перекоса рабочего органа по углу β_РО.

При осуществлении изобретения блок задатчика положения рабочего органа 1, третье устройство сравнения 10, четвертое устройство сравнения 14, пятое устройство сравнения 15, шестое устройство сравнения 21, арифметическое устройство 11, задатчик ΔZ_O 18, задатчик ΔZ₁ 19, блок вычисления Z₃ 16, динамический фильтр 20, третий регулятор 12, четвертый регулятор 23 могут быть реализованы, например, на универсальном программируемом контроллере SIMATIC S7-300 /Simatic. Комплекты для комплексной автоматизации. Каталог ST70-2105. Каталог продукции SIEMENS, СПБ:, 2005/. В качестве спутниковой навигационной системы может быть использована, например, система TOPSON 3D ГНСС /Система TOPSON 3D ГНСС для автогрейдеров www.gsi.ru/art.php?id=600.

Первый регулятора 5 и второй регулятора 8 может заменить, например, машинист автогрейдера, который, наблюдая на мониторе программируемого контроллера, например, SIMATIC S7-300, значения ΔХ_РО и ΔY_PO, формирует воздействия на ходовое и рулевое устройства автогрейдера с помощью, например, джойстика.

В качестве блока датчиков альтернативного измерения Z_PO 17 может быть применен, например, ультразвуковой датчик, расположенный на автогрейдере в точке, координату Z_PO которой измеряют спутниковая навигационная система, и несколько элементов, формирующих альтернативную плоскость 27, каждый из которых закреплен выше автогрейдера на струнах 26 опор 25, расположенных вдоль трассы рабочей зоны автогрейдера. Опоры 25 закреплены в реперных точках строящегося дорожного полотна. Точность измерения координаты Z_PO ультразвуковым датчиком, например, ультразвуковой дальномер типа: SKILL 0520 или КРАТОН ДУ-01 / Промышленные ультразвуковые дальномеры https://market.yandex.ru (дата обращения: 21.03.2018 г.)./ составляет ±3 мм при диапазоне измерения 0.6-15 м, что существенно превышает точность измерения по координате Z спутниковой навигационной системы, поэтому сигнал Z_PO.А выхода блока датчиков альтернативного измерения Z_PO 17 используется для формирования корректирующего сигнала Z_K, используемого в цепи обратной связи системы автоматического управления положения рабочего органа по координате Z_PO.

В качестве динамического фильтра 20, необходимость которого обусловлена исключением скачкообразного изменения сигнала Z_K и тем самым предотвращением резкого изменения положения рабочего органа по координате Z_PO, используется, например, апериодическое звено. Использования сигналов ΔZ_O и ΔZ₁, формируемых задатчиком ΔZ_O 18 и задатчиком ΔZ₁ 19, в блоке вычисления Z₃ 16 вычисления Z_З необходимо для исключения ложного срабатывания процесса формирования сигнала Z_K.

При профилировании дороги автогрейдером, оснащенным спутниковой навигационной системой, имеет место существенная нестационарность значений выходных сигналов этой системы, измеряющей координаты Х_РО, Y_PO, Z_PO средней точки режущей кромки рабочего органа. Наиболее существенно это проявляется по координате Z_PO, где погрешность измерения составляет 20-50 мм. Этот фактор не позволяет обеспечить профилирование дороги с требуемой точностью геометрических параметров. Путем применения многомерной системы автоматического управления профилирования дороги автогрейдером, оснащенным спутниковой навигационной системой, блоком датчиков альтернативного периодического измерения координаты Z_PO рабочего органа, блока вычисления сигнала Z_K и динамического фильтра, с помощью которых выполняется коррекция сигнала обратной связи в системе управления положением рабочего органа по координате Z_PO становится возможным обеспечить требуемые показатели точности геометрических параметров дорожного полотна при минимальном расходе энергоресурсов.

Заявленный способ профилирования дороги позволяет автоматически обеспечить требуемое значение точности геометрических параметров дорожного полотна в процессе его профилирования при нестационарности значения координаты Z_PO.С, измеряемой спутниковой навигационной системой. Поскольку точность измерения этой координаты комплектом датчиков спутниковой навигационной системы соответствует 20-30 мм и может достигать, как показали экспериментальные исследования, выполненные с участием авторов настоящей заявки на изобретение, 40-50 мм, что делает невозможным получение дорожного полотна с минимальными отклонениями от проекта, составляющими 2-3 мм.

С применением заявленного способа стабилизируется процесс профилирования дороги, в результате чего повышается ее качество.

Изобретение относится к профилированию дорожного полотна автогрейдером. Техническим результатом является повышение точности геометрических параметров возводимого полотна. Способ профилирования дорожного полотна включает формирование вектора₃, задающих сигналов многомерной системы управления положением Х_РО, Y_PO, Z_PO средней точки режущей кромки и углом β_РО поперечного перекоса рабочего органа автогрейдера в базовой системе координат О_бХ_бY_бZ_б, измерение координат X_PO, Y_PO, Z_PO комплектом датчиков спутниковой навигационной системы, измерение угла β_PO датчиком угла, расположенным на автогрейдере, определение отклонений положения рабочего органа по координатам Х_РО, Y_PO, Z_PO, β_PO относительно заданного вектора , управление положением рабочего органа в функции этих отклонений с помощью ходового и рулевого устройств автогрейдера и гидроприводов подъема-опускания и перекоса рабочего органа, периодическое измерение координаты Z_PO одним или несколькими альтернативными датчиками, вычисление по разработанному алгоритму сигнала Z_K коррекции, который используют в системе управления положением рабочего органа по координате Z_PO. 4 ил.

Способ профилирования дорожного полотна автогрейдером с ходовым, рулевым устройствами и гидроприводами подъема-опускания и перекоса рабочего органа, включающий в себя формирование в соответствии с цифровым проектом дорожного полотна, выполненного в виде совокупности плановых координат X, Y и высот Z, и принятой схемой движения автогрейдера вектора задающих сигналов многомерной системы управления положением Х_РО, Y_PO, Z_PO средней точки режущей кромки и углом β_РО поперечного перекоса рабочего органа автогрейдера в базовой прямоугольной системе координат O_бX_бY_бZ_б при профилировании дорожного полотна, измерение координат Х_РО, Y_PO, Z_PO положения средней точки режущей кромки рабочего органа автогрейдера в базовой системе координат в процессе профилирования дорожного полотна комплектом датчиков спутниковой навигационной системы и формирование на выходе этой системы сигналов Х_ОС.С, Y_OC.С, Z_OC.С, измерение угла β_PO с помощью датчика β, расположенного на автогрейдере, и формирование на выходе этого датчика сигнала β_РО.С, определение отклонений ΔX_PO=Х_ОС.З-Х_ОС.С, ΔY_PO=Y_OC.З-Y_OC.С, Δβ_РО=β_ОС.З-β_ОС.С положения средней точки режущей кромки и угла перекоса рабочего органа автогрейдера относительно заданного, управление положением средней точки режущей кромки рабочего органа по координатам Х_РО и Y_PO ходовым и рулевым устройствами автогрейдера, по координате β_РО гидроприводом перекоса рабочего органа автогрейдера в функции значений ΔХ_РО, ΔY_PO, Δβ_PO соответственно, отличающийся тем, что дополнительно периодически измеряют в системе O_бX_бY_бZ_б координату Z_PO одним или несколькими альтернативными датчиками и формируют из выходных сигналов этих датчиков альтернативный сигнал Z_PO._А высотного положения рабочего органа, определяют первую разность Z₁=Z_PO._С-Z_PO._А и вторую разность Z_O=Z_PO._З-Z_PO._С, задают величины ΔZ₁ и ΔZ_O допустимых значений разностей Z₁ и Z_O при штатном режиме работы системы управления положением Z_PO рабочего органа, вычисляют первый промежуточный сигнал второй промежуточный сигнал преобразуют сигнал Z_З в корректирующий сигнал Z_K с помощью динамического фильтра, определяют сигнал обратной связи высотного положения рабочего органа Z_OC=Z_PO.C-Z_K, определяют отклонение ΔZ_PO=Z_PO.З-Z_OC, управляют положением рабочего органа по координате Z_PO его гидроприводом подъема-опускания в функции значения ΔZ_PO.