zkv1000 / Systems / autopilot.xml /
Newer Older
414 lines | 10.141kb
commit initial
Sébastien MARQUE authored on 2017-03-07
1
<?xml version="1.0"?>
2
 
3
<!-- From Generic Autopilot Configuration -->
4

            
5
<PropertyList>
6

            
7
  <!-- =============================================================== -->
8
  <!-- Roll Axis Modes                                                 -->
9
  <!-- =============================================================== -->
10

            
11
  <pid-controller>
12
    <name>Wing Leveler (Turn Coordinator based)</name>
13
    <debug>false</debug>
14
    <enable>
15
      <condition>
16
        <and>
17
          <equals>
18
            <property>/autopilot/locks/roll</property>
19
            <value>wing-leveler</value>
20
          </equals>
21
          <not>
22
            <property>/autopilot/locks/passive-mode</property>
23
          </not>
24
        </and>
25
      </condition>
26
    </enable>
27
    <input>
28
      <prop>/instrumentation/turn-indicator/indicated-turn-rate</prop>
29
    </input>
30
    <reference>
31
      <value>0.0</value>
32
    </reference>
33
    <output>
34
      <prop>/controls/flight/aileron</prop>
35
    </output>
36
    <config>
37
      <Kp>0.5</Kp>
38
      <beta>1.0</beta>
39
      <alpha>0.1</alpha>
40
      <gamma>0.0</gamma>
41
      <Ti>10.0</Ti>
42
      <Td>0.00001</Td>
43
      <u_min>-1.0</u_min>
44
      <u_max>1.0</u_max>
45
    </config>
46
  </pid-controller>
47

            
48
  <pid-controller>
49
    <name>Heading Bug Hold (DG based) Stage 1</name>
50
    <debug>false</debug>
51
    <enable>
52
      <prop>/autopilot/locks/roll</prop>
53
      <value>dg-heading-hold</value>
54
    </enable>
55
    <input>
56
      <prop>/autopilot/internal/heading-bug-error-deg</prop>
57
    </input>
58
    <reference>
59
      <value>0.0</value>
60
    </reference>
61
    <output>
62
      <prop>/autopilot/internal/target-roll-deg</prop>
63
    </output>
64
    <config>
65
      <Kp>-1.0</Kp>
66
      <beta>1.0</beta>
67
      <alpha>0.1</alpha>
68
      <gamma>0.0</gamma>
69
      <Ti>10.0</Ti>
70
      <Td>0.00001</Td>
71
      <u_min>-22.0</u_min>
72
      <u_max>22.0</u_max>
73
    </config>
74
  </pid-controller>
75

            
76
  <pid-controller>
77
    <name>NAV Hold Stage 1</name>
78
    <debug>false</debug>
79
    <enable>
80
      <prop>/autopilot/locks/roll</prop>
81
      <value>nav1-hold</value>
82
    </enable>
83
    <input>
84
      <prop>/instrumentation/zkv1000/cdi/course-deflection</prop>
85
    </input>
86
    <reference>
87
      <value>0.0</value>
88
    </reference>
89
    <output>
90
      <prop>/autopilot/internal/target-roll-deg</prop>
91
    </output>
92
    <config>
93
      <Kp>-1.0</Kp>
94
      <beta>1.0</beta>
95
      <alpha>0.1</alpha>
96
      <gamma>0.0</gamma>
97
      <Ti>10.0</Ti>
98
      <Td>0.00001</Td>
99
      <u_min>-22.0</u_min>
100
      <u_max>22.0</u_max>
101
    </config>
102
  </pid-controller>
103

            
104
  <pid-controller>
105
    <name>Approach mode Stage 1</name>
106
    <debug>false</debug>
107
    <enable>
108
      <prop>/autopilot/locks/roll</prop>
109
      <value>APR</value>
110
    </enable>
111
    <input>
112
      <prop>/instrumentation/zkv1000/cdi/course-deflection</prop>
113
    </input>
114
    <reference>
115
      <value>0.0</value>
116
    </reference>
117
    <output>
118
      <prop>/autopilot/internal/target-roll-deg</prop>
119
    </output>
120
    <config>
121
      <Kp>-1.0</Kp>
122
      <beta>1.0</beta>
123
      <alpha>0.1</alpha>
124
      <gamma>0.0</gamma>
125
      <Ti>10.0</Ti>
126
      <Td>0.00001</Td>
127
      <u_min>-22.0</u_min>
128
      <u_max>22.0</u_max>
129
    </config>
130
  </pid-controller>
131

            
132
  <pid-controller>
133
    <name>Ailerons control</name>
134
    <debug>false</debug>
135
    <enable>
136
      <condition>
137
        <and>
138
          <not-equals>
139
            <property>/autopilot/locks/roll</property>
140
            <value>wing-leveler</value>
141
          </not-equals>
142
          <not>
143
            <property>/autopilot/locks/passive-mode</property>
144
          </not>
145
        </and>
146
      </condition>  
147
      <honor-passive>true</honor-passive>
148
    </enable>
149
    <input>
150
      <prop>/orientation/roll-deg</prop>
151
    </input>
152
    <reference>
153
      <prop>/autopilot/internal/target-roll-deg</prop>
154
    </reference>
155
    <output>
156
      <prop>/controls/flight/aileron</prop>
157
    </output>
158
    <config>
159
      <Kp>0.1</Kp>
160
      <beta>1.0</beta>
161
      <alpha>0.1</alpha>
162
      <gamma>0.0</gamma>
163
      <Ti>10.0</Ti>
164
      <Td>0.00001</Td>
165
      <u_min>-1.0</u_min>
166
      <u_max>1.0</u_max>
167
    </config>
168
  </pid-controller>
169

            
170
 <!-- =============================================================== -->
171
 <!-- Pitch Axis Modes                                                -->
172
 <!-- =============================================================== -->
173

            
174
 <pid-controller>
175
    <name>Pitch hold</name>
176
    <debug>false</debug>
177
    <enable>
178
      <condition>
179
        <and>
180
          <equals>
181
            <property>/autopilot/locks/pitch</property>
182
            <value>pitch-hold</value>
183
          </equals>
184
          <not>
185
            <property>/autopilot/locks/passive-mode</property>
186
          </not>
187
        </and>
188
      </condition>
189
    </enable>
190
    <input>
191
      <prop>/orientation/pitch-deg</prop>
192
    </input>
193
    <reference>
194
      <prop>/autopilot/internal/target-pitch-deg</prop>
195
    </reference>
196
    <output>
197
      <prop>/controls/flight/elevator-trim</prop>
198
    </output>
199
    <config>
200
      <Kp>-0.05</Kp>
201
      <beta>1.0</beta>
202
      <alpha>0.1</alpha>
203
      <gamma>0.0</gamma>
204
      <Ti>1.0</Ti>
205
      <Td>0.00001</Td>
206
      <u_min>-1.0</u_min>
207
      <u_max>1.0</u_max>
208
    </config>
209
   </pid-controller>
210
  
211
  <pid-controller>
212
    <name>Altitude Hold</name>
213
    <debug>false</debug>
214
    <enable>
215
      <prop>/autopilot/locks/pitch</prop>
216
      <value>altitude-hold</value>
217
    </enable>
218
    <input>
219
      <prop>/instrumentation/altimeter/indicated-altitude-ft</prop>
220
    </input>
221
    <reference>
222
      <prop>/autopilot/settings/target-altitude-ft</prop>
223
    </reference>
224
    <output>
225
      <prop>/autopilot/internal/target-pitch-deg</prop>
226
    </output>
227
    <config>
228
      <Kp>0.025</Kp>
229
      <beta>1.0</beta>
230
      <alpha>0.1</alpha>
231
      <gamma>0.0</gamma>
232
      <Ti>50.0</Ti>
233
      <Td>0.0</Td>
234
      <u_min>-20.0</u_min>
235
      <u_max>15.0</u_max>
236
    </config>
237
  </pid-controller>
238

            
239
  <!--pid-controller>
240
    <name>Selected Altitude Hold</name>
241
    <debug>false</debug>
242
    <enable>
243
      <prop>/autopilot/locks/pitch</prop>
244
      <value>ALTS</value>
245
    </enable>
246
    <input>
247
      <prop>/instrumentation/altimeter/indicated-altitude-ft</prop>
248
    </input>
249
    <reference>
250
      <prop>/autopilot/settings/target-altitude-ft</prop>
251
    </reference>
252
    <output>
253
      <prop>/autopilot/internal/target-pitch-deg</prop>
254
    </output>
255
    <config>
256
      <Kp>0.025</Kp>
257
      <beta>1.0</beta>
258
      <alpha>0.1</alpha>
259
      <gamma>0.0</gamma>
260
      <Ti>50.0</Ti>
261
      <Td>0.0</Td>
262
      <u_min>-20.0</u_min>
263
      <u_max>15.0</u_max>
264
    </config>
265
  </pid-controller-->
266

            
267
  <pid-controller>
268
    <name>Glideslop Hold</name>
269
    <debug>false</debug>
270
    <enable>
271
      <prop>/autopilot/locks/pitch</prop>
272
      <value>glide-slope</value>
273
    </enable>
274
    <input>
275
      <prop>/instrumentation/zkv1000/cdi/gs-deflection</prop>
276
    </input>
277
    <reference>
278
      <value>0.0</value>
279
    </reference>
280
    <output>
281
      <prop>/autopilot/internal/target-pitch-deg</prop>
282
    </output>
283
    <config>
284
      <Kp>-1.5</Kp>
285
      <beta>1.0</beta>
286
      <alpha>0.1</alpha>
287
      <gamma>0.0</gamma>
288
      <Ti>10.0</Ti>
289
      <Td>0.0</Td>
290
      <u_min>-10</u_min>
291
      <u_max>5</u_max>
292
    </config>
293
  </pid-controller>
294

            
295
  <pi-simple-controller>
296
    <name>Vertical Speed Hold</name>
297
    <debug>false</debug>
298
    <enable>
299
      <prop>/autopilot/locks/pitch</prop>
300
      <value>version-speed-hold</value>
301
    </enable>
302
    <input>
303
      <prop>/velocities/vertical-speed-fps</prop>
304
    </input>
305
    <reference>
306
      <prop>/autopilot/settings/vertical-speed-fpm</prop>
307
      <scale>0.01667</scale>
308
    </reference>
309
    <output>
310
      <prop>/autopilot/internal/target-pitch-deg</prop>
311
    </output>
312
    <config>
313
      <Kp>0.05</Kp>
314
      <Ki>0.1</Ki>
315
      <u_min>-20.0</u_min>
316
      <u_max>15.0</u_max>
317
    </config>
318
  </pi-simple-controller>
319

            
320
  <pid-controller>
321
    <name>Flight Change Level (altitude) stage #1</name>
322
    <debug>false</debug>
323
    <enable>
324
      <prop>/autopilot/locks/pitch</prop>
325
      <value>flight-level-change</value>
326
    </enable>
327
    <input>
328
      <prop>/instrumentation/altimeter/indicated-altitude-ft</prop>
329
    </input>
330
    <reference>
331
      <prop>/autopilot/settings/target-altitude-ft</prop>
332
    </reference>
333
    <output>
334
      <prop>/autopilot/internal/flc-altitude-pitch-deg</prop>
335
    </output>
336
    <config>
337
      <Kp>0.025</Kp>
338
      <beta>1.0</beta>
339
      <alpha>0.1</alpha>
340
      <gamma>0.0</gamma>
341
      <Ti>50.0</Ti>
342
      <Td>0.0</Td>
343
      <u_min>-20.0</u_min>
344
      <u_max>15.0</u_max>
345
    </config>
346
  </pid-controller>
347

            
348
  <pid-controller>
349
    <name>Flight Change Level (airspeed) stage #1</name>
350
    <debug>false</debug>
351
    <enable>
352
      <prop>/autopilot/locks/pitch</prop>
353
      <value>flight-level-change</value>
354
    </enable>
355
    <input>
356
      <prop>/autopilot/internal/lookahead-5-sec-airspeed-kt</prop>
357
    </input>
358
    <reference>
359
      <prop>/autopilot/settings/target-speed-kt</prop>
360
    </reference>
361
    <output>
362
      <prop>/autopilot/internal/flc-airspeed-pitch-deg</prop>
363
    </output>
364
    <config>
365
      <Kp>-1.0</Kp>
366
      <beta>1.0</beta>
367
      <alpha>0.1</alpha>
368
      <gamma>0.0</gamma>
369
      <Ti>1.0</Ti>
370
      <Td>0.00001</Td>
371
      <u_min>-15.0</u_min>
372
      <u_max>15.0</u_max>
373
    </config>
374
  </pid-controller>
375

            
376
  <pid-controller>
377
    <name>Elevator Trim Control</name>
378
    <debug>false</debug>
379
    <enable>
380
      <condition>
381
        <and>
382
          <not-equals>
383
            <property>/autopilot/locks/pitch</property>
384
            <value>pitch-hold</value>
385
          </not-equals>
386
          <not>
387
            <property>/autopilot/locks/passive-mode</property>
388
          </not>
389
        </and>
390
      </condition>
391
      <honor-passive>true</honor-passive>
392
    </enable>
393
    <input>
394
      <prop>/orientation/pitch-deg</prop>
395
    </input>
396
    <reference>
397
      <prop>/autopilot/internal/target-pitch-deg</prop>
398
    </reference>
399
    <output>
400
      <prop>/controls/flight/elevator-trim</prop>
401
    </output>
402
    <config>
403
      <Kp>-0.25</Kp>
404
      <beta>1.0</beta>
405
      <alpha>0.1</alpha>
406
      <gamma>0.0</gamma>
407
      <Ti>20.0</Ti>
408
      <Td>0.000001</Td>
409
      <u_min>-1.0</u_min>
410
      <u_max>1.0</u_max>
411
    </config>
412
  </pid-controller>
413

            
414
</PropertyList>