1   /* Copyright 2002-2020 CS Group
2    * Licensed to CS Group (CS) under one or more
3    * contributor license agreements.  See the NOTICE file distributed with
4    * this work for additional information regarding copyright ownership.
5    * CS licenses this file to You under the Apache License, Version 2.0
6    * (the "License"); you may not use this file except in compliance with
7    * the License.  You may obtain a copy of the License at
8    *
9    *   http://www.apache.org/licenses/LICENSE-2.0
10   *
11   * Unless required by applicable law or agreed to in writing, software
12   * distributed under the License is distributed on an "AS IS" BASIS,
13   * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
14   * See the License for the specific language governing permissions and
15   * limitations under the License.
16   */
17  
18  package org.orekit.estimation.common;
19  
20  import org.hipparchus.geometry.euclidean.threed.Vector3D;
21  import org.orekit.estimation.measurements.EstimatedMeasurement;
22  import org.orekit.estimation.measurements.PV;
23  
24  /** Logger for velocity measurements.
25   * @author Luc Maisonobe
26   */
27  class VelocityLog extends MeasurementLog<PV> {
28  
29      /** {@inheritDoc} */
30      @Override
31      double residual(final EstimatedMeasurement<PV> evaluation) {
32          final double[] theoretical = evaluation.getEstimatedValue();
33          final double[] observed    = evaluation.getObservedMeasurement().getObservedValue();
34          return Vector3D.distance(new Vector3D(theoretical[3], theoretical[4], theoretical[5]),
35                                   new Vector3D(observed[3],    observed[4],    observed[5]));
36      }
37  
38  }