Вычисление элементов орбиты ИСЗ по координатам и составляющим скорости

Вычисляем постоянные площадей
с1=y·z-y∙z
с1=-5599222.389·-1767.28-93.74·-10334653.090=10864105220.881м2с
с2=z·x-z∙x
с2=-10334653.090·5277.38--1767.28·-4002572.060=-61613556977.293м2с
с3=x·y-x∙y
с3=-4002572.060·93.74-5277.38·-5599222.389=29174045904.430м2с
c=с12+с22+с32
c=10864105220.8812+-61613556977.2932+29174045904.4302=69031761820.761м2с
2. Вычисляем фокальный параметр
p=c2μ
p=69031761820.76123.9860044∙1014=11955290.717 м
3. Вычисляем угол наклона плоскости орбиты к плоскости экватора
i=arccosс3c
i=arccos29174045904.430 69031761820.761=65°00΄00,1''
4. Вычисляем долготу восходящего узла Ω
sinΩ=c1c∙sini
sinΩ=11510864105220.881 69031761820.761·sin65°00΄00,1''=0.173647755
cosΩ=c2c∙sini
cosΩ=-61613556977.293 69031761820.761·sin65°00΄00,1''=0.984807828
Ω=9°59΄59,9''
5 . Вычисляем квадрат скорости спутника и геоцентрическое расстояние до спутника
v2=x2+y2+z2
v2=-5277.382+2993.742+5-1767.282=30982807.414м2с2
r=x2+y2+z2
r=-4002572.0602+390-5599222.3892+-10334653.09092=12416800.270 м
6.Вычисляем постоянную энергии
h=v2-2∙μr
h=30982807.414 -2∙3.9860044∙101412416800.270=-33220599.475м2с2
7. Вычисляем большую полуось орбиты спутника
a=-μh
a=-3.9860044∙1014-33220599.475=11998592.629 м
8. Вычисляем составляющие вектора Лапласа
D=x∙x+y∙y+z∙z
D=-4002572.060·5277.38+-5599222.389·93.74+-10334653.090·-1767.28=
D=-3383778527.524 м
D=μr+h
D =3.9860044∙1014112416800.270+-33220599.475=-1118896.031
f1=D∙x-D∙x
f1=-1118896.031·-4002572.060--3383778527.524·5277.38=
f1=22335953350793.500
f2=D∙y-D∙y
f2=-1118896.031·-5599222.389--3383778527.524·93.74=
f2=6582132585784.230
f3=D∙z-D∙z
f3=-1118896.031·-10334653.090--3383778527.524·-1767.28=
f3=5583334386605.130
f=f12+f22+f32
f=22335953350793.5002+6582132585784.2302+5583334386605.1302=23945623907894.200 м
9