Новый алгоритм и оценка точности определения на судне центра масс по сигналам спутниковых радионавигационных систем, страница 2

       Для определения второй производной z² в точке x=0 по экспериментальным данным необходимы минимум три значения: z-1=z(-h), z0=z(0), z+1=z(+h). При малых h и отсутствии погрешностей измерений можно (с помощью формул  /7/,с.904) установить, что

 z²0=(z-1-2z0+z1)/h2=1/R. Из-за погрешностей измерени появится и погрешность DR » R2Dz²= R2(Dz-1-2Dz0+Dz1)/h2. Существуют и другие варианты  определения z², Поэтому возможен /1, 2/ и поиск наиболее оптимального варианта, что, к сожалению, из-за громоздкости и высокого уровня понятий дифференциальной геометрии оказалось пока  затруднительным.

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

2. Новый алгоритм определения  оси  и центра плоской круговой пространственной траектории  по трем ее точкам в пространстве.

 2.1. Пусть в три момента времени tj  аппаратура потребителя выдает оценки координат  (xj уj zj ), j= -1, 0, +1 трех точек Р-1, Р0, Р+1 плоской окружности постоянного искомого радиуса R.

2.1.1. «Проведем» хорды  - направленные отрезки Р-1Р0 и Р0Р+1, т.е. вектора хорд с проекциями   (x0-x -1), (y0-y -1), (z0-z –1)   и  (x0-x+1), (y0-y+1), (z0-z+1).  Координаты средних точек (x, y-C, z--C) и (x+C y+C z+C)  хорд  равны полусумме координат граничных точек, например:
x –С=(x0+x -1)/2,  y-C=(y0+y -1)/2,   z C=(z0+z –1)/2,    x+C=(x0+x+1)/2 и т.д.

   Через средние точки «проводится» плоскости, перпендикулярные хорде. Уравнения таких  плоскостей выражаются (/6/ п.3.2-1b3) равной нулю суммой произведений проекций  вектора хорды на разности проекций  текущей и средней точек:

           (x0-x -1)(х-х -C)+(y0-y -1)(у-у-C)+ (z0-z -1)(z-z -C)=0,

           (x0-x+1)(х-х+C)+(y0-y+1)(у-у+C)+ (z0-z+1)(z-z+C)=0, или:

  x2(x0-x -1)+y2(y0-y -1)+z2(z0-z -1) -x02-y02-z02+x -12+y-12 +z –12=0           (1)
  x2(x0-x1) + y2(y0-y1) + z2(z0-z1)  - x02-y02-z02+x12+ y12 + z 12= 0           (2) 

Первые три коэффициента уравнений (1) и (2), переписанных в общем виде xA-1+yB-1+zC-1+D-1=0, xA1+yB1+zC1+D1=0, превышают вдвое прекции вектора хорд. Эта две плоскости определяет прямую линию  их пересечения, проходящую через центр окружности по нормали, пропорциональной  векторному произведению двух векторов с проекциями (A-1 B-1 C-1) и (A1 B1 C1), Это ось вращения корпуса судна, определявшаяся более сложно в /1, 2/.

 2.1.2.    Уравнение А0х+В0y+C0z+D0=0 плоскости окружности  может (однозначно при отсутствии погрешностей измерений) определяться, например, как включающая три заданных точки концов двух хорд.  Такое уравнение (/7/, п.3.2.1b4) в общем виде представляется как

 y-1  z –1 1               z-1  x -1 1                  x -1 y-1  1         x -1 y-1   z –1

  y0    z0   1 x +    z0  x0   1 y +        x0  y0    1 z --  x0   y0   z   = 0           (3)

 y+!   z+!  1                 z +1 x+1 1                    x+1 y+!  1        x+1 y+!   z+!

Вместо (3) можно плоскость окружности в принципе определить и по одной или по всем местоопределяемым точкам траектории.

2.1.3. Точка, удовлетворяющая уравнениям плоскостей (1), (2), (3), т.е.

xA-1+yB-1+zC-1+D-1=0,   xA1+yB1+zC1+D1=0,   А0х+В0y+C0z+D0=0,

и есть центр окружности. Главный D и частные DX, DY, DZ определители такой системы соответственно равны (/7/, 3.4-5d):

      A-1 B-1 C-1        D-1 B-1 C-1       A-1  D-1  C-1        A-1  B-1  D-1   

   -  A0  B0  C0        D0  B0  C0        A0   D0   C0        A0  B0   D0   

      A1  B1  C1        D B C      A1   D1   C1        A1  B1   D1