1
|
-- File generated using Simulink2Lustre r550
|
2
|
-- More informations at https://cavale.enseeiht.fr/redmine/projects/cristalcavegem
|
3
|
--Trace FROMFILE : AltitudeControl_AltConfig.mdl ;
|
4
|
--Trace FROMFILE_SHA256 : d1ec5a2af426376e4af6b5bb52b80f7065403900e3e4708daf7f1448fad07e8a ;
|
5
|
|
6
|
open "mathFunctionsLibrary"
|
7
|
|
8
|
open "arrayFunctionsLibrary"
|
9
|
|
10
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Constant/Value" ;
|
11
|
const AltitudeControlAltConfig_Constant_Value = 0.0001 ;
|
12
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Constant1/Value" ;
|
13
|
const AltitudeControlAltConfig_Constant1_Value = 0 ;
|
14
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Constant3/Value" ;
|
15
|
const AltitudeControlAltConfig_Constant3_Value = 10 ;
|
16
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Constant4/Value" ;
|
17
|
const AltitudeControlAltConfig_Constant4_Value = 3.2 ;
|
18
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Constant5/Value" ;
|
19
|
const AltitudeControlAltConfig_Constant5_Value = 1000 ;
|
20
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Kh/Gain" ;
|
21
|
const AltitudeControlAltConfig_Kh_Gain = 0.08 ;
|
22
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Variable \\nRate Limit/Gain/Gain" ;
|
23
|
const AltitudeControlAltConfig_VariableRateLimit_Gain_Gain = 20 ;
|
24
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Variable \\nRate Limit/Gain1/Gain" ;
|
25
|
const AltitudeControlAltConfig_VariableRateLimit_Gain1_Gain = -1 ;
|
26
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Constant/Value" ;
|
27
|
const AltitudeControlAltConfig_VariableRateLimit_integratorreset_Constant_Value = 0.0 ;
|
28
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Gain1/Gain" ;
|
29
|
const AltitudeControlAltConfig_VariableRateLimit_integratorreset_Gain1_Gain = 0.02 ;
|
30
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#1/InitialValue" ;
|
31
|
const AltitudeControlAltConfig_VariableRateLimit_integratorreset_delaysharp1_InitialValue = 1.0 ;
|
32
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#2/InitialValue" ;
|
33
|
const AltitudeControlAltConfig_VariableRateLimit_integratorreset_delaysharp2_InitialValue = 0.0 ;
|
34
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#3/InitialValue" ;
|
35
|
const AltitudeControlAltConfig_VariableRateLimit_integratorreset_delaysharp3_InitialValue = 0.0 ;
|
36
|
--Trace PARAMETER : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/zero/Value" ;
|
37
|
const AltitudeControlAltConfig_VariableRateLimit_integratorreset_zero_Value = 0 ;
|
38
|
--Trace PARAMETER : "AltitudeControl_AltConfig/k/Gain" ;
|
39
|
const AltitudeControlAltConfig_k_Gain = -1 ;
|
40
|
--Trace PARAMETER : "AltitudeControl_AltConfig/kts2fps/Gain" ;
|
41
|
const AltitudeControlAltConfig_kts2fps_Gain = 1.6878 ;
|
42
|
--Trace PARAMETER : "AltitudeControl_AltConfig/observer/Constant/Value" ;
|
43
|
const AltitudeControlAltConfig_observer_Constant_Value = 100000 ;
|
44
|
--Trace PARAMETER : "AltitudeControl_AltConfig/observer/Constant2/Value" ;
|
45
|
const AltitudeControlAltConfig_observer_Constant2_Value = 1 ;
|
46
|
--Trace PARAMETER : "AltitudeControl_AltConfig/r2d/Gain" ;
|
47
|
const AltitudeControlAltConfig_r2d_Gain = 57.2958 ;
|
48
|
--Trace BLOCK : "AltitudeControl_AltConfig" ;
|
49
|
--@ ensures AltitudeControlAltConfig_observer (Altitude_Out1_95) ;
|
50
|
|
51
|
node AltitudeControlAltConfig (
|
52
|
--Trace PORT : "AltitudeControl_AltConfig/alteng/Out1" ;
|
53
|
alteng_Out1_75 : real ;
|
54
|
--Trace PORT : "AltitudeControl_AltConfig/AltCmd/Out1" ;
|
55
|
AltCmd_Out1_85 : real ;
|
56
|
--Trace PORT : "AltitudeControl_AltConfig/Altitude/Out1" ;
|
57
|
Altitude_Out1_95 : real ;
|
58
|
--Trace PORT : "AltitudeControl_AltConfig/gskts/Out1" ;
|
59
|
gskts_Out1_105 : real ;
|
60
|
--Trace PORT : "AltitudeControl_AltConfig/hdot/Out1" ;
|
61
|
hdot_Out1_115 : real)
|
62
|
returns (
|
63
|
--Trace PORT : "AltitudeControl_AltConfig/altgamcmd/In1" ;
|
64
|
altgamcmd_In1_835 : real ;
|
65
|
--Trace PORT : "AltitudeControl_AltConfig/observer_output/In1" ;
|
66
|
observeroutput_In1_847 : bool) ;
|
67
|
var
|
68
|
--Trace PORT : "AltitudeControl_AltConfig/Abs/Out1" ;
|
69
|
Abs_Out1_118 : real ;
|
70
|
--Trace PORT : "AltitudeControl_AltConfig/Divide/Out1" ;
|
71
|
Divide_Out1_174 : real ;
|
72
|
--Trace PORT : "AltitudeControl_AltConfig/Kh/Out1" ;
|
73
|
Kh_Out1_183 : real ;
|
74
|
--Trace PORT : "AltitudeControl_AltConfig/Logical\\nOperator/Out1" ;
|
75
|
LogicalOperator_Out1_188 : bool ;
|
76
|
--Trace PORT : "AltitudeControl_AltConfig/MinMax/Out1" ;
|
77
|
MinMax_Out1_198 : real ;
|
78
|
--Trace PORT : "AltitudeControl_AltConfig/MinMax1/Out1" ;
|
79
|
MinMax1_Out1_208 : real ;
|
80
|
--Trace PORT : "AltitudeControl_AltConfig/Mux/Out1" ;
|
81
|
Mux_Out1_212 : real^2 ;
|
82
|
--Trace PORT : "AltitudeControl_AltConfig/Mux1/Out1" ;
|
83
|
Mux1_Out1_216 : real^2 ;
|
84
|
--Trace PORT : "AltitudeControl_AltConfig/Sum/Out1" ;
|
85
|
Sum_Out1_226 : real ;
|
86
|
--Trace PORT : "AltitudeControl_AltConfig/Sum3/Out1" ;
|
87
|
Sum3_Out1_236 : real ;
|
88
|
--Trace PORT : "AltitudeControl_AltConfig/Switch/Out1" ;
|
89
|
Switch_Out1_245 : real ;
|
90
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Out1" ;
|
91
|
VariableRateLimit_Out1_255 : real ;
|
92
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Out1" ;
|
93
|
VariableLimitSaturation0_Out1_655 : real ;
|
94
|
--Trace PORT : "AltitudeControl_AltConfig/k/Out1" ;
|
95
|
k_Out1_731 : real ;
|
96
|
--Trace PORT : "AltitudeControl_AltConfig/kts2fps/Out1" ;
|
97
|
kts2fps_Out1_740 : real ;
|
98
|
--Trace PORT : "AltitudeControl_AltConfig/r2d/Out1" ;
|
99
|
r2d_Out1_823 : real ;
|
100
|
--Trace PORT : "AltitudeControl_AltConfig/Abs/In1" ;
|
101
|
Abs_In1_117 : real ;
|
102
|
--Trace PORT : "AltitudeControl_AltConfig/AltCtnlScope/In1" ;
|
103
|
AltCtnlScope_In1_120 : real^2 ;
|
104
|
--Trace PORT : "AltitudeControl_AltConfig/AltCtnlScope/In2" ;
|
105
|
AltCtnlScope_In2_121 : real^2 ;
|
106
|
--Trace PORT : "AltitudeControl_AltConfig/AltCtnlScope/In3" ;
|
107
|
AltCtnlScope_In3_122 : real ;
|
108
|
--Trace PORT : "AltitudeControl_AltConfig/Divide/In1" ;
|
109
|
Divide_In1_172 : real ;
|
110
|
--Trace PORT : "AltitudeControl_AltConfig/Divide/In2" ;
|
111
|
Divide_In2_173 : real ;
|
112
|
--Trace PORT : "AltitudeControl_AltConfig/Kh/In1" ;
|
113
|
Kh_In1_182 : real ;
|
114
|
--Trace PORT : "AltitudeControl_AltConfig/Logical\\nOperator/In1" ;
|
115
|
LogicalOperator_In1_187 : bool ;
|
116
|
--Trace PORT : "AltitudeControl_AltConfig/MinMax/In1" ;
|
117
|
MinMax_In1_196 : real ;
|
118
|
--Trace PORT : "AltitudeControl_AltConfig/MinMax/In2" ;
|
119
|
MinMax_In2_197 : real ;
|
120
|
--Trace PORT : "AltitudeControl_AltConfig/MinMax1/In1" ;
|
121
|
MinMax1_In1_206 : real ;
|
122
|
--Trace PORT : "AltitudeControl_AltConfig/MinMax1/In2" ;
|
123
|
MinMax1_In2_207 : real ;
|
124
|
--Trace PORT : "AltitudeControl_AltConfig/Mux/In1" ;
|
125
|
Mux_In1_210 : real ;
|
126
|
--Trace PORT : "AltitudeControl_AltConfig/Mux/In2" ;
|
127
|
Mux_In2_211 : real ;
|
128
|
--Trace PORT : "AltitudeControl_AltConfig/Mux1/In1" ;
|
129
|
Mux1_In1_214 : real ;
|
130
|
--Trace PORT : "AltitudeControl_AltConfig/Mux1/In2" ;
|
131
|
Mux1_In2_215 : real ;
|
132
|
--Trace PORT : "AltitudeControl_AltConfig/Sum/In1" ;
|
133
|
Sum_In1_224 : real ;
|
134
|
--Trace PORT : "AltitudeControl_AltConfig/Sum/In2" ;
|
135
|
Sum_In2_225 : real ;
|
136
|
--Trace PORT : "AltitudeControl_AltConfig/Sum3/In1" ;
|
137
|
Sum3_In1_234 : real ;
|
138
|
--Trace PORT : "AltitudeControl_AltConfig/Sum3/In2" ;
|
139
|
Sum3_In2_235 : real ;
|
140
|
--Trace PORT : "AltitudeControl_AltConfig/Switch/In1" ;
|
141
|
Switch_In1_242 : real ;
|
142
|
--Trace PORT : "AltitudeControl_AltConfig/Switch/In2" ;
|
143
|
Switch_In2_243 : bool ;
|
144
|
--Trace PORT : "AltitudeControl_AltConfig/Switch/In3" ;
|
145
|
Switch_In3_244 : real ;
|
146
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/In1" ;
|
147
|
VariableRateLimit_In1_251 : real ;
|
148
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/In2" ;
|
149
|
VariableRateLimit_In2_252 : real ;
|
150
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/In3" ;
|
151
|
VariableRateLimit_In3_253 : bool ;
|
152
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/In4" ;
|
153
|
VariableRateLimit_In4_254 : real ;
|
154
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/In1" ;
|
155
|
VariableLimitSaturation0_In1_652 : real ;
|
156
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/In2" ;
|
157
|
VariableLimitSaturation0_In2_653 : real ;
|
158
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/In3" ;
|
159
|
VariableLimitSaturation0_In3_654 : real ;
|
160
|
--Trace PORT : "AltitudeControl_AltConfig/k/In1" ;
|
161
|
k_In1_730 : real ;
|
162
|
--Trace PORT : "AltitudeControl_AltConfig/kts2fps/In1" ;
|
163
|
kts2fps_In1_739 : real ;
|
164
|
--Trace PORT : "AltitudeControl_AltConfig/r2d/In1" ;
|
165
|
r2d_In1_822 : real ;
|
166
|
let
|
167
|
--Trace BLOCK : "AltitudeControl_AltConfig/Abs" ;
|
168
|
Abs_Out1_118 =
|
169
|
if Abs_In1_117 < 0.0 then
|
170
|
- Abs_In1_117
|
171
|
else Abs_In1_117 ;
|
172
|
--Trace BLOCK : "AltitudeControl_AltConfig/Divide" ;
|
173
|
Divide_Out1_174 = Divide_In1_172 * (1.0 div Divide_In2_173) ;
|
174
|
--Trace BLOCK : "AltitudeControl_AltConfig/Kh" ;
|
175
|
Kh_Out1_183 = AltitudeControlAltConfig_Kh_Gain * Kh_In1_182 ;
|
176
|
--Trace BLOCK : "AltitudeControl_AltConfig/Logical\\nOperator" ;
|
177
|
LogicalOperator_Out1_188 = not LogicalOperator_In1_187 ;
|
178
|
--Trace BLOCK : "AltitudeControl_AltConfig/MinMax" ;
|
179
|
MinMax_Out1_198 =
|
180
|
if MinMax_In1_196 <= MinMax_In2_197 then
|
181
|
MinMax_In1_196
|
182
|
else MinMax_In2_197 ;
|
183
|
--Trace BLOCK : "AltitudeControl_AltConfig/MinMax1" ;
|
184
|
MinMax1_Out1_208 =
|
185
|
if MinMax1_In1_206 >= MinMax1_In2_207 then
|
186
|
MinMax1_In2_207
|
187
|
else MinMax1_In1_206 ;
|
188
|
--Trace BLOCK : "AltitudeControl_AltConfig/Mux" ;
|
189
|
Mux_Out1_212 = [ Mux_In1_210, Mux_In2_211 ] ;
|
190
|
--Trace BLOCK : "AltitudeControl_AltConfig/Mux1" ;
|
191
|
Mux1_Out1_216 = [ Mux1_In1_214, Mux1_In2_215 ] ;
|
192
|
--Trace BLOCK : "AltitudeControl_AltConfig/Sum" ;
|
193
|
Sum_Out1_226 = Sum_In1_224 + - Sum_In2_225 ;
|
194
|
--Trace BLOCK : "AltitudeControl_AltConfig/Sum3" ;
|
195
|
Sum3_Out1_236 = Sum3_In1_234 + Sum3_In2_235 ;
|
196
|
--Trace BLOCK : "AltitudeControl_AltConfig/Switch" ;
|
197
|
Switch_Out1_245 =
|
198
|
if Switch_In2_243 then
|
199
|
Switch_In1_242
|
200
|
else Switch_In3_244 ;
|
201
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit" ;
|
202
|
VariableRateLimit_Out1_255 = AltitudeControlAltConfig_VariableRateLimit (VariableRateLimit_In1_251, VariableRateLimit_In2_252, VariableRateLimit_In3_253, VariableRateLimit_In4_254) ;
|
203
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0" ;
|
204
|
VariableLimitSaturation0_Out1_655 = AltitudeControlAltConfig_VariableLimitSaturation0 (VariableLimitSaturation0_In1_652, VariableLimitSaturation0_In2_653, VariableLimitSaturation0_In3_654) ;
|
205
|
--Trace BLOCK : "AltitudeControl_AltConfig/k" ;
|
206
|
k_Out1_731 = int_to_real (AltitudeControlAltConfig_k_Gain) * k_In1_730 ;
|
207
|
--Trace BLOCK : "AltitudeControl_AltConfig/kts2fps" ;
|
208
|
kts2fps_Out1_740 = AltitudeControlAltConfig_kts2fps_Gain * kts2fps_In1_739 ;
|
209
|
--Trace BLOCK : "AltitudeControl_AltConfig/r2d" ;
|
210
|
r2d_Out1_823 = AltitudeControlAltConfig_r2d_Gain * r2d_In1_822 ;
|
211
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Sum_2_Kh" ;
|
212
|
Kh_In1_182 = Sum_Out1_226 ;
|
213
|
--Trace SIGNAL : "AltitudeControl_AltConfig/AltCmd_2_Sum" ;
|
214
|
Sum_In1_224 = AltCmd_Out1_85 ;
|
215
|
--Trace SIGNAL : "AltitudeControl_AltConfig/AltCmd_2_Mux" ;
|
216
|
Mux_In1_210 = AltCmd_Out1_85 ;
|
217
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Altitude_2_Sum" ;
|
218
|
Sum_In2_225 = Altitude_Out1_95 ;
|
219
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Altitude_2_Mux" ;
|
220
|
Mux_In2_211 = Altitude_Out1_95 ;
|
221
|
--Trace SIGNAL : "AltitudeControl_AltConfig/hdot_2_Abs" ;
|
222
|
Abs_In1_117 = hdot_Out1_115 ;
|
223
|
--Trace SIGNAL : "AltitudeControl_AltConfig/hdot_2_Variable \\nRate Limit" ;
|
224
|
VariableRateLimit_In4_254 = hdot_Out1_115 ;
|
225
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Abs_2_Sum3" ;
|
226
|
Sum3_In1_234 = Abs_Out1_118 ;
|
227
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Constant3_2_Sum3" ;
|
228
|
Sum3_In2_235 = int_to_real (AltitudeControlAltConfig_Constant3_Value) ;
|
229
|
--Trace SIGNAL : "AltitudeControl_AltConfig/k_2_Variable Limit\\nSaturation_0" ;
|
230
|
VariableLimitSaturation0_In3_654 = k_Out1_731 ;
|
231
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Sum3_2_k" ;
|
232
|
k_In1_730 = Sum3_Out1_236 ;
|
233
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Sum3_2_Variable Limit\\nSaturation_0" ;
|
234
|
VariableLimitSaturation0_In1_652 = Sum3_Out1_236 ;
|
235
|
--Trace SIGNAL : "AltitudeControl_AltConfig/alteng_2_Logical\\nOperator" ;
|
236
|
LogicalOperator_In1_187 =
|
237
|
if alteng_Out1_75 = 0.0 then
|
238
|
false
|
239
|
else true ;
|
240
|
--Trace SIGNAL : "AltitudeControl_AltConfig/alteng_2_AltCtnlScope" ;
|
241
|
AltCtnlScope_In3_122 = alteng_Out1_75 ;
|
242
|
--Trace SIGNAL : "AltitudeControl_AltConfig/alteng_2_Switch" ;
|
243
|
Switch_In2_243 =
|
244
|
if alteng_Out1_75 = 0.0 then
|
245
|
false
|
246
|
else true ;
|
247
|
--Trace SIGNAL : "AltitudeControl_AltConfig/gskts_2_kts2fps" ;
|
248
|
kts2fps_In1_739 = gskts_Out1_105 ;
|
249
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Divide_2_r2d" ;
|
250
|
r2d_In1_822 = Divide_Out1_174 ;
|
251
|
--Trace SIGNAL : "AltitudeControl_AltConfig/r2d_2_altgamcmd" ;
|
252
|
altgamcmd_In1_835 = r2d_Out1_823 ;
|
253
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Logical\\nOperator_2_Variable \\nRate Limit" ;
|
254
|
VariableRateLimit_In3_253 = LogicalOperator_Out1_188 ;
|
255
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0_2_Mux1" ;
|
256
|
Mux1_In1_214 = VariableLimitSaturation0_Out1_655 ;
|
257
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0_2_Variable \\nRate Limit" ;
|
258
|
VariableRateLimit_In2_252 = VariableLimitSaturation0_Out1_655 ;
|
259
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Constant4_2_Variable \\nRate Limit" ;
|
260
|
VariableRateLimit_In1_251 = AltitudeControlAltConfig_Constant4_Value ;
|
261
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit_2_Mux1" ;
|
262
|
Mux1_In2_215 = VariableRateLimit_Out1_255 ;
|
263
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit_2_Divide" ;
|
264
|
Divide_In1_172 = VariableRateLimit_Out1_255 ;
|
265
|
--Trace SIGNAL : "AltitudeControl_AltConfig/kts2fps_2_MinMax1" ;
|
266
|
MinMax1_In1_206 = kts2fps_Out1_740 ;
|
267
|
--Trace SIGNAL : "AltitudeControl_AltConfig/MinMax_2_Divide" ;
|
268
|
Divide_In2_173 = MinMax_Out1_198 ;
|
269
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Switch_2_Variable Limit\\nSaturation_0" ;
|
270
|
VariableLimitSaturation0_In2_653 = Switch_Out1_245 ;
|
271
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Kh_2_Switch" ;
|
272
|
Switch_In1_242 = Kh_Out1_183 ;
|
273
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Constant1_2_Switch" ;
|
274
|
Switch_In3_244 = int_to_real (AltitudeControlAltConfig_Constant1_Value) ;
|
275
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Mux_2_AltCtnlScope" ;
|
276
|
AltCtnlScope_In1_120 = Mux_Out1_212 ;
|
277
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Mux1_2_AltCtnlScope" ;
|
278
|
AltCtnlScope_In2_121 = Mux1_Out1_216 ;
|
279
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Constant_2_MinMax1" ;
|
280
|
MinMax1_In2_207 = AltitudeControlAltConfig_Constant_Value ;
|
281
|
--Trace SIGNAL : "AltitudeControl_AltConfig/MinMax1_2_MinMax" ;
|
282
|
MinMax_In1_196 = MinMax1_Out1_208 ;
|
283
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Constant5_2_MinMax" ;
|
284
|
MinMax_In2_197 = int_to_real (AltitudeControlAltConfig_Constant5_Value) ;
|
285
|
--Trace SIGNAL : "AltitudeControl_AltConfig/observer_2_observer_output" ;
|
286
|
observeroutput_In1_847 = observer_Out1_753 ;
|
287
|
--! MAIN : true ;
|
288
|
|
289
|
tel
|
290
|
|
291
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit" ;
|
292
|
|
293
|
node AltitudeControlAltConfig_VariableRateLimit (
|
294
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/ratelim/Out1" ;
|
295
|
ratelim_Out1_265 : real ;
|
296
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/input/Out1" ;
|
297
|
input_Out1_275 : real ;
|
298
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/ICtrig/Out1" ;
|
299
|
ICtrig_Out1_285 : bool ;
|
300
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/IC/Out1" ;
|
301
|
IC_Out1_295 : real)
|
302
|
returns (
|
303
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/output/In1" ;
|
304
|
output_In1_635 : real) ;
|
305
|
var
|
306
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Gain/Out1" ;
|
307
|
Gain_Out1_304 : real ;
|
308
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Gain1/Out1" ;
|
309
|
Gain1_Out1_313 : real ;
|
310
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Sum2/Out1" ;
|
311
|
Sum2_Out1_323 : real ;
|
312
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Out1" ;
|
313
|
VariableLimitSaturation_Out1_332 : real ;
|
314
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Out1" ;
|
315
|
integratorreset_Out1_408 : real ;
|
316
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Gain/In1" ;
|
317
|
Gain_In1_303 : real ;
|
318
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Gain1/In1" ;
|
319
|
Gain1_In1_312 : real ;
|
320
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Sum2/In1" ;
|
321
|
Sum2_In1_321 : real ;
|
322
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Sum2/In2" ;
|
323
|
Sum2_In2_322 : real ;
|
324
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/In1" ;
|
325
|
VariableLimitSaturation_In1_329 : real ;
|
326
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/In2" ;
|
327
|
VariableLimitSaturation_In2_330 : real ;
|
328
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/In3" ;
|
329
|
VariableLimitSaturation_In3_331 : real ;
|
330
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/In1" ;
|
331
|
integratorreset_In1_405 : real ;
|
332
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/In2" ;
|
333
|
integratorreset_In2_406 : real ;
|
334
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/In3" ;
|
335
|
integratorreset_In3_407 : real ;
|
336
|
let
|
337
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/Gain" ;
|
338
|
Gain_Out1_304 = int_to_real (AltitudeControlAltConfig_VariableRateLimit_Gain_Gain) * Gain_In1_303 ;
|
339
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/Gain1" ;
|
340
|
Gain1_Out1_313 = int_to_real (AltitudeControlAltConfig_VariableRateLimit_Gain1_Gain) * Gain1_In1_312 ;
|
341
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/Sum2" ;
|
342
|
Sum2_Out1_323 = Sum2_In1_321 + - Sum2_In2_322 ;
|
343
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation" ;
|
344
|
VariableLimitSaturation_Out1_332 = AltitudeControlAltConfig_VariableRateLimit_VariableLimitSaturation (VariableLimitSaturation_In1_329, VariableLimitSaturation_In2_330, VariableLimitSaturation_In3_331) ;
|
345
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset" ;
|
346
|
integratorreset_Out1_408 = AltitudeControlAltConfig_VariableRateLimit_integratorreset (integratorreset_In1_405, integratorreset_In2_406, integratorreset_In3_407) ;
|
347
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/Sum2_2_Gain" ;
|
348
|
Gain_In1_303 = Sum2_Out1_323 ;
|
349
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/Gain_2_Variable Limit\\nSaturation" ;
|
350
|
VariableLimitSaturation_In2_330 = Gain_Out1_304 ;
|
351
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/ratelim_2_Gain1" ;
|
352
|
Gain1_In1_312 = ratelim_Out1_265 ;
|
353
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/ratelim_2_Variable Limit\\nSaturation" ;
|
354
|
VariableLimitSaturation_In1_329 = ratelim_Out1_265 ;
|
355
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/Gain1_2_Variable Limit\\nSaturation" ;
|
356
|
VariableLimitSaturation_In3_331 = Gain1_Out1_313 ;
|
357
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset_2_Sum2" ;
|
358
|
Sum2_In2_322 = integratorreset_Out1_408 ;
|
359
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset_2_output" ;
|
360
|
output_In1_635 = integratorreset_Out1_408 ;
|
361
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/input_2_Sum2" ;
|
362
|
Sum2_In1_321 = input_Out1_275 ;
|
363
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/ICtrig_2_integrator_reset" ;
|
364
|
integratorreset_In2_406 =
|
365
|
if ICtrig_Out1_285 then
|
366
|
1.0
|
367
|
else 0.0 ;
|
368
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/IC_2_integrator_reset" ;
|
369
|
integratorreset_In3_407 = IC_Out1_295 ;
|
370
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation_2_integrator_reset" ;
|
371
|
integratorreset_In1_405 = VariableLimitSaturation_Out1_332 ;
|
372
|
|
373
|
tel
|
374
|
|
375
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation" ;
|
376
|
|
377
|
node AltitudeControlAltConfig_VariableRateLimit_VariableLimitSaturation (
|
378
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/up_lim/Out1" ;
|
379
|
uplim_Out1_342 : real ;
|
380
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/SigIn/Out1" ;
|
381
|
SigIn_Out1_352 : real ;
|
382
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Lo_lim/Out1" ;
|
383
|
Lolim_Out1_362 : real)
|
384
|
returns (
|
385
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Out1/In1" ;
|
386
|
Out1_In1_394 : real) ;
|
387
|
var
|
388
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Enforce\\nlow lim/Out1" ;
|
389
|
Enforcelowlim_Out1_372 : real ;
|
390
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Enforce\\nup lim/Out1" ;
|
391
|
Enforceuplim_Out1_382 : real ;
|
392
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Enforce\\nlow lim/In1" ;
|
393
|
Enforcelowlim_In1_370 : real ;
|
394
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Enforce\\nlow lim/In2" ;
|
395
|
Enforcelowlim_In2_371 : real ;
|
396
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Enforce\\nup lim/In1" ;
|
397
|
Enforceuplim_In1_380 : real ;
|
398
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Enforce\\nup lim/In2" ;
|
399
|
Enforceuplim_In2_381 : real ;
|
400
|
let
|
401
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Enforce\\nlow lim" ;
|
402
|
Enforcelowlim_Out1_372 =
|
403
|
if Enforcelowlim_In1_370 >= Enforcelowlim_In2_371 then
|
404
|
Enforcelowlim_In2_371
|
405
|
else Enforcelowlim_In1_370 ;
|
406
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Enforce\\nup lim" ;
|
407
|
Enforceuplim_Out1_382 =
|
408
|
if Enforceuplim_In1_380 <= Enforceuplim_In2_381 then
|
409
|
Enforceuplim_In1_380
|
410
|
else Enforceuplim_In2_381 ;
|
411
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Enforce\\nup lim_2_Out1" ;
|
412
|
Out1_In1_394 = Enforceuplim_Out1_382 ;
|
413
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/up_lim_2_Enforce\\nup lim" ;
|
414
|
Enforceuplim_In2_381 = uplim_Out1_342 ;
|
415
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Enforce\\nlow lim_2_Enforce\\nup lim" ;
|
416
|
Enforceuplim_In1_380 = Enforcelowlim_Out1_372 ;
|
417
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/SigIn_2_Enforce\\nlow lim" ;
|
418
|
Enforcelowlim_In2_371 = SigIn_Out1_352 ;
|
419
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/Variable Limit\\nSaturation/Lo_lim_2_Enforce\\nlow lim" ;
|
420
|
Enforcelowlim_In1_370 = Lolim_Out1_362 ;
|
421
|
|
422
|
tel
|
423
|
|
424
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset" ;
|
425
|
|
426
|
node AltitudeControlAltConfig_VariableRateLimit_integratorreset (
|
427
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/f(x)/Out1" ;
|
428
|
fx_Out1_418 : real ;
|
429
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/reset_level/Out1" ;
|
430
|
resetlevel_Out1_428 : real ;
|
431
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/x0/Out1" ;
|
432
|
x0_Out1_438 : real)
|
433
|
returns (
|
434
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/F(x)/In1" ;
|
435
|
Fx_In1_595 : real) ;
|
436
|
var
|
437
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Add/Out1" ;
|
438
|
Add_Out1_448 : real ;
|
439
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Gain1/Out1" ;
|
440
|
Gain1_Out1_465 : real ;
|
441
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product/Out1" ;
|
442
|
Product_Out1_477 : real ;
|
443
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product1/Out1" ;
|
444
|
Product1_Out1_489 : real ;
|
445
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product2/Out1" ;
|
446
|
Product2_Out1_502 : real ;
|
447
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum1/Out1" ;
|
448
|
Sum1_Out1_512 : real ;
|
449
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum2/Out1" ;
|
450
|
Sum2_Out1_522 : real ;
|
451
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum3/Out1" ;
|
452
|
Sum3_Out1_532 : real ;
|
453
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum4/Out1" ;
|
454
|
Sum4_Out1_542 : real ;
|
455
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#1/Out1" ;
|
456
|
delaysharp1_Out1_547 : real ;
|
457
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#2/Out1" ;
|
458
|
delaysharp2_Out1_552 : real ;
|
459
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#3/Out1" ;
|
460
|
delaysharp3_Out1_557 : real ;
|
461
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/eq0/Out1" ;
|
462
|
eq0_Out1_563 : bool ;
|
463
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/ne0/Out1" ;
|
464
|
ne0_Out1_569 : bool ;
|
465
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/ne1/Out1" ;
|
466
|
ne1_Out1_575 : bool ;
|
467
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Add/In1" ;
|
468
|
Add_In1_446 : real ;
|
469
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Add/In2" ;
|
470
|
Add_In2_447 : real ;
|
471
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Gain1/In1" ;
|
472
|
Gain1_In1_464 : real ;
|
473
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product/In1" ;
|
474
|
Product_In1_475 : real ;
|
475
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product/In2" ;
|
476
|
Product_In2_476 : real ;
|
477
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product1/In1" ;
|
478
|
Product1_In1_487 : real ;
|
479
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product1/In2" ;
|
480
|
Product1_In2_488 : real ;
|
481
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product2/In1" ;
|
482
|
Product2_In1_499 : real ;
|
483
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product2/In2" ;
|
484
|
Product2_In2_500 : real ;
|
485
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product2/In3" ;
|
486
|
Product2_In3_501 : real ;
|
487
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum1/In1" ;
|
488
|
Sum1_In1_510 : real ;
|
489
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum1/In2" ;
|
490
|
Sum1_In2_511 : real ;
|
491
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum2/In1" ;
|
492
|
Sum2_In1_520 : real ;
|
493
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum2/In2" ;
|
494
|
Sum2_In2_521 : real ;
|
495
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum3/In1" ;
|
496
|
Sum3_In1_530 : real ;
|
497
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum3/In2" ;
|
498
|
Sum3_In2_531 : real ;
|
499
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum4/In1" ;
|
500
|
Sum4_In1_540 : real ;
|
501
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum4/In2" ;
|
502
|
Sum4_In2_541 : real ;
|
503
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#1/In1" ;
|
504
|
delaysharp1_In1_546 : real ;
|
505
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#2/In1" ;
|
506
|
delaysharp2_In1_551 : real ;
|
507
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#3/In1" ;
|
508
|
delaysharp3_In1_556 : real ;
|
509
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/eq0/In1" ;
|
510
|
eq0_In1_561 : real ;
|
511
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/eq0/In2" ;
|
512
|
eq0_In2_562 : real ;
|
513
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/ne0/In1" ;
|
514
|
ne0_In1_567 : real ;
|
515
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/ne0/In2" ;
|
516
|
ne0_In2_568 : real ;
|
517
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/ne1/In1" ;
|
518
|
ne1_In1_573 : real ;
|
519
|
--Trace PORT : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/ne1/In2" ;
|
520
|
ne1_In2_574 : real ;
|
521
|
let
|
522
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Add" ;
|
523
|
Add_Out1_448 = Add_In1_446 + Add_In2_447 ;
|
524
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Gain1" ;
|
525
|
Gain1_Out1_465 = AltitudeControlAltConfig_VariableRateLimit_integratorreset_Gain1_Gain * Gain1_In1_464 ;
|
526
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product" ;
|
527
|
Product_Out1_477 = Product_In1_475 * Product_In2_476 ;
|
528
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product1" ;
|
529
|
Product1_Out1_489 = Product1_In1_487 * Product1_In2_488 ;
|
530
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product2" ;
|
531
|
Product2_Out1_502 = Product2_In1_499 * (Product2_In2_500 * Product2_In3_501) ;
|
532
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum1" ;
|
533
|
Sum1_Out1_512 = Sum1_In1_510 + Sum1_In2_511 ;
|
534
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum2" ;
|
535
|
Sum2_Out1_522 = Sum2_In1_520 + Sum2_In2_521 ;
|
536
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum3" ;
|
537
|
Sum3_Out1_532 = - Sum3_In1_530 + Sum3_In2_531 ;
|
538
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum4" ;
|
539
|
Sum4_Out1_542 = Sum4_In1_540 + Sum4_In2_541 ;
|
540
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#1" ;
|
541
|
delaysharp1_Out1_547 = AltitudeControlAltConfig_VariableRateLimit_integratorreset_delaysharp1_InitialValue -> pre delaysharp1_In1_546 ;
|
542
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#2" ;
|
543
|
delaysharp2_Out1_552 = AltitudeControlAltConfig_VariableRateLimit_integratorreset_delaysharp2_InitialValue -> pre delaysharp2_In1_551 ;
|
544
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#3" ;
|
545
|
delaysharp3_Out1_557 = AltitudeControlAltConfig_VariableRateLimit_integratorreset_delaysharp3_InitialValue -> pre delaysharp3_In1_556 ;
|
546
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/eq0" ;
|
547
|
eq0_Out1_563 = eq0_In1_561 = eq0_In2_562 ;
|
548
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/ne0" ;
|
549
|
ne0_Out1_569 = ne0_In1_567 <> ne0_In2_568 ;
|
550
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/ne1" ;
|
551
|
ne1_Out1_575 = ne1_In1_573 <> ne1_In2_574 ;
|
552
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum1_2_delay#2" ;
|
553
|
delaysharp2_In1_551 = Sum1_Out1_512 ;
|
554
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Gain1_2_Sum1" ;
|
555
|
Sum1_In1_510 = Gain1_Out1_465 ;
|
556
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#2_2_F(x)" ;
|
557
|
Fx_In1_595 = delaysharp2_Out1_552 ;
|
558
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#2_2_Sum3" ;
|
559
|
Sum3_In1_530 = delaysharp2_Out1_552 ;
|
560
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#2_2_Sum4" ;
|
561
|
Sum4_In1_540 = delaysharp2_Out1_552 ;
|
562
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum2_2_Sum1" ;
|
563
|
Sum1_In2_511 = Sum2_Out1_522 ;
|
564
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product_2_Sum2" ;
|
565
|
Sum2_In2_521 = Product_Out1_477 ;
|
566
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#1_2_Product" ;
|
567
|
Product_In2_476 = delaysharp1_Out1_547 ;
|
568
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Constant_2_delay#1" ;
|
569
|
delaysharp1_In1_546 = AltitudeControlAltConfig_VariableRateLimit_integratorreset_Constant_Value ;
|
570
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/f(x)_2_Gain1" ;
|
571
|
Gain1_In1_464 = fx_Out1_418 ;
|
572
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/x0_2_Product" ;
|
573
|
Product_In1_475 = x0_Out1_438 ;
|
574
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/x0_2_Sum3" ;
|
575
|
Sum3_In2_531 = x0_Out1_438 ;
|
576
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/reset_level_2_delay#3" ;
|
577
|
delaysharp3_In1_556 = resetlevel_Out1_428 ;
|
578
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/reset_level_2_ne0" ;
|
579
|
ne0_In1_567 = resetlevel_Out1_428 ;
|
580
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/reset_level_2_eq0" ;
|
581
|
eq0_In1_561 = resetlevel_Out1_428 ;
|
582
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/delay#3_2_ne1" ;
|
583
|
ne1_In1_573 = delaysharp3_Out1_557 ;
|
584
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum3_2_Product1" ;
|
585
|
Product1_In1_487 = Sum3_Out1_532 ;
|
586
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum3_2_Product2" ;
|
587
|
Product2_In2_500 = Sum3_Out1_532 ;
|
588
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/ne0_2_Product1" ;
|
589
|
Product1_In2_488 =
|
590
|
if ne0_Out1_569 then
|
591
|
1.0
|
592
|
else 0.0 ;
|
593
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/eq0_2_Product2" ;
|
594
|
Product2_In1_499 =
|
595
|
if eq0_Out1_563 then
|
596
|
1.0
|
597
|
else 0.0 ;
|
598
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product1_2_Add" ;
|
599
|
Add_In1_446 = Product1_Out1_489 ;
|
600
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Product2_2_Add" ;
|
601
|
Add_In2_447 = Product2_Out1_502 ;
|
602
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/zero_2_ne0" ;
|
603
|
ne0_In2_568 = int_to_real (AltitudeControlAltConfig_VariableRateLimit_integratorreset_zero_Value) ;
|
604
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/zero_2_eq0" ;
|
605
|
eq0_In2_562 = int_to_real (AltitudeControlAltConfig_VariableRateLimit_integratorreset_zero_Value) ;
|
606
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/zero_2_ne1" ;
|
607
|
ne1_In2_574 = int_to_real (AltitudeControlAltConfig_VariableRateLimit_integratorreset_zero_Value) ;
|
608
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/ne1_2_Product2" ;
|
609
|
Product2_In3_501 =
|
610
|
if ne1_Out1_575 then
|
611
|
1.0
|
612
|
else 0.0 ;
|
613
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Sum4_2_Sum2" ;
|
614
|
Sum2_In1_520 = Sum4_Out1_542 ;
|
615
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable \\nRate Limit/integrator_reset/Add_2_Sum4" ;
|
616
|
Sum4_In2_541 = Add_Out1_448 ;
|
617
|
|
618
|
tel
|
619
|
|
620
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0" ;
|
621
|
|
622
|
node AltitudeControlAltConfig_VariableLimitSaturation0 (
|
623
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/up_lim/Out1" ;
|
624
|
uplim_Out1_665 : real ;
|
625
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/SigIn/Out1" ;
|
626
|
SigIn_Out1_675 : real ;
|
627
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Lo_lim/Out1" ;
|
628
|
Lolim_Out1_685 : real)
|
629
|
returns (
|
630
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Out1/In1" ;
|
631
|
Out1_In1_717 : real) ;
|
632
|
var
|
633
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Enforce\\nlow lim/Out1" ;
|
634
|
Enforcelowlim_Out1_695 : real ;
|
635
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Enforce\\nup lim/Out1" ;
|
636
|
Enforceuplim_Out1_705 : real ;
|
637
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Enforce\\nlow lim/In1" ;
|
638
|
Enforcelowlim_In1_693 : real ;
|
639
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Enforce\\nlow lim/In2" ;
|
640
|
Enforcelowlim_In2_694 : real ;
|
641
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Enforce\\nup lim/In1" ;
|
642
|
Enforceuplim_In1_703 : real ;
|
643
|
--Trace PORT : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Enforce\\nup lim/In2" ;
|
644
|
Enforceuplim_In2_704 : real ;
|
645
|
let
|
646
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Enforce\\nlow lim" ;
|
647
|
Enforcelowlim_Out1_695 =
|
648
|
if Enforcelowlim_In1_693 >= Enforcelowlim_In2_694 then
|
649
|
Enforcelowlim_In2_694
|
650
|
else Enforcelowlim_In1_693 ;
|
651
|
--Trace BLOCK : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Enforce\\nup lim" ;
|
652
|
Enforceuplim_Out1_705 =
|
653
|
if Enforceuplim_In1_703 <= Enforceuplim_In2_704 then
|
654
|
Enforceuplim_In1_703
|
655
|
else Enforceuplim_In2_704 ;
|
656
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Lo_lim_2_Enforce\\nlow lim" ;
|
657
|
Enforcelowlim_In1_693 = Lolim_Out1_685 ;
|
658
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/SigIn_2_Enforce\\nlow lim" ;
|
659
|
Enforcelowlim_In2_694 = SigIn_Out1_675 ;
|
660
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Enforce\\nlow lim_2_Enforce\\nup lim" ;
|
661
|
Enforceuplim_In1_703 = Enforcelowlim_Out1_695 ;
|
662
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/up_lim_2_Enforce\\nup lim" ;
|
663
|
Enforceuplim_In2_704 = uplim_Out1_665 ;
|
664
|
--Trace SIGNAL : "AltitudeControl_AltConfig/Variable Limit\\nSaturation_0/Enforce\\nup lim_2_Out1" ;
|
665
|
Out1_In1_717 = Enforceuplim_Out1_705 ;
|
666
|
|
667
|
tel
|
668
|
|
669
|
--Trace BLOCK : "AltitudeControl_AltConfig/observer" ;
|
670
|
|
671
|
node AltitudeControlAltConfig_observer (
|
672
|
--Trace PORT : "AltitudeControl_AltConfig/observer/altitude/Out1" ;
|
673
|
altitude_Out1_763 : real)
|
674
|
returns (
|
675
|
--Trace PORT : "AltitudeControl_AltConfig/observer/observer_output/In1" ;
|
676
|
observeroutput_In1_808 : bool) ;
|
677
|
var
|
678
|
--Trace PORT : "AltitudeControl_AltConfig/observer/Logical Operator1/Out1" ;
|
679
|
LogicalOperator1_Out1_784 : bool ;
|
680
|
--Trace PORT : "AltitudeControl_AltConfig/observer/Logical Operator2/Out1" ;
|
681
|
LogicalOperator2_Out1_790 : bool ;
|
682
|
--Trace PORT : "AltitudeControl_AltConfig/observer/Relational Operator/Out1" ;
|
683
|
RelationalOperator_Out1_796 : bool ;
|
684
|
--Trace PORT : "AltitudeControl_AltConfig/observer/Logical Operator1/In1" ;
|
685
|
LogicalOperator1_In1_783 : bool ;
|
686
|
--Trace PORT : "AltitudeControl_AltConfig/observer/Logical Operator2/In1" ;
|
687
|
LogicalOperator2_In1_788 : bool ;
|
688
|
--Trace PORT : "AltitudeControl_AltConfig/observer/Logical Operator2/In2" ;
|
689
|
LogicalOperator2_In2_789 : bool ;
|
690
|
--Trace PORT : "AltitudeControl_AltConfig/observer/Relational Operator/In1" ;
|
691
|
RelationalOperator_In1_794 : real ;
|
692
|
--Trace PORT : "AltitudeControl_AltConfig/observer/Relational Operator/In2" ;
|
693
|
RelationalOperator_In2_795 : real ;
|
694
|
let
|
695
|
--Trace BLOCK : "AltitudeControl_AltConfig/observer/Logical Operator1" ;
|
696
|
LogicalOperator1_Out1_784 = not LogicalOperator1_In1_783 ;
|
697
|
--Trace BLOCK : "AltitudeControl_AltConfig/observer/Logical Operator2" ;
|
698
|
LogicalOperator2_Out1_790 = LogicalOperator2_In1_788 or LogicalOperator2_In2_789 ;
|
699
|
--Trace BLOCK : "AltitudeControl_AltConfig/observer/Relational Operator" ;
|
700
|
RelationalOperator_Out1_796 = RelationalOperator_In1_794 > RelationalOperator_In2_795 ;
|
701
|
--Trace SIGNAL : "AltitudeControl_AltConfig/observer/Relational Operator_2_Logical Operator1" ;
|
702
|
LogicalOperator1_In1_783 = RelationalOperator_Out1_796 ;
|
703
|
--Trace SIGNAL : "AltitudeControl_AltConfig/observer/Constant2_2_Logical Operator2" ;
|
704
|
LogicalOperator2_In2_789 =
|
705
|
if AltitudeControlAltConfig_observer_Constant2_Value = 0 then
|
706
|
false
|
707
|
else true ;
|
708
|
--Trace SIGNAL : "AltitudeControl_AltConfig/observer/altitude_2_Relational Operator" ;
|
709
|
RelationalOperator_In1_794 = altitude_Out1_763 ;
|
710
|
--Trace SIGNAL : "AltitudeControl_AltConfig/observer/Logical Operator1_2_Logical Operator2" ;
|
711
|
LogicalOperator2_In1_788 = LogicalOperator1_Out1_784 ;
|
712
|
--Trace SIGNAL : "AltitudeControl_AltConfig/observer/Logical Operator2_2_observer_output" ;
|
713
|
observeroutput_In1_808 = LogicalOperator2_Out1_790 ;
|
714
|
--Trace SIGNAL : "AltitudeControl_AltConfig/observer/Constant_2_Relational Operator" ;
|
715
|
RelationalOperator_In2_795 = int_to_real (AltitudeControlAltConfig_observer_Constant_Value) ;
|
716
|
|
717
|
tel
|