1   /* Copyright 2022-2026 Romain Serra
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.model;
18  
19  import org.hipparchus.CalculusFieldElement;
20  import org.hipparchus.Field;
21  import org.hipparchus.geometry.euclidean.threed.FieldVector3D;
22  import org.hipparchus.geometry.euclidean.threed.Vector3D;
23  import org.orekit.signal.AdjustableEmitterSignalTimer;
24  import org.orekit.signal.FieldAdjustableEmitterSignalTimer;
25  import org.orekit.signal.FieldSignalEmissionCondition;
26  import org.orekit.signal.FieldSignalReceptionCondition;
27  import org.orekit.signal.SignalEmissionCondition;
28  import org.orekit.signal.SignalReceptionCondition;
29  import org.orekit.signal.SignalTravelTimeModel;
30  import org.orekit.time.AbsoluteDate;
31  import org.orekit.time.FieldAbsoluteDate;
32  import org.orekit.utils.FieldPVCoordinatesProvider;
33  import org.orekit.utils.PVCoordinatesProvider;
34  
35  /**
36   * Abstract class for angular measurement model.
37   * @since 14.0
38   * @author Romain Serra
39   */
40  public abstract class AbstractAngularMeasurementModel extends AbstractSignalBasedModel {
41  
42      /**
43       * Constructor.
44       * @param signalTravelTimeModel time delay computer
45       */
46      protected AbstractAngularMeasurementModel(final SignalTravelTimeModel signalTravelTimeModel) {
47          super(signalTravelTimeModel);
48      }
49  
50      /**
51       * Compute emitter-to-receiver vector.
52       * @param receptionCondition signal reception conditions
53       * @param emitter signal emitter coordinates provider
54       * @param approxEmissionDate guess for the emission date (shall be adjusted by signal travel time computer)
55       * @return emitter-to-receiver vector
56       */
57      protected Vector3D getEmitterToReceiverVector(final SignalReceptionCondition receptionCondition,
58                                                    final PVCoordinatesProvider emitter,
59                                                    final AbsoluteDate approxEmissionDate) {
60          final AdjustableEmitterSignalTimer signalTravelTime = getSignalTravelTimeModel().getAdjustableEmitterComputer(emitter);
61          final SignalEmissionCondition emissionCondition = signalTravelTime.computeEmissionCondition(receptionCondition,
62                  approxEmissionDate);
63          final Vector3D observedPosition = emissionCondition.emitterPosition();
64          return observedPosition.subtract(receptionCondition.receiverPosition()).normalize();
65      }
66  
67      /**
68       * Compute emitter-to-receiver vector with FIeld.
69       * @param <T> field type
70       * @param receptionCondition signal reception conditions
71       * @param emitter signal emitter coordinates provider
72       * @param approxEmissionDate guess for the emission date (shall be adjusted by signal travel time computer)
73       * @return emitter-to-receiver vector
74       */
75      protected <T extends CalculusFieldElement<T>> FieldVector3D<T> getEmitterToReceiverVector(final FieldSignalReceptionCondition<T> receptionCondition,
76                                                                                                final FieldPVCoordinatesProvider<T> emitter,
77                                                                                                final FieldAbsoluteDate<T> approxEmissionDate) {
78          final Field<T> field = receptionCondition.receptionDate().getField();
79          final FieldAdjustableEmitterSignalTimer<T> signalTravelTime = getSignalTravelTimeModel()
80                  .getFieldAdjustableEmitterComputer(field, emitter);
81          final FieldSignalEmissionCondition<T> emissionCondition = signalTravelTime.computeEmissionCondition(receptionCondition,
82                  approxEmissionDate);
83          final FieldVector3D<T> observedPosition = emissionCondition.emitterPosition();
84          return observedPosition.subtract(receptionCondition.receiverPosition());
85      }
86  }