CristalCaveGem » LustreC

#include <stdlib.h>

#include <assert.h>

#include "ALT_2.lustrec.h"

/* C code generated by lustrec

   SVN version number 342

   Code is C99 compliant */

/* Imported nodes declarations */

/* Global constants (definitions) */

void top_reset (struct top_mem *self) {

  AltitudeControl_reset(&self->ni_0);

  return;

}

void top_step (_Bool AltEng, double AltCmd, double Altitude, double gskts,

               double hdot, double hdotChgRate, 

               _Bool (*obs),

               struct top_mem *self) {

  double altgammaCmd;

  double tempAlt;

  tempAlt = (AltEng?(1.):(0.));

  AltitudeControl_step (tempAlt, AltCmd, Altitude, gskts, hdot, hdotChgRate, &altgammaCmd, &self->ni_0);

  *obs = (altgammaCmd == 0.);

  return;

}

void AltitudeControl_reset (struct AltitudeControl_mem *self) {

  VariableRateLimit_reset(&self->ni_1);

  return;

}

void AltitudeControl_step (double AntEng_Out1_19, double AltCmd_Out1_29,

                           double Alt_Out1_39, double GsKts_Out1_49,

                           double hdot_Out1_59, double hdotChgRate_Out1_69, 

                           double (*altgammacmd_In1_661),

                           struct AltitudeControl_mem *self) {

  double Abs_Out1_144;

  double Kh_Out1_193;

  _Bool Logical_Operator_In1_197;

  _Bool Logical_Operator_Out1_198;

  double Saturation1_Out1_213;

  double Sum3_Out1_296;

  double Sum_Out1_286;

  _Bool Switch1_In2_312;

  double Switch1_Out1_314;

  _Bool Switch_In2_303;

  double Switch_Out1_305;

  double Variable_Limit_Saturation_0_Out1_509;

  double Variable__Rate_Limit_Out1_324;

  _Bool __AltitudeControl_1;

  _Bool __AltitudeControl_2;

  double k_Out1_585;

  double kts2fps_Out1_594;

  double r2d_Out1_603;

  __AltitudeControl_1 = (hdot_Out1_59 < 0.);

  Abs_Out1_144 = (__AltitudeControl_1?((- hdot_Out1_59)):(hdot_Out1_59));

  Sum3_Out1_296 = (Abs_Out1_144 + 10.);

  k_Out1_585 = (- Sum3_Out1_296);

  __AltitudeControl_2 = (AntEng_Out1_19 == 0.);

  Logical_Operator_In1_197 = (__AltitudeControl_2?(0):(1));

  Logical_Operator_Out1_198 = (!Logical_Operator_In1_197);

  Switch_In2_303 = (__AltitudeControl_2?(0):(1));

  Sum_Out1_286 = (AltCmd_Out1_29 + (- Alt_Out1_39));

  Kh_Out1_193 = (0.08 * Sum_Out1_286);

  Switch_Out1_305 = (Switch_In2_303?(Kh_Out1_193):(0.));

  VariableLimitSaturation_step (Sum3_Out1_296, Switch_Out1_305, k_Out1_585, &Variable_Limit_Saturation_0_Out1_509);

  VariableRateLimit_step (hdotChgRate_Out1_69, Variable_Limit_Saturation_0_Out1_509, Logical_Operator_Out1_198, hdot_Out1_59, &Variable__Rate_Limit_Out1_324, &self->ni_1);

  r2d_Out1_603 = (57.2958 * Variable__Rate_Limit_Out1_324);

  kts2fps_Out1_594 = (1.6878 * GsKts_Out1_49);

  Switch1_In2_312 = (__AltitudeControl_2?(0):(1));

  Switch1_Out1_314 = (Switch1_In2_312?(r2d_Out1_603):(0.));

  *altgammacmd_In1_661 = Switch1_Out1_314;

  Saturation_step (kts2fps_Out1_594, &Saturation1_Out1_213);

  return;

}

void VariableRateLimit_reset (struct VariableRateLimit_mem *self) {

  _arrow_reset(&self->ni_3);

  integrator_reset_reset(&self->ni_2);

  return;

}

void VariableRateLimit_step (double ratelim_Out1_334, double input_Out1_344,

                             _Bool ICtrig_Out1_354, double IC_Out1_364, 

                             double (*output_In1_489),

                             struct VariableRateLimit_mem *self) {

  double Gain1_Out1_382;

  double Gain_Out1_373;

  double Integrator1_Out1_391;

  double Sum2_Out1_401;

  double Variable_Limit_Saturation_Out1_410;

  _Bool __VariableRateLimit_1;

  double __VariableRateLimit_2;

  _arrow_step (1, 0, &__VariableRateLimit_1, &self->ni_3);

  Integrator1_Out1_391 = (__VariableRateLimit_1?(IC_Out1_364):(self->_reg.__VariableRateLimit_3));

  *output_In1_489 = Integrator1_Out1_391;

  Gain1_Out1_382 = (- ratelim_Out1_334);

  Sum2_Out1_401 = (input_Out1_344 + (- Integrator1_Out1_391));

  Gain_Out1_373 = (20. * Sum2_Out1_401);

  VariableLimitSaturation_step (ratelim_Out1_334, Gain_Out1_373, Gain1_Out1_382, &Variable_Limit_Saturation_Out1_410);

  integrator_reset_step (Variable_Limit_Saturation_Out1_410, ICtrig_Out1_354, IC_Out1_364, &__VariableRateLimit_2, &self->ni_2);

  self->_reg.__VariableRateLimit_3 = __VariableRateLimit_2;

  return;

}

void Saturation_step (double Signal, 

                      double (*s_out)

                      ) {

  _Bool __Saturation_1;

  _Bool __Saturation_2;

  double enforce_lo_lim;

  __Saturation_1 = (0.0001 >= Signal);

  enforce_lo_lim = (__Saturation_1?(0.0001):(Signal));

  __Saturation_2 = (1000. <= enforce_lo_lim);

  *s_out = (__Saturation_2?(1000.):(enforce_lo_lim));

  return;

}

void integrator_reset_reset (struct integrator_reset_mem *self) {

  _arrow_reset(&self->ni_4);

  return;

}

void integrator_reset_step (double Fx, _Bool ResetLevel, double x0, 

                            double (*ir_out),

                            struct integrator_reset_mem *self) {

  _Bool __integrator_reset_1;

  _arrow_step (1, 0, &__integrator_reset_1, &self->ni_4);

  *ir_out = (__integrator_reset_1?(x0):((ResetLevel?(x0):(((Fx * 1.) + self->_reg.__integrator_reset_2)))));

  self->_reg.__integrator_reset_2 = *ir_out;

  return;

}

void VariableLimitSaturation_step (double up_lim, double Signal,

                                   double lo_lim, 

                                   double (*out)

                                   ) {

  _Bool __VariableLimitSaturation_1;

  _Bool __VariableLimitSaturation_2;

  double enforce_lo_lim;

  __VariableLimitSaturation_1 = (Signal >= lo_lim);

  enforce_lo_lim = (__VariableLimitSaturation_1?(Signal):(lo_lim));

  __VariableLimitSaturation_2 = (enforce_lo_lim <= up_lim);

  *out = (__VariableLimitSaturation_2?(enforce_lo_lim):(up_lim));

  return;

}