1   /* Copyright 2002-2021 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  package org.orekit.estimation.measurements.generation;
18  
19  import org.hipparchus.random.CorrelatedRandomVectorGenerator;
20  import org.orekit.estimation.measurements.AngularRaDec;
21  import org.orekit.estimation.measurements.EstimationModifier;
22  import org.orekit.estimation.measurements.GroundStation;
23  import org.orekit.estimation.measurements.ObservableSatellite;
24  import org.orekit.frames.Frame;
25  import org.orekit.propagation.SpacecraftState;
26  import org.orekit.time.AbsoluteDate;
27  import org.orekit.utils.ParameterDriver;
28  
29  
30  /** Builder for {@link AngularRaDec} measurements.
31   * @author Luc Maisonobe
32   * @since 9.3
33   */
34  public class AngularRaDecBuilder extends AbstractMeasurementBuilder<AngularRaDec> {
35  
36      /** Ground station from which measurement is performed. */
37      private final GroundStation station;
38  
39      /** Reference frame in which the right ascension - declination angles are given. */
40      private final Frame referenceFrame;
41  
42      /** Simple constructor.
43       * @param noiseSource noise source, may be null for generating perfect measurements
44       * @param station ground station from which measurement is performed
45       * @param referenceFrame Reference frame in which the right ascension - declination angles are given
46       * @param sigma theoretical standard deviation
47       * @param baseWeight base weight
48       * @param satellite satellite related to this builder
49       */
50      public AngularRaDecBuilder(final CorrelatedRandomVectorGenerator noiseSource,
51                                 final GroundStation station, final Frame referenceFrame,
52                                 final double[] sigma, final double[] baseWeight,
53                                 final ObservableSatellite satellite) {
54          super(noiseSource, sigma, baseWeight, satellite);
55          this.station        = station;
56          this.referenceFrame = referenceFrame;
57      }
58  
59      /** {@inheritDoc} */
60      @Override
61      public AngularRaDec build(final SpacecraftState[] states) {
62  
63          final ObservableSatellite satellite = getSatellites()[0];
64          final double[] sigma                = getTheoreticalStandardDeviation();
65          final double[] baseWeight           = getBaseWeight();
66          final SpacecraftState[] relevant    = new SpacecraftState[] { states[satellite.getPropagatorIndex()] };
67  
68          // create a dummy measurement
69          final AngularRaDec dummy = new AngularRaDec(station, referenceFrame, relevant[0].getDate(),
70                                                      new double[] {
71                                                          0.0, 0.0
72                                                      }, sigma, baseWeight, satellite);
73          for (final EstimationModifier<AngularRaDec> modifier : getModifiers()) {
74              dummy.addModifier(modifier);
75          }
76  
77          // set a reference date for parameters missing one
78          for (final ParameterDriver driver : dummy.getParametersDrivers()) {
79              if (driver.getReferenceDate() == null) {
80                  final AbsoluteDate start = getStart();
81                  final AbsoluteDate end   = getEnd();
82                  driver.setReferenceDate(start.durationFrom(end) <= 0 ? start : end);
83              }
84          }
85  
86          // estimate the perfect value of the measurement
87          final double[] angular = dummy.estimate(0, 0, relevant).getEstimatedValue();
88  
89          // add the noise
90          final double[] noise = getNoise();
91          if (noise != null) {
92              angular[0] += noise[0];
93              angular[1] += noise[1];
94          }
95  
96          // generate measurement
97          final AngularRaDec measurement = new AngularRaDec(station, referenceFrame, relevant[0].getDate(),
98                                                            angular, sigma, baseWeight, satellite);
99          for (final EstimationModifier<AngularRaDec> modifier : getModifiers()) {
100             measurement.addModifier(modifier);
101         }
102         return measurement;
103 
104     }
105 
106 }