Skip to content
Projects
Groups
Snippets
Help
Loading...
Help
Submit feedback
Contribute to GitLab
Sign in / Register
Toggle navigation
O
Orekit
Project
Project
Details
Activity
Releases
Cycle Analytics
Repository
Repository
Files
Commits
Branches
Tags
Contributors
Graph
Compare
Charts
Issues
34
Issues
34
List
Board
Labels
Milestones
Merge Requests
0
Merge Requests
0
CI / CD
CI / CD
Pipelines
Jobs
Schedules
Charts
Wiki
Wiki
Snippets
Snippets
Members
Members
Collapse sidebar
Close sidebar
Activity
Graph
Charts
Create a new issue
Jobs
Commits
Issue Boards
Open sidebar
Orekit
Orekit
Commits
440095bf
Commit
440095bf
authored
May 25, 2018
by
Maxime Journot
Committed by
Luc Maisonobe
May 25, 2018
Browse files
Options
Browse Files
Download
Email Patches
Plain Diff
Added tests.
parent
9ad52251
Changes
2
Expand all
Hide whitespace changes
Inline
Side-by-side
Showing
2 changed files
with
589 additions
and
5 deletions
+589
-5
UnivariateProcessNoise.java
.../orekit/estimation/sequential/UnivariateProcessNoise.java
+19
-5
UnivariateprocessNoiseTest.java
...kit/estimation/sequential/UnivariateprocessNoiseTest.java
+570
-0
No files found.
src/main/java/org/orekit/estimation/sequential/UnivariateProcessNoise.java
View file @
440095bf
...
...
@@ -18,10 +18,12 @@ package org.orekit.estimation.sequential;
import
org.hipparchus.analysis.UnivariateFunction
;
import
org.hipparchus.exception.LocalizedCoreFormats
;
import
org.hipparchus.geometry.euclidean.threed.Vector3D
;
import
org.hipparchus.linear.MatrixUtils
;
import
org.hipparchus.linear.RealMatrix
;
import
org.orekit.errors.OrekitException
;
import
org.orekit.frames.LOFType
;
import
org.orekit.frames.Transform
;
import
org.orekit.orbits.PositionAngle
;
import
org.orekit.propagation.SpacecraftState
;
...
...
@@ -64,7 +66,7 @@ import org.orekit.propagation.SpacecraftState;
*/
public
class
UnivariateProcessNoise
extends
AbstractCovarianceMatrixProvider
{
/** L
OF
used. */
/** L
ocal Orbital Frame (LOF) type
used. */
private
final
LOFType
lofType
;
/** Position angle for the orbital process noise matrix. */
...
...
@@ -195,19 +197,31 @@ public class UnivariateProcessNoise extends AbstractCovarianceMatrixProvider {
jacLofToInertial
.
setSubMatrix
(
lofToInertialRotation
,
0
,
0
);
jacLofToInertial
.
setSubMatrix
(
lofToInertialRotation
,
3
,
3
);
// Jacobian from orbit parameters to Cartesian parameters
// FIXME: Trying to fix the transform from LOF to inertial
final
Transform
lofToInertial
=
lofType
.
transformFromInertial
(
current
.
getDate
(),
current
.
getPVCoordinates
()).
getInverse
();
final
Vector3D
OM
=
lofToInertial
.
getRotationRate
().
negate
();
final
double
[][]
MOM
=
new
double
[
3
][
3
];
MOM
[
0
][
1
]
=
-
OM
.
getZ
();
MOM
[
0
][
2
]
=
OM
.
getY
();
MOM
[
1
][
0
]
=
OM
.
getZ
();
MOM
[
1
][
2
]
=
-
OM
.
getX
();
MOM
[
2
][
0
]
=
-
OM
.
getY
();
MOM
[
2
][
1
]
=
OM
.
getX
();
//jacLofToInertial.setSubMatrix(MOM, 3, 0);
//debug
// Jacobian of orbit parameters with respect to Cartesian parameters
final
double
[][]
dYdC
=
new
double
[
6
][
6
];
current
.
getOrbit
().
getJacobianWrtCartesian
(
positionAngle
,
dYdC
);
final
RealMatrix
jacParameters
to
Cartesian
=
MatrixUtils
.
createRealMatrix
(
dYdC
);
final
RealMatrix
jacParameters
Wrt
Cartesian
=
MatrixUtils
.
createRealMatrix
(
dYdC
);
// Complete Jacobian of the transformation
final
RealMatrix
jacobian
=
jacParameters
to
Cartesian
.
multiply
(
jacLofToInertial
);
final
RealMatrix
jacobian
=
jacParameters
Wrt
Cartesian
.
multiply
(
jacLofToInertial
);
// Return the orbital process noise matrix in inertial frame and proper orbit type
final
RealMatrix
inertialOrbitalProcessNoiseMatrix
=
jacobian
.
multiply
(
lofCartesianProcessNoiseMatrix
).
multiply
(
jacobian
.
transpose
());
return
inertialOrbitalProcessNoiseMatrix
;
}
...
...
src/test/java/org/orekit/estimation/sequential/UnivariateprocessNoiseTest.java
0 → 100644
View file @
440095bf
This diff is collapsed.
Click to expand it.
Write
Preview
Markdown
is supported
0%
Try again
or
attach a new file
Attach a file
Cancel
You are about to add
0
people
to the discussion. Proceed with caution.
Finish editing this message first!
Cancel
Please
register
or
sign in
to comment