4 Author: Yurik V. Nikiforoff, yurik@megasignal.com
6 Function: NVU navigation system TU-154B
11 <!--******************** Interface to NVU nav computer ************************ -->
12 <!--<property>instrumentation/tks-heading</property>-->
14 <property>instrumentation/nvu-selector</property>
15 <property>instrumentation/zpu-deg-1</property>
16 <property>instrumentation/zpu-deg-2</property>
17 <!--<property>ap/input-drift-deg</property>-->
18 <!--<property>instrumentation/input-vg-fps</property>-->
19 <!--RSBN correction-->
20 <property>instrumentation/rsbn-d-m</property>
21 <property>instrumentation/rsbn-angle-deg</property>
22 <property>instrumentation/rsbn-uk-deg</property>
24 <property>instrumentation/svs-speed-kt</property>
25 <property>instrumentation/svs-enable</property>
26 <!--Enable RSBN correction-->
27 <property>instrumentation/rsbn-cft-1</property>
28 <property>instrumentation/rsbn-cft-2</property>
29 <!--Enable coordinate convertion-->
30 <property>instrumentation/enable-convertion</property>
31 <!--Enable coordinate count (value should be fps2kmh const) -->
32 <property>instrumentation/enable-count</property>
33 <!--Point Input S-1 -->
34 <property>instrumentation/p-input-s-1</property>
35 <!--Point Input S-2 -->
36 <property>instrumentation/p-input-s-2</property>
37 <!--Point Input Z-1 -->
38 <property>instrumentation/p-input-z-1</property>
39 <!--Point Input Z-2 -->
40 <property>instrumentation/p-input-z-2</property>
42 <!--Aircraft Input S-1 -->
43 <property>instrumentation/a-input-s-1</property>
44 <!--Aircraft Input S-2 -->
45 <property>instrumentation/a-input-s-2</property>
46 <!--Aircraft Input Z-1 -->
47 <property>instrumentation/a-input-z-1</property>
48 <!--Aircraft Input Z-2 -->
49 <property>instrumentation/a-input-z-2</property>
51 <!--Internal NVU variables.
52 It's should be declared here, cause FDM not allowed forward declaration-->
53 <!--Enable coordinate convertion-->
54 <property>instrumentation/corr-rsbn-s-1</property>
55 <property>instrumentation/corr-rsbn-z-1</property>
56 <property>instrumentation/corr-rsbn-s-2</property>
57 <property>instrumentation/corr-rsbn-z-2</property>
59 <property>instrumentation/cc-s-1</property>
60 <property>instrumentation/cc-z-1</property>
61 <property>instrumentation/cc-s-2</property>
62 <property>instrumentation/cc-z-2</property>
64 <property>instrumentation/aircraft-integrator-s-1</property>
65 <property>instrumentation/aircraft-integrator-z-1</property>
66 <property>instrumentation/point-integrator-s-1</property>
67 <property>instrumentation/point-integrator-z-1</property>
69 <property>instrumentation/aircraft-integrator-s-2</property>
70 <property>instrumentation/aircraft-integrator-z-2</property>
71 <property>instrumentation/point-integrator-s-2</property>
72 <property>instrumentation/point-integrator-z-2</property>
76 <!--**************************** NVU staff ******************************-->
77 <!--Ground speed from DISS or SVS -->
78 <switch name="instrumentation/v-fps">
79 <default value="velocities/vg-fps"/>
80 <test value="velocities/vc-fps">
81 instrumentation/svs-enable ne 0
85 <pure_gain name="instrumentation/vg-kmh">
86 <input>instrumentation/v-fps</input>
87 <gain>instrumentation/enable-count</gain><!--1.09728 from fps to kmh-->
90 <summer name="instrumentation/rsbn-angle">
91 <input>instrumentation/rsbn-angle-deg</input>
92 <input>-instrumentation/rsbn-uk-deg</input>
97 <fcs_function name="instrumentation/rsbn-s-distance">
98 <description>cos(rsbn-angle)</description>
101 <property>instrumentation/rsbn-d-m</property>
104 <property>instrumentation/rsbn-angle</property>
105 <value>0.0174533</value><!--to rad-->
112 <fcs_function name="instrumentation/rsbn-z-distance">
113 <description>sin(rsbn-angle)</description>
116 <property>instrumentation/rsbn-d-m</property>
119 <property>instrumentation/rsbn-angle</property>
120 <value>0.0174533</value>
126 <!-- ******************* Begin V-52[0] procedure ******************** -->
127 <!--Ortodromic heading-->
128 <!--<summer name="instrumentation/ort-hdg-raw-1">-->
129 <summer name="instrumentation/ort-hdg-1">
130 <input>instrumentation/tks-heading</input>
131 <input>-instrumentation/zpu-deg-1</input>
132 <!--<input>ap/input-drift-deg</input>-->
133 <input>instrumentation/drift-angle-deg</input>
136 <switch name="instrumentation/ort-hdg-bias-1">
137 <default value="0.0"/>
139 instrumentation/ort-hdg-raw-1 lt -180
141 <test value="-360.0">
142 instrumentation/ort-hdg-raw-1 gt 180
145 <summer name="instrumentation/ort-hdg-1">
146 <input>instrumentation/ort-hdg-raw-1</input>
147 <input>instrumentation/ort-hdg-bias-1</input>
150 <!--Ortodromic heading here in ort-hdg -->
153 <fcs_function name="instrumentation/aircraft-s-speed-1">
154 <description>cos(ort-hdg)</description>
157 <property>instrumentation/vg-kmh</property>
160 <property>instrumentation/ort-hdg-1</property>
161 <value>0.0174533</value><!--to rad-->
168 <fcs_function name="instrumentation/aircraft-z-speed-1">
169 <description>sin(ort-hdg)</description>
172 <property>instrumentation/vg-kmh</property>
175 <property>instrumentation/ort-hdg-1</property>
176 <value>0.0174533</value>
182 <!--Count new coordinate (S, Z) for next ort -->
183 <fcs_function name="instrumentation/s-next-1">
184 <description>S coordinate for next ort - block 1</description>
187 <property>instrumentation/point-integrator-s-1</property>
192 <property>instrumentation/aircraft-integrator-s-2</property>
193 <property>instrumentation/aircraft-integrator-s-2</property>
196 <property>instrumentation/aircraft-integrator-z-2</property>
197 <property>instrumentation/aircraft-integrator-z-2</property>
200 <value>0.5</value><!--we need sqrt-->
206 <property>instrumentation/aircraft-integrator-z-2</property>
207 <property>instrumentation/aircraft-integrator-s-2</property>
209 <value>3.1415926</value>
213 <property>instrumentation/zpu-deg-2</property>
214 <property>instrumentation/zpu-deg-1</property>
216 <value>0.0174533</value><!--to rad -->
225 <fcs_function name="instrumentation/z-next-1">
226 <description>Z coordinate for next ort - block 1</description>
229 <property>instrumentation/point-integrator-z-1</property>
234 <property>instrumentation/aircraft-integrator-s-2</property>
235 <property>instrumentation/aircraft-integrator-s-2</property>
238 <property>instrumentation/aircraft-integrator-z-2</property>
239 <property>instrumentation/aircraft-integrator-z-2</property>
248 <property>instrumentation/aircraft-integrator-z-2</property>
249 <property>instrumentation/aircraft-integrator-s-2</property>
251 <value>3.1415926</value>
255 <property>instrumentation/zpu-deg-2</property>
256 <property>instrumentation/zpu-deg-1</property>
258 <value>0.0174533</value><!-- to rad -->
267 <!--Input and convertion procedures-->
270 <integrator name="instrumentation/p-i-s-1">
271 <input>instrumentation/p-input-s-1</input>
273 <output>instrumentation/point-integrator-s-1</output>
276 <!--Deadband for point blanker-->
277 <deadband name="instrumentation/p-blanker-db-s-1">
278 <input>instrumentation/point-integrator-s-1</input>
283 <integrator name="instrumentation/p-i-z-1">
284 <input>instrumentation/p-input-z-1</input>
286 <output>instrumentation/point-integrator-z-1</output>
289 <!--Deadband for point blanker-->
290 <deadband name="instrumentation/p-blanker-db-z-1">
291 <input>instrumentation/point-integrator-z-1</input>
295 <switch name="instrumentation/a-s-switched-speed-1">
296 <default value="0.0"/>
297 <test value="instrumentation/aircraft-s-speed-1">
298 instrumentation/nvu-selector eq 1
301 <!--Aircraft S 1 Input -->
302 <summer name="instrumentation/inp-integr-s-1">
303 <input>instrumentation/a-s-switched-speed-1</input>
304 <input>instrumentation/corr-rsbn-s-1</input>
305 <input>instrumentation/cc-s-1</input>
306 <input>instrumentation/a-input-s-1</input>
308 <!-- Aircraft Integrator S -->
309 <!--Distance in meters here!-->
310 <integrator name="instrumentation/a-i-s-1">
311 <input>instrumentation/inp-integr-s-1</input>
313 <output>instrumentation/aircraft-integrator-s-1</output>
315 <!--Deadband for aircraft blanker-->
316 <deadband name="instrumentation/a-blanker-db-s-1">
317 <input>instrumentation/aircraft-integrator-s-1</input>
320 <!--Deadband for coordinate convertion - input from 2-nd block! -->
321 <deadband name="instrumentation/a-cc-db-s-1">
322 <input>instrumentation/aircraft-integrator-s-2</input>
323 <width> 160000 </width> <!-- 80 km * 2 -->
325 <!--Switch for coordinate convertion-->
326 <switch name="instrumentation/a-cc-sw-s-1">
327 <default value="0.0"/>
329 instrumentation/a-cc-db-s-1 eq 0
331 <!-- <output>instrumentation/cc-enable-1</output>-->
333 <switch name="instrumentation/cc-enable-1">
334 <default value="0.0"/>
335 <test value="instrumentation/a-cc-sw-s-1">
336 instrumentation/nvu-selector eq 0
339 <!--Coordinate convertion for S-->
340 <summer name="instrumentation/cc-s-error-raw-1">
341 <input>instrumentation/aircraft-integrator-s-1</input>
342 <input>-instrumentation/s-next-1</input>
344 <pure_gain name="instrumentation/cc-blanked-s-error-1">
345 <input>instrumentation/cc-s-error-raw-1</input>
346 <gain>instrumentation/enable-convertion</gain>
348 <pure_gain name="instrumentation/cc-s-error-1">
349 <input>instrumentation/cc-blanked-s-error-1</input>
350 <gain>instrumentation/cc-enable-1</gain>
351 <output>instrumentation/cc-s-1</output>
353 <min>-40001.0</min><!--Speed of convertion set here-->
358 <!--RSBN S Correction-->
359 <summer name="instrumentation/rsbn-s-error-raw-1">
360 <input>instrumentation/aircraft-integrator-s-1</input>
361 <input>-instrumentation/rsbn-s-distance</input>
362 <input>-instrumentation/point-integrator-s-1</input>
364 <pure_gain name="instrumentation/rsbn-s-error-1">
365 <input>instrumentation/rsbn-s-error-raw-1</input>
366 <gain>instrumentation/rsbn-cft-1</gain>
367 <output>instrumentation/corr-rsbn-s-1</output>
374 <!--Aircraft Z 1 Input -->
375 <summer name="instrumentation/inp-integr-z-1">
376 <input>instrumentation/aircraft-z-speed-1</input>
377 <input>instrumentation/corr-rsbn-z-1</input>
378 <input>instrumentation/cc-z-1</input>
379 <input>instrumentation/a-input-z-1</input>
381 <!-- Aircraft Integrator Z -->
382 <!--Distance in meters here!-->
383 <integrator name="instrumentation/a-i-z-1">
384 <input>instrumentation/inp-integr-z-1</input>
386 <output>instrumentation/aircraft-integrator-z-1</output>
388 <!--Deadband for aircraft blanker-->
389 <deadband name="instrumentation/a-blanker-db-z-1">
390 <input>instrumentation/aircraft-integrator-z-1</input>
393 <!--Coordinate convertion for Z-->
394 <summer name="instrumentation/cc-z-error-raw-1">
395 <input>instrumentation/aircraft-integrator-z-1</input>
396 <input>-instrumentation/z-next-1</input>
398 <pure_gain name="instrumentation/cc-blanked-z-error-1">
399 <input>instrumentation/cc-z-error-raw-1</input>
400 <gain>instrumentation/enable-convertion</gain>
402 <pure_gain name="instrumentation/cc-z-error-1">
403 <input>instrumentation/cc-blanked-z-error-1</input>
404 <gain>instrumentation/cc-enable-1</gain>
405 <output>instrumentation/cc-z-1</output>
412 <!--RSBN Z Correction-->
413 <summer name="instrumentation/rsbn-z-error-raw-1">
414 <input>instrumentation/aircraft-integrator-z-1</input>
415 <input>-instrumentation/rsbn-z-distance</input>
416 <input>-instrumentation/point-integrator-z-1</input>
419 <pure_gain name="instrumentation/rsbn-z-error-1">
420 <input>instrumentation/rsbn-z-error-raw-1</input>
421 <gain>instrumentation/rsbn-cft-1</gain>
422 <output>instrumentation/corr-rsbn-z-1</output>
428 <!--End RSBN Z Correction-->
431 <!-- <deadband name="instrumentation/db-lur-1">
432 <input>instrumentation/aircraft-integrator-s-1</input>
433 <width> instrumentation/lur-1 </width>
435 <!-- ******************* END V-52[0] procedure ******************** -->
436 <!-- ****************** BEGIN V-52[1] procedure ******************* -->
437 <!--Ortodromic heading-->
438 <!--<summer name="instrumentation/ort-hdg-raw-2">-->
439 <summer name="instrumentation/ort-hdg-2">
440 <input>instrumentation/tks-heading</input>
441 <input>-instrumentation/zpu-deg-2</input>
442 <!-- <input>ap/input-drift-deg</input>-->
443 <input>instrumentation/drift-angle-deg</input>
446 <switch name="instrumentation/ort-hdg-bias-2">
447 <default value="0.0"/>
449 instrumentation/ort-hdg-raw-2 lt -180
451 <test value="-360.0">
452 instrumentation/ort-hdg-raw-2 gt 180
455 <summer name="instrumentation/ort-hdg-2">
456 <input>instrumentation/ort-hdg-raw-2</input>
457 <input>instrumentation/ort-hdg-bias-2</input>
460 <!--Ortodromic heading here in ort-hdg -->
463 <fcs_function name="instrumentation/aircraft-s-speed-2">
464 <description>cos(ort-hdg)</description>
467 <property>instrumentation/vg-kmh</property>
470 <property>instrumentation/ort-hdg-2</property>
471 <value>0.0174533</value><!--to rad-->
478 <fcs_function name="instrumentation/aircraft-z-speed-2">
479 <description>sin(ort-hdg)</description>
482 <property>instrumentation/vg-kmh</property>
485 <property>instrumentation/ort-hdg-2</property>
486 <value>0.0174533</value>
492 <!--Count new coordinate (S, Z) for next ort -->
493 <fcs_function name="instrumentation/s-next-2">
494 <description>S coordinate for next ort - block 2</description>
497 <property>instrumentation/point-integrator-s-2</property>
502 <property>instrumentation/aircraft-integrator-s-1</property>
503 <property>instrumentation/aircraft-integrator-s-1</property>
506 <property>instrumentation/aircraft-integrator-z-1</property>
507 <property>instrumentation/aircraft-integrator-z-1</property>
516 <property>instrumentation/aircraft-integrator-z-1</property>
517 <property>instrumentation/aircraft-integrator-s-1</property>
519 <value>3.1415926</value>
523 <property>instrumentation/zpu-deg-1</property>
524 <property>instrumentation/zpu-deg-2</property>
526 <value>0.0174533</value><!--to rad -->
535 <fcs_function name="instrumentation/z-next-2">
536 <description>Z coordinate for next ort - block 2</description>
539 <property>instrumentation/point-integrator-z-2</property>
544 <property>instrumentation/aircraft-integrator-s-1</property>
545 <property>instrumentation/aircraft-integrator-s-1</property>
548 <property>instrumentation/aircraft-integrator-z-1</property>
549 <property>instrumentation/aircraft-integrator-z-1</property>
558 <property>instrumentation/aircraft-integrator-z-1</property>
559 <property>instrumentation/aircraft-integrator-s-1</property>
561 <value>3.1415926</value>
565 <property>instrumentation/zpu-deg-1</property>
566 <property>instrumentation/zpu-deg-2</property>
568 <value>0.0174533</value><!--to rad-->
577 <!--Input and convertion procedures-->
580 <integrator name="instrumentation/p-i-s-2">
581 <input>instrumentation/p-input-s-2</input>
583 <output>instrumentation/point-integrator-s-2</output>
586 <!--Deadband for point blanker-->
587 <deadband name="instrumentation/p-blanker-db-s-2">
588 <input>instrumentation/point-integrator-s-2</input>
593 <integrator name="instrumentation/p-i-z-2">
594 <input>instrumentation/p-input-z-2</input>
596 <output>instrumentation/point-integrator-z-2</output>
599 <!--Deadband for point blanker-->
600 <deadband name="instrumentation/p-blanker-db-z-2">
601 <input>instrumentation/point-integrator-z-2</input>
605 <switch name="instrumentation/a-s-switched-speed-2">
606 <default value="0.0"/>
607 <test value="instrumentation/aircraft-s-speed-2">
608 instrumentation/nvu-selector eq 0
612 <!--Aircraft S 2 Input -->
613 <summer name="instrumentation/inp-integr-s-2">
614 <input>instrumentation/a-s-switched-speed-2</input>
615 <input>instrumentation/corr-rsbn-s-2</input>
616 <input>instrumentation/cc-s-2</input>
617 <input>instrumentation/a-input-s-2</input>
620 <!--Distance in meters here!-->
621 <integrator name="instrumentation/a-i-s-2">
622 <input>instrumentation/inp-integr-s-2</input>
624 <output>instrumentation/aircraft-integrator-s-2</output>
626 <!--Deadband for aircraft blanker-->
627 <deadband name="instrumentation/a-blanker-db-s-2">
628 <input>instrumentation/aircraft-integrator-s-2</input>
631 <!--Deadband for coordinate convertion - input from 1-st block! -->
632 <deadband name="instrumentation/a-cc-db-s-2">
633 <input>instrumentation/aircraft-integrator-s-1</input>
634 <width> 160000 </width> <!-- 80 km * 2 -->
636 <!--Switch for coordinate convertion-->
637 <switch name="instrumentation/a-cc-sw-s-2">
638 <default value="0.0"/>
640 instrumentation/a-cc-db-s-2 eq 0
642 <!--<output>instrumentation/cc-enable-2</output>-->
644 <switch name="instrumentation/cc-enable-2">
645 <default value="0.0"/>
646 <test value="instrumentation/a-cc-sw-s-2">
647 instrumentation/nvu-selector eq 1
650 <!--Coordinate convertion for S-->
651 <summer name="instrumentation/cc-s-error-raw-2">
652 <input>instrumentation/aircraft-integrator-s-2</input>
653 <input>-instrumentation/s-next-2</input>
655 <pure_gain name="instrumentation/cc-blanked-s-error-2">
656 <input>instrumentation/cc-s-error-raw-2</input>
657 <gain>instrumentation/enable-convertion</gain>
659 <pure_gain name="instrumentation/cc-s-error-2">
660 <input>instrumentation/cc-blanked-s-error-2</input>
661 <gain>instrumentation/cc-enable-2</gain>
662 <output>instrumentation/cc-s-2</output>
669 <!--RSBN S Correction-->
670 <summer name="instrumentation/rsbn-s-error-raw-2">
671 <input>instrumentation/aircraft-integrator-s-2</input>
672 <input>-instrumentation/rsbn-s-distance</input>
673 <input>-instrumentation/point-integrator-s-2</input>
675 <pure_gain name="instrumentation/rsbn-s-error-2">
676 <input>instrumentation/rsbn-s-error-raw-2</input>
677 <gain>instrumentation/rsbn-cft-2</gain>
678 <output>instrumentation/corr-rsbn-s-2</output>
685 <switch name="instrumentation/a-z-switched-speed-2">
686 <default value="0.0"/>
687 <test value="instrumentation/aircraft-z-speed-2">
688 instrumentation/nvu-selector eq 0
692 <!--Aircraft Z 2 Input -->
693 <summer name="instrumentation/inp-integr-z-2">
694 <input>instrumentation/a-z-switched-speed-2</input>
695 <input>instrumentation/corr-rsbn-z-2</input>
696 <input>instrumentation/cc-z-2</input>
697 <input>instrumentation/a-input-z-2</input>
700 <!--Distance in meters here!-->
701 <integrator name="instrumentation/a-i-z-2">
702 <input>instrumentation/inp-integr-z-2</input>
704 <output>instrumentation/aircraft-integrator-z-2</output>
706 <!--Deadband for aircraft blanker-->
707 <deadband name="instrumentation/a-blanker-db-z-2">
708 <input>instrumentation/aircraft-integrator-z-2</input>
711 <!--Coordinate convertion for Z-->
712 <summer name="instrumentation/cc-z-error-raw-2">
713 <input>instrumentation/aircraft-integrator-z-2</input>
714 <input>-instrumentation/z-next-2</input>
716 <pure_gain name="instrumentation/cc-blanked-z-error-2">
717 <input>instrumentation/cc-z-error-raw-2</input>
718 <gain>instrumentation/enable-convertion</gain>
720 <pure_gain name="instrumentation/cc-z-error-2">
721 <input>instrumentation/cc-blanked-z-error-2</input>
722 <gain>instrumentation/cc-enable-2</gain>
723 <output>instrumentation/cc-z-2</output>
730 <!--RSBN Z Correction-->
731 <summer name="instrumentation/rsbn-z-error-raw-2">
732 <input>instrumentation/aircraft-integrator-z-2</input>
733 <input>-instrumentation/rsbn-z-distance</input>
734 <input>-instrumentation/point-integrator-z-2</input>
737 <pure_gain name="instrumentation/rsbn-z-error-2">
738 <input>instrumentation/rsbn-z-error-raw-2</input>
739 <gain>instrumentation/rsbn-cft-2</gain>
740 <output>instrumentation/corr-rsbn-z-2</output>
746 <!--End RSBN Z Correction-->
748 <!-- ******************* END V-52[1] procedure ********************** -->
751 <switch name="instrumentation/nvu-out-z">
752 <default value="instrumentation/aircraft-integrator-z-2"/>
753 <test value="instrumentation/aircraft-integrator-z-1">
754 instrumentation/nvu-selector eq 1
756 <output>ap/input-z</output>
759 <switch name="instrumentation/nvu-out-hdg">
760 <default value="instrumentation/zpu-deg-2"/>
761 <test value="instrumentation/zpu-deg-1">
762 instrumentation/nvu-selector eq 1
764 <output>ap/input-heading-nvu</output>
767 <!--************************* END NVU staff **************************-->