EventEnablingPredicateFilter.java

  1. /* Copyright 2002-2025 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.propagation.events;

  18. import java.util.Arrays;

  19. import org.hipparchus.ode.events.Action;
  20. import org.orekit.propagation.SpacecraftState;
  21. import org.orekit.propagation.events.handlers.EventHandler;
  22. import org.orekit.time.AbsoluteDate;

  23. /** Wrapper used to detect events only when enabled by an external predicated function.
  24.  *
  25.  * <p>General {@link EventDetector events} are defined implicitly
  26.  * by a {@link EventDetector#g(SpacecraftState) g function} crossing
  27.  * zero. This implies that during an orbit propagation, events are
  28.  * triggered at all zero crossings.
  29.  * </p>
  30.  *
  31.  * <p>Sometimes, users would like to enable or disable events by themselves,
  32.  * for example to trigger them only for certain orbits, or to check elevation
  33.  * maximums only when elevation itself is positive (i.e. they want to
  34.  * discard elevation maximums below ground). In these cases, looking precisely
  35.  * for all events location and triggering events that will later be ignored
  36.  * is a waste of computing time.</p>
  37.  *
  38.  * <p>Users can wrap a regular {@link EventDetector event detector} in
  39.  * an instance of this class and provide this wrapping instance to
  40.  * a {@link org.orekit.propagation.Propagator}
  41.  * in order to avoid wasting time looking for uninteresting events.
  42.  * The wrapper will intercept the calls to the {@link
  43.  * EventDetector#g(SpacecraftState) g function} and to the {@link
  44.  * EventHandler#eventOccurred(SpacecraftState, EventDetector, boolean)
  45.  * eventOccurred} method in order to ignore uninteresting events. The
  46.  * wrapped regular {@link EventDetector event detector} will the see only
  47.  * the interesting events, i.e. either only events that occur when a
  48.  * user-provided event enabling predicate function is true, ignoring all events
  49.  * that occur when the event enabling predicate function is false. The number of
  50.  * calls to the {@link EventDetector#g(SpacecraftState) g function} will also be
  51.  * reduced.</p>
  52.  * @see EventSlopeFilter
  53.  * @since 7.1
  54.  */

  55. public class EventEnablingPredicateFilter implements DetectorModifier {

  56.     /** Number of past transformers updates stored. */
  57.     private static final int HISTORY_SIZE = 100;

  58.     /** Wrapped event detector. */
  59.     private final EventDetector rawDetector;

  60.     /** Enabling predicate function. */
  61.     private final EnablingPredicate enabler;

  62.     /** Transformers of the g function. */
  63.     private final Transformer[] transformers;

  64.     /** Update time of the transformers. */
  65.     private final AbsoluteDate[] updates;

  66.     /** Event detection settings. */
  67.     private final EventDetectionSettings detectionSettings;

  68.     /** Specialized event handler. */
  69.     private final LocalHandler handler;

  70.     /** Indicator for forward integration. */
  71.     private boolean forward;

  72.     /** Extreme time encountered so far. */
  73.     private AbsoluteDate extremeT;

  74.     /** Detector function value at extremeT. */
  75.     private double extremeG;

  76.     /** Wrap an {@link EventDetector event detector}.
  77.      * @param rawDetector event detector to wrap (its detection settings are taken as well)
  78.      * @param enabler event enabling predicate function to use
  79.      */
  80.     public EventEnablingPredicateFilter(final EventDetector rawDetector,
  81.                                         final EnablingPredicate enabler) {
  82.         this(rawDetector.getDetectionSettings(), rawDetector, enabler);
  83.     }

  84.     /** Constructor with full parameters.
  85.      * @param detectionSettings event detection settings
  86.      * @param rawDetector event detector to wrap
  87.      * @param enabler event enabling function to use
  88.      * @since 13.0
  89.      */
  90.     public EventEnablingPredicateFilter(final EventDetectionSettings detectionSettings,
  91.                                         final EventDetector rawDetector, final EnablingPredicate enabler) {
  92.         this.detectionSettings = detectionSettings;
  93.         this.handler = new LocalHandler();
  94.         this.rawDetector  = rawDetector;
  95.         this.enabler      = enabler;
  96.         this.transformers = new Transformer[HISTORY_SIZE];
  97.         this.updates      = new AbsoluteDate[HISTORY_SIZE];
  98.     }

  99.     /**
  100.      * Builds a new instance from the input detection settings.
  101.      * @param settings event detection settings to be used
  102.      * @return a new detector
  103.      */
  104.     public EventEnablingPredicateFilter withDetectionSettings(final EventDetectionSettings settings) {
  105.         return new EventEnablingPredicateFilter(settings, rawDetector, enabler);
  106.     }

  107.     /**
  108.      * Get the wrapped raw detector.
  109.      * @return the wrapped raw detector
  110.      * @since 11.1
  111.      */
  112.     public EventDetector getDetector() {
  113.         return rawDetector;
  114.     }

  115.     /** {@inheritDoc} */
  116.     @Override
  117.     public EventHandler getHandler() {
  118.         return handler;
  119.     }

  120.     /** {@inheritDoc} */
  121.     @Override
  122.     public EventDetectionSettings getDetectionSettings() {
  123.         return detectionSettings;
  124.     }

  125.     /**  {@inheritDoc} */
  126.     @Override
  127.     public void init(final SpacecraftState s0, final AbsoluteDate t) {
  128.         DetectorModifier.super.init(s0, t);

  129.         // initialize events triggering logic
  130.         forward  = AbstractDetector.checkIfForward(s0, t);
  131.         extremeT = forward ? AbsoluteDate.PAST_INFINITY : AbsoluteDate.FUTURE_INFINITY;
  132.         extremeG = Double.NaN;

  133.         Arrays.fill(transformers, Transformer.UNINITIALIZED);
  134.         Arrays.fill(updates, extremeT);

  135.     }

  136.     /**  {@inheritDoc} */
  137.     @Override
  138.     public void reset(final SpacecraftState state, final AbsoluteDate target) {
  139.         DetectorModifier.super.reset(state, target);
  140.         forward  = AbstractDetector.checkIfForward(state, target);
  141.         extremeT = forward ? AbsoluteDate.PAST_INFINITY : AbsoluteDate.FUTURE_INFINITY;
  142.         extremeG = Double.NaN;
  143.     }

  144.     /**  {@inheritDoc} */
  145.     @Override
  146.     public double g(final SpacecraftState s) {

  147.         final double  rawG      = rawDetector.g(s);
  148.         final boolean isEnabled = enabler.eventIsEnabled(s, rawDetector, rawG);
  149.         if (Double.isNaN(extremeG)) {
  150.             extremeG = rawG;
  151.         }

  152.         // search which transformer should be applied to g
  153.         if (isForward()) {
  154.             final int last = transformers.length - 1;
  155.             if (extremeT.compareTo(s.getDate()) < 0) {
  156.                 // we are at the forward end of the history

  157.                 // check if enabled status has changed
  158.                 final Transformer previous = transformers[last];
  159.                 final Transformer next     = selectTransformer(previous, extremeG, isEnabled);
  160.                 if (next != previous) {
  161.                     // there is a status change somewhere between extremeT and t.
  162.                     // the new transformer is valid for t (this is how we have just computed
  163.                     // it above), but it is in fact valid on both sides of the change, so
  164.                     // it was already valid before t and even up to previous time. We store
  165.                     // the switch at extremeT for safety, to ensure the previous transformer
  166.                     // is not applied too close of the root
  167.                     System.arraycopy(updates,      1, updates,      0, last);
  168.                     System.arraycopy(transformers, 1, transformers, 0, last);
  169.                     updates[last]      = extremeT;
  170.                     transformers[last] = next;
  171.                 }

  172.                 extremeT = s.getDate();
  173.                 extremeG = rawG;

  174.                 // apply the transform
  175.                 return next.transformed(rawG);

  176.             } else {
  177.                 // we are in the middle of the history

  178.                 // select the transformer
  179.                 for (int i = last; i > 0; --i) {
  180.                     if (updates[i].compareTo(s.getDate()) <= 0) {
  181.                         // apply the transform
  182.                         return transformers[i].transformed(rawG);
  183.                     }
  184.                 }

  185.                 return transformers[0].transformed(rawG);

  186.             }
  187.         } else {
  188.             if (s.getDate().compareTo(extremeT) < 0) {
  189.                 // we are at the backward end of the history

  190.                 // check if a new rough root has been crossed
  191.                 final Transformer previous = transformers[0];
  192.                 final Transformer next     = selectTransformer(previous, extremeG, isEnabled);
  193.                 if (next != previous) {
  194.                     // there is a status change somewhere between extremeT and t.
  195.                     // the new transformer is valid for t (this is how we have just computed
  196.                     // it above), but it is in fact valid on both sides of the change, so
  197.                     // it was already valid before t and even up to previous time. We store
  198.                     // the switch at extremeT for safety, to ensure the previous transformer
  199.                     // is not applied too close of the root
  200.                     System.arraycopy(updates,      0, updates,      1, updates.length - 1);
  201.                     System.arraycopy(transformers, 0, transformers, 1, transformers.length - 1);
  202.                     updates[0]      = extremeT;
  203.                     transformers[0] = next;
  204.                 }

  205.                 extremeT = s.getDate();
  206.                 extremeG = rawG;

  207.                 // apply the transform
  208.                 return next.transformed(rawG);

  209.             } else {
  210.                 // we are in the middle of the history

  211.                 // select the transformer
  212.                 for (int i = 0; i < updates.length - 1; ++i) {
  213.                     if (s.getDate().compareTo(updates[i]) <= 0) {
  214.                         // apply the transform
  215.                         return transformers[i].transformed(rawG);
  216.                     }
  217.                 }

  218.                 return transformers[updates.length - 1].transformed(rawG);

  219.             }
  220.         }

  221.     }

  222.     /** Get next function transformer in the specified direction.
  223.      * @param previous transformer active on the previous point with respect
  224.      * to integration direction (may be null if no previous point is known)
  225.      * @param previousG value of the g function at the previous point
  226.      * @param isEnabled if true the event should be enabled now
  227.      * @return next transformer transformer
  228.      */
  229.     private Transformer selectTransformer(final Transformer previous, final double previousG, final boolean isEnabled) {
  230.         if (isEnabled) {
  231.             // we need to select a transformer that can produce zero crossings,
  232.             // so it is either Transformer.PLUS or Transformer.MINUS
  233.             switch (previous) {
  234.                 case UNINITIALIZED :
  235.                     return Transformer.PLUS; // this initial choice is arbitrary, it could have been Transformer.MINUS
  236.                 case MIN :
  237.                     return previousG >= 0 ? Transformer.MINUS : Transformer.PLUS;
  238.                 case MAX :
  239.                     return previousG >= 0 ? Transformer.PLUS : Transformer.MINUS;
  240.                 default :
  241.                     return previous;
  242.             }
  243.         } else {
  244.             // we need to select a transformer that cannot produce any zero crossings,
  245.             // so it is either Transformer.MAX or Transformer.MIN
  246.             switch (previous) {
  247.                 case UNINITIALIZED :
  248.                     return Transformer.MAX; // this initial choice is arbitrary, it could have been Transformer.MIN
  249.                 case PLUS :
  250.                     return previousG >= 0 ? Transformer.MAX : Transformer.MIN;
  251.                 case MINUS :
  252.                     return previousG >= 0 ? Transformer.MIN : Transformer.MAX;
  253.                 default :
  254.                     return previous;
  255.             }
  256.         }
  257.     }

  258.     /** Check if the current propagation is forward or backward.
  259.      * @return true if the current propagation is forward
  260.      */
  261.     public boolean isForward() {
  262.         return forward;
  263.     }

  264.     /** Local handler. */
  265.     private static class LocalHandler implements EventHandler {

  266.         /** {@inheritDoc} */
  267.         public Action eventOccurred(final SpacecraftState s, final EventDetector detector, final boolean increasing) {
  268.             final EventEnablingPredicateFilter ef = (EventEnablingPredicateFilter) detector;
  269.             final Transformer transformer = ef.isForward() ? ef.transformers[ef.transformers.length - 1] : ef.transformers[0];
  270.             return ef.rawDetector.getHandler().eventOccurred(s, ef.rawDetector, transformer == Transformer.PLUS ? increasing : !increasing);
  271.         }

  272.         /** {@inheritDoc} */
  273.         @Override
  274.         public SpacecraftState resetState(final EventDetector detector, final SpacecraftState oldState) {
  275.             final EventEnablingPredicateFilter ef = (EventEnablingPredicateFilter) detector;
  276.             return ef.rawDetector.getHandler().resetState(ef.rawDetector, oldState);
  277.         }

  278.     }

  279. }