Акустический фазовый пеленгатор Российский патент 2020 года по МПК G01S3/802 G01S15/46 G05D1/02 

Описание патента на изобретение RU2728515C1

Изобретение относится к робототехнике, а именно к аппаратуре для ориентации транспортных роботов по акустическому сигналу стационарного маяка или маяка ведущего транспортного устройства. В настоящее время получают распространение ведомые роботизированные транспортные средства доставки груза, следующие за ведущим устройством или определяющие место нахождения по опорным маякам. Для определения направления на ведущее устройство или маяк обычно применяют оптические системы [1, 2], однако в случае малопрозрачной среды (туман, дым в воздухе или замутнение в водной среде) ориентация на оптический маяк осложнена и даже невозможна. Для определения направления в таких случаях применяются акустические сигналы [3, 4]. Достаточно известны устройства для акустической пеленгации при выполнении подводных работ, такие как, например пеленгатор для водолазов по патенту РФ 2439602 [5], использующий амплитудный способ пеленгации, патент РФ 2494914 [6], использующий корреляционный способ. Оба патента предназначены для ориентации людей и не применимы в автоматизированных транспортных устройствах (роботах). Кроме того точность пеленгации таких устройств невысокая, порядка 10-20°.

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

Поставленная задача может быть решена применением радиофизических методов фазовой пеленгации (Чердынцев В.А. Радиотехнические системы: Уч. Пос. стр. 194-196) [7]. Указанные методы применимы и для гармонических звуковых волн, излучаемых непрерывно или периодическими пакетами. В отличие от радиочастотных пеленгаторов, нет необходимости акустические гармонические сигналы преобразовывать в промежуточную частоту, а обработку выполнять на применяемой звуковой (ультразвуковой) частоте. По построению измерительной базы близким к предлагаемому изобретению является патент РФ 2155352 [8], имеющий две одинаковые взаимно перпендикулярные измерительные базы.

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

На фиг. 1 показаны микрофоны M0, M1 и М2, образующие две взаимно перпендикулярные базы пеленгатора M0-M1 и М02 с одинаковой длиной L. Акустический сигнал приходит под углом α относительно оси пеленгатора М0-Х. Линия АВ, проходящая через микрофон М0, совпадающий с центром координат пеленгатора, в определенный момент времени t0 совпадает с фронтом акустического сигнала. Разности фаз сигналов, снимаемых с микрофонов M1 и М2 относительно М0, определяются следующими выражениями:

где λ длина волны λ=; С - скорость звука в среде, F - частота сигнала.

Таким образом, азимут источника сигнала определяется по разностям фаз:

Или

Для устранения неоднозначности значение измерительной базы должно удовлетворять условию L≤λ/2 и для расчета угла прихода а в пределах -π…π следует использовать знаки величин разностей фаз Δϕ1 и Δϕ2, приведенных в таблице 1.

Так как при измерении разностей фаз неизбежны погрешности, то следует учитывать, что при вычислении обратных тригонометрических функций результат будет иметь максимальную погрешность при абсолютных значениях аргумента близких к единице (0.8-1). Для снижения погрешностей преобразования следует выбирать (2) или (3) из сравнения абсолютных величин |Δϕ1| и |Δϕ2|. При |Δϕ1|≤|Δϕ2| для расчетов применять формулу (2), а при |Δϕ1|>|Δϕ2| - применять (3).

На фиг. 2 приведена блок-схема фазового акустического пеленгатора. Устройство содержит три микрофона 1, 2, 3, подключенных к трем одинаковым блокам предварительной обработки сигналов 4, 5, 6, каждый из них состоит из последовательно включенных предварительного усилителя 7, 8, 9, полосового фильтра 10, 11, 12 и усилителя - ограничителя 13, 14, 15, формирующего логические уровни. Выходы усилителей -ограничителей подключены ко входам инверторов 16, 17, 18, и формирователей коротких импульсов 19, 20, 21. У опорного канала 4, входной сигнал которого снимается с микрофона 1, расположенного в вершине прямого угла пеленгатора, выход предварительного усилителя 7 и выход полосового фильтра 10 подключены к входам выпрямителей 22 и 23, выходы которых соединены со входом схемы сравнения 24. Выход усилителя - ограничителя 13 опорного канала подключен к счетному входу делителя на два 25, прямой и инверсный выходы которого, а так же выходы всех усилителей - ограничителей 13-15, инверторов 16 - 18 и формирователей коротких импульсов 19-21 подключены к входам блока логики 26, выполняющим формирование сигналов в соответствии с таблицей 2. Выходы блока логики 26 соединены с входами сброса счетчиков 27, 28, входами сброса и установки триггеров знака 29, 30 и входами записи параллельных регистров 31, 32. К тактовым входам счетчиков 27, 28 подключен выход тактового генератора 33. Выходы счетчиков 27, 28 и триггеров знака 29, 30 подключены к входам данных регистров 31, 32. Трехуровневые выходы регистров 31, 32 через шину соединены с входами данных микроконтроллера 34, к другим входам которого подключены выход схемы сравнения 24, и один из выходов делителя на два 25. Два выхода микроконтроллера 34 соединены с входами разрешения вывода данных регистров 31, 32. Результат измерений выводится на выходной порт микроконтроллера 34.

Устройство работает следующим образом. Сигналы с микрофонов 1-3 усиливаются предварительными усилителями 7-9, далее полосовыми фильтрами 10-12 выделяется составляющая с рабочей частотой сигнала от маяка. В опорном канале 4, обрабатывающим сигнал микрофона Мо, с выхода усилителя 7 сигнал всего принимаемого частотного диапазона и с выхода фильтра 10 отфильтрованный сигнал поступают на выпрямители 22, 23, с которых средние уровни выпрямленных напряжений сравниваются схемой сравнения 24. При отсутствии полезного сигнала уровень на выходе фильтра 10 ниже уровня на выходе предварительного усилителя 7, при этом схема сравнения 24 подает сигнал отсутствия полезного сигнала на микроконтроллер 34. При появлении сигнала на рабочей частоте уровень сигнала на выходе фильтра 10 значительно возрастает и схема сравнения 24 подает на микроконтроллер 34 сигнал на разрешения определения пеленга PelEn.

Вариант временных диаграмм при пеленгации приведен на фиг. 3.

Логические уровни с выходов усилителей - ограничителей 13-15, инверторов 16-18 и формирователей коротких импульсов 19-21, которые вырабатывают импульсы Т0, Т1, Т2 по положительным (либо, как вариант, отрицательным) фронтам с выходов усилителей -ограничителей 13-15, поступают на входы блока логики 26. Длительность импульсов Т0, Т1, Т2 не превышает половины периода счетных импульсов тактового генератора 33.

На выходах блока логики 26 вырабатываются сигналы по логическим функциям приведенным в таблице 2.

В зависимости от знака разности фаз триггер знака (29, 30) соответствующего канала устанавливается в «1» или сбрасывается в «0». На фиг. 3 приведен пример временных диаграмм для угла π/2<α<π, в этом случае разности фаз Δϕ1>0 и Δϕ2<0. Сигналы RES1 и RES2 обнуляют счетчики 27, 28 в начале интервала измерения разности фаз, а импульсы WR1 и WR2 передним фронтом записывают абсолютные значения разностей фаз |Δϕ1| и |Δϕ2| с выходов счетчиков 27, 28 и триггеров 29, 30 в параллельные регистры 31, 32 в конце интервалов измерения. Тактовая частота fclk на выходе тактового генератора 33 определяется величиной шага дискретизации измеряемых разностей фаз и для двоичных счетчиков разрядности N составляет π/2N. Таким образом для fclk необходимо соблюдение условия fclk≤F*(2N+1) во избежание переполнения счетчиков 27, 28. Чтобы значительно не увеличивать шаг дискретизации достаточно чтобы fclk ≈ F*(2N). Для транспортных роботов достаточно точности пеленгации 2-4°, что достижимо при разрядности двоичных счетчиков N=6-7 бит. Как положительная, так и отрицательная разности фаз измеряются в течение полупериода уровня «1» на выходе QE делителя на два 25. Уровень «1» с инверсного выхода /QE, подаваемый на микроконтроллер 34 сообщает о готовности данных. Чтение данных с регистров 27, 28 микроконтроллером 34 выполняется поочередной подачей разрешающих уровней на входы разрешения трехуровневых выходов регистров 127, 28. Обработка полученных данных заключается в выборе из постоянной памяти микроконтроллера 34 запрограммированных основных значений обратных тригонометрических функций по результатам считывания разностей фаз Δϕ со счетчиков 27, 28 в зависимости от их соотношения, а так же учета дополнений, кратных π/2, в зависимости от знаков разностей фаз Δϕ. Результат измерений угла и признак обнаружения сигнала маяка выводится на выходную шину (OUT DATA) микроконтроллера 34.

Источники:

1. Власов С.М., Бойков В.И., Быстров С.В., Григорьев В.В. Бесконтактные средства локальной ориентации роботов. - СПб: Университет ИТМО, 2017. - 169 с.

2. Карпов В.Э., Платонова М.В. СИСТЕМА НАВИГАЦИИ МОБИЛЬНОГО РОБОТА (Москва, Московский Энергетический Институт (Технический Университет), Россия /docplayer.ru/

3. Тихомиров А.В., Иванов М.С., Омельянчук Е.В. Разработка акустического пеленгатора. Труды МАИ. Выпуск №90

4. Качармина Е.Г., Глазков В.В. Разработка модели акустического пеленгатора в пакете MATLAB; электронный журнал «молодежный научно-технический вестник», ФГБОУ МГТУ им. Баумана, №11, 2015 г.

5. Кранц В.З., Островский Д.Б. Устройство и способ определения водолазом направления на источник звукового сигнала; патент на изобретение RU 2439602 С2, кл. G01S 3/802: 10.01.2012 Бюл. №1, (fips.ru).

6. Берков Ю.А. Пеленгатор водолаза; патент на изобретение RU 2494914 С1, кл. G01S 3/802: 10.10.2013 Бюл. №28, (fips.ru).

7. Чердынцев В.А. Радиотехнические системы: Учеб. Пособие для вузов. - Минск.: Выш. Шк., 1988, - 369 с.: ил.

8. Дикарев В.И., Гумен С.Г., Журкович В.В. и др. Фазовый способ пеленгации и фазовый пеленгатор для его осуществления; патент на изобретение RU 2155352 С1, кл. G01S 3/46: 27.04.2003 Бюл. Изобр. №12/2003.

Похожие патенты RU2728515C1

название год авторы номер документа
АКУСТООПТИЧЕСКИЙ ПРИЕМНИК 1991
  • Дикарев Виктор Иванович
  • Медведев Владимир Михайлович
  • Федоров Валентин Васильевич
  • Шилим Иван Тимофеевич
RU2007046C1
ПЕЛЕНГАТОР ИСТОЧНИКОВ АКУСТИЧЕСКИХ ИЗЛУЧЕНИЙ 1993
  • Хохлов В.К.
  • Пылаев В.А.
  • Волчихин И.В.
  • Степаненко Н.В.
RU2048678C1
СПОСОБ АВТОКОРРЕЛЯЦИОННОГО ПРИЕМА ШУМОПОДОБНЫХ СИГНАЛОВ 2005
  • Дикарев Виктор Иванович
  • Зайцев Игорь Евгеньевич
  • Рюмшин Константин Юрьевич
  • Теремов Михаил Петрович
  • Спасибин Андрей Александрович
RU2296432C1
ФАЗОВЫЙ ПЕЛЕНГАТОР 2001
  • Заренков В.А.
  • Заренков Д.В.
  • Дикарев В.И.
RU2189609C1
ПАНОРАМНЫЙ ПРИЕМНИК 1992
  • Дикарев Виктор Иванович
  • Койнаш Борис Васильевич
  • Медведев Владимир Михайлович
  • Шилим Иван Тимофеевич
  • Шкуро Александр Георгиевич
RU2010245C1
СИСТЕМА ОПРЕДЕЛЕНИЯ ПАРАМЕТРОВ ДВИЖЕНИЯ АСТЕРОИДА 2016
  • Медведев Юрий Дмитриевич
  • Бондаренко Юрий Сергеевич
  • Дикарев Виктор Иванович
  • Койнаш Борис Васильевич
RU2637048C1
СПОСОБ ФАЗОВОЙ ПЕЛЕНГАЦИИ И ФАЗОВЫЙ ПЕЛЕНГАТОР 2018
  • Валяев Игорь Николаевич
  • Коваленко Владимир Павлович
  • Турлов Залимхан Нурланович
  • Филиппов Федор Евгеньевич
RU2681942C1
ФАЗОВЫЙ СПОСОБ ПЕЛЕНГАЦИИ И ФАЗОВЫЙ ПЕЛЕНГАТОР ДЛЯ ЕГО ОСУЩЕСТВЛЕНИЯ 1999
  • Дикарев В.И.
  • Гумен С.Г.
  • Журкович В.В.
  • Замарин А.И.
  • Карелов И.Н.
  • Кармазинов Ф.В.
  • Рыбкин Л.В.
  • Сергеева В.Г.
RU2155352C1
СПОСОБ ОБНАРУЖЕНИЯ ТЕРПЯЩИХ БЕДСТВИЕ 2007
  • Заренков Вячеслав Адамович
  • Заренков Дмитрий Вячеславович
  • Дикарев Виктор Иванович
  • Койнаш Борис Васильевич
RU2346290C1
ФАЗОВЫЙ СПОСОБ ПЕЛЕНГАЦИИ И ФАЗОВЫЙ ПЕЛЕНГАТОР ДЛЯ ЕГО ОСУЩЕСТВЛЕНИЯ 2000
  • Дикарев В.И.
  • Гумен С.Г.
  • Журкович В.В.
  • Замарин А.И.
  • Карелов И.Н.
  • Кармазинов Ф.В.
  • Рыбкин Л.В.
  • Сергеева В.Г.
RU2175770C1

Иллюстрации к изобретению RU 2 728 515 C1

Реферат патента 2020 года Акустический фазовый пеленгатор

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

Формула изобретения RU 2 728 515 C1

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

Документы, цитированные в отчете о поиске Патент 2020 года RU2728515C1

УСТРОЙСТВО И СПОСОБ ОПРЕДЕЛЕНИЯ ВОДОЛАЗОМ НАПРАВЛЕНИЯ НА ИСТОЧНИК ЗВУКОВОГО СИГНАЛА 2010
  • Кранц Виталий Залманович
  • Островский Дмитрий Борисович
RU2439602C2
ПЕЛЕНГАТОР ВОДОЛАЗА 2012
  • Берков Юрий Алексеевич
RU2494914C1
СПОСОБ И УСТРОЙСТВО ОПРЕДЕЛЕНИЯ НАЧАЛЬНЫХ КООРДИНАТ АВТОНОМНОГО НЕОБИТАЕМОГО ПОДВОДНОГО АППАРАТА 2016
  • Хаметов Руслан Касымович
  • Бородин Михаил Анатольевич
RU2629916C1
СИСТЕМА И СПОСОБ ОПРЕДЕЛЕНИЯ МЕСТОПОЛОЖЕНИЯ ВОДОЛАЗА 2014
  • Кранц Виталий Залманович
  • Островский Дмитрий Борисович
RU2575045C1
СПОСОБ НАВИГАЦИОННОГО ОБЕСПЕЧЕНИЯ АВТОНОМНОГО ПОДВОДНОГО РОБОТА, КОНТРОЛИРУЕМОГО С БОРТА ОБЕСПЕЧИВАЮЩЕГО СУДНА 2007
  • Матвиенко Юрий Викторович
  • Каморный Александр Валерьевич
  • Кузьмин Андрей Витальевич
  • Нургалиев Радмир Фаридович
  • Рылов Роман Николаевич
RU2344435C1
CN 103376452 A, 30.10.2013
US 5940346 A, 17.08.1999
US 8289811 B2, 16.10.2012.

RU 2 728 515 C1

Авторы

Антошкин Станислав Борисович

Даты

2020-07-30Публикация

2019-05-14Подача