RU2574938C2 - Способ автоматического управления наземным робототехническим комплексом - Google Patents
Способ автоматического управления наземным робототехническим комплексом Download PDFInfo
- Publication number
- RU2574938C2 RU2574938C2 RU2014116179/02A RU2014116179A RU2574938C2 RU 2574938 C2 RU2574938 C2 RU 2574938C2 RU 2014116179/02 A RU2014116179/02 A RU 2014116179/02A RU 2014116179 A RU2014116179 A RU 2014116179A RU 2574938 C2 RU2574938 C2 RU 2574938C2
- Authority
- RU
- Russia
- Prior art keywords
- robotic system
- control
- robotic
- robot
- control panel
- Prior art date
Links
- 238000004805 robotic Methods 0.000 title claims abstract description 33
- 238000004891 communication Methods 0.000 claims abstract description 6
- 239000000126 substance Substances 0.000 abstract description 3
- 238000003384 imaging method Methods 0.000 abstract 1
- 230000001276 controlling effect Effects 0.000 description 4
- 230000003044 adaptive Effects 0.000 description 3
- 230000004438 eyesight Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 230000015572 biosynthetic process Effects 0.000 description 2
- 238000011109 contamination Methods 0.000 description 2
- 238000001514 detection method Methods 0.000 description 2
- 238000005755 formation reaction Methods 0.000 description 2
- 230000004301 light adaptation Effects 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000000875 corresponding Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 230000004907 flux Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 238000000034 method Methods 0.000 description 1
- 230000001537 neural Effects 0.000 description 1
- 230000002285 radioactive Effects 0.000 description 1
- 238000011084 recovery Methods 0.000 description 1
- 239000011150 reinforced concrete Substances 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
- 230000001702 transmitter Effects 0.000 description 1
Images
Abstract
Изобретение относится к области робототехники, а именно к робототехническим средствам, предназначенным для работы в дистанционном режиме в особо опасных условиях без участия человека. Способ автоматического управления наземным робототехническим комплексом включает радиообмен между пультом управления и объектом управления, обеспечение ввода и обработки входной информации, поступающей от бортовых датчиков, осуществление вычисления текущей ориентации и местоположения робототехнического комплекса. При этом осуществляют автоматический возврат робототехнического комплекса в точку старта или в зону уверенного радиообмена при потере радиосвязи между пультом и объектом управления по ранее пройденной траектории с корректировкой этой траектории в обход обнаруженных препятствий. Для этого производится реализация на борту робототехнического комплекса базовых алгоритмов движения в заранее неизвестной обстановке. Предлагаемое техническое решение позволит решить задачу трехмерной визуализации робототехнического комплекса в окружающей обстановке с наложением опасных факторов аварийной ситуации и задачу автономных движений по скорректированным при необходимости траекториям. 1 ил.
Description
Изобретение относится к области робототехники, а именно к робототехническим средствам, предназначенным для работы в дистанционном режиме в особо опасных условиях без участия человека.
Известно, что в случае возникновения техногенных аварий и пожаров, сопряженных с поражением больших площадей в зонах повышенного риска, обусловленных наличием радиации, химической и биологической зараженности местности, взрывоопасностью, для подавления пожара, проведения пожарно-спасательных и аварийно-восстановительных работ необходимо максимально сократить непосредственное нахождение людей в опасных зонах, исключив при этом возможность их поражения. Для выполнения этих работ наиболее эффективно применять технологии проведения аварийно-спасательных работ с использованием робототехнических комплексов различного назначения.
Существенные трудности для операторов при управлении роботом вне зоны прямой видимости представляют ситуации серьезного ухудшения качества или полной потери видеосигнала, принимаемого с расположенных на роботе телекамер, а также ситуация частичной или полной потери управления и прекращение получения телеметрической информации вследствие прерывания канала связи. Это обусловлено в первую очередь физическими ограничениями на беспроводную передачу сигналов управления и телевидения с применением передатчиков, усилителей и антенн, работающих в разрешенном диапазоне частот. Причинами этих помех могут являться как естественные преграды, например железобетонные конструкции, складки местности, растительность, так и искусственные, например сильные индустриальные радиопомехи.
Для решения этих задач в части автономности движения необходимо иметь подсистемы технического зрения, навигации, формирования модели внешней среды, планирования и отработки автономного целенаправленного движения. С точки зрения аппаратного расширения в системах управления должны быть предусмотрены элементы коммутации для внедрения таких составляющих, как системы сбора информации на основе датчиков, системы технического зрения на основе телекамер и тепловизоров, а также измерительных приборов и устройств, предназначенных для сбора информации об опасных факторах внешней среды (таких как химическое и радиоактивное загрязнение).
С точки зрения программного расширения возможностей работы удобным является применение в системе отлаженных протоколов обмена информацией как на борту робота, так и между роботом и пультом управления.
Известно устройство управления адаптивным мобильным роботом по патенту РФ №2187832, кл. G05D 1/02, G06F 19/00, опубликованному 20.08.2002.
Данное устройство предназначено для управления движением адаптивного робота, обладающего свойствами искусственного интеллекта.
Устройство управления адаптивным роботом содержит блок сенсорных датчиков, выходы которого соединены с входами блока формирования модели внешней среды, чьи выходы подключены к первым входам вычислительного блока, вторые входы которого связаны со вторыми выходами блока исполнительных устройств, а выходы подключены к входам m-стабильного триггера. В качестве вычислительного блока используется нейросеть, содержащая матрицу k·m ключевых элементов. Кроме того, имеется схема сравнения, блок задания движения, блок задания констант, блок регулирования, блок определения координат робота, блок датчиков внутренней информации.
Недостатками данного устройства являются его плохая адаптация к сложной и изменяющейся окружающей среде и к сложному и изменяющемуся внутреннему состоянию робота и узкая область применения.
Наиболее близким к предлагаемому техническому решению является мобильный робот и способ корректировки его курса по патенту РФ №2210492, кл. B25J 5/00, B25J 9/00, опубликованному 27.03.2003, принятый за прототип.
Данное техническое решение содержит устройство для перемещения мобильного робота по помещению, устройство для обнаружения наличия препятствия, управляющую часть, соединенную с устройством для перемещения мобильного робота и устройством для обнаружения препятствия и управляющую ими, устройство для определения текущего местоположения мобильного робота, соединенное с управляющей частью, и источник питания. Устройство для определения текущего местоположения мобильного робота содержит первую обзорную телекамеру для создания изображения потолка помещения и распознавания базового знака на потолке и первую видеоплату, обрабатывающую изображение, полученное с первой обзорной телекамеры, и передающую данные в управляющую часть. Источник питания соединен с управляющей частью и аккумулирует электроэнергию и питает устройство для перемещения мобильного робота, устройство для обнаружения препятствия, устройство для определения местоположения и управляющую часть. Устройство для обнаружения препятствия содержит линейный лазер для излучения линейного светового пучка по направлению к препятствию, вторую обзорную телекамеру для распознавания отраженного от препятствия линейного светового пучка и вторую видеоплату для обработки видеоданных, полученных второй телекамерой. Изобретение позволяет определять местоположение робота и корректировать его направление при обнаружении препятствия.
Недостатками данного устройства являются: плохая адаптация к изменяющимся условиям окружающей среды, ограниченность числа решаемых задач из-за узконаправленной комплектации и отсутствие внешнего наблюдения.
Задачей, на решение которой направлено предлагаемое техническое решение, является разработка системы автоматического возврата робототехнического комплекса в исходную позицию в экстремальной ситуации при потере связи по каналу управления.
Для этого в способе автоматического управления наземным робототехническим комплексом, включающим в себя радиообмен между пультом управления и робототехническим комплексом, обеспечение ввода и обработку входной информации, поступающей от бортовых датчиков, вычисление текущей ориентации и местоположения робототехнического комплекса, при потере радиосвязи между пультом управления и робототехническим комплексом осуществляют его автоматический возврат в точку старта или в зону уверенного радиообмена по ранее пройденной траектории с корректировкой этой траектории в обход обнаруженных препятствий путем реализации на борту робототехнического комплекса базовых алгоритмов движения в заранее неизвестной обстановке по дальнометрическому изображению внешней среды с помощью навигационно-вычислительного блока.
Технический результат заключается в повышении эффективности управления робототехническим средством и приспособляемости к сложной и изменяющейся окружающей среде. Такой способ является аварийным способом управления робототехническим средством и позволяет сохранить робототехническое средство в экстремальных условиях при нарушении штатных режимов управления.
В целях повышения эффективности работы операторов в дистанционном режиме управления и обеспечения автономного и/или автоматического управления наземными робототехническими комплексами в особо сложных условиях работы в штатные системы управления робототехнических комплексов встраивают комплект устройств интеллектуального управления.
При помощи специального измерительного оборудования на базе сканирующего лазерного дальномера, ультразвуковых датчиков и датчиков теплового потока комплект формирует на экране пульта управления упрощенную модель окружающей обстановки вокруг мобильного робота. Также комплект обеспечивает моделирование положения самого робота, его ориентации в пространстве и положение его подвижных частей. Это позволяет оператору намного более полно оценивать рабочую ситуацию в режиме реального времени.
Комплект обладает возможностью управления роботом в автоматическом режиме, а именно позволяет вернуть робота к оператору при наличии серьезных помех или полном пропадании сигналов радиоуправления. При ручном управлении роботом, позволяет избегать попадания робота в зоны с опасно высокой температурой, дает возможность управления роботом с помощью макрокоманд выведения манипулятора в рабочее или транспортное положения.
В состав комплекта входят: устройство сопряжения со штатной системой управления, навигационно-вычислительный блок, комплект датчиков и комплект расширения пульта дистанционного управления.
Все составные части комплекта выполнены в виде конструктивно законченных изделий (модулей) с местами крепления на несущие части корпуса робота и оснащены необходимыми разъемами для внешнего подключения.
Навигационно-вычислительный блок предназначен для непосредственного управления движением мобильного робота по заданной траектории.
Аппаратно-программное обеспечение навигационно-вычислительного блока выполняет задачи сбора информации, подготовленной другими устройствами, ее анализа и выработки управляющих команд на штатные устройства робототехнического комплекса. Блок работает независимо от канала дистанционного управления и в автоматическом режиме следит за состоянием окружающей среды. Блок выполняет задачи построения карты местности, формирования траектории движения при автономном возврате робота и посылки команд движения или остановки на исполнительные механизмы шасси робота. В том числе блок препятствует управлению подвижными механизмами робототехнического комплекса в случае их непосредственной близости к температурно-опасным зонам. Память навигационно-вычислительного блока позволяет запомнить маршрут до 50 метров пройденного пути.
На чертеже изображена схема возврата робототехнического комплекса в точку старта или в зону уверенного радиообмена.
Реализация заявляемого способа автоматического управления наземным робототехническим комплексом заключается в следующем.
Для получения детального дальнометрического изображения внешней среды во фронтальной части робота размещают лазерный дальномер, что позволяет решить задачу определения геометрических параметров заранее неопределенного пространства вокруг робота при прямолинейном движении. В навигационно-вычислительном блоке происходит обработка значений, поступающих от дальномера. Далее с использованием полученной информации решается задача построения карты местности и формирования траектории движения.
Кадр изображения формируется в виде массива дальностей, полученных лазерным дальномером. Сканирование лазерного луча производится по углу азимута и возвышения. Этот массив данных поступает в навигационно-вычислительный блок, который дополняет его данными о пройденном пути, полученными с обоих датчиков пройденного пути, о курсе движения, поступившем от гироскопа, о крене и дифференте робота. Кроме того, в кадр изображения заносится информация о глобальных координатах положения робота в пространстве, полученных спутниковой навигационной системой. Окончательно сформированный кадр передается в бортовой компьютер по быстродействующему интерфейсу Ethernet для дальнейшей его обработки. Обработав введенный кадр изображения внешней среды, бортовой компьютер строит траекторию движения внутри этого кадра и выводит ее в навигационно-вычислительный блок для дальнейшей ее реализации.
Уже на первом этапе обработки с целью получения для каждой отдельной точки обзора текстурированный фрагмент виртуального трехмерного изображения окружающей среды предлагается комплексировать информацию от видеокамеры и дальномера. В дальнейшем в процессе движения такие фрагменты собираются в объединенную трехмерную модель больших областей внешней среды (например, одного этажа или всего здания). В предлагаемом решении лазерный сенсор с зоной обзора в виде плоского сектора 180° (270°) и широкоугольная видеокамера с одной ПЗС-линейкой с зоной обзора в виде плоского сектора 90° собирают в единый модуль для обеспечения максимально общей зоны обзора. Данный модуль закрепляется на вращающемся сканаторе, позволяющем получать круговую зону обзора в телесном угле 360°×90°, и устанавливается на одну из площадок крепления телекамеры.
Комплексирование дальнометрического и телевизионного изображений выполняется в два этапа.
На первом этапе для каждого элементарного дальнометрического измерения (дальнометрического пикселя) находится соответствие в пространстве видеокадра и для соседних измерений определяется геометрическое и цветовое расстояния, с учетом которых на втором этапе строются аппроксимирующие элементарные грани каркасной модели. Соответствие пикселей видеокадра и измерений дальномера находится путем преобразования координат. На втором этапе по дальнометрическому изображению строится трехмерная каркасная модель и на нее "натягивается" соответствующий телевизионный кадр. При этом каркасная модель формируется в виде набора отдельных треугольников, а телевизионный кадр с исправленной геометрией загружается в текстуру. Для построений может быть использован графический пакет Direct3D. В этой модели могут быть отмечены температурно-опасные зоны, выявленные с помощью температурных датчиков и навигационной подсистемы.
При этом эффективность управления существенно возрастает вследствие появления дополнительной возможности получения различных геометрических сечений рабочей зоны и ее осмотра с различных позиций наблюдения (в том числе и с позиций, в которых сенсоры не находились или находится не могут).
Комплексирование дальнометрического и телевизионного изображения, снятых с одной позиции, позволяет получить только фрагмент рабочей зоны.
Для формирования полной модели рабочей зоны (например, целого помещения, одного этажа или всего здания) комплексированные изображения получают для разных позиций (например, в процессе движения), а затем объединяют в обобщенную модель.
Объединение отдельных комплексированных изображений возможно только при решении навигационной задачи - определении приращения координат (линейных и угловых) между позициями съема изображений.
Реальная ситуация во внешней среде по каким-либо причинам может меняться с течением времени.
В процессе движения робота эти несоответствия могут быть обнаружены и использованы для уточнения модели внешней среды. Обнаруженные бортовой системой технического зрения препятствия и свободные от препятствий участки заносятся в модель путем преобразования из подвижной системы координат, связанной с роботом, в неподвижную систему координат, связанную с внешней средой.
Используя информацию о построенной модели и о местонахождении в ней робота, бортовое программное обеспечение формирует целенаправленную безопасную траекторию движения. Отработка найденной траектории сводится к выполнению определенной последовательности ограниченного набора команд, сводящихся к удержанию на заданном курсе и поддержанию заданного радиуса поворота.
Предлагаемое техническое решение позволит решить задачу трехмерной визуализации робототехнического комплекса в окружающей обстановке с наложением опасных факторов аварийной ситуации и задачу автономных движений по скорректированным при необходимости траекториям.
Claims (1)
- Способ автоматического управления наземным робототехническим комплексом, включающий радиообмен между пультом управления и робототехническим комплексом, обеспечение ввода и обработку входной информации, поступающей от бортовых датчиков, вычисление текущей ориентации и местоположения робототехнического комплекса, отличающийся тем, что при потере радиосвязи между пультом управления и робототехническим комплексом осуществляют его автоматический возврат в точку старта или в зону уверенного радиообмена по ранее пройденной траектории с корректировкой этой траектории в обход обнаруженных препятствий путем реализации на борту робототехнического комплекса базовых алгоритмов движения в заранее неизвестной обстановке по дальнометрическому изображению внешней среды с помощью навигационно-вычислительного блока.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2014116179/02A RU2574938C2 (ru) | 2014-04-22 | Способ автоматического управления наземным робототехническим комплексом |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2014116179/02A RU2574938C2 (ru) | 2014-04-22 | Способ автоматического управления наземным робототехническим комплексом |
Publications (2)
Publication Number | Publication Date |
---|---|
RU2014116179A RU2014116179A (ru) | 2015-10-27 |
RU2574938C2 true RU2574938C2 (ru) | 2016-02-10 |
Family
ID=
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2661964C2 (ru) * | 2016-04-12 | 2018-07-23 | Федеральное государственное бюджетное учреждение науки Институт автоматики и процессов управления Дальневосточного отделения Российской академии наук (ИАПУ ДВО РАН) | Способ автоматического формирования гладких траекторий движения мобильного робота в неизвестном окружении |
RU2718015C2 (ru) * | 2018-07-16 | 2020-03-30 | ФЕДЕРАЛЬНОЕ ГОСУДАРСТВЕННОЕ КАЗЕННОЕ ВОЕННОЕ ОБРАЗОВАТЕЛЬНОЕ УЧРЕЖДЕНИЕ ВЫСШЕГО ОБРАЗОВАНИЯ Военная академия Ракетных войск стратегического назначения имени Петра Великого МИНИСТЕРСТВА ОБОРОНЫ РОССИЙСКОЙ ФЕДЕРАЦИИ | Способ автоматического управления наземным робототехническим комплексом или их группой в обороне |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5219264A (en) * | 1986-09-19 | 1993-06-15 | Texas Instruments Incorporated | Mobile robot on-board vision system |
RU2143334C1 (ru) * | 1998-07-27 | 1999-12-27 | Таганрогский государственный радиотехнический университет | Устройство управления адаптивным мобильным роботом |
RU2210492C2 (ru) * | 2000-11-17 | 2003-08-20 | Самсунг Кванджу Электроникс Ко., Лтд. | Мобильный робот и способ корректировки его курса |
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5219264A (en) * | 1986-09-19 | 1993-06-15 | Texas Instruments Incorporated | Mobile robot on-board vision system |
RU2143334C1 (ru) * | 1998-07-27 | 1999-12-27 | Таганрогский государственный радиотехнический университет | Устройство управления адаптивным мобильным роботом |
RU2210492C2 (ru) * | 2000-11-17 | 2003-08-20 | Самсунг Кванджу Электроникс Ко., Лтд. | Мобильный робот и способ корректировки его курса |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2661964C2 (ru) * | 2016-04-12 | 2018-07-23 | Федеральное государственное бюджетное учреждение науки Институт автоматики и процессов управления Дальневосточного отделения Российской академии наук (ИАПУ ДВО РАН) | Способ автоматического формирования гладких траекторий движения мобильного робота в неизвестном окружении |
RU2718015C2 (ru) * | 2018-07-16 | 2020-03-30 | ФЕДЕРАЛЬНОЕ ГОСУДАРСТВЕННОЕ КАЗЕННОЕ ВОЕННОЕ ОБРАЗОВАТЕЛЬНОЕ УЧРЕЖДЕНИЕ ВЫСШЕГО ОБРАЗОВАНИЯ Военная академия Ракетных войск стратегического назначения имени Петра Великого МИНИСТЕРСТВА ОБОРОНЫ РОССИЙСКОЙ ФЕДЕРАЦИИ | Способ автоматического управления наземным робототехническим комплексом или их группой в обороне |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CA3006155C (en) | Positioning system for aerial non-destructive inspection | |
US20220124303A1 (en) | Methods and systems for selective sensor fusion | |
CN109669468B (zh) | 测量装置、无人机及其控制装置、控制方法及存储介质 | |
US9183638B2 (en) | Image based position determination | |
CN115597659B (zh) | 一种变电站智能安全管控方法 | |
EP3168704A1 (en) | 3d surveying of a surface by mobile vehicles | |
CN108958250A (zh) | 多传感器移动平台及基于已知地图的导航与避障方法 | |
CN104932001A (zh) | 一种实时3d核辐射环境重建监测*** | |
CN214520204U (zh) | 一种基于深度相机和激光雷达的港区智能巡检机器人 | |
CN104122890A (zh) | 城市地下轨道巡检机器人***及检测方法 | |
CN115793649B (zh) | 一种电缆沟自动巡检装置及巡检方法 | |
JP2014203146A (ja) | ロボット誘導方法と装置 | |
RU2661964C2 (ru) | Способ автоматического формирования гладких траекторий движения мобильного робота в неизвестном окружении | |
CN109960254B (zh) | 机器人及其路径规划方法 | |
Liu et al. | Vision aided unmanned aerial vehicle autonomy: An overview | |
CN102736633A (zh) | 一种用于空间站舱外机动监视器的导航、控制与成像*** | |
El-Hakim et al. | A mobile system for indoors 3-D mapping and positioning | |
Zalud et al. | Calibration and evaluation of parameters in a 3D proximity rotating scanner | |
KR101319526B1 (ko) | 이동 로봇을 이용하여 목표물의 위치 정보를 제공하기 위한 방법 | |
Su et al. | A framework of cooperative UAV-UGV system for target tracking | |
RU2574938C2 (ru) | Способ автоматического управления наземным робототехническим комплексом | |
McArthur et al. | Pose-estimate-based target tracking for human-guided remote sensor mounting with a UAV | |
Pugliese et al. | LiDAR-aided relative and absolute localization for automated UAV-based inspection of aircraft fuselages | |
Troll et al. | Indoor Localization of Quadcopters in Industrial Environment | |
JP2021182177A (ja) | 車両操縦システムと車両操縦方法 |