src/FDM/UIUCModel/uiuc_icing_demo.cpp

   1 /**********************************************************************
   2
   3  FILENAME:     uiuc_icing_demo.cpp
   4
   5 ----------------------------------------------------------------------
   6
   7  DESCRIPTION:
   8
   9 ----------------------------------------------------------------------
  10
  11  STATUS:       alpha version
  12
  13 ----------------------------------------------------------------------
  14
  15  REFERENCES:
  16
  17 ----------------------------------------------------------------------
  18
  19  HISTORY:      12/02/2002   initial release - originally in
  20                             uiuc_coefficients()
  21
  22 ----------------------------------------------------------------------
  23
  24  AUTHOR(S):    Robert Deters      <rdeters@uiuc.edu>
  25
  26 ----------------------------------------------------------------------
  27
  28  VARIABLES:
  29
  30 ----------------------------------------------------------------------
  31
  32  INPUTS:
  33
  34 ----------------------------------------------------------------------
  35
  36  OUTPUTS:
  37
  38 ----------------------------------------------------------------------
  39
  40  CALLED BY:    uiuc_coefficients
  41
  42 ----------------------------------------------------------------------
  43
  44  CALLS TO:
  45
  46 ----------------------------------------------------------------------
  47
  48  COPYRIGHT:    (C) 2002 by Michael Selig
  49
  50  This program is free software; you can redistribute it and/or
  51  modify it under the terms of the GNU General Public License
  52  as published by the Free Software Foundation.
  53
  54  This program is distributed in the hope that it will be useful,
  55  but WITHOUT ANY WARRANTY; without even the implied warranty of
  56  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  57  GNU General Public License for more details.
  58
  59  You should have received a copy of the GNU General Public License
  60  along with this program; if not, write to the Free Software
  61  Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307,
  62  USA or view http://www.gnu.org/copyleft/gpl.html.
  63
  64 **********************************************************************/
  65
  66 #include "uiuc_icing_demo.h"
  67
  68 void uiuc_icing_demo()
  69 {
  70   // Envelope protection values
  71   if (demo_eps_alpha_max) {
  72     double time = Simtime - demo_eps_alpha_max_startTime;
  73     eps_alpha_max = uiuc_1Dinterpolation(demo_eps_alpha_max_timeArray,
  74                                          demo_eps_alpha_max_daArray,
  75                                          demo_eps_alpha_max_ntime,
  76                                          time);
  77   }
  78   if (demo_eps_pitch_max) {
  79     double time = Simtime - demo_eps_pitch_max_startTime;
  80     eps_pitch_max = uiuc_1Dinterpolation(demo_eps_pitch_max_timeArray,
  81                                          demo_eps_pitch_max_daArray,
  82                                          demo_eps_pitch_max_ntime,
  83                                          time);
  84   }
  85   if (demo_eps_pitch_min) {
  86     double time = Simtime - demo_eps_pitch_min_startTime;
  87     eps_pitch_min = uiuc_1Dinterpolation(demo_eps_pitch_min_timeArray,
  88                                          demo_eps_pitch_min_daArray,
  89                                          demo_eps_pitch_min_ntime,
  90                                          time);
  91   }
  92   if (demo_eps_roll_max) {
  93     double time = Simtime - demo_eps_roll_max_startTime;
  94     eps_roll_max = uiuc_1Dinterpolation(demo_eps_roll_max_timeArray,
  95                                         demo_eps_roll_max_daArray,
  96                                         demo_eps_roll_max_ntime,
  97                                         time);
  98   }
  99   if (demo_eps_thrust_min) {
 100     double time = Simtime - demo_eps_thrust_min_startTime;
 101     eps_thrust_min = uiuc_1Dinterpolation(demo_eps_thrust_min_timeArray,
 102                                           demo_eps_thrust_min_daArray,
 103                                           demo_eps_thrust_min_ntime,
 104                                           time);
 105   }
 106   if (demo_eps_airspeed_max) {
 107     double time = Simtime - demo_eps_airspeed_max_startTime;
 108     eps_airspeed_max = uiuc_1Dinterpolation(demo_eps_airspeed_max_timeArray,
 109                                             demo_eps_airspeed_max_daArray,
 110                                             demo_eps_airspeed_max_ntime,
 111                                             time);
 112   }
 113   if (demo_eps_airspeed_min) {
 114     double time = Simtime - demo_eps_airspeed_min_startTime;
 115     eps_airspeed_min = uiuc_1Dinterpolation(demo_eps_airspeed_min_timeArray,
 116                                             demo_eps_airspeed_min_daArray,
 117                                             demo_eps_airspeed_min_ntime,
 118                                             time);
 119   }
 120   if (demo_eps_flap_max) {
 121     double time = Simtime - demo_eps_flap_max_startTime;
 122     eps_flap_max = uiuc_1Dinterpolation(demo_eps_flap_max_timeArray,
 123                                         demo_eps_flap_max_daArray,
 124                                         demo_eps_flap_max_ntime,
 125                                         time);
 126   }
 127   if (demo_eps_pitch_input) {
 128     double time = Simtime - demo_eps_pitch_input_startTime;
 129     eps_pitch_input = uiuc_1Dinterpolation(demo_eps_pitch_input_timeArray,
 130                                            demo_eps_pitch_input_daArray,
 131                                            demo_eps_pitch_input_ntime,
 132                                            time);
 133   }
 134
 135   // Boot cycle values
 136   if (demo_boot_cycle_tail) {
 137     double time = Simtime - demo_boot_cycle_tail_startTime;
 138     boot_cycle_tail = uiuc_1Dinterpolation(demo_boot_cycle_tail_timeArray,
 139                                            demo_boot_cycle_tail_daArray,
 140                                            demo_boot_cycle_tail_ntime,
 141                                            time);
 142   }
 143   if (demo_boot_cycle_wing_left) {
 144     double time = Simtime - demo_boot_cycle_wing_left_startTime;
 145     boot_cycle_wing_left = uiuc_1Dinterpolation(demo_boot_cycle_wing_left_timeArray,
 146                                                 demo_boot_cycle_wing_left_daArray,
 147                                                 demo_boot_cycle_wing_left_ntime,
 148                                                 time);
 149   }
 150   if (demo_boot_cycle_wing_right) {
 151     double time = Simtime - demo_boot_cycle_wing_right_startTime;
 152     boot_cycle_wing_right = uiuc_1Dinterpolation(demo_boot_cycle_wing_right_timeArray,
 153                                                  demo_boot_cycle_wing_right_daArray,
 154                                                  demo_boot_cycle_wing_right_ntime,
 155                                                  time);
 156   }
 157
 158   // Ice values
 159   if (demo_ice_tail) {
 160     double time = Simtime - demo_ice_tail_startTime;
 161     ice_tail = uiuc_1Dinterpolation(demo_ice_tail_timeArray,
 162                                     demo_ice_tail_daArray,
 163                                     demo_ice_tail_ntime,
 164                                     time);
 165   }
 166   if (demo_ice_left) {
 167     double time = Simtime - demo_ice_left_startTime;
 168     ice_left = uiuc_1Dinterpolation(demo_ice_left_timeArray,
 169                                     demo_ice_left_daArray,
 170                                     demo_ice_left_ntime,
 171                                     time);
 172   }
 173   if (demo_ice_right) {
 174     double time = Simtime - demo_ice_right_startTime;
 175     ice_right = uiuc_1Dinterpolation(demo_ice_right_timeArray,
 176                                      demo_ice_right_daArray,
 177                                      demo_ice_right_ntime,
 178                                      time);
 179   }
 180
 181   // Autopilot
 182   if (demo_ap_pah_on){
 183     double time = Simtime - demo_ap_pah_on_startTime;
 184     ap_pah_on = uiuc_1Dinterpolation(demo_ap_pah_on_timeArray,
 185                                      demo_ap_pah_on_daArray,
 186                                      demo_ap_pah_on_ntime,
 187                                      time);
 188   }
 189   if (demo_ap_alh_on){
 190     double time = Simtime - demo_ap_alh_on_startTime;
 191     ap_alh_on = uiuc_1Dinterpolation(demo_ap_alh_on_timeArray,
 192                                      demo_ap_alh_on_daArray,
 193                                      demo_ap_alh_on_ntime,
 194                                      time);
 195   }
 196   if (demo_ap_rah_on){
 197     double time = Simtime - demo_ap_rah_on_startTime;
 198     ap_rah_on = uiuc_1Dinterpolation(demo_ap_rah_on_timeArray,
 199                                      demo_ap_rah_on_daArray,
 200                                      demo_ap_rah_on_ntime,
 201                                      time);
 202   }
 203   if (demo_ap_hh_on){
 204     double time = Simtime - demo_ap_hh_on_startTime;
 205     ap_hh_on = uiuc_1Dinterpolation(demo_ap_hh_on_timeArray,
 206                                     demo_ap_hh_on_daArray,
 207                                     demo_ap_hh_on_ntime,
 208                                     time);
 209   }
 210   if (demo_ap_Theta_ref){
 211     double time = Simtime - demo_ap_Theta_ref_startTime;
 212     ap_Theta_ref_rad = uiuc_1Dinterpolation(demo_ap_Theta_ref_timeArray,
 213                                             demo_ap_Theta_ref_daArray,
 214                                             demo_ap_Theta_ref_ntime,
 215                                             time);
 216   }
 217   if (demo_ap_alt_ref){
 218     double time = Simtime - demo_ap_alt_ref_startTime;
 219     ap_alt_ref_ft = uiuc_1Dinterpolation(demo_ap_alt_ref_timeArray,
 220                                             demo_ap_alt_ref_daArray,
 221                                             demo_ap_alt_ref_ntime,
 222                                             time);
 223   }
 224   if (demo_ap_Phi_ref){
 225     double time = Simtime - demo_ap_Phi_ref_startTime;
 226     ap_Phi_ref_rad = uiuc_1Dinterpolation(demo_ap_Phi_ref_timeArray,
 227                                             demo_ap_Phi_ref_daArray,
 228                                             demo_ap_Phi_ref_ntime,
 229                                             time);
 230   }
 231   if (demo_ap_Psi_ref){
 232     double time = Simtime - demo_ap_Psi_ref_startTime;
 233     ap_Psi_ref_rad = uiuc_1Dinterpolation(demo_ap_Psi_ref_timeArray,
 234                                             demo_ap_Psi_ref_daArray,
 235                                             demo_ap_Psi_ref_ntime,
 236                                             time);
 237   }
 238
 239   return;
 240 }