Г.И.Чесноков, канд. техн. наук, В.И.Галкин, канд. техн. наук, Д.В.Галкин, канд. техн. наук,
АООТ “Московский институт электромеханики и автоматики”
![]()
|
Представлены алгоритмы определения углов пространственной ориентации скважины в процессе движения измерительного блока гироскопического инклинометра бесплатформенного типа. Рассмотрены и проанализированы различные способы построения кинематических уравнений на предмет минимизации времени, затрачиваемого на их решение. Показан рабочий алгоритм наиболее перспективного многошагового построения с использованием параметров Родрига-Гамильтона в кватернионной форме записи угловых поворотов измерительного блока |
Представление кинематических
уравнений через измеряемые углы
Определение углов ориентации
скважины через направляющие косинусы
Определение углов ориентации
скважины через параметры Родрига-Гамильтона
Применение гироскопических инклинометров для определения пространственной ориентации скважин в нефтегазодобывающей промышленности позволяет осуществлять строительство скважин в условиях магнитных аномалий с использованием обсадных труб из магнитомягких материалов. Это существенно расширяет возможности промышленной добычи нефти и газа, снижает затраты на строительство скважин.
АООТ “Московский институт электромеханики и автоматики” (АООТ “МИЭА”), используя свой научно-технический потенциал по созданию инерциальных навигационных систем для аэрокосмической отрасли, разрабатывает малогабаритные высокоточные гироскопические инклинометры бесплатформенного типа [1,2], позволяющие реализовать наиболее эффективные способы построения скважин на основе кустового, наклонного и горизонтального бурения. Примером таких разработок является гироскопический инклинометр “ГИД” [2], измерительный блок которого представлен на рис. 1.
|
|
|
Рис. 1. Измерительный
блок гироскопического |
Важнейшей технической характеристикой современных инклинометров является оперативность получения и обработки информации. Разрабатываемые в АООТ “МИЭА” гироскопические инклинометры позволяют определять угловое положение скважины в процессе движения измерительного блока, что приводит к максимальному сокращению времени промера скважины. Достигается это за счет использования специальных расчетных алгоритмов. Ниже изложены особенности разработанных алгоритмов, показаны различные варианты их реализации.
Измерительный блок гироскопического инклинометра бесплатформенного типа в общем случае состоит из трех двухстепенных гироскопов, работающих в режиме датчиков угловых скоростей (ДУС), и трех линейных акселерометров. На рис. 2 показана структурная схема измерительного блока и система координат, используемая для определения углового положения ствола скважины. Местоположение измерительного блока в скважине определяется по длине каротажного кабеля.
|
|
|
Рис. 2.
Расчетная система координат |
В качестве базовой системы координат, относительно которой определяется
угловое положение скважины, принят географический сопровождающий трехгранник
, в котором
ось
направлена по местной вертикали
к центру Земли, ось
лежит в плоскости
горизонта и направлена на север, а ось
направлена на восток.
Угловое положение оси ствола скважины в точке ее замера, задаваемое системой
координат
определяется двумя
углами: зенитным углом
– углом отклонения
ствола скважины относительно местной вертикали и азимутальным углом
– углом отклонения
апсидальной плоскости ствола скважины от плоскости местного меридиана.
Система координат измерительного блока
,
,
связана с осями
чувствительности гироскопов и акселерометров. В расчетах принято, что
одноименные оси чувствительности гироскопов и акселерометров совпадают друг с
другом и лежат в точке измерения положения оси ствола скважины
.
Основной особенностью определения пространственной ориентации скважины с
помощью бесплатформенного измерительного блока является отсутствие жесткой
связи между измерительным блоком и скважиной, т.е. измерительный блок может
поворачиваться вокруг оси скважины
на угол
. Этот угол в геодезии принято называть углом установки
отклонителя или углом поворота инклинометра.
Для определения углового положения скважины в процессе движения измерительного блока разработаны кинематические уравнения, учитывающие вышеуказанную особенность. При этом принято допущение, что скоростью движения измерительного блока, перпендикулярной местной вертикали, можно пренебречь. Исследовано несколько способов представления кинематических уравнений: через измеряемые углы, через направляющие косинусы, через параметры Родрига-Гамильтона.
Такое представление уравнений является наиболее простым и очевидным.
Используя принятые системы координат и находя проекции векторов угловых
скоростей на измерительные оси трехгранника ![]()
![]()
при его поворотах
относительно базового трехгранника
на интересующие нас
углы
,
,
(рис. 1), получим
три дифференциальных уравнения [3]:
(2.1)
где
,
,
– проекции угловой
скорости вращения измерительного трехгранника ![]()
![]()
в инерциальном
пространстве, измеряемые гироскопами;
– горизонтальная
составляющая скорости вращения Земли;
– вертикальная
составляющая скорости вращения Земли;
– угловая скорость вращения Земли;
– широта
местности в точке замера скважины.
Решая полученные уравнения относительно
,
и
, найдем искомые углы ориентации скважины и инклинометра.
Однако, несмотря на кажущуюся простоту полученных уравнений, их решение
представляет собой весьма трудоемкую задачу из-за нелинейности уравнений,
необходимости в каждый момент времени определять тригонометрические функции,
из-за неопределенности решений при
, равном нулю.
В теории бесплатформенных инерциальных систем, к которым относится и рассматриваемый инклинометр, наибольшее распространение получили кинематические уравнения, использующие методы направляющих косинусов и параметры Родрига-Гамильтона. Получаемые при этом уравнения линейны и не вырождаются ни при каких углах поворота инклинометра.
В этом случае запись кинематических уравнений осуществляется через матрицу
направляющих косинусов, которая связывает угловое положение измерительного
трехгранника ![]()
![]()
относительно сопровождающего
географического трехгранника
следующим образом:
,
(3.1)
где
– матрица направляющих косинусов, записываемая
для рассматриваемого случая в следующем виде [4]:
, (3.2)
или через ее элементы:
.
(3.3)
Как видно из (3.2), (3.3), зная элементы
матрицы
, углы
наклона скважины и угол поворота инклинометра легко определить из следующих
соотношений:
;
;
. (3.4)
При поворотах измерительного трехгранника
относительно
сопровождающего трехгранника
в результате движения
измерительного блока внутри скважины элементы матрицы
являются функциями
времени
. Естественно, функциями времени являются и определяемые углы
,
,
.
Связь матрицы направляющих косинусов с вектором скорости вращения измерительного трехгранника относительно географического сопровождающего трехгранника устанавливается кинематическим уравнением Пуассона [5]:
,
(3.5)
где
– матрица направляющих косинусов в
функции времени;
– кососимметричная
матрица вектора угловой скорости вращения измерительного трехгранника
относительно
сопровождающего трехгранника
.
Поскольку гироскопы измеряют абсолютную угловую скорость измерительного блока в инерциальном пространстве, то выражение (3.5) удобнее записать в виде:
, (3.6)
где
– кососимметричная
матрица абсолютной угловой скорости вращения измерительного трехгранника
в инерциальном
пространстве;
– кососимметричная
матрица абсолютной угловой скорости вращения географического сопровождающего
трехгранника
в инерциальном
пространстве, определяемая при принятых допущениях скоростью вращения Земли.
Матричное уравнение (3.6) содержит девять скалярных дифференциальных уравнений:
(3.7)
Значения угловых скоростей
,
,
определяются по
показаниям гироскопов, а
,
являются
горизонтальной и вертикальной составляющими скорости вращения Земли. Решая
полученную систему уравнений (3.7) численными методами, находим значения
элементов матрицы в каждый момент времени, а по ним, используя соотношения
(3.4), – и искомые углы ориентации скважины.
Недостатками такого способа решения задачи является большой объем вычислений, что накладывает ограничения на скорость обработки информации в реальном масштабе времени. Более эффективным в этом отношении является использование параметров Родрига-Гамильтона.
Кинематические уравнения движения измерительного блока в этом случае записываются в кватернионной форме [6]:
,
(4.1)
где
– кватернион,
описывающий поворот измерительного трехгранника
относительно базового
сопровождающего трехгранника
:
,
(4.2)
,
,
,
– параметры
Родрига-Гамильтона;
– вектор угловой
скорости трехгранника
относительно
трехгранника
.
Так как гироскопы измеряют абсолютную угловую скорость трехгранника
в инерциальном
пространстве, то результирующий кватернион
следует записать в
виде произведения двух кватернионов:
– кватерниона поворота измерительного
трехгранника
в инерциальном
пространстве и
– кватерниона поворота географического
сопровождающего трехгранника
в этом же
пространстве:
![]()
. (4.3)
Способ нахождения
и
, а
следовательно и
, зависят от формы представления первичной информации – в
виде угловых скоростей или в виде квазикоординат. Рассмотрим оба эти случая.
При представлении первичной информации в виде угловых скоростей для определения кватернионов
и
и соответствующих им параметров
Родрига-Гамильтона необходимо решить частные кинематические уравнения:
;
. (4.4)
В скалярном виде эти уравнения запишутся следующим образом:
(4.5)
Решение этих уравнений позволит найти значения параметров Родрига-Гамильтона
,
,
,
и
,
,
,
, а через
них, используя соотношение (4.3), – и значения
,
,
,
, необходимые для определения
элементов матрицы направляющих косинусов:
(4.6)
В ряде случаев информация с датчиков угловых скоростей выдается в форме так называемых квазикоординат:
,
(4.7)
где
– угловая скорость
измерительного блока;
- временной интервал интегрирования
;
– квазикоордината
углового поворота измерительного блока за время
.
В этом случае кватернионы удобнее находить через приращение вектора
истинного поворота
. Расчет вектора истинного поворота выполняют через
квазикоординаты в одношаговом или многошаговом режимах. В одношаговом режиме
приращение вектора истинного поворота эквивалентно квазикоординате за
рассматриваемый интервал времени. В более точном многошаговом режиме, когда
приращение вектора истинного поворота определяется за несколько шагов
измерений, его связь с квазикоординатами имеет более сложную форму [7].
Например, для четырехшагового режима она имеет вид:
. (4.8)
где
;
;
– номер шагов;
– кососимметричная матрица, элементами
которой являются квазикоординаты:
. (4.9)
Для определения кватерниона
через
используется следующее
выражение:
,
(4.10)
где
;
, откуда параметры Родрига-Гамильтона определяются
следующим образом:
(4.11)
Аналогичным образом находятся параметры Родрига-Гамильтона и для кватерниона
. Параметры
Родрига-Гамильтона результирующего кватерниона
рассчитываются с
помощью системы уравнений (4.6).
Зная параметры Родриго-Гамильтона результирующего кварерниона, значения
элементов
матрицы направляющих косинусов можно
определить, используя известные соотношения [5]:
(4.12)
По результатам вычислений
, используя соотношение (3.4), находят искомые углы
ориентации скважины и измерительного блока
,
,
.
Исследования алгоритмов, основанных на использовании параметров Родрига-Гамильтона, показали, что с их помощью можно сократить время расчета углов ориентации скважины на (30-50) % по сравнению с матрицей направляющих косинусов, особенно при использовании квазикоординат, так как в этом случае отпадает необходимость решать дифференциальные уравнения.
На рис. 3 в качестве примера показан рабочий четырехшаговый алгоритм, реализующий идею использования параметров Родрига-Гамильтона в кватернионной форме записи на базе представления первичной информации в виде квазикоординат. Он имеет ряд особенностей, обеспечивающих его практическую реализацию и необходимую точность расчетов.
|
|
|
Рис. 3. Структурная схема рабочего алгоритма |
Перед запуском алгоритма необходимо определять начальный нулевой кватернион
. Осуществляется это следующим образом. В режиме выставки,
когда измерительный блок стоит неподвижно, рассчитываются начальные углы
ориентации скважины
,
,
. Для этого используется аналитическая связь (3.1) между
показаниями гироскопов и акселерометров по измерительным осям ![]()
![]()
и значениями проекций
скорости вращения Земли
и ускорения силы
тяжести
на базовые оси
сопровождающего географического трехгранника
. После
соответствующих преобразований уравнения (3.1) с учетом (3.2) выражения для
определения начальных углов ориентации могут быть представлены в следующем виде
[4]:
;
;
. (4.13)
По начальным углам ориентации
рассчитываются параметры Родрига-Гамильтона нулевого кватерниона
, а затем и сам кватернион:
(4.14)
С целью сведения к минимуму ошибок
вычислений кватерниона
,
результирующего поворота определяется и учитывается отклонение нормы
кватерниона от единицы:
. (4.15)
Полученное в результате расчетов значение
сравнивается с
допускаемым отклонением
. Если
, то в дальнейших расчетах используется кватернион
. Если же
, то определяется новый нормированный кватернион
, который и используется в дальнейших расчетах при
определении углов
,
,
:
.
(4.16)
В представленном алгоритме кватернион
обновленного положения
трехгранника ![]()
![]()
является произведением
кватерниона
результирующего
поворота трехгранника, полученного на предыдущем шаге измерений, на кватернион
поворота трехгранника
текущего шага измерений.
1. Получены расчетные алгоритмы для определения углов пространственной ориентации скважины с помощью гироскопического инклинометра бесплатформенного типа в процессе движения его измерительного блока.
2. Исследования полученных алгоритмов показали, что наиболее перспективным с точки зрения скорости обработки информации является алгоритм, построенный на базе параметров Родрига-Гамильтона с представлением исходных для расчетов данных в виде квазикоординат
3. По мнению авторов, рассмотренные в настоящей статье алгоритмы представляют практический интерес не только для разработчиков гироскопических инклинометров бесплатформенного типа, но и для разработчиков бесплатформенных измерительных устройств иного назначения, когда при определении ориентации объекта измерительное устройство может свободно перемещаться внутри этого объекта.
Список литературы
1. А. с. № 1827541. Измерительный блок инклинометра / В.И.Галкин, Е.А.Измайлов, А.А.Маслов – Б. И. № 26, 1993.
2. Галкин В.И., Измайлов Е.А., Жилин В.Б., Суминов В.М., Галкин Д.В. Гироскопический инклинометр “ГИД” // Гироскопия и навигация. 1997. № 4. С. 26-33.
3. Галкин Д.В. Разработка и исследование информационно-вычислительной системы гироскопического инклинометра для диагностики и активного контроля пространственного положения ствола скважин: Автореф. дисс. на соиск. учен. ст. к.т.н. М: Моск. авиационно-технолог. ин-т РГТУ им К.Э.Циолковского, 1999. 26 с.
4. Суминов В.М., Галкин Д.В. Математическая модель метрологической системы гироскопического инклинометра // Научно-технический сборник “Стандартизация и унификация авиационной техники” М: НИИСУ, 1997. С. 39-47.
5. Ишлинский А.Ю. Ориентация, гироскопы и инерциальная навигация. М: Наука, 1976.
6. Бранен В.Н., Шмыглевский И.П. Применение кватернионов в задачах ориентации твердого тела. М: Наука. 1973.
7. Панов А.П. Математические основы теории инерциальной навигации. Киев. Наукова думка, 1995.
8. Чесноков Г.И., Галкин В.И., Галкин Д.В. Контроль пространственной ориентации стволов скважин гироскопическим инклинометром в процессе движения измерительного блока // Материалы VII Санкт-Петербургской международной конференции по интегрированным навигационным системам (29-21 мая, 2000 г) М, 2000. С. 51-59.
| Наверх |