RU2386107C1 - Автономный способ определения начальной ориентации приборной системы координат бесплатформенного инерциального блока управляемого объекта относительно базовой системы координат - Google Patents
Автономный способ определения начальной ориентации приборной системы координат бесплатформенного инерциального блока управляемого объекта относительно базовой системы координат Download PDFInfo
- Publication number
- RU2386107C1 RU2386107C1 RU2008150507/28A RU2008150507A RU2386107C1 RU 2386107 C1 RU2386107 C1 RU 2386107C1 RU 2008150507/28 A RU2008150507/28 A RU 2008150507/28A RU 2008150507 A RU2008150507 A RU 2008150507A RU 2386107 C1 RU2386107 C1 RU 2386107C1
- Authority
- RU
- Russia
- Prior art keywords
- coordinate system
- projections
- earth
- angular velocity
- bib
- Prior art date
Links
Landscapes
- Navigation (AREA)
Abstract
Изобретение относится к области приборостроения и может быть использовано в инерциальных системах управления для определения навигационных параметров управляемых подвижных объектов. Технический результат - повышение точности. Для достижения данного результата по сигналам акселерометров определяют приращения проекций вектора кажущейся скорости на оси приборной системы координат (ПСК). Затем определяют вектора скорости и ускорения, производят измерения датчиками угловой скорости бесплатформенного инерциального блока (БИБ). По значениям измеренных ускорений и угловой скорости вращения Земли определяют угловое положение ПСК относительно базовой (стартовой) системы координат (БСК), широту места испытаний, положение осей карданова подвеса относительно БСК и проекции угловой скорости вращения Земли на оси карданова подвеса. Затем осуществляют калибровку чувствительных элементов БИБ и повторно определяют начальную ориентацию ПСК относительно БСК.
Description
Изобретение относится к области приборостроения и может быть использовано при создании инерциальных систем управления для определения навигационных параметров управляемых подвижных объектов с помощью бесплатформенной инерциальной навигационной системы (БИНС).
Известен способ определения начальной выставки приборной системы координат бесплатформенного инерциального блока (БИБ) управляемого объекта (УО), установленного на пусковой установке (ПУ), относительно базовой (стартовой) системы координат, материализованной стабилизированной платформой курсовертикали (KB), также установленной на ПУ. Начальная выставка осуществляется комбинированным способом, использующим автономное определение положения приборной системы координат относительно плоскости горизонта стартовой системы координат по сигналам акселерометров БИБ и метод векторного согласования систем координат для определения положения приборной системы координат в азимуте. Для векторного согласования используется информация чувствительных элементов БИБ и информация прибора типа курсовертикаль (прототип: патент №2279635, приоритет от 02.11.2004 г.).
Недостатком этого способа является необходимость использования для определения начальной выставки сложной наземной аппаратуры, в том числе прибора типа курсовертикаль, наземного вычислительного устройства и других наземных средств.
Задачей предлагаемого изобретения является определение начальной выставки приборной системы координат БИБ автономными средствами.
Сущность заявленного изобретения заключается в том, что в автономном способе определения начальной ориентации приборной системы координат (ПСК) бесплатформенного инерциального блока управляемого объекта относительно базовой (стартовой) системы координат (БСК), согласно изобретению, по сигналам акселерометров на интервале времени от t0 до tn определяют n приращений каждой из проекций вектора кажущейся скорости на оси ПСК за выбранные заранее интервалы времени от t0 до tj (j=1, …, n), методом анализа регрессии определяют оценки каждой проекции вектора кажущейся скорости и оценки проекций кажущегося ускорения, по оценкам проекций кажущегося ускорения прогнозируют на некоторый заранее выбранный момент времени в конце выбранного интервала значение каждой проекции кажущегося ускорения, производят измерения датчиками угловой скорости БИБ одновременно с измерениями акселерометрами, аналогично определению проекций кажущегося ускорения определяют проекции угловой скорости вращения Земли на оси ПСК. По определенным проекциям кажущегося ускорения и проекциям угловой скорости вращения Земли определяют угловое положение ПСК относительно БСК, широту места испытаний, положение осей карданова подвеса (КП) относительно БСК и проекции угловой скорости вращения Земли на оси КП, проводят калибровку чувствительных элементов БИБ, используя КП, в результате которой определяют значения калибруемых параметров, используя метод итерации, повторно определяют начальную ориентацию ПСК относительно БСК, выполняя вышеуказанные действия с учетом новых значений калибруемых параметров.
Предлагаемый способ автономного определения основан на автономном определении положения ПСК относительно БСК по сигналам измерений проекций вектора ускорения силы тяжести акселерометрами БИБ и измерений проекций вектора угловой скорости вращения Земли датчиками угловой скорости (ДУС) БИБ на оси ПСК OXnYnZn.
В предлагаемом способе используется метод векторного согласования систем координат (см., например, А.Липтон. Выставка инерциальных систем на подвижном основании. М.: Наука, 1971 г., стр.114-122). При этом учитывается, что проекции векторов и в БСК известны по построению этой системы координат, а проекции этих же векторов в ПСК определяются по сигналам акселерометров и ДУСов БИБ.
Для повышения точности предлагается перед началом измерений производить калибровку чувствительных элементов (ЧЭ) (акселерометров и ДУСов) БИБ. Для калибровки ЧЭ БИБ предлагается применить способ калибровки ЧЭ БИНС и устройство для его осуществления, изложенные в заявке на изобретение №2007111096 приоритет от 26.03.2007 г. с расположением ЧЭ БИБ в двухосном КП. Для повышения точности съема информации с ДУСов можно использовать известный способ переключения масштаба с диапазона измерения больших угловых скоростей, составляющих десятки градусов в секунду, на масштаб измерения малых угловых скоростей, не превышающих долей градуса в секунду.
При расположении ЧЭ в двухосном КП, кроме возможности калибровки ЧЭ перед началом работы, можно уменьшить диапазон измерения рабочих угловых скоростей путем разворота приборной площадки (ПП) вокруг осей двухосного КП относительно УО с относительной угловой скоростью вращения ПП вокруг этих осей, которая приблизительно равна по величине и обратна по направлению угловой скорости вращения УО. Для повышения точности автономного определения начальной выставки при обработке информации ЧЭ БИБ можно использовать метод анализа регрессий.
Исследования показывают, что при жестком креплении БИБ на изделии, при наличии акселерометров БИБ с погрешностями масштабного коэффициента 0,03% и смещением нуля акселерометра 0,0003 g, а также ДУСов с погрешностями масштабного коэффициента 0,05% и случайным уходом 0,01 угл. мин/мин можно автономно определять предлагаемым способом угловую ориентацию ПСК в азимуте с погрешностями 3-5 угл. мин и ориентацию относительно плоскости горизонта с погрешностью не более 1,5 угл. мин. Элементная база, т.е. акселерометры и ДУСы, не обладают требуемыми точностными характеристиками в заданных диапазонах изменения измеряемых величин. Одним из способов повышения точности является создание более комфортных условий для работы ЧЭ и возможность их калибровки непосредственно во время предстартовой подготовки. Для этого предлагается размещать БИБ в двухосном КП, который обеспечивает возможность калибровки перед пуском и позволяет уменьшать диапазон рабочих угловых скоростей.
Калибровка акселерометров и датчиков угловой скорости заключается в том, что по сигналам акселерометра, измерительная ось которого ортогональна внутренней оси КП, и сигналам с датчика угла, установленного на внутренней оси КП, в вычислительном устройстве (ВУ) определяют угол отклонения наружной оси КП от плоскости горизонта, для каждого акселерометра в ВУ по конечным формулам рассчитывают углы Ф1 и Ф2 поворотов ПП вокруг наружной и внутренней осей из исходного положения в положения калибровки, в которых измерительные оси калибруемого акселерометра располагаются вдоль положительного, затем вдоль отрицательного направления ускорения силы тяжести, ПП по сигналам, формируемым в ВУ, с помощью двигателей вращения разворачивают относительно исходного положения на углы Ф1 и Ф2 в положения калибровки акселерометров, удерживают калибруемые акселерометры в положениях калибровки в течение заданных в ВУ интервалов времени, в течение которых выполняют измерения калибруемым акселерометром, в ВУ рассчитывают значение масштабного коэффициента и смещение нуля каждого калибруемого акселерометра, для калибровки ДУСов ПП выставляют в исходное положение, выполняют измерения углового положения осей КП относительно плоскости горизонта и их азимут, на основе которых рассчитывают в ВУ проекции угловой скорости вращения Земли на оси КП, двигателем вращения, установленным на внутренней оси КП, по сигналам с ВУ совмещают измерительные оси Хд и Yд соответствующих ДУСов с направлением наружной оси КП, при указанных совмещениях с помощью двигателя вращения, установленного на наружной оси КП, поворачивают ПП с заданными угловыми скоростями вокруг наружной оси подвеса на заданные положительный, а затем отрицательный угол, при этом за время поворотов ПП выполняют измерения датчиком угла, установленным на наружной оси КП, и калибруемым ДУСом, определяют проекции вектора поворота в результате вращения Земли на измерительную ось калибруемого ДУСа, в ВУ, с учетом вращения Земли, рассчитывают значения масштабных коэффициентов и смещение нуля для первого и второго ДУСов, аналогичным способом осуществляют калибровку третьего ДУСа, при этом с помощью двигателя вращения, установленного на внутренней оси КП, ПП поворачивают вокруг внутренней оси КП, за время поворотов ПП выполняют измерения третьим ДУСом и датчиком угла, установленным на внутренней оси КП, в ВУ, с учетом вращения Земли, рассчитывают значение масштабного коэффициента и смещение нуля третьего ДУСа, используя метод итерации, повторно определяют начальную ориентацию ПСК относительно БСК.
Устройство для автономного определения начальной выставки БИБ установленного в корпусе управляемого объекта содержит ПП с тремя акселерометрами и тремя ДУСами, вычислительное устройство, входами связанное с соответствующими выходами акселерометров и ДУСов, а выходами связанное с соответствующими входами потребителей навигационных параметров, двухосный КП, на каждой оси которого установлены соответствующие датчик угла и двигатель вращения, при этом ПП установлена в КП, ДУСы и акселерометры установлены на ПП таким образом, что их измерительные оси (ИО) образуют соответствующие правые прямоугольные системы координат XдYдZд и XaYaZa, ИО Ya и Yд ортогональны внутренней оси КП, ИО Za образует угол 45° с внутренней осью КП и лежит с ней в плоскости ПП, а ИО Zд параллельна внутренней оси КП, ВУ выполнено с возможностью управления двигателями вращения и контроля углового положения ПП посредством датчиков угла, расчета масштабного коэффициента и смещения нуля калибруемого чувствительного элемента и учета величин калибруемых параметров в алгоритмах для определения начальной ориентации ПСК, выходы датчиков угла соединены с соответствующими дополнительными входами ВУ, два дополнительных выхода которого через усилители соединены с соответствующими входами двигателей вращения, а третий дополнительный выход соединен с входом потребителя параметров калибровки и автономного определения начальной выставки и определения навигационных параметров.
Таким образом, предлагается автономный способ определения начальной ориентации приборной системы координат БИБ управляемого объекта относительно БСК, использующий метод векторного согласования систем координат. Отличительная особенность способа состоит в том, что в неподвижном относительно Земли положении БИБ по сигналам акселерометров (от действия ускорения силы тяжести) на интервале времени от t0 до tn определяют n приращений каждой из проекций вектора кажущейся скорости на оси ПСК за выбранные заранее интервалы времени от t0 до tj (j=1, …, n), методом анализа регрессии определяют оценки каждой проекции вектора кажущейся скорости и оценки проекций кажущегося ускорения, по оценкам проекций кажущегося ускорения прогнозируют на некоторый заранее выбранный момент времени в конце выбранного интервала значение каждой проекции кажущегося ускорения. По сигналам датчиков угловой скорости БИБ на том же интервале времени от t0 до tn определяют n приращений каждой из проекций вектора поворота Земли на оси ПСК за выбранные заранее интервалы времени от t0 до tj (j=1, …, n), методом анализа регрессии определяют оценки каждой проекции вектора поворота Земли и оценки каждой проекции угловой скорости вращения Земли на оси ПСК и прогнозируют значения проекций угловой скорости Земли на заданный момент времени, по спрогнозированным проекциям кажущегося ускорения и проекциям угловой скорости вращения Земли определяют угловое положение ПСК относительно БСК и широту места испытаний, положение осей КП, в котором установлен БИБ, относительно БСК и проекции угловой скорости вращения Земли на оси КП, проводят калибровку акселерометров и датчиков угловой скорости БИБ, используя КП, в результате которой определяют значения калибруемых параметров, используя метод итерации, повторно определяют начальную ориентацию ПСК относительно БСК, выполняя вышеуказанные измерения и определения проекций кажущегося ускорения и проекций угловой скорости вращения Земли с учетом новых значений калибруемых параметров.
Следует отметить, что перед началом измерений выставляют БИБ в оптимальное положение, при котором достигается наиболее высокая точность измерений.
Техническим результатом предлагаемого автономного способа определения начальной выставки приборной системы координат БИБ относительно БСК и устройства для его осуществления является возможность автономного определения начальной выставки БИБ без использования сложной наземной аппаратуры, в том числе прибора типа курсовертикаль, наземного ВУ и других наземных средств.
Claims (1)
- Автономный способ определения начальной ориентации приборной системы координат (ПСК) бесплатформенного инерциального блока (БИБ) управляемого объекта относительно базовой системы координат (БСК), использующий метод векторного согласования систем координат, отличающийся тем, что в неподвижном относительно Земли положении БИБ по сигналам акселерометров на интервале времени от t0 до tn определяют n приращений каждой из проекций вектора кажущейся скорости от действия ускорения силы тяжести на оси ПСК за выбранные заранее интервалы времени от t0 до tj (j=1, …, n), определяют оценки каждой проекции вектора кажущейся скорости и оценки проекций кажущегося ускорения, по оценкам проекций кажущегося ускорения прогнозируют на некоторый заранее выбранный момент времени в конце выбранного интервала значение каждой проекции кажущегося ускорения, по сигналам датчиков угловой скорости БИБ на том же интервале времени от t0 до tn определяют n приращений каждой из проекций вектора поворота Земли на оси ПСК за выбранные заранее интервалы времени от t0 до tj (j=1, …, n), определяют оценки каждой проекции вектора поворота и оценки каждой проекции угловой скорости вращения Земли на оси ПСК и прогнозируют значения проекций угловой скорости Земли на заданный момент времени, по спрогнозированным проекциям кажущегося ускорения и проекциям угловой скорости вращения Земли определяют угловое положение ПСК относительно БСК и широту места испытаний, положение осей карданова подвеса, в котором установлен БИБ, относительно БСК и проекции угловой скорости вращения Земли на оси карданова подвеса проводят калибровку акселерометров и датчиков угловой скорости БИБ, используя карданов подвес, в результате которой определяют значения калибруемых параметров, используя метод итерации, повторно определяют начальную ориентацию ПСК относительно БСК, выполняя вышеуказанные измерения и определения проекций кажущегося ускорения и проекций угловой скорости вращения Земли с учетом новых значений калибруемых параметров.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2008150507/28A RU2386107C1 (ru) | 2008-12-19 | 2008-12-19 | Автономный способ определения начальной ориентации приборной системы координат бесплатформенного инерциального блока управляемого объекта относительно базовой системы координат |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2008150507/28A RU2386107C1 (ru) | 2008-12-19 | 2008-12-19 | Автономный способ определения начальной ориентации приборной системы координат бесплатформенного инерциального блока управляемого объекта относительно базовой системы координат |
Publications (1)
Publication Number | Publication Date |
---|---|
RU2386107C1 true RU2386107C1 (ru) | 2010-04-10 |
Family
ID=42671246
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
RU2008150507/28A RU2386107C1 (ru) | 2008-12-19 | 2008-12-19 | Автономный способ определения начальной ориентации приборной системы координат бесплатформенного инерциального блока управляемого объекта относительно базовой системы координат |
Country Status (1)
Country | Link |
---|---|
RU (1) | RU2386107C1 (ru) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2504734C1 (ru) * | 2012-06-28 | 2014-01-20 | Федеральное государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А. Пилюгина" (ФГУП "НПЦАП") | Способ определения параметров модели погрешностей измерений акселерометров инерциальной навигационной системы по измерениям спутниковой навигации |
RU2505785C1 (ru) * | 2012-06-28 | 2014-01-27 | Федеральное государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А. Пилюгина" (ФГУП "НПЦАП") | Способ определения параметров модели погрешностей измерений акселерометров ведомой инерциальной навигационной системы по измерениям эталонной инерциальной навигационной системы |
CN112033439A (zh) * | 2020-08-20 | 2020-12-04 | 哈尔滨工业大学 | 一种摇摆基座地球系下重力加速度矢量无纬度构建方法 |
RU2784859C1 (ru) * | 2022-06-14 | 2022-11-30 | Федеральное государственное бюджетное образовательное учреждение высшего образования "Саратовский государственный технический университет имени Гагарина Ю.А." (СГТУ имени Гагарина Ю.А.) | Способ бесплатформенной ориентации подвижных объектов |
-
2008
- 2008-12-19 RU RU2008150507/28A patent/RU2386107C1/ru active
Non-Patent Citations (3)
Title |
---|
БОДНЕР В.А. Системы управления ЛА. - М.: Машиностроение, 1973, с.87, с.181-182. * |
Бортовые системы управления полетом. Под общей редакцией Ю.В.БАЙБОРОДИНА. - М.: Транспорт, 1975, 336 с. * |
Системы адаптивного управления летательными аппаратами. НОВОСЕЛОВ А.С., БОЛНОКИН В.Е., ЧИНАЕВ П.И., ЮРЬЕВ А.Н. - М.: Машиностроение, 1987, с.165. * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2504734C1 (ru) * | 2012-06-28 | 2014-01-20 | Федеральное государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А. Пилюгина" (ФГУП "НПЦАП") | Способ определения параметров модели погрешностей измерений акселерометров инерциальной навигационной системы по измерениям спутниковой навигации |
RU2505785C1 (ru) * | 2012-06-28 | 2014-01-27 | Федеральное государственное унитарное предприятие "Научно-производственный центр автоматики и приборостроения имени академика Н.А. Пилюгина" (ФГУП "НПЦАП") | Способ определения параметров модели погрешностей измерений акселерометров ведомой инерциальной навигационной системы по измерениям эталонной инерциальной навигационной системы |
CN112033439A (zh) * | 2020-08-20 | 2020-12-04 | 哈尔滨工业大学 | 一种摇摆基座地球系下重力加速度矢量无纬度构建方法 |
CN112033439B (zh) * | 2020-08-20 | 2022-08-12 | 哈尔滨工业大学 | 一种摇摆基座地球系下重力加速度矢量无纬度构建方法 |
RU2784859C1 (ru) * | 2022-06-14 | 2022-11-30 | Федеральное государственное бюджетное образовательное учреждение высшего образования "Саратовский государственный технический университет имени Гагарина Ю.А." (СГТУ имени Гагарина Ю.А.) | Способ бесплатформенной ориентации подвижных объектов |
RU2820026C1 (ru) * | 2024-01-23 | 2024-05-28 | Ордена Трудового Красного Знамени Федеральное Государственное Бюджетное Образовательное Учреждение Высшего Образования "Московский Технический Университет Связи И Информатики" | Способ определения начальной ориентации объекта |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Unsal et al. | Estimation of deterministic and stochastic IMU error parameters | |
CN103221788B (zh) | 陀螺仪传感器的标定设备和方法 | |
RU2395061C1 (ru) | Способ определения местоположения подвижных объектов и комплексированная навигационная система для его реализации | |
RU2269813C2 (ru) | Способ калибровки параметров бесплатформенного инерциального измерительного модуля | |
CN102116634A (zh) | 一种着陆深空天体探测器的降维自主导航方法 | |
RU2488776C1 (ru) | Способ повышения точности калибровки трехосных лазерных гироскопов с одним общим вибратором | |
EP3123209B1 (en) | Absolute vector gravimeter and methods of measuring an absolute gravity vector | |
RU2504734C1 (ru) | Способ определения параметров модели погрешностей измерений акселерометров инерциальной навигационной системы по измерениям спутниковой навигации | |
US20140249750A1 (en) | Navigational and location determination system | |
CN103674064A (zh) | 捷联惯性导航***的初始标定方法 | |
Troni et al. | Experimental evaluation of a MEMS inertial measurements unit for Doppler navigation of underwater vehicles | |
RU2386107C1 (ru) | Автономный способ определения начальной ориентации приборной системы координат бесплатформенного инерциального блока управляемого объекта относительно базовой системы координат | |
RU2334947C1 (ru) | Способ калибровки чувствительных элементов бесплатформенной инерциальной навигационной системы и устройство для его осуществления | |
RU2683144C1 (ru) | Способ определения ошибок ориентации измерительных осей лазерных гироскопов и маятниковых акселерометров в бесплатформенной инерциальной навигационной системе | |
Emel’yantsev et al. | Improving the accuracy of GPS compass for small-sized objects | |
RU2348010C1 (ru) | Способ определения начальной выставки бесплатформенного инерциального блока управляемого объекта | |
Wongwirat et al. | A position tracking experiment of mobile robot with inertial measurement unit (imu) | |
JP2006038650A (ja) | 姿勢計測方法、姿勢制御装置、方位計及びコンピュータプログラム | |
RU2539131C1 (ru) | Бесплатформенная интегрированная навигационная система средней точности для мобильного наземного объекта | |
Eldesoky et al. | Performance enhancement of low-cost MEMS inertial sensors using extensive calibration technique | |
Kis et al. | Development of state estimation system with INS, magnetometer and carrier phase GPS for vehicle navigation | |
Hasan et al. | Evaluation of a low-cost MEMS IMU for indoor positioning system | |
RU2486472C1 (ru) | Способ калибровки чувствительных элементов бесплатформенной инерциальной навигационной системы в полете | |
RU2529649C1 (ru) | Способ угловой ориентации объекта по радионавигационным сигналам космических аппаратов | |
Emel'Yantsev et al. | Dual-mode GNSS gyrocompass using primary satellite measurements |