ShiftingTransformProvider.java

  1. /* Copyright 2002-2023 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.frames;

  18. import java.io.Serializable;
  19. import java.util.HashMap;
  20. import java.util.Map;

  21. import org.hipparchus.Field;
  22. import org.hipparchus.CalculusFieldElement;
  23. import org.hipparchus.util.FastMath;
  24. import org.orekit.time.AbsoluteDate;
  25. import org.orekit.time.FieldAbsoluteDate;
  26. import org.orekit.utils.AngularDerivativesFilter;
  27. import org.orekit.utils.CartesianDerivativesFilter;
  28. import org.orekit.utils.GenericTimeStampedCache;

  29. /** Transform provider using thread-safe shifts on transforms sample.
  30.  * <p>
  31.  * The shifts take derivatives into account, up to user specified order.
  32.  * </p>
  33.  * @see GenericTimeStampedCache
  34.  * @see InterpolatingTransformProvider
  35.  * @since 7.1
  36.  * @author Luc Maisonobe
  37.  */
  38. public class ShiftingTransformProvider implements TransformProvider {

  39.     /** Serializable UID. */
  40.     private static final long serialVersionUID = 20150601L;

  41.     /** First level cache. */
  42.     private final InterpolatingTransformProvider interpolatingProvider;

  43.     /** Cache for sample points. */
  44.     private final transient GenericTimeStampedCache<Transform> cache;

  45.     /** Field caches for sample points. */
  46.     // we use Object as the value of fieldCaches because despite numerous attempts,
  47.     // we could not find a way to use GenericTimeStampedCache<FieldTransform<? extends CalculusFieldElement<?>>
  48.     // without the compiler complaining
  49.     private final transient Map<Field<? extends CalculusFieldElement<?>>, Object> fieldCaches;

  50.     /** Simple constructor.
  51.      * @param rawProvider provider for raw (non-interpolated) transforms
  52.      * @param cFilter filter for derivatives from the sample to use in interpolation
  53.      * @param aFilter filter for derivatives from the sample to use in interpolation
  54.      * @param gridPoints number of interpolation grid points
  55.      * @param step grid points time step
  56.      * @param maxSlots maximum number of independent cached time slots
  57.      * in the {@link GenericTimeStampedCache time-stamped cache}
  58.      * @param maxSpan maximum duration span in seconds of one slot
  59.      * in the {@link GenericTimeStampedCache time-stamped cache}
  60.      * @param newSlotInterval time interval above which a new slot is created
  61.      * in the {@link GenericTimeStampedCache time-stamped cache}
  62.      * @since 9.1
  63.      */
  64.     public ShiftingTransformProvider(final TransformProvider rawProvider,
  65.                                      final CartesianDerivativesFilter cFilter,
  66.                                      final AngularDerivativesFilter aFilter,
  67.                                      final int gridPoints, final double step,
  68.                                      final int maxSlots, final double maxSpan, final double newSlotInterval) {
  69.         this(new InterpolatingTransformProvider(rawProvider, cFilter, aFilter,
  70.                                                 gridPoints, step, maxSlots, maxSpan, newSlotInterval),
  71.              maxSlots, maxSpan, newSlotInterval);
  72.     }

  73.     /** Simple constructor.
  74.      * @param interpolatingProvider first level cache provider
  75.      * @param maxSlots maximum number of independent cached time slots
  76.      * in the {@link GenericTimeStampedCache time-stamped cache}
  77.      * @param maxSpan maximum duration span in seconds of one slot
  78.      * in the {@link GenericTimeStampedCache time-stamped cache}
  79.      * @param newSlotInterval time interval above which a new slot is created
  80.      * in the {@link GenericTimeStampedCache time-stamped cache}
  81.      */
  82.     private ShiftingTransformProvider(final InterpolatingTransformProvider interpolatingProvider,
  83.                                      final int maxSlots, final double maxSpan, final double newSlotInterval) {
  84.         this.interpolatingProvider = interpolatingProvider;
  85.         this.cache = new GenericTimeStampedCache<Transform>(2, maxSlots, maxSpan, newSlotInterval,
  86.                                                             new TransformGenerator(2,
  87.                                                                                    interpolatingProvider,
  88.                                                                                    interpolatingProvider.getStep()));
  89.         this.fieldCaches = new HashMap<>();
  90.     }

  91.     /** Get the underlying provider for raw (non-interpolated) transforms.
  92.      * @return provider for raw (non-interpolated) transforms
  93.      */
  94.     public TransformProvider getRawProvider() {
  95.         return interpolatingProvider.getRawProvider();
  96.     }

  97.     /** Get the number of interpolation grid points.
  98.      * @return number of interpolation grid points
  99.      */
  100.     public int getGridPoints() {
  101.         return interpolatingProvider.getGridPoints();
  102.     }

  103.     /** Get the grid points time step.
  104.      * @return grid points time step
  105.      */
  106.     public double getStep() {
  107.         return interpolatingProvider.getStep();
  108.     }

  109.     /** {@inheritDoc} */
  110.     public Transform getTransform(final AbsoluteDate date) {
  111.         // retrieve a sample from the thread-safe cache
  112.         final Transform closest = cache.getNeighbors(date).reduce((t0, t1) ->
  113.             FastMath.abs(date.durationFrom(t0.getDate())) < FastMath.abs(date.durationFrom(t1.getDate())) ? t0 : t1
  114.         ).get();
  115.         return closest.shiftedBy(date.durationFrom(closest.getDate()));
  116.     }

  117.     /** {@inheritDoc} */
  118.     @Override
  119.     public StaticTransform getStaticTransform(final AbsoluteDate date) {
  120.         // retrieve a sample from the thread-safe cache
  121.         final Transform closest = cache.getNeighbors(date).reduce((t0, t1) ->
  122.                 FastMath.abs(date.durationFrom(t0.getDate())) < FastMath.abs(date.durationFrom(t1.getDate())) ? t0 : t1
  123.         ).get();
  124.         return closest.staticShiftedBy(date.durationFrom(closest.getDate()));
  125.     }

  126.     /** {@inheritDoc} */
  127.     public <T extends CalculusFieldElement<T>> FieldTransform<T> getTransform(final FieldAbsoluteDate<T> date) {
  128.         @SuppressWarnings("unchecked")
  129.         GenericTimeStampedCache<FieldTransform<T>> fieldCache =
  130.             (GenericTimeStampedCache<FieldTransform<T>>) fieldCaches.get(date.getField());
  131.         if (fieldCache == null) {
  132.             fieldCache =
  133.                 new GenericTimeStampedCache<FieldTransform<T>>(cache.getMaxNeighborsSize(),
  134.                                                                cache.getMaxSlots(),
  135.                                                                cache.getMaxSpan(),
  136.                                                                cache.getNewSlotQuantumGap(),
  137.                                                                new FieldTransformGenerator<>(date.getField(),
  138.                                                                                              cache.getMaxNeighborsSize(),
  139.                                                                                              interpolatingProvider,
  140.                                                                                              interpolatingProvider.getStep()));
  141.             fieldCaches.put(date.getField(), fieldCache);
  142.         }

  143.         // retrieve a sample from the thread-safe cache
  144.         final FieldTransform<T> closest = fieldCache.getNeighbors(date.toAbsoluteDate()).reduce((t0, t1) ->
  145.             date.durationFrom(t0.getDate()).abs().getReal() < date.durationFrom(t1.getDate()).abs().getReal() ?
  146.             t0 : t1
  147.         ).get();
  148.         return closest.shiftedBy(date.durationFrom(closest.getDate()));
  149.     }

  150.     /** {@inheritDoc} */
  151.     @Override
  152.     public <T extends CalculusFieldElement<T>> FieldStaticTransform<T> getStaticTransform(final FieldAbsoluteDate<T> date) {
  153.         @SuppressWarnings("unchecked")
  154.         GenericTimeStampedCache<FieldTransform<T>> fieldCache =
  155.             (GenericTimeStampedCache<FieldTransform<T>>) fieldCaches.get(date.getField());
  156.         if (fieldCache == null) {
  157.             fieldCache =
  158.                 new GenericTimeStampedCache<FieldTransform<T>>(cache.getMaxNeighborsSize(),
  159.                                                                cache.getMaxSlots(),
  160.                                                                cache.getMaxSpan(),
  161.                                                                cache.getNewSlotQuantumGap(),
  162.                                                                new FieldTransformGenerator<>(date.getField(),
  163.                                                                                              cache.getMaxNeighborsSize(),
  164.                                                                                              interpolatingProvider,
  165.                                                                                              interpolatingProvider.getStep()));
  166.             fieldCaches.put(date.getField(), fieldCache);
  167.         }

  168.         // retrieve a sample from the thread-safe cache
  169.         final FieldTransform<T> closest = fieldCache.getNeighbors(date.toAbsoluteDate()).reduce((t0, t1) ->
  170.             date.durationFrom(t0.getDate()).abs().getReal() < date.durationFrom(t1.getDate()).abs().getReal() ?
  171.             t0 : t1
  172.         ).get();
  173.         return closest.staticShiftedBy(date.durationFrom(closest.getDate()));
  174.     }

  175.     /** Replace the instance with a data transfer object for serialization.
  176.      * <p>
  177.      * This intermediate class serializes only the data needed for generation,
  178.      * but does <em>not</em> serializes the cache itself (in fact the cache is
  179.      * not serializable).
  180.      * </p>
  181.      * @return data transfer object that will be serialized
  182.      */
  183.     private Object writeReplace() {
  184.         return new DTO(interpolatingProvider,
  185.                        cache.getMaxSlots(), cache.getMaxSpan(), cache.getNewSlotQuantumGap());
  186.     }

  187.     /** Internal class used only for serialization. */
  188.     private static class DTO implements Serializable {

  189.         /** Serializable UID. */
  190.         private static final long serialVersionUID = 20150601L;

  191.         /** Provider for raw (non-interpolated) transforms. */
  192.         private final InterpolatingTransformProvider interpolatingProvider;

  193.         /** Maximum number of independent cached time slots. */
  194.         private final int maxSlots;

  195.         /** Maximum duration span in seconds of one slot. */
  196.         private final double maxSpan;

  197.         /** Time interval above which a new slot is created. */
  198.         private final double newSlotInterval;

  199.         /** Simple constructor.
  200.          * @param interpolatingProvider first level cache provider
  201.          * @param maxSlots maximum number of independent cached time slots
  202.          * in the {@link GenericTimeStampedCache time-stamped cache}
  203.          * @param maxSpan maximum duration span in seconds of one slot
  204.          * in the {@link GenericTimeStampedCache time-stamped cache}
  205.          * @param newSlotInterval time interval above which a new slot is created
  206.          * in the {@link GenericTimeStampedCache time-stamped cache}
  207.          */
  208.         private DTO(final InterpolatingTransformProvider interpolatingProvider,
  209.                     final int maxSlots, final double maxSpan, final double newSlotInterval) {
  210.             this.interpolatingProvider = interpolatingProvider;
  211.             this.maxSlots              = maxSlots;
  212.             this.maxSpan               = maxSpan;
  213.             this.newSlotInterval       = newSlotInterval;
  214.         }

  215.         /** Replace the deserialized data transfer object with a {@link ShiftingTransformProvider}.
  216.          * @return replacement {@link ShiftingTransformProvider}
  217.          */
  218.         private Object readResolve() {
  219.             // build a new provider, with an empty cache
  220.             return new ShiftingTransformProvider(interpolatingProvider,
  221.                                                  maxSlots, maxSpan, newSlotInterval);
  222.         }

  223.     }

  224. }