DTM2000.java

  1. /* Copyright 2002-2019 CS Systèmes d'Information
  2.  * Licensed to CS Systèmes d'Information (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.forces.drag.atmosphere;

  18. import java.io.BufferedReader;
  19. import java.io.IOException;
  20. import java.io.InputStream;
  21. import java.io.InputStreamReader;
  22. import java.util.Arrays;
  23. import java.util.Calendar;
  24. import java.util.GregorianCalendar;

  25. import org.hipparchus.RealFieldElement;
  26. import org.hipparchus.exception.DummyLocalizable;
  27. import org.hipparchus.geometry.euclidean.threed.FieldVector3D;
  28. import org.hipparchus.geometry.euclidean.threed.Vector3D;
  29. import org.hipparchus.util.FastMath;
  30. import org.hipparchus.util.MathArrays;
  31. import org.orekit.bodies.BodyShape;
  32. import org.orekit.bodies.FieldGeodeticPoint;
  33. import org.orekit.bodies.GeodeticPoint;
  34. import org.orekit.errors.OrekitException;
  35. import org.orekit.errors.OrekitMessages;
  36. import org.orekit.frames.Frame;
  37. import org.orekit.time.AbsoluteDate;
  38. import org.orekit.time.FieldAbsoluteDate;
  39. import org.orekit.time.TimeScalesFactory;
  40. import org.orekit.utils.PVCoordinatesProvider;

  41. /** This atmosphere model is the realization of the DTM-2000 model.
  42.  * <p>
  43.  * It is described in the paper: <br>
  44.  *
  45.  * <b>The DTM-2000 empirical thermosphere model with new data assimilation
  46.  *  and constraints at lower boundary: accuracy and properties</b><br>
  47.  *
  48.  * <i>S. Bruinsma, G. Thuillier and F. Barlier</i> <br>
  49.  *
  50.  * Journal of Atmospheric and Solar-Terrestrial Physics 65 (2003) 1053–1070<br>
  51.  *
  52.  *</p>
  53.  *<p>
  54.  * This model provides dense output for altitudes beyond 120 km.
  55.  *</p>
  56.  *
  57.  * <p>
  58.  * The model needs geographical and time information to compute general values,
  59.  * but also needs space weather data : mean and instantaneous solar flux and
  60.  * geomagnetic indices.
  61.  * </p>
  62.  * <p>
  63.  * Mean solar flux is (for the moment) represented by the F10.7 indices. Instantaneous
  64.  * flux can be set to the mean value if the data is not available. Geomagnetic
  65.  * activity is represented by the Kp indice, which goes from 1 (very low activity) to
  66.  * 9 (high activity).
  67.  *
  68.  * <p>
  69.  * All these data can be found on the <a href="http://sec.noaa.gov/Data/index.html">
  70.  * NOAA (National Oceanic and Atmospheric Administration) website.</a>
  71.  * </p>
  72.  *
  73.  *
  74.  * @author R. Biancale, S. Bruinsma: original fortran routine
  75.  * @author Fabien Maussion (java translation)
  76.  */
  77. public class DTM2000 implements Atmosphere {

  78.     /** Identifier for hydrogen. */
  79.     public static final int HYDROGEN = 1;

  80.     /** Identifier for helium. */
  81.     public static final int HELIUM = 2;

  82.     /** Identifier for atomic oxygen. */
  83.     public static final int ATOMIC_OXYGEN = 3;

  84.     /** Identifier for molecular nitrogen. */
  85.     public static final int MOLECULAR_NITROGEN = 4;

  86.     /** Identifier for molecular oxygen. */
  87.     public static final int MOLECULAR_OXYGEN = 5;

  88.     /** Identifier for atomic nitrogen. */
  89.     public static final int ATOMIC_NITROGEN = 6;

  90.     /** Serializable UID. */
  91.     private static final long serialVersionUID = 20170705L;

  92.     // Constants :

  93.     /** Number of parameters. */
  94.     private static final int NLATM = 96;

  95.     /** Thermal diffusion coefficient. */
  96.     private static final double[] ALEFA = {
  97.         0, -0.40, -0.38, 0, 0, 0, 0
  98.     };

  99.     /** Atomic mass  H, He, O, N2, O2, N. */
  100.     private static final double[] MA = {
  101.         0, 1, 4, 16, 28, 32, 14
  102.     };

  103.     /** Atomic mass  H, He, O, N2, O2, N. */
  104.     private static final double[] VMA = {
  105.         0, 1.6606e-24, 6.6423e-24, 26.569e-24, 46.4958e-24, 53.1381e-24, 23.2479e-24
  106.     };

  107.     /** Polar Earth radius. */
  108.     private static final double RE = 6356.77;

  109.     /** Reference altitude. */
  110.     private static final double ZLB0 = 120.0;

  111.     /** Cosine of the latitude of the magnetic pole (79N, 71W). */
  112.     private static final double CPMG = .19081;

  113.     /** Sine of the latitude of the magnetic pole (79N, 71W). */
  114.     private static final double SPMG = .98163;

  115.     /** Longitude (in radians) of the magnetic pole (79N, 71W). */
  116.     private static final double XLMG = -1.2392;

  117.     /** Gravity acceleration at 120 km altitude. */
  118.     private static final double GSURF = 980.665;

  119.     /** Universal gas constant. */
  120.     private static final double RGAS = 831.4;

  121.     /** 2 * π / 365. */
  122.     private static final double ROT = 0.017214206;

  123.     /** 2 * rot. */
  124.     private static final double ROT2 = 0.034428412;

  125.     /** Resources text file. */
  126.     private static final String DTM2000 = "/assets/org/orekit/dtm_2000.txt";

  127.     // CHECKSTYLE: stop JavadocVariable check

  128.     /** Elements coefficients. */
  129.     private static double[] tt   = null;
  130.     private static double[] h    = null;
  131.     private static double[] he   = null;
  132.     private static double[] o    = null;
  133.     private static double[] az2  = null;
  134.     private static double[] o2   = null;
  135.     private static double[] az   = null;
  136.     private static double[] t0   = null;
  137.     private static double[] tp   = null;

  138.     /** Sun position. */
  139.     private PVCoordinatesProvider sun;

  140.     /** External data container. */
  141.     private DTM2000InputParameters inputParams;

  142.     /** Earth body shape. */
  143.     private BodyShape earth;

  144.     /** Simple constructor for independent computation.
  145.      * @param parameters the solar and magnetic activity data
  146.      * @param sun the sun position
  147.      * @param earth the earth body shape
  148.      */
  149.     public DTM2000(final DTM2000InputParameters parameters,
  150.                    final PVCoordinatesProvider sun, final BodyShape earth) {

  151.         synchronized (DTM2000.class) {
  152.             // lazy reading of model coefficients
  153.             if (tt == null) {
  154.                 readcoefficients();
  155.             }
  156.         }

  157.         this.earth = earth;
  158.         this.sun = sun;
  159.         this.inputParams = parameters;

  160.     }

  161.     /** {@inheritDoc} */
  162.     public Frame getFrame() {
  163.         return earth.getBodyFrame();
  164.     }

  165.     /** Get the local density with initial entries.
  166.      * @param day day of year
  167.      * @param alti altitude in meters
  168.      * @param lon local longitude (rad)
  169.      * @param lat local latitude (rad)
  170.      * @param hl local solar time in rad (O hr = 0 rad)
  171.      * @param f instantaneous solar flux (F10.7)
  172.      * @param fbar mean solar flux (F10.7)
  173.      * @param akp3 3 hrs geomagnetic activity index (1-9)
  174.      * @param akp24 Mean of last 24 hrs geomagnetic activity index (1-9)
  175.      * @return the local density (kg/m³)
  176.      */
  177.     public double getDensity(final int day,
  178.                              final double alti, final double lon, final double lat,
  179.                              final double hl, final double f, final double fbar,
  180.                              final double akp3, final double akp24) {
  181.         final double threshold = 120000;
  182.         if (alti < threshold) {
  183.             throw new OrekitException(OrekitMessages.ALTITUDE_BELOW_ALLOWED_THRESHOLD,
  184.                                       alti, threshold);
  185.         }
  186.         final Computation result = new Computation(day, alti / 1000, lon, lat, hl,
  187.                                                    new double[] {
  188.                                                        0, f, 0
  189.                                                    }, new double[] {
  190.                                                        0, fbar, 0
  191.                                                    }, new double[] {
  192.                                                        0, akp3, 0, akp24, 0
  193.                                                    });
  194.         return result.ro * 1000;
  195.     }

  196.     /** Get the local density with initial entries.
  197.      * @param day day of year
  198.      * @param alti altitude in meters
  199.      * @param lon local longitude (rad)
  200.      * @param lat local latitude (rad)
  201.      * @param hl local solar time in rad (O hr = 0 rad)
  202.      * @param f instantaneous solar flux (F10.7)
  203.      * @param fbar mean solar flux (F10.7)
  204.      * @param akp3 3 hrs geomagnetic activity index (1-9)
  205.      * @param akp24 Mean of last 24 hrs geomagnetic activity index (1-9)
  206.      * @param <T> type of the field elements
  207.      * @return the local density (kg/m³)
  208.           * @since 9.0
  209.      */
  210.     public <T extends RealFieldElement<T>> T getDensity(final int day,
  211.                                                         final T alti, final T lon, final T lat,
  212.                                                         final T hl, final double f, final double fbar,
  213.                                                         final double akp3, final double akp24) {
  214.         final double threshold = 120000;
  215.         if (alti.getReal() < threshold) {
  216.             throw new OrekitException(OrekitMessages.ALTITUDE_BELOW_ALLOWED_THRESHOLD,
  217.                                       alti, threshold);
  218.         }
  219.         final FieldComputation<T> result = new FieldComputation<>(day, alti.divide(1000), lon, lat, hl,
  220.                                                                   new double[] {
  221.                                                                       0, f, 0
  222.                                                                   }, new double[] {
  223.                                                                       0, fbar, 0
  224.                                                                   }, new double[] {
  225.                                                                       0, akp3, 0, akp24, 0
  226.                                                                   });
  227.         return result.ro.multiply(1000);
  228.     }

  229.     /** Store the DTM model elements coefficients in internal arrays.
  230.      */
  231.     private static void readcoefficients() {

  232.         final int size = NLATM + 1;
  233.         tt   = new double[size];
  234.         h    = new double[size];
  235.         he   = new double[size];
  236.         o    = new double[size];
  237.         az2  = new double[size];
  238.         o2   = new double[size];
  239.         az   = new double[size];
  240.         t0   = new double[size];
  241.         tp   = new double[size];

  242.         final InputStream in = DTM2000.class.getResourceAsStream(DTM2000);
  243.         if (in == null) {
  244.             throw new OrekitException(OrekitMessages.UNABLE_TO_FIND_RESOURCE, DTM2000);
  245.         }

  246.         BufferedReader r = null;
  247.         try {

  248.             r = new BufferedReader(new InputStreamReader(in, "UTF-8"));
  249.             r.readLine();
  250.             r.readLine();
  251.             for (String line = r.readLine(); line != null; line = r.readLine()) {
  252.                 final int num = Integer.parseInt(line.substring(0, 4).replace(' ', '0'));
  253.                 line = line.substring(4);
  254.                 tt[num] = Double.parseDouble(line.substring(0, 13).replace(' ', '0'));
  255.                 line = line.substring(13 + 9);
  256.                 h[num] = Double.parseDouble(line.substring(0, 13).replace(' ', '0'));
  257.                 line = line.substring(13 + 9);
  258.                 he[num] = Double.parseDouble(line.substring(0, 13).replace(' ', '0'));
  259.                 line = line.substring(13 + 9);
  260.                 o[num] = Double.parseDouble(line.substring(0, 13).replace(' ', '0'));
  261.                 line = line.substring(13 + 9);
  262.                 az2[num] = Double.parseDouble(line.substring(0, 13).replace(' ', '0'));
  263.                 line = line.substring(13 + 9);
  264.                 o2[num] = Double.parseDouble(line.substring(0, 13).replace(' ', '0'));
  265.                 line = line.substring(13 + 9);
  266.                 az[num] = Double.parseDouble(line.substring(0, 13).replace(' ', '0'));
  267.                 line = line.substring(13 + 9);
  268.                 t0[num] = Double.parseDouble(line.substring(0, 13).replace(' ', '0'));
  269.                 line = line.substring(13 + 9);
  270.                 tp[num] = Double.parseDouble(line.substring(0, 13).replace(' ', '0'));
  271.             }
  272.         } catch (IOException ioe) {
  273.             throw new OrekitException(ioe, new DummyLocalizable(ioe.getMessage()));
  274.         } finally {
  275.             if (r != null) {
  276.                 try {
  277.                     r.close();
  278.                 } catch (IOException ioe) {
  279.                     throw new OrekitException(ioe, new DummyLocalizable(ioe.getMessage()));
  280.                 }
  281.             }
  282.         }
  283.     }

  284.     /** Get the local density.
  285.      * @param date current date
  286.      * @param position current position in frame
  287.      * @param frame the frame in which is defined the position
  288.      * @return local density (kg/m³)
  289.      */
  290.     public double getDensity(final AbsoluteDate date, final Vector3D position,
  291.                              final Frame frame) {

  292.         // check if data are available :
  293.         if ((date.compareTo(inputParams.getMaxDate()) > 0) ||
  294.             (date.compareTo(inputParams.getMinDate()) < 0)) {
  295.             throw new OrekitException(OrekitMessages.NO_SOLAR_ACTIVITY_AT_DATE,
  296.                                       date, inputParams.getMinDate(), inputParams.getMaxDate());
  297.         }

  298.         // compute day number in current year
  299.         final Calendar cal = new GregorianCalendar();
  300.         cal.setTime(date.toDate(TimeScalesFactory.getUTC()));
  301.         final int day = cal.get(Calendar.DAY_OF_YEAR);
  302.         //position in ECEF so we only have to do the transform once
  303.         final Frame ecef = earth.getBodyFrame();
  304.         final Vector3D pEcef = frame.getTransformTo(ecef, date)
  305.                 .transformPosition(position);
  306.         // compute geodetic position
  307.         final GeodeticPoint inBody = earth.transform(pEcef, ecef, date);
  308.         final double alti = inBody.getAltitude();
  309.         final double lon = inBody.getLongitude();
  310.         final double lat = inBody.getLatitude();

  311.         // compute local solar time
  312.         final Vector3D sunPos = sun.getPVCoordinates(date, ecef).getPosition();
  313.         final double hl = FastMath.PI + FastMath.atan2(
  314.                 sunPos.getX() * pEcef.getY() - sunPos.getY() * pEcef.getX(),
  315.                 sunPos.getX() * pEcef.getX() + sunPos.getY() * pEcef.getY());

  316.         // get current solar activity data and compute
  317.         return getDensity(day, alti, lon, lat, hl, inputParams.getInstantFlux(date),
  318.                           inputParams.getMeanFlux(date), inputParams.getThreeHourlyKP(date),
  319.                           inputParams.get24HoursKp(date));

  320.     }

  321.     /** {@inheritDoc} */
  322.     @Override
  323.     public <T extends RealFieldElement<T>> T
  324.         getDensity(final FieldAbsoluteDate<T> date, final FieldVector3D<T> position,
  325.                    final Frame frame) {
  326.         // check if data are available :
  327.         final AbsoluteDate dateD = date.toAbsoluteDate();
  328.         if ((dateD.compareTo(inputParams.getMaxDate()) > 0) ||
  329.             (dateD.compareTo(inputParams.getMinDate()) < 0)) {
  330.             throw new OrekitException(OrekitMessages.NO_SOLAR_ACTIVITY_AT_DATE,
  331.                                       dateD, inputParams.getMinDate(), inputParams.getMaxDate());
  332.         }

  333.         // compute day number in current year
  334.         final Calendar cal = new GregorianCalendar();
  335.         cal.setTime(date.toDate(TimeScalesFactory.getUTC()));
  336.         final int day = cal.get(Calendar.DAY_OF_YEAR);
  337.         //position in ECEF so we only have to do the transform once
  338.         final Frame ecef = earth.getBodyFrame();
  339.         final FieldVector3D<T> pEcef = frame.getTransformTo(ecef, date).transformPosition(position);
  340.         // compute geodetic position
  341.         final FieldGeodeticPoint<T> inBody = earth.transform(pEcef, ecef, date);
  342.         final T alti = inBody.getAltitude();
  343.         final T lon = inBody.getLongitude();
  344.         final T lat = inBody.getLatitude();

  345.         // compute local solar time
  346.         final Vector3D sunPos = sun.getPVCoordinates(dateD, ecef).getPosition();
  347.         final T y  = pEcef.getY().multiply(sunPos.getX()).subtract(pEcef.getX().multiply(sunPos.getY()));
  348.         final T x  = pEcef.getX().multiply(sunPos.getX()).add(pEcef.getY().multiply(sunPos.getY()));
  349.         final T hl = y.atan2(x).add(FastMath.PI);

  350.         // get current solar activity data and compute
  351.         return getDensity(day, alti, lon, lat, hl, inputParams.getInstantFlux(dateD),
  352.                           inputParams.getMeanFlux(dateD), inputParams.getThreeHourlyKP(dateD),
  353.                           inputParams.get24HoursKp(dateD));
  354.     }

  355.     /** Local holder for intermediate results ensuring the model is reentrant. */
  356.     private static class Computation {

  357.         /** Number of days in current year. */
  358.         private final int day;

  359.         /** Instant solar flux. f[1] = instantaneous flux; f[2] = 0. (not used). */
  360.         private final double[] f;

  361.         /** Mean solar flux. fbar[1] = mean flux; fbar[2] = 0. (not used). */
  362.         private final double[] fbar;

  363.         /** Kp coefficients.
  364.          * <ul>
  365.          *   <li>akp[1] = 3-hourly kp</li>
  366.          *   <li>akp[2] = 0 (not used)</li>
  367.          *   <li>akp[3] = mean kp of last 24 hours</li>
  368.          *   <li>akp[4] = 0 (not used)</li>
  369.          * </ul>
  370.          */
  371.         private final double[] akp;

  372.         /** Cosine of the longitude. */
  373.         private final double clfl;

  374.         /** Sine of the longitude. */
  375.         private final double slfl;

  376.         /** Total density (g/cm3). */
  377.         private final double ro;

  378.         // CHECKSTYLE: stop JavadocVariable check

  379.         /** Legendre coefficients. */
  380.         private final double p10;
  381.         private final double p20;
  382.         private final double p30;
  383.         private final double p40;
  384.         private final double p50;
  385.         private final double p60;
  386.         private final double p11;
  387.         private final double p21;
  388.         private final double p31;
  389.         private final double p41;
  390.         private final double p51;
  391.         private final double p22;
  392.         private final double p32;
  393.         private final double p42;
  394.         private final double p52;
  395.         private final double p62;
  396.         private final double p33;
  397.         private final double p10mg;
  398.         private final double p20mg;
  399.         private final double p40mg;

  400.         /** Local time intermediate values. */
  401.         private final double hl0;
  402.         private final double ch;
  403.         private final double sh;
  404.         private final double c2h;
  405.         private final double s2h;
  406.         private final double c3h;
  407.         private final double s3h;

  408.         /** Simple constructor.
  409.          * @param day day of year
  410.          * @param altiKM altitude <em>in kilometers</em>
  411.          * @param lon local longitude (rad)
  412.          * @param lat local latitude (rad)
  413.          * @param hl local solar time in rad (O hr = 0 rad)
  414.          * @param f instantaneous solar flux (F10.7)
  415.          * @param fbar mean solar flux (F10.7)
  416.          * @param akp geomagnetic activity index
  417.          */
  418.         Computation(final int day,
  419.                     final double altiKM, final double lon, final double lat,
  420.                     final double hl, final double[] f, final double[] fbar,
  421.                     final double[] akp) {

  422.             this.day  = day;
  423.             this.f    = f;
  424.             this.fbar = fbar;
  425.             this.akp  = akp;

  426.             // compute Legendre polynomials wrt geographic pole
  427.             final double c = FastMath.sin(lat);
  428.             final double c2 = c * c;
  429.             final double c4 = c2 * c2;
  430.             final double s = FastMath.cos(lat);
  431.             final double s2 = s * s;
  432.             p10 = c;
  433.             p20 = 1.5 * c2 - 0.5;
  434.             p30 = c * (2.5 * c2 - 1.5);
  435.             p40 = 4.375 * c4 - 3.75 * c2 + 0.375;
  436.             p50 = c * (7.875 * c4 - 8.75 * c2 + 1.875);
  437.             p60 = (5.5 * c * p50 - 2.5 * p40) / 3.0;
  438.             p11 = s;
  439.             p21 = 3.0 * c * s;
  440.             p31 = s * (7.5 * c2 - 1.5);
  441.             p41 = c * s * (17.5 * c2 - 7.5);
  442.             p51 = s * (39.375 * c4 - 26.25 * c2 + 1.875);
  443.             p22 = 3.0 * s2;
  444.             p32 = 15.0 * c * s2;
  445.             p42 = s2 * (52.5 * c2 - 7.5);
  446.             p52 = 3.0 * c * p42 - 2.0 * p32;
  447.             p62 = 2.75 * c * p52 - 1.75 * p42;
  448.             p33 = 15.0 * s * s2;

  449.             // compute Legendre polynomials wrt magnetic pole (79N, 71W)
  450.             final double clmlmg = FastMath.cos(lon - XLMG);
  451.             final double cmg  = s * CPMG * clmlmg + c * SPMG;
  452.             final double cmg2 = cmg * cmg;
  453.             final double cmg4 = cmg2 * cmg2;
  454.             p10mg = cmg;
  455.             p20mg = 1.5 * cmg2 - 0.5;
  456.             p40mg = 4.375 * cmg4 - 3.75 * cmg2 + 0.375;

  457.             clfl = FastMath.cos(lon);
  458.             slfl = FastMath.sin(lon);

  459.             // local time
  460.             hl0 = hl;
  461.             ch  = FastMath.cos(hl0);
  462.             sh  = FastMath.sin(hl0);
  463.             c2h = ch * ch - sh * sh;
  464.             s2h = 2.0 * ch * sh;
  465.             c3h = c2h * ch - s2h * sh;
  466.             s3h = s2h * ch + c2h * sh;

  467.             final double zlb = ZLB0; // + dzlb ??

  468.             final double[] dtt  = new double[tt.length];
  469.             final double[] dh   = new double[tt.length];
  470.             final double[] dhe  = new double[tt.length];
  471.             final double[] dox  = new double[tt.length];
  472.             final double[] daz2 = new double[tt.length];
  473.             final double[] do2  = new double[tt.length];
  474.             final double[] daz  = new double[tt.length];
  475.             final double[] dt0  = new double[tt.length];
  476.             final double[] dtp  = new double[tt.length];

  477.             Arrays.fill(dtt,  Double.NaN);
  478.             Arrays.fill(dh,   Double.NaN);
  479.             Arrays.fill(dhe,  Double.NaN);
  480.             Arrays.fill(dox,  Double.NaN);
  481.             Arrays.fill(daz2, Double.NaN);
  482.             Arrays.fill(do2,  Double.NaN);
  483.             Arrays.fill(daz,  Double.NaN);
  484.             Arrays.fill(dt0,  Double.NaN);
  485.             Arrays.fill(dtp,  Double.NaN);

  486.             //  compute function g(l) / tinf, t120, tp120
  487.             int kleq = 1;
  488.             final double gdelt = gFunction(tt, dtt, 1, kleq);
  489.             dtt[1] = 1.0 + gdelt;
  490.             final double tinf   = tt[1] * dtt[1];

  491.             kleq = 0; // equinox

  492.             if ((day < 59) || (day > 284)) {
  493.                 kleq = -1; // north winter
  494.             }
  495.             if ((day > 99) && (day < 244)) {
  496.                 kleq = 1; // north summer
  497.             }

  498.             final double gdelt0 =  gFunction(t0, dt0, 0, kleq);
  499.             dt0[1] = (t0[1] + gdelt0) / t0[1];
  500.             final double t120 = t0[1] + gdelt0;
  501.             final double gdeltp = gFunction(tp, dtp, 0, kleq);
  502.             dtp[1] = (tp[1] + gdeltp) / tp[1];
  503.             final double tp120 = tp[1] + gdeltp;

  504.             // compute n(z) concentrations: H, He, O, N2, O2, N
  505.             final double sigma   = tp120 / (tinf - t120);
  506.             final double dzeta   = (RE + zlb) / (RE + altiKM);
  507.             final double zeta    = (altiKM - zlb) * dzeta;
  508.             final double sigzeta = sigma * zeta;
  509.             final double expsz   = FastMath.exp(-sigzeta);
  510.             final double tz = tinf - (tinf - t120) * expsz;

  511.             final double[] dbase = new double[7];

  512.             kleq = 1;

  513.             final double gdelh = gFunction(h, dh, 0, kleq);
  514.             dh[1] = FastMath.exp(gdelh);
  515.             dbase[1] = h[1] * dh[1];

  516.             final double gdelhe = gFunction(he, dhe, 0, kleq);
  517.             dhe[1] = FastMath.exp(gdelhe);
  518.             dbase[2] = he[1] * dhe[1];

  519.             final double gdelo = gFunction(o, dox, 1, kleq);
  520.             dox[1] = FastMath.exp(gdelo);
  521.             dbase[3] = o[1] * dox[1];

  522.             final double gdelaz2 = gFunction(az2, daz2, 1, kleq);
  523.             daz2[1] = FastMath.exp(gdelaz2);
  524.             dbase[4] = az2[1] * daz2[1];

  525.             final double gdelo2 = gFunction(o2, do2, 1, kleq);
  526.             do2[1] = FastMath.exp(gdelo2);
  527.             dbase[5] = o2[1] * do2[1];

  528.             final double gdelaz = gFunction(az, daz, 1, kleq);
  529.             daz[1] = FastMath.exp(gdelaz);
  530.             dbase[6] = az[1] * daz[1];

  531.             final double zlbre  = 1.0 + zlb / RE;
  532.             final double glb    = (GSURF / (zlbre * zlbre)) / (sigma * RGAS * tinf);
  533.             final double t120tz = t120 / tz;

  534.             // Partial densities in (g/cm3).
  535.             // d(1) = hydrogen
  536.             // d(2) = helium
  537.             // d(3) = atomic oxygen
  538.             // d(4) = molecular nitrogen
  539.             // d(5) = molecular oxygen
  540.             // d(6) = atomic nitrogen
  541.             double tmpro = 0;
  542.             for (int i = 1; i <= 6; i++) {
  543.                 final double gamma = MA[i] * glb;
  544.                 final double upapg = 1.0 + ALEFA[i] + gamma;
  545.                 final double fzI = FastMath.pow(t120tz, upapg) * FastMath.exp(-sigzeta * gamma);
  546.                 // concentrations of H, He, O, N2, O2, N (particles/cm³)
  547.                 final double ccI = dbase[i] * fzI;
  548.                 // contribution of densities of H, He, O, N2, O2, N (g/cm³)
  549.                 tmpro += ccI * VMA[i];
  550.             }
  551.             this.ro = tmpro;

  552.         }

  553.         /** Computation of function G.
  554.          * @param a vector of coefficients for computation
  555.          * @param da vector of partial derivatives
  556.          * @param ff0 coefficient flag (1 for Ox, Az, He, T°; 0 for H and tp120)
  557.          * @param kle_eq season indicator flag (summer, winter, equinox)
  558.          * @return value of G
  559.          */
  560.         private double gFunction(final double[] a, final double[] da,
  561.                                  final int ff0, final int kle_eq) {

  562.             final double[] fmfb   = new double[3];
  563.             final double[] fbm150 = new double[3];

  564.             // latitude terms
  565.             da[2]  = p20;
  566.             da[3]  = p40;
  567.             da[74] = p10;
  568.             double a74 = a[74];
  569.             double a77 = a[77];
  570.             double a78 = a[78];
  571.             if (kle_eq == -1) {
  572.                 // winter
  573.                 a74 = -a74;
  574.                 a77 = -a77;
  575.                 a78 = -a78;
  576.             }
  577.             if (kle_eq == 0 ) {
  578.                 // equinox
  579.                 a74 = semestrialCorrection(a74);
  580.                 a77 = semestrialCorrection(a77);
  581.                 a78 = semestrialCorrection(a78);
  582.             }
  583.             da[77] = p30;
  584.             da[78] = p50;
  585.             da[79] = p60;

  586.             // flux terms
  587.             fmfb[1]   = f[1] - fbar[1];
  588.             fmfb[2]   = f[2] - fbar[2];
  589.             fbm150[1] = fbar[1] - 150.0;
  590.             fbm150[2] = fbar[2];
  591.             da[4]     = fmfb[1];
  592.             da[6]     = fbm150[1];
  593.             da[4]     = da[4] + a[70] * fmfb[2];
  594.             da[6]     = da[6] + a[71] * fbm150[2];
  595.             da[70]    = fmfb[2] * (a[4] + 2.0 * a[5] * da[4] + a[82] * p10 +
  596.                                    a[83] * p20 + a[84] * p30);
  597.             da[71]    = fbm150[2] * (a[6] + 2.0 * a[69] * da[6] + a[85] * p10 +
  598.                                      a[86] * p20 + a[87] * p30);
  599.             da[5]     = da[4] * da[4];
  600.             da[69]    = da[6] * da[6];
  601.             da[82]    = da[4] * p10;
  602.             da[83]    = da[4] * p20;
  603.             da[84]    = da[4] * p30;
  604.             da[85]    = da[6] * p20;
  605.             da[86]    = da[6] * p30;
  606.             da[87]    = da[6] * p40;

  607.             // Kp terms
  608.             final int ikp  = 62;
  609.             final int ikpm = 67;
  610.             final double c2fi = 1.0 - p10mg * p10mg;
  611.             final double dkp  = akp[1] + (a[ikp] + c2fi * a[ikp + 1]) * akp[2];
  612.             double dakp = a[7] + a[8] * p20mg + a[68] * p40mg +
  613.                           2.0 * dkp * (a[60] + a[61] * p20mg +
  614.                                        a[75] * 2.0 * dkp * dkp);
  615.             da[ikp] = dakp * akp[2];
  616.             da[ikp + 1] = da[ikp] * c2fi;
  617.             final double dkpm  = akp[3] + a[ikpm] * akp[4];
  618.             final double dakpm = a[64] + a[65] * p20mg + a[72] * p40mg +
  619.                                  2.0 * dkpm * (a[66] + a[73] * p20mg +
  620.                                                a[76] * 2.0 * dkpm * dkpm);
  621.             da[ikpm] = dakpm * akp[4];
  622.             da[7]    = dkp;
  623.             da[8]    = p20mg * dkp;
  624.             da[68]   = p40mg * dkp;
  625.             da[60]   = dkp * dkp;
  626.             da[61]   = p20mg * da[60];
  627.             da[75]   = da[60] * da[60];
  628.             da[64]   = dkpm;
  629.             da[65]   = p20mg * dkpm;
  630.             da[72]   = p40mg * dkpm;
  631.             da[66]   = dkpm * dkpm;
  632.             da[73]   = p20mg * da[66];
  633.             da[76]   = da[66] * da[66];

  634.             // non-periodic g(l) function
  635.             double f0 = a[4]  * da[4]  + a[5]  * da[5]  + a[6]  * da[6]  +
  636.                         a[69] * da[69] + a[82] * da[82] + a[83] * da[83] +
  637.                         a[84] * da[84] + a[85] * da[85] + a[86] * da[86] +
  638.                         a[87] * da[87];
  639.             final double f1f = 1.0 + f0 * ff0;

  640.             f0 = f0 + a[2] * da[2] + a[3] * da[3] + a74 * da[74] +
  641.                  a77 * da[77] + a[7] * da[7] + a[8] * da[8] +
  642.                  a[60] * da[60] + a[61] * da[61] + a[68] * da[68] +
  643.                  a[64] * da[64] + a[65] * da[65] + a[66] * da[66] +
  644.                  a[72] * da[72] + a[73] * da[73] + a[75] * da[75] +
  645.                  a[76] * da[76] + a78   * da[78] + a[79] * da[79];
  646. //          termes annuels symetriques en latitude
  647.             da[9]  = FastMath.cos(ROT * (day - a[11]));
  648.             da[10] = p20 * da[9];
  649. //          termes semi-annuels symetriques en latitude
  650.             da[12] = FastMath.cos(ROT2 * (day - a[14]));
  651.             da[13] = p20 * da[12];
  652. //          termes annuels non symetriques en latitude
  653.             final double coste = FastMath.cos(ROT * (day - a[18]));
  654.             da[15] = p10 * coste;
  655.             da[16] = p30 * coste;
  656.             da[17] = p50 * coste;
  657. //          terme  semi-annuel  non symetrique  en latitude
  658.             final double cos2te = FastMath.cos(ROT2 * (day - a[20]));
  659.             da[19] = p10 * cos2te;
  660.             da[39] = p30 * cos2te;
  661.             da[59] = p50 * cos2te;
  662. //          termes diurnes [et couples annuel]
  663.             da[21] = p11 * ch;
  664.             da[22] = p31 * ch;
  665.             da[23] = p51 * ch;
  666.             da[24] = da[21] * coste;
  667.             da[25] = p21 * ch * coste;
  668.             da[26] = p11 * sh;
  669.             da[27] = p31 * sh;
  670.             da[28] = p51 * sh;
  671.             da[29] = da[26] * coste;
  672.             da[30] = p21 * sh * coste;
  673. //          termes semi-diurnes [et couples annuel]
  674.             da[31] = p22 * c2h;
  675.             da[37] = p42 * c2h;
  676.             da[32] = p32 * c2h * coste;
  677.             da[33] = p22 * s2h;
  678.             da[38] = p42 * s2h;
  679.             da[34] = p32 * s2h * coste;
  680.             da[88] = p32 * c2h;
  681.             da[89] = p32 * s2h;
  682.             da[90] = p52 * c2h;
  683.             da[91] = p52 * s2h;
  684.             double a88 = a[88];
  685.             double a89 = a[89];
  686.             double a90 = a[90];
  687.             double a91 = a[91];
  688.             if (kle_eq == -1) {            //hiver
  689.                 a88 = -a88;
  690.                 a89 = -a89;
  691.                 a90 = -a90;
  692.                 a91 = -a91;
  693.             }
  694.             if (kle_eq == 0) {             //equinox
  695.                 a88 = semestrialCorrection(a88);
  696.                 a89 = semestrialCorrection(a89);
  697.                 a90 = semestrialCorrection(a90);
  698.                 a91 = semestrialCorrection(a91);
  699.             }
  700.             da[92] = p62 * c2h;
  701.             da[93] = p62 * s2h;
  702. //          termes ter-diurnes
  703.             da[35] = p33 * c3h;
  704.             da[36] = p33 * s3h;
  705. //          fonction g[l] periodique
  706.             double fp = a[9]  * da[9]  + a[10] * da[10] + a[12] * da[12] + a[13] * da[13] +
  707.                         a[15] * da[15] + a[16] * da[16] + a[17] * da[17] + a[19] * da[19] +
  708.                         a[21] * da[21] + a[22] * da[22] + a[23] * da[23] + a[24] * da[24] +
  709.                         a[25] * da[25] + a[26] * da[26] + a[27] * da[27] + a[28] * da[28] +
  710.                         a[29] * da[29] + a[30] * da[30] + a[31] * da[31] + a[32] * da[32] +
  711.                         a[33] * da[33] + a[34] * da[34] + a[35] * da[35] + a[36] * da[36] +
  712.                         a[37] * da[37] + a[38] * da[38] + a[39] * da[39] + a[59] * da[59] +
  713.                         a88   * da[88] + a89   * da[89] + a90   * da[90] + a91   * da[91] +
  714.                         a[92] * da[92] + a[93] * da[93];
  715. //          termes d'activite magnetique
  716.             da[40] = p10 * coste * dkp;
  717.             da[41] = p30 * coste * dkp;
  718.             da[42] = p50 * coste * dkp;
  719.             da[43] = p11 * ch * dkp;
  720.             da[44] = p31 * ch * dkp;
  721.             da[45] = p51 * ch * dkp;
  722.             da[46] = p11 * sh * dkp;
  723.             da[47] = p31 * sh * dkp;
  724.             da[48] = p51 * sh * dkp;

  725. //          fonction g[l] periodique supplementaire
  726.             fp += a[40] * da[40] + a[41] * da[41] + a[42] * da[42] + a[43] * da[43] +
  727.                   a[44] * da[44] + a[45] * da[45] + a[46] * da[46] + a[47] * da[47] +
  728.                   a[48] * da[48];

  729.             dakp = (a[40] * p10 + a[41] * p30 + a[42] * p50) * coste +
  730.                    (a[43] * p11 + a[44] * p31 + a[45] * p51) * ch +
  731.                    (a[46] * p11 + a[47] * p31 + a[48] * p51) * sh;
  732.             da[ikp] += dakp * akp[2];
  733.             da[ikp + 1] = da[ikp] + dakp * c2fi * akp[2];
  734. //          termes de longitude
  735.             da[49] = p11 * clfl;
  736.             da[50] = p21 * clfl;
  737.             da[51] = p31 * clfl;
  738.             da[52] = p41 * clfl;
  739.             da[53] = p51 * clfl;
  740.             da[54] = p11 * slfl;
  741.             da[55] = p21 * slfl;
  742.             da[56] = p31 * slfl;
  743.             da[57] = p41 * slfl;
  744.             da[58] = p51 * slfl;

  745. //          fonction g[l] periodique supplementaire
  746.             fp += a[49] * da[49] + a[50] * da[50] + a[51] * da[51] + a[52] * da[52] +
  747.                   a[53] * da[53] + a[54] * da[54] + a[55] * da[55] + a[56] * da[56] +
  748.                   a[57] * da[57] + a[58] * da[58];

  749. //          fonction g(l) totale (couplage avec le flux)
  750.             return f0 + fp * f1f;

  751.         }


  752.         /** Apply a correction coefficient to the given parameter.
  753.          * @param param the parameter to correct
  754.          * @return the corrected parameter
  755.          */
  756.         private double semestrialCorrection(final double param) {
  757.             final int debeq_pr = 59;
  758.             final int debeq_au = 244;
  759.             final double result;
  760.             if (day >= 100) {
  761.                 final double xmult  = (day - debeq_au) / 40.0;
  762.                 result = param - 2.0 * param * xmult;
  763.             } else {
  764.                 final double xmult  = (day - debeq_pr) / 40.0;
  765.                 result = 2.0 * param * xmult - param;
  766.             }
  767.             return result;
  768.         }


  769.     }

  770.     /** Local holder for intermediate results ensuring the model is reentrant.
  771.      * @param <T> type of the field elements
  772.      */
  773.     private static class FieldComputation<T extends RealFieldElement<T>> {

  774.         /** Number of days in current year. */
  775.         private int day;

  776.         /** Instant solar flux. f[1] = instantaneous flux; f[2] = 0. (not used). */
  777.         private double[] f = new double[3];

  778.         /** Mean solar flux. fbar[1] = mean flux; fbar[2] = 0. (not used). */
  779.         private double[] fbar = new double[3];

  780.         /** Kp coefficients.
  781.          * <ul>
  782.          *   <li>akp[1] = 3-hourly kp</li>
  783.          *   <li>akp[2] = 0 (not used)</li>
  784.          *   <li>akp[3] = mean kp of last 24 hours</li>
  785.          *   <li>akp[4] = 0 (not used)</li>
  786.          * </ul>
  787.          */
  788.         private double[] akp = new double[5];

  789.         /** Cosine of the longitude. */
  790.         private final T clfl;

  791.         /** Sine of the longitude. */
  792.         private final T slfl;

  793.         /** Total density (g/cm3). */
  794.         private final T ro;

  795.         // CHECKSTYLE: stop JavadocVariable check

  796.         /** Legendre coefficients. */
  797.         private final T p10;
  798.         private final T p20;
  799.         private final T p30;
  800.         private final T p40;
  801.         private final T p50;
  802.         private final T p60;
  803.         private final T p11;
  804.         private final T p21;
  805.         private final T p31;
  806.         private final T p41;
  807.         private final T p51;
  808.         private final T p22;
  809.         private final T p32;
  810.         private final T p42;
  811.         private final T p52;
  812.         private final T p62;
  813.         private final T p33;
  814.         private final T p10mg;
  815.         private final T p20mg;
  816.         private final T p40mg;

  817.         /** Local time intermediate values. */
  818.         private final T hl0;
  819.         private final T ch;
  820.         private final T sh;
  821.         private final T c2h;
  822.         private final T s2h;
  823.         private final T c3h;
  824.         private final T s3h;

  825.         /** Simple constructor.
  826.          * @param day day of year
  827.          * @param altiKM altitude <em>in kilometers</em>
  828.          * @param lon local longitude (rad)
  829.          * @param lat local latitude (rad)
  830.          * @param hl local solar time in rad (O hr = 0 rad)
  831.          * @param f instantaneous solar flux (F10.7)
  832.          * @param far mean solar flux (F10.7)
  833.          * @param akp geomagnetic activity index
  834.          */
  835.         FieldComputation(final int day,
  836.                          final T altiKM, final T lon, final T lat,
  837.                          final T hl, final double[] f, final double[] far,
  838.                          final double[] akp) {

  839.             this.day  = day;
  840.             this.f    = f;
  841.             this.fbar = far;
  842.             this.akp  = akp;

  843.             // compute Legendre polynomials wrt geographic pole
  844.             final T c = lat.sin();
  845.             final T c2 = c.multiply(c);
  846.             final T c4 = c2.multiply(c2);
  847.             final T s = lat.cos();
  848.             final T s2 = s.multiply(s);
  849.             p10 = c;
  850.             p20 = c2.multiply(1.5).subtract(0.5);
  851.             p30 = c.multiply(c2.multiply(2.5).subtract(1.5));
  852.             p40 = c4.multiply(4.375).subtract(c2.multiply(3.75)).add(0.375);
  853.             p50 = c.multiply(c4.multiply(7.875).subtract(c2.multiply(8.75)).add(1.875));
  854.             p60 = (c.multiply(5.5).multiply(p50).subtract(p40.multiply(2.5))).divide(3.0);
  855.             p11 = s;
  856.             p21 = c.multiply(3.0).multiply(s);
  857.             p31 = s.multiply(c2.multiply(7.5).subtract(1.5));
  858.             p41 = c.multiply(s).multiply(c2.multiply(17.5).subtract(7.5));
  859.             p51 = s.multiply(c4.multiply(39.375).subtract(c2.multiply(26.25)).add(1.875));
  860.             p22 = s2.multiply(3.0);
  861.             p32 = c.multiply(15.0).multiply(s2);
  862.             p42 = s2.multiply(c2.multiply(52.5).subtract(7.5));
  863.             p52 = c.multiply(3.0).multiply(p42).subtract(p32.multiply(2.0));
  864.             p62 = c.multiply(2.75).multiply(p52).subtract(p42.multiply(1.75));
  865.             p33 = s.multiply(15.0).multiply(s2);

  866.             // compute Legendre polynomials wrt magnetic pole (79N, 71W)
  867.             final T clmlmg = lon.subtract(XLMG).cos();
  868.             final T cmg  = s.multiply(CPMG).multiply(clmlmg).add(c.multiply(SPMG));
  869.             final T cmg2 = cmg.multiply(cmg);
  870.             final T cmg4 = cmg2.multiply(cmg2);
  871.             p10mg = cmg;
  872.             p20mg = cmg2.multiply(1.5).subtract(0.5);
  873.             p40mg = cmg4.multiply(4.375).subtract(cmg2.multiply(3.75)).add(0.375);

  874.             clfl = lon.cos();
  875.             slfl = lon.sin();

  876.             // local time
  877.             hl0 = hl;
  878.             ch  = hl0.cos();
  879.             sh  = hl0.sin();
  880.             c2h = ch.multiply(ch).subtract(sh.multiply(sh));
  881.             s2h = ch.multiply(sh).multiply(2);
  882.             c3h = c2h.multiply(ch).subtract(s2h.multiply(sh));
  883.             s3h = s2h.multiply(ch).add(c2h.multiply(sh));

  884.             final double zlb = ZLB0; // + dzlb ??

  885.             final T[] dtt  = MathArrays.buildArray(altiKM.getField(), tt.length);
  886.             final T[] dh   = MathArrays.buildArray(altiKM.getField(), tt.length);
  887.             final T[] dhe  = MathArrays.buildArray(altiKM.getField(), tt.length);
  888.             final T[] dox  = MathArrays.buildArray(altiKM.getField(), tt.length);
  889.             final T[] daz2 = MathArrays.buildArray(altiKM.getField(), tt.length);
  890.             final T[] do2  = MathArrays.buildArray(altiKM.getField(), tt.length);
  891.             final T[] daz  = MathArrays.buildArray(altiKM.getField(), tt.length);
  892.             final T[] dt0  = MathArrays.buildArray(altiKM.getField(), tt.length);
  893.             final T[] dtp  = MathArrays.buildArray(altiKM.getField(), tt.length);

  894.             //  compute function g(l) / tinf, t120, tp120
  895.             int kleq = 1;
  896.             final T gdelt = gFunction(tt, dtt, 1, kleq);
  897.             dtt[1] = gdelt.add(1);
  898.             final T tinf   = dtt[1].multiply(tt[1]);

  899.             kleq = 0; // equinox

  900.             if ((day < 59) || (day > 284)) {
  901.                 kleq = -1; // north winter
  902.             }
  903.             if ((day > 99) && (day < 244)) {
  904.                 kleq = 1; // north summer
  905.             }

  906.             final T gdelt0 =  gFunction(t0, dt0, 0, kleq);
  907.             dt0[1] = gdelt0.add(t0[1]).divide(t0[1]);
  908.             final T t120 = gdelt0.add(t0[1]);
  909.             final T gdeltp = gFunction(tp, dtp, 0, kleq);
  910.             dtp[1] = gdeltp.add(tp[1]).divide(tp[1]);
  911.             final T tp120 = gdeltp.add(tp[1]);

  912.             // compute n(z) concentrations: H, He, O, N2, O2, N
  913.             final T sigma   = tp120.divide(tinf.subtract(t120));
  914.             final T dzeta   = altiKM.add(RE).reciprocal().multiply(zlb + RE);
  915.             final T zeta    = altiKM.subtract(zlb).multiply(dzeta);
  916.             final T sigzeta = sigma.multiply(zeta);
  917.             final T expsz   = sigzeta.negate().exp();
  918.             final T tz = tinf.subtract(tinf.subtract(t120).multiply(expsz));

  919.             final T[] dbase = MathArrays.buildArray(altiKM.getField(), 7);

  920.             kleq = 1;

  921.             final T gdelh = gFunction(h, dh, 0, kleq);
  922.             dh[1] = gdelh.exp();
  923.             dbase[1] = dh[1].multiply(h[1]);

  924.             final T gdelhe = gFunction(he, dhe, 0, kleq);
  925.             dhe[1] = gdelhe.exp();
  926.             dbase[2] = dhe[1].multiply(he[1]);

  927.             final T gdelo = gFunction(o, dox, 1, kleq);
  928.             dox[1] = gdelo.exp();
  929.             dbase[3] = dox[1].multiply(o[1]);

  930.             final T gdelaz2 = gFunction(az2, daz2, 1, kleq);
  931.             daz2[1] = gdelaz2.exp();
  932.             dbase[4] = daz2[1].multiply(az2[1]);

  933.             final T gdelo2 = gFunction(o2, do2, 1, kleq);
  934.             do2[1] = gdelo2.exp();
  935.             dbase[5] = do2[1].multiply(o2[1]);

  936.             final T gdelaz = gFunction(az, daz, 1, kleq);
  937.             daz[1] = gdelaz.exp();
  938.             dbase[6] = daz[1].multiply(az[1]);

  939.             final double zlbre  = 1.0 + zlb / RE;
  940.             final T glb    = sigma.multiply(RGAS).multiply(tinf).reciprocal().multiply(GSURF / (zlbre * zlbre));
  941.             final T t120tz = t120.divide(tz);

  942.             // Partial densities in (g/cm3).
  943.             // d(1) = hydrogen
  944.             // d(2) = helium
  945.             // d(3) = atomic oxygen
  946.             // d(4) = molecular nitrogen
  947.             // d(5) = molecular oxygen
  948.             // d(6) = atomic nitrogen
  949.             T tmpro = altiKM.getField().getZero();
  950.             for (int i = 1; i <= 6; i++) {
  951.                 final T gamma = glb.multiply(MA[i]);
  952.                 final T upapg = gamma.add(1.0 + ALEFA[i]);
  953.                 final T fzI = t120tz.pow(upapg).multiply(sigzeta.negate().multiply(gamma).exp());
  954.                 // concentrations of H, He, O, N2, O2, N (particles/cm³)
  955.                 final T ccI = dbase[i].multiply(fzI);
  956.                 // contribution of densities of H, He, O, N2, O2, N (g/cm³)
  957.                 tmpro = tmpro.add(ccI.multiply(VMA[i]));
  958.             }
  959.             this.ro = tmpro;

  960.         }

  961.         /** Computation of function G.
  962.          * @param a vector of coefficients for computation
  963.          * @param da vector of partial derivatives
  964.          * @param ff0 coefficient flag (1 for Ox, Az, He, T°; 0 for H and tp120)
  965.          * @param kle_eq season indicator flag (summer, winter, equinox)
  966.          * @return value of G
  967.          */
  968.         private T gFunction(final double[] a, final T[] da,
  969.                             final int ff0, final int kle_eq) {

  970.             final T zero = da[0].getField().getZero();
  971.             final double[] fmfb   = new double[3];
  972.             final double[] fbm150 = new double[3];

  973.             // latitude terms
  974.             da[2]  = p20;
  975.             da[3]  = p40;
  976.             da[74] = p10;
  977.             double a74 = a[74];
  978.             double a77 = a[77];
  979.             double a78 = a[78];
  980.             if (kle_eq == -1) {
  981.                 // winter
  982.                 a74 = -a74;
  983.                 a77 = -a77;
  984.                 a78 = -a78;
  985.             }
  986.             if (kle_eq == 0 ) {
  987.                 // equinox
  988.                 a74 = semestrialCorrection(a74);
  989.                 a77 = semestrialCorrection(a77);
  990.                 a78 = semestrialCorrection(a78);
  991.             }
  992.             da[77] = p30;
  993.             da[78] = p50;
  994.             da[79] = p60;

  995.             // flux terms
  996.             fmfb[1]   = f[1] - fbar[1];
  997.             fmfb[2]   = f[2] - fbar[2];
  998.             fbm150[1] = fbar[1] - 150.0;
  999.             fbm150[2] = fbar[2];
  1000.             da[4]     = zero.add(fmfb[1]);
  1001.             da[6]     = zero.add(fbm150[1]);
  1002.             da[4]     = da[4].add(a[70] * fmfb[2]);
  1003.             da[6]     = da[6].add(a[71] * fbm150[2]);
  1004.             da[70]    = da[4].multiply(a[ 5]).multiply(2).
  1005.                             add(p10.multiply(a[82])).
  1006.                             add(p20.multiply(a[83])).
  1007.                             add(p30.multiply(a[84])).
  1008.                             add(a[4]).
  1009.                         multiply(fmfb[2]);
  1010.             da[71]    = da[6].multiply(a[69]).multiply(2).
  1011.                             add(p10.multiply(a[85])).
  1012.                             add(p20.multiply(a[86])).
  1013.                             add(p30.multiply(a[87])).
  1014.                             add(a[6]).
  1015.                         multiply(fbm150[2]);
  1016.             da[5]     = da[4].multiply(da[4]);
  1017.             da[69]    = da[6].multiply(da[6]);
  1018.             da[82]    = da[4].multiply(p10);
  1019.             da[83]    = da[4].multiply(p20);
  1020.             da[84]    = da[4].multiply(p30);
  1021.             da[85]    = da[6].multiply(p20);
  1022.             da[86]    = da[6].multiply(p30);
  1023.             da[87]    = da[6].multiply(p40);

  1024.             // Kp terms
  1025.             final int ikp  = 62;
  1026.             final int ikpm = 67;
  1027.             final T c2fi = p10mg.multiply(p10mg).negate().add(1);
  1028.             final T dkp  = c2fi.multiply(a[ikp + 1]).add(a[ikp]).multiply(akp[2]).add(akp[1]);
  1029.             T dakp = p20mg.multiply(a[8]).add(p40mg.multiply(a[68])).
  1030.                      add(p20mg.multiply(a[61]).add(dkp.multiply(dkp).multiply(2 * a[75]).add(a[60])).multiply(dkp.multiply(2))).
  1031.                      add(a[7]);
  1032.             da[ikp]     = dakp.multiply(akp[2]);
  1033.             da[ikp + 1] = da[ikp].multiply(c2fi);
  1034.             final double dkpm  = akp[3] + a[ikpm] * akp[4];
  1035.             final T dakpm = p20mg.multiply(a[65]).add(p40mg.multiply(a[72])).
  1036.                             add(p20mg.multiply(a[73]).add(a[66] + a[76] * 2.0 * dkpm * dkpm).multiply( 2.0 * dkpm)).
  1037.                             add(a[64]);
  1038.             da[ikpm] = dakpm.multiply(akp[4]);
  1039.             da[7]    = dkp;
  1040.             da[8]    = p20mg.multiply(dkp);
  1041.             da[68]   = p40mg.multiply(dkp);
  1042.             da[60]   = dkp.multiply(dkp);
  1043.             da[61]   = p20mg.multiply(da[60]);
  1044.             da[75]   = da[60].multiply(da[60]);
  1045.             da[64]   = zero.add(dkpm);
  1046.             da[65]   = p20mg.multiply(dkpm);
  1047.             da[72]   = p40mg.multiply(dkpm);
  1048.             da[66]   = zero.add(dkpm * dkpm);
  1049.             da[73]   = p20mg.multiply(da[66]);
  1050.             da[76]   = da[66].multiply(da[66]);

  1051.             // non-periodic g(l) function
  1052.             T f0 = da[4].multiply(a[4]).
  1053.                    add(da[5].multiply(a[5])).
  1054.                    add(da[6].multiply(a[6])).
  1055.                    add(da[69].multiply(a[69])).
  1056.                    add(da[82].multiply(a[82])).
  1057.                    add(da[83].multiply(a[83])).
  1058.                    add(da[84].multiply(a[84])).
  1059.                    add(da[85].multiply(a[85])).
  1060.                    add(da[86].multiply(a[86])).
  1061.                    add(da[87].multiply(a[87]));
  1062.             final T f1f = f0.multiply(ff0).add(1);

  1063.             f0 = f0.
  1064.                  add(da[2].multiply(a[2])).
  1065.                  add(da[3].multiply(a[3])).
  1066.                  add(da[7].multiply(a[7])).
  1067.                  add(da[8].multiply(a[8])).
  1068.                  add(da[60].multiply(a[60])).
  1069.                  add(da[61].multiply(a[61])).
  1070.                  add(da[68].multiply(a[68])).
  1071.                  add(da[64].multiply(a[64])).
  1072.                  add(da[65].multiply(a[65])).
  1073.                  add(da[66].multiply(a[66])).
  1074.                  add(da[72].multiply(a[72])).
  1075.                  add(da[73].multiply(a[73])).
  1076.                  add(da[74].multiply(a74)).
  1077.                  add(da[75].multiply(a[75])).
  1078.                  add(da[76].multiply(a[76])).
  1079.                  add(da[77].multiply(a77)).
  1080.                  add(da[78].multiply(a78)).
  1081.                  add(da[79].multiply(a[79]));
  1082. //          termes annuels symetriques en latitude
  1083.             da[9]  = zero.add(FastMath.cos(ROT * (day - a[11])));
  1084.             da[10] = p20.multiply(da[9]);
  1085. //          termes semi-annuels symetriques en latitude
  1086.             da[12] = zero.add(FastMath.cos(ROT2 * (day - a[14])));
  1087.             da[13] = p20.multiply(da[12]);
  1088. //          termes annuels non symetriques en latitude
  1089.             final double coste = FastMath.cos(ROT * (day - a[18]));
  1090.             da[15] = p10.multiply(coste);
  1091.             da[16] = p30.multiply(coste);
  1092.             da[17] = p50.multiply(coste);
  1093. //          terme  semi-annuel  non symetrique  en latitude
  1094.             final double cos2te = FastMath.cos(ROT2 * (day - a[20]));
  1095.             da[19] = p10.multiply(cos2te);
  1096.             da[39] = p30.multiply(cos2te);
  1097.             da[59] = p50.multiply(cos2te);
  1098. //          termes diurnes [et couples annuel]
  1099.             da[21] = p11.multiply(ch);
  1100.             da[22] = p31.multiply(ch);
  1101.             da[23] = p51.multiply(ch);
  1102.             da[24] = da[21].multiply(coste);
  1103.             da[25] = p21.multiply(ch).multiply(coste);
  1104.             da[26] = p11.multiply(sh);
  1105.             da[27] = p31.multiply(sh);
  1106.             da[28] = p51.multiply(sh);
  1107.             da[29] = da[26].multiply(coste);
  1108.             da[30] = p21.multiply(sh).multiply(coste);
  1109. //          termes semi-diurnes [et couples annuel]
  1110.             da[31] = p22.multiply(c2h);
  1111.             da[37] = p42.multiply(c2h);
  1112.             da[32] = p32.multiply(c2h).multiply(coste);
  1113.             da[33] = p22.multiply(s2h);
  1114.             da[38] = p42.multiply(s2h);
  1115.             da[34] = p32.multiply(s2h).multiply(coste);
  1116.             da[88] = p32.multiply(c2h);
  1117.             da[89] = p32.multiply(s2h);
  1118.             da[90] = p52.multiply(c2h);
  1119.             da[91] = p52.multiply(s2h);
  1120.             double a88 = a[88];
  1121.             double a89 = a[89];
  1122.             double a90 = a[90];
  1123.             double a91 = a[91];
  1124.             if (kle_eq == -1) {            //hiver
  1125.                 a88 = -a88;
  1126.                 a89 = -a89;
  1127.                 a90 = -a90;
  1128.                 a91 = -a91;
  1129.             }
  1130.             if (kle_eq == 0) {             //equinox
  1131.                 a88 = semestrialCorrection(a88);
  1132.                 a89 = semestrialCorrection(a89);
  1133.                 a90 = semestrialCorrection(a90);
  1134.                 a91 = semestrialCorrection(a91);
  1135.             }
  1136.             da[92] = p62.multiply(c2h);
  1137.             da[93] = p62.multiply(s2h);
  1138. //          termes ter-diurnes
  1139.             da[35] = p33.multiply(c3h);
  1140.             da[36] = p33.multiply(s3h);
  1141. //          fonction g[l] periodique
  1142.             T fp =     da[ 9].multiply(a[ 9]) .add(da[10].multiply(a[10])).add(da[12].multiply(a[12])).add(da[13].multiply(a[13])).
  1143.                    add(da[15].multiply(a[15])).add(da[16].multiply(a[16])).add(da[17].multiply(a[17])).add(da[19].multiply(a[19])).
  1144.                    add(da[21].multiply(a[21])).add(da[22].multiply(a[22])).add(da[23].multiply(a[23])).add(da[24].multiply(a[24])).
  1145.                    add(da[25].multiply(a[25])).add(da[26].multiply(a[26])).add(da[27].multiply(a[27])).add(da[28].multiply(a[28])).
  1146.                    add(da[29].multiply(a[29])).add(da[30].multiply(a[30])).add(da[31].multiply(a[31])).add(da[32].multiply(a[32])).
  1147.                    add(da[33].multiply(a[33])).add(da[34].multiply(a[34])).add(da[35].multiply(a[35])).add(da[36].multiply(a[36])).
  1148.                    add(da[37].multiply(a[37])).add(da[38].multiply(a[38])).add(da[39].multiply(a[39])).add(da[59].multiply(a[59])).
  1149.                    add(da[88].multiply(a88))  .add(da[89].multiply(a89)  ).add(da[90].multiply(a90)  ).add(da[91].multiply(a91)  ).
  1150.                    add(da[92].multiply(a[92])).add(da[93].multiply(a[93]));
  1151. //          termes d'activite magnetique
  1152.             da[40] = p10.multiply(coste).multiply(dkp);
  1153.             da[41] = p30.multiply(coste).multiply(dkp);
  1154.             da[42] = p50.multiply(coste).multiply(dkp);
  1155.             da[43] = p11.multiply(ch).multiply(dkp);
  1156.             da[44] = p31.multiply(ch).multiply(dkp);
  1157.             da[45] = p51.multiply(ch).multiply(dkp);
  1158.             da[46] = p11.multiply(sh).multiply(dkp);
  1159.             da[47] = p31.multiply(sh).multiply(dkp);
  1160.             da[48] = p51.multiply(sh).multiply(dkp);

  1161. //          fonction g[l] periodique supplementaire
  1162.             fp = fp.
  1163.                   add(da[40].multiply(a[40])).
  1164.                   add(da[41].multiply(a[41])).
  1165.                   add(da[42].multiply(a[42])).
  1166.                   add(da[43].multiply(a[43])).
  1167.                   add(da[44].multiply(a[44])).
  1168.                   add(da[45].multiply(a[45])).
  1169.                   add(da[46].multiply(a[46])).
  1170.                   add(da[47].multiply(a[47])).
  1171.                   add(da[48].multiply(a[48]));

  1172.             dakp =     p10.multiply(a[40]).add(p30.multiply(a[41])).add(p50.multiply(a[42])).multiply(coste).
  1173.                    add(p11.multiply(a[40]).add(p31.multiply(a[44])).add(p51.multiply(a[45])).multiply(ch)).
  1174.                    add(p11.multiply(a[46]).add(p31.multiply(a[47])).add(p51.multiply(a[48])).multiply(sh));
  1175.             da[ikp] = da[ikp].add(dakp.multiply(akp[2]));
  1176.             da[ikp + 1] = da[ikp].add(dakp.multiply(c2fi).multiply(akp[2]));
  1177. //          termes de longitude
  1178.             da[49] = p11.multiply(clfl);
  1179.             da[50] = p21.multiply(clfl);
  1180.             da[51] = p31.multiply(clfl);
  1181.             da[52] = p41.multiply(clfl);
  1182.             da[53] = p51.multiply(clfl);
  1183.             da[54] = p11.multiply(slfl);
  1184.             da[55] = p21.multiply(slfl);
  1185.             da[56] = p31.multiply(slfl);
  1186.             da[57] = p41.multiply(slfl);
  1187.             da[58] = p51.multiply(slfl);

  1188. //          fonction g[l] periodique supplementaire
  1189.             fp = fp.
  1190.                  add(da[49].multiply(a[49])).
  1191.                  add(da[50].multiply(a[50])).
  1192.                  add(da[51].multiply(a[51])).
  1193.                  add(da[52].multiply(a[52])).
  1194.                  add(da[53].multiply(a[53])).
  1195.                  add(da[54].multiply(a[54])).
  1196.                  add(da[55].multiply(a[55])).
  1197.                  add(da[56].multiply(a[56])).
  1198.                  add(da[57].multiply(a[57])).
  1199.                  add(da[58].multiply(a[58]));

  1200. //          fonction g(l) totale (couplage avec le flux)
  1201.             return f0.add(fp.multiply(f1f));

  1202.         }


  1203.         /** Apply a correction coefficient to the given parameter.
  1204.          * @param param the parameter to correct
  1205.          * @return the corrected parameter
  1206.          */
  1207.         private double semestrialCorrection(final double param) {
  1208.             final int debeq_pr = 59;
  1209.             final int debeq_au = 244;
  1210.             final double result;
  1211.             if (day >= 100) {
  1212.                 final double xmult  = (day - debeq_au) / 40.0;
  1213.                 result = param - 2.0 * param * xmult;
  1214.             } else {
  1215.                 final double xmult  = (day - debeq_pr) / 40.0;
  1216.                 result = 2.0 * param * xmult - param;
  1217.             }
  1218.             return result;
  1219.         }

  1220.     }

  1221. }