From 9062486b9b2676f5312223d318d42c40dec9b4c6 Mon Sep 17 00:00:00 2001
From: flogross89 <63071941+flogross89@users.noreply.github.com>
Date: Thu, 2 Jan 2025 23:29:00 +0100
Subject: [PATCH] add direct law PFD indications

---
 .../src/PFD/AttitudeIndicatorFixed.tsx        |  26 ++-
 .../src/PFD/AttitudeIndicatorHorizon.tsx      |  38 +++-
 .../src/systems/instruments/src/PFD/FMA.tsx   |  20 +-
 .../instruments/src/PFD/SpeedIndicator.tsx    |  76 ++++----
 .../wasm/fbw_a380/src/FlyByWireInterface.cpp  |  32 ++--
 .../wasm/fbw_a380/src/FlyByWireInterface.h    |   3 +
 fbw-a380x/src/wasm/fbw_a380/src/fcdc/Fcdc.cpp | 174 ++++++++++++++----
 fbw-a380x/src/wasm/fbw_a380/src/fcdc/Fcdc.h   |  40 +++-
 8 files changed, 293 insertions(+), 116 deletions(-)

diff --git a/fbw-a380x/src/systems/instruments/src/PFD/AttitudeIndicatorFixed.tsx b/fbw-a380x/src/systems/instruments/src/PFD/AttitudeIndicatorFixed.tsx
index d7c775cf227..5db0fa26552 100644
--- a/fbw-a380x/src/systems/instruments/src/PFD/AttitudeIndicatorFixed.tsx
+++ b/fbw-a380x/src/systems/instruments/src/PFD/AttitudeIndicatorFixed.tsx
@@ -1,6 +1,6 @@
 import { DisplayComponent, EventBus, FSComponent, Subject, Subscribable, VNode } from '@microsoft/msfs-sdk';
 import { getDisplayIndex } from 'instruments/src/PFD/PFD';
-import { Arinc429Word } from '@flybywiresim/fbw-sdk';
+import { Arinc429ConsumerSubject, Arinc429Word } from '@flybywiresim/fbw-sdk';
 import { FlightPathDirector } from './FlightPathDirector';
 import { FlightPathVector } from './FlightPathVector';
 import { Arinc429Values } from './shared/ArincValueProvider';
@@ -11,18 +11,22 @@ interface AttitudeIndicatorFixedUpperProps {
 }
 
 export class AttitudeIndicatorFixedUpper extends DisplayComponent<AttitudeIndicatorFixedUpperProps> {
+  private readonly sub = this.props.bus.getSubscriber<Arinc429Values>();
+
   private roll = new Arinc429Word(0);
 
   private pitch = new Arinc429Word(0);
 
   private visibilitySub = Subject.create('hidden');
 
+  private readonly fcdcDiscreteWord1 = Arinc429ConsumerSubject.create(this.sub.on('fcdcDiscreteWord1'));
+
+  private readonly isNormalLawActive = this.fcdcDiscreteWord1.map((dw) => dw.bitValue(11) && !dw.isFailureWarning());
+
   onAfterRender(node: VNode): void {
     super.onAfterRender(node);
 
-    const sub = this.props.bus.getSubscriber<Arinc429Values>();
-
-    sub.on('rollAr').handle((roll) => {
+    this.sub.on('rollAr').handle((roll) => {
       this.roll = roll;
       if (!this.roll.isNormalOperation()) {
         this.visibilitySub.set('hidden');
@@ -31,7 +35,7 @@ export class AttitudeIndicatorFixedUpper extends DisplayComponent<AttitudeIndica
       }
     });
 
-    sub.on('pitchAr').handle((pitch) => {
+    this.sub.on('pitchAr').handle((pitch) => {
       this.pitch = pitch;
       if (!this.pitch.isNormalOperation()) {
         this.visibilitySub.set('hidden');
@@ -44,11 +48,19 @@ export class AttitudeIndicatorFixedUpper extends DisplayComponent<AttitudeIndica
   render(): VNode {
     return (
       <g id="AttitudeUpperInfoGroup" visibility={this.visibilitySub}>
-        <g id="RollProtGroup" class="SmallStroke Green">
+        <g
+          id="RollProtGroup"
+          class="SmallStroke Green"
+          style={{ display: this.isNormalLawActive.map((nl) => (nl ? 'block' : 'none')) }}
+        >
           <path id="RollProtRight" d="m105.64 62.887 1.5716-0.8008m-1.5716-0.78293 1.5716-0.8008" />
           <path id="RollProtLeft" d="m32.064 61.303-1.5716-0.8008m1.5716 2.3845-1.5716-0.8008" />
         </g>
-        <g id="RollProtLost" style="display: none" class="NormalStroke Amber">
+        <g
+          id="RollProtLost"
+          class="NormalStroke Amber"
+          style={{ display: this.isNormalLawActive.map((nl) => (!nl ? 'block' : 'none')) }}
+        >
           <path id="RollProtLostRight" d="m107.77 60.696-1.7808 1.7818m1.7808 0-1.7808-1.7818" />
           <path id="RollProtLostLeft" d="m30.043 62.478 1.7808-1.7818m-1.7808 0 1.7808 1.7818" />
         </g>
diff --git a/fbw-a380x/src/systems/instruments/src/PFD/AttitudeIndicatorHorizon.tsx b/fbw-a380x/src/systems/instruments/src/PFD/AttitudeIndicatorHorizon.tsx
index 2ca618f3725..ffc1389e3c7 100644
--- a/fbw-a380x/src/systems/instruments/src/PFD/AttitudeIndicatorHorizon.tsx
+++ b/fbw-a380x/src/systems/instruments/src/PFD/AttitudeIndicatorHorizon.tsx
@@ -8,7 +8,7 @@ import {
   VNode,
 } from '@microsoft/msfs-sdk';
 
-import { Arinc429Register, Arinc429Word, ArincEventBus } from '@flybywiresim/fbw-sdk';
+import { Arinc429ConsumerSubject, Arinc429Register, Arinc429Word, ArincEventBus } from '@flybywiresim/fbw-sdk';
 import {
   calculateHorizonOffsetFromPitch,
   calculateVerticalOffsetFromRoll,
@@ -109,18 +109,22 @@ interface HorizonProps {
 }
 
 export class Horizon extends DisplayComponent<HorizonProps> {
+  private readonly sub = this.props.bus.getArincSubscriber<Arinc429Values>();
+
   private pitchGroupRef = FSComponent.createRef<SVGGElement>();
 
   private rollGroupRef = FSComponent.createRef<SVGGElement>();
 
   private yOffset = Subject.create(0);
 
+  private readonly fcdcDiscreteWord1 = Arinc429ConsumerSubject.create(this.sub.on('fcdcDiscreteWord1'));
+
+  private readonly isNormalLawActive = this.fcdcDiscreteWord1.map((dw) => dw.bitValue(11) && !dw.isFailureWarning());
+
   onAfterRender(node: VNode): void {
     super.onAfterRender(node);
 
-    const apfd = this.props.bus.getArincSubscriber<Arinc429Values>();
-
-    apfd
+    this.sub
       .on('pitchAr')
       .withArinc429Precision(3)
       .handle((pitch) => {
@@ -137,7 +141,7 @@ export class Horizon extends DisplayComponent<HorizonProps> {
         this.yOffset.set(yOffset);
       });
 
-    apfd
+    this.sub
       .on('rollAr')
       .withArinc429Precision(2)
       .handle((roll) => {
@@ -189,19 +193,35 @@ export class Horizon extends DisplayComponent<HorizonProps> {
             <path d="m47.906-19.177h42h0" />
           </g>
 
-          <g id="PitchProtUpper" class="NormalStroke Green">
+          <g
+            id="PitchProtUpper"
+            class="NormalStroke Green"
+            style={{ display: this.isNormalLawActive.map((nl) => (nl ? 'inherit' : 'none')) }}
+          >
             <path d="m51.506 31.523h4m-4-1.4h4" />
             <path d="m86.306 31.523h-4m4-1.4h-4" />
           </g>
-          <g id="PitchProtLostUpper" style="display: none" class="NormalStroke Amber">
+          <g
+            id="PitchProtLostUpper"
+            class="NormalStroke Amber"
+            style={{ display: this.isNormalLawActive.map((nl) => (!nl ? 'inherit' : 'none')) }}
+          >
             <path d="m52.699 30.116 1.4142 1.4142m-1.4142 0 1.4142-1.4142" />
             <path d="m85.114 31.53-1.4142-1.4142m1.4142 0-1.4142 1.4142" />
           </g>
-          <g id="PitchProtLower" class="NormalStroke Green">
+          <g
+            id="PitchProtLower"
+            class="NormalStroke Green"
+            style={{ display: this.isNormalLawActive.map((nl) => (nl ? 'inherit' : 'none')) }}
+          >
             <path d="m59.946 104.52h4m-4-1.4h4" />
             <path d="m77.867 104.52h-4m4-1.4h-4" />
           </g>
-          <g id="PitchProtLostLower" style="display: none" class="NormalStroke Amber">
+          <g
+            id="PitchProtLostLower"
+            class="NormalStroke Amber"
+            style={{ display: this.isNormalLawActive.map((nl) => (!nl ? 'inherit' : 'none')) }}
+          >
             <path d="m61.199 103.12 1.4142 1.4142m-1.4142 0 1.4142-1.4142" />
             <path d="m76.614 104.53-1.4142-1.4142m1.4142 0-1.4142 1.4142" />
           </g>
diff --git a/fbw-a380x/src/systems/instruments/src/PFD/FMA.tsx b/fbw-a380x/src/systems/instruments/src/PFD/FMA.tsx
index fd9cc280592..e060ac4c2d3 100644
--- a/fbw-a380x/src/systems/instruments/src/PFD/FMA.tsx
+++ b/fbw-a380x/src/systems/instruments/src/PFD/FMA.tsx
@@ -14,7 +14,7 @@ import {
 import { ArmedLateralMode, isArmed, LateralMode, VerticalMode } from '@shared/autopilot';
 import { Arinc429Values } from './shared/ArincValueProvider';
 import { PFDSimvars } from './shared/PFDSimvarPublisher';
-import { Arinc429Word } from '@flybywiresim/fbw-sdk';
+import { Arinc429ConsumerSubject, Arinc429Word, Arinc429WordData } from '@flybywiresim/fbw-sdk';
 
 abstract class ShowForSecondsComponent<T extends ComponentProps> extends DisplayComponent<T> {
   private timeout: number = 0;
@@ -89,6 +89,10 @@ export class FMA extends DisplayComponent<{ bus: EventBus; isAttExcessive: Subsc
 
   private readonly approachCapability = ConsumerSubject.create(this.sub.on('approachCapability'), 0);
 
+  private readonly fcdcDiscreteWord1 = Arinc429ConsumerSubject.create(this.sub.on('fcdcDiscreteWord1'));
+
+  private readonly fwcFlightPhase = ConsumerSubject.create(this.sub.on('fwcFlightPhase'), 0);
+
   private disconnectApForLdg = MappedSubject.create(
     ([ap1, ap2, ra, altitude, landingElevation, verticalMode, selectedFpa, selectedVs, approachCapability]) => {
       return (
@@ -126,6 +130,8 @@ export class FMA extends DisplayComponent<{ bus: EventBus; isAttExcessive: Subsc
         this.props.isAttExcessive.get(),
         this.armedVerticalModeSub.get(),
         this.setHoldSpeed,
+        this.fcdcDiscreteWord1.get(),
+        this.fwcFlightPhase.get(),
         this.trkFpaDeselected.get(),
         this.tcasRaInhibited.get(),
         this.tdReached,
@@ -1347,11 +1353,15 @@ const getBC3Message = (
   isAttExcessive: boolean,
   armedVerticalMode: number,
   setHoldSpeed: boolean,
+  fcdcWord1: Arinc429WordData,
+  fwcFlightPhase: number,
   trkFpaDeselectedTCAS: boolean,
   tcasRaInhibited: boolean,
   tdReached: boolean,
   disconnectApForLdg: boolean,
 ) => {
+  const flightPhaseForWarning =
+    fwcFlightPhase >= 2 && fwcFlightPhase <= 11 && !(fwcFlightPhase >= 4 && fwcFlightPhase <= 7);
   const armedVerticalBitmask = armedVerticalMode;
   const TCASArmed = (armedVerticalBitmask >> 6) & 1;
 
@@ -1359,7 +1369,7 @@ const getBC3Message = (
   let className: string;
 
   // All currently unused message are set to false
-  if (false) {
+  if (fcdcWord1.bitValue(15) && !fcdcWord1.isFailureWarning() && flightPhaseForWarning) {
     text = 'USE MAN PITCH TRIM';
     className = 'PulseAmber9Seconds Amber';
   } else if (false) {
@@ -1425,11 +1435,17 @@ class BC3Cell extends DisplayComponent<{
 
   private tdReached = false;
 
+  private readonly fcdcDiscreteWord1 = Arinc429ConsumerSubject.create(this.sub.on('fcdcDiscreteWord1'));
+
+  private readonly fwcFlightPhase = ConsumerSubject.create(this.sub.on('fwcFlightPhase'), 0);
+
   private fillBC3Cell() {
     const [text, className] = getBC3Message(
       this.isAttExcessive,
       this.armedVerticalMode,
       this.setHoldSpeed,
+      this.fcdcDiscreteWord1.get(),
+      this.fwcFlightPhase.get(),
       this.trkFpaDeselected,
       this.tcasRaInhibited,
       this.tdReached,
diff --git a/fbw-a380x/src/systems/instruments/src/PFD/SpeedIndicator.tsx b/fbw-a380x/src/systems/instruments/src/PFD/SpeedIndicator.tsx
index f15b42e9c02..6c93ec9fbb9 100644
--- a/fbw-a380x/src/systems/instruments/src/PFD/SpeedIndicator.tsx
+++ b/fbw-a380x/src/systems/instruments/src/PFD/SpeedIndicator.tsx
@@ -214,8 +214,7 @@ class VAlphaProtBar extends DisplayComponent<{ bus: ArincEventBus }> {
 }
 
 class FlapsSpeedPointBugs extends DisplayComponent<{ bus: ArincEventBus }> {
-
-  private readonly sub = this.props.bus.getArincSubscriber<PFDSimvars & Arinc429Values>()
+  private readonly sub = this.props.bus.getArincSubscriber<PFDSimvars & Arinc429Values>();
 
   private greenDotBug = FSComponent.createRef<SVGGElement>();
 
@@ -231,69 +230,63 @@ class FlapsSpeedPointBugs extends DisplayComponent<{ bus: ArincEventBus }> {
   private readonly leftMainGearCompressedConsumer = ConsumerSubject.create(
     this.sub.on('leftMainGearCompressed').whenChanged(),
     true,
-  )
+  );
 
   private readonly rightMainGearCompressedConsumer = ConsumerSubject.create(
     this.sub.on('rightMainGearCompressed').whenChanged(),
     true,
-  )
+  );
 
   private readonly airspeedRaw = ConsumerSubject.create(this.sub.on('speed').whenChanged(), null);
 
   private readonly airspeed = Arinc429RegisterSubject.createEmpty();
 
-  private readonly shortTermManagedSpeedExists =
-  MappedSubject.create(
-    ([shortTermManagedSpeed, leftGearCompressed, rightGearCompressed, ]) => shortTermManagedSpeed > 0 && (!leftGearCompressed || !rightGearCompressed),
+  private readonly shortTermManagedSpeedExists = MappedSubject.create(
+    ([shortTermManagedSpeed, leftGearCompressed, rightGearCompressed]) =>
+      shortTermManagedSpeed > 0 && (!leftGearCompressed || !rightGearCompressed),
     this.shortTermManagedSpeedConsumer,
     this.leftMainGearCompressedConsumer,
-    this.rightMainGearCompressedConsumer
-  )
+    this.rightMainGearCompressedConsumer,
+  );
 
   private readonly shortTermVisibility = this.shortTermManagedSpeedExists.map((v) => (v ? 'visible' : 'hidden'));
 
   private readonly shortTermPath = MappedSubject.create(
     ([ias, shortTermSpeed]) => {
-      if(ias.isNormalOperation() && shortTermSpeed) {
-      const diff = Math.abs(ias.value - shortTermSpeed);
-      if(diff < DisplayRange ) {
-        return 'm20.29 80.85a1.2592 1.2599 0 1 0-2.5184 0 1.2592 1.2599 0 1 0 2.5184 0z'
-      } else if (ias.value > shortTermSpeed) {
-        return 'm 17.91,80.60c 4.07e-4,0.6238 0.5384,1.1293 1.2019,1.1293 0.6635,0 1.2015,-0.5055 1.2019,-1.1293h -1.2019z';
+      if (ias.isNormalOperation() && shortTermSpeed) {
+        const diff = Math.abs(ias.value - shortTermSpeed);
+        if (diff < DisplayRange) {
+          return 'm20.29 80.85a1.2592 1.2599 0 1 0-2.5184 0 1.2592 1.2599 0 1 0 2.5184 0z';
+        } else if (ias.value > shortTermSpeed) {
+          return 'm 17.91,80.60c 4.07e-4,0.6238 0.5384,1.1293 1.2019,1.1293 0.6635,0 1.2015,-0.5055 1.2019,-1.1293h -1.2019z';
+        } else {
+          return 'm 17.91,80.60c 4.07e-4,0.6743 0.5612,1.2207 1.2530,1.2207 0.6917,0 1.2525,-0.5464 1.2530,-1.2207h -1.2530z';
+        }
       } else {
-        return 'm 17.91,80.60c 4.07e-4,0.6743 0.5612,1.2207 1.2530,1.2207 0.6917,0 1.2525,-0.5464 1.2530,-1.2207h -1.2530z';
-      } 
-    } else {
-      return '';
-    }
+        return '';
+      }
     },
     this.airspeed,
-    this.shortTermManagedSpeedConsumer
-  )
-
+    this.shortTermManagedSpeedConsumer,
+  );
 
-  private readonly shortTermStyle =
-  MappedSubject.create(
+  private readonly shortTermStyle = MappedSubject.create(
     ([shortTermVisible, ias, shortTermManagedSpeed]) => {
-      if(shortTermVisible && ias.isNormalOperation()) {
-        return `transform: translate(0px, ${getSpeedTapeOffsetAlwaysVisible(ias.value, 
-          shortTermManagedSpeed)}px)`
+      if (shortTermVisible && ias.isNormalOperation()) {
+        return `transform: translate(0px, ${getSpeedTapeOffsetAlwaysVisible(ias.value, shortTermManagedSpeed)}px)`;
       }
       return '';
     },
     this.shortTermManagedSpeedExists,
     this.airspeed,
-    this.shortTermManagedSpeedConsumer
-  )
+    this.shortTermManagedSpeedConsumer,
+  );
 
   render(): VNode {
     return (
       <>
-          <g id="ShortTermManagedSpeed" visibility={this.shortTermVisibility} style={this.shortTermStyle}>
-          <path
-            class="Fill Magenta"
-            d={this.shortTermPath}
-          />
+        <g id="ShortTermManagedSpeed" visibility={this.shortTermVisibility} style={this.shortTermStyle}>
+          <path class="Fill Magenta" d={this.shortTermPath} />
         </g>
         <g id="GreenDotSpeedMarker" ref={this.greenDotBug} style="transform:translate3d(0px, 0px,0px)">
           <path class="ThickOutline" d="m20.29 80.85a1.2592 1.2599 0 1 0-2.5184 0 1.2592 1.2599 0 1 0 2.5184 0z" />
@@ -311,7 +304,6 @@ class FlapsSpeedPointBugs extends DisplayComponent<{ bus: ArincEventBus }> {
             S
           </text>
         </g>
-
       </>
     );
   }
@@ -319,7 +311,6 @@ class FlapsSpeedPointBugs extends DisplayComponent<{ bus: ArincEventBus }> {
   onAfterRender(node: VNode): void {
     super.onAfterRender(node);
 
-
     this.airspeedRaw.sub((w) => this.airspeed.setWord(w));
 
     this.sub
@@ -359,14 +350,14 @@ class FlapsSpeedPointBugs extends DisplayComponent<{ bus: ArincEventBus }> {
 }
 
 const getSpeedTapeOffset = (speed: number): number => (-speed * DistanceSpacing) / ValueSpacing;
-const getSpeedTapeOffsetAlwaysVisible = (currentSpeed : number, bugSpeed : number) => {
+const getSpeedTapeOffsetAlwaysVisible = (currentSpeed: number, bugSpeed: number) => {
   const diff = Math.abs(currentSpeed - bugSpeed);
-  if(diff < DisplayRange) { 
+  if (diff < DisplayRange) {
     return getSpeedTapeOffset(bugSpeed);
   } else {
-   return getSpeedTapeOffset(currentSpeed > bugSpeed? currentSpeed - DisplayRange : currentSpeed + DisplayRange); // speed always visible on tape
+    return getSpeedTapeOffset(currentSpeed > bugSpeed ? currentSpeed - DisplayRange : currentSpeed + DisplayRange); // speed always visible on tape
   }
-}
+};
 
 export class AirspeedIndicatorOfftape extends DisplayComponent<{ bus: ArincEventBus }> {
   private lowerRef = FSComponent.createRef<SVGGElement>();
@@ -1490,10 +1481,11 @@ class VProtBug extends DisplayComponent<{ bus: EventBus }> {
       .whenChanged()
       .handle((vm) => {
         this.Vmax = vm;
+        // console.log(vm);
 
         this.handleVProtBugDisplay();
       });
-    
+
     sub
       .on('fcdcDiscreteWord1')
       .whenChanged()
diff --git a/fbw-a380x/src/wasm/fbw_a380/src/FlyByWireInterface.cpp b/fbw-a380x/src/wasm/fbw_a380/src/FlyByWireInterface.cpp
index 1f37c2cb39f..f80d63a5b83 100644
--- a/fbw-a380x/src/wasm/fbw_a380/src/FlyByWireInterface.cpp
+++ b/fbw-a380x/src/wasm/fbw_a380/src/FlyByWireInterface.cpp
@@ -489,6 +489,11 @@ void FlyByWireInterface::setupLocalVariables() {
 
   idFmGrossWeight = std::make_unique<LocalVariable>("A32NX_FM_GROSS_WEIGHT");
 
+  for (int i = 0; i < 2; i++) {
+    std::string idString = std::to_string(i + 1);
+    idCpiomCxAvailable[i] = std::make_unique<LocalVariable>("A32NX_CPIOM_C" + idString + "_AVAIL");
+  }
+
   for (int i = 0; i < 3; i++) {
     std::string idString = std::to_string(i + 1);
     idRadioAltimeterHeight[i] = std::make_unique<LocalVariable>("A32NX_RA_" + idString + "_RADIO_ALTITUDE");
@@ -1692,29 +1697,18 @@ bool FlyByWireInterface::updateFcdc(double sampleTime, int fcdcIndex) {
 
   const int oppFcdcIndex = fcdcIndex == 0 ? 1 : 0;
 
-  // Phase 1 of refactoring: Populate FCDC discrete words as per a32nx spec, disregarding the obvious differences.
-  // Target: Should behave unsuspiciously in normal ops
-  // Select master PRIM, use it for population of FCDC discrete words
-  int masterPrim = -1;
-  for (int i = 0; i < 3; i++) {
-    if (primsDiscreteOutputs[i].prim_healthy) {
-      masterPrim = i;
-      break;
-    }
-  }
+  Failures failureIndex = fcdcIndex == 0 ? Failures::Fcdc1 : Failures::Fcdc2;
 
-  FcdcBus output = {};
+  fcdcs[fcdcIndex].discreteInputs.noseGearPressed = idLgciuNoseGearCompressed[0]->get();
+  fcdcs[fcdcIndex].discreteInputs.spoilersArmed = spoilersHandler->getIsArmed() ? true : false;
 
-  if (masterPrim == -1) {
-    output.efcsStatus1.setSsm(Arinc429SignStatus::FailureWarning);
-    output.efcsStatus2.setSsm(Arinc429SignStatus::FailureWarning);
-    output.efcsStatus3.setSsm(Arinc429SignStatus::FailureWarning);
-    output.efcsStatus4.setSsm(Arinc429SignStatus::FailureWarning);
-    output.efcsStatus5.setSsm(Arinc429SignStatus::FailureWarning);
-  } else {
-    output = fcdcs[fcdcIndex].update(primsBusOutputs[masterPrim], spoilersHandler->getIsArmed() ? true : false);
+  for (int i = 0; i < 3; i++) {
+    fcdcs[fcdcIndex].discreteInputs.primHealthy[i] = primsDiscreteOutputs[i].prim_healthy;
+    fcdcs[fcdcIndex].busInputs.prims[i] = primsBusOutputs[i];
   }
 
+  FcdcBus output = fcdcs[fcdcIndex].update(sampleTime, failuresConsumer.isActive(failureIndex), idCpiomCxAvailable[fcdcIndex]->get());
+
   idFcdcDiscreteWord1[fcdcIndex]->set(output.efcsStatus1.toSimVar());
   idFcdcDiscreteWord2[fcdcIndex]->set(output.efcsStatus2.toSimVar());
   idFcdcDiscreteWord3[fcdcIndex]->set(output.efcsStatus3.toSimVar());
diff --git a/fbw-a380x/src/wasm/fbw_a380/src/FlyByWireInterface.h b/fbw-a380x/src/wasm/fbw_a380/src/FlyByWireInterface.h
index 303865b2823..fd765956deb 100644
--- a/fbw-a380x/src/wasm/fbw_a380/src/FlyByWireInterface.h
+++ b/fbw-a380x/src/wasm/fbw_a380/src/FlyByWireInterface.h
@@ -356,6 +356,9 @@ class FlyByWireInterface {
 
   std::unique_ptr<LocalVariable> idFmGrossWeight;
 
+  // CPIOM status
+  std::unique_ptr<LocalVariable> idCpiomCxAvailable[2];
+
   // RA bus inputs
   std::unique_ptr<LocalVariable> idRadioAltimeterHeight[3];
 
diff --git a/fbw-a380x/src/wasm/fbw_a380/src/fcdc/Fcdc.cpp b/fbw-a380x/src/wasm/fbw_a380/src/fcdc/Fcdc.cpp
index f99d812801d..4688a24f0ca 100644
--- a/fbw-a380x/src/wasm/fbw_a380/src/fcdc/Fcdc.cpp
+++ b/fbw-a380x/src/wasm/fbw_a380/src/fcdc/Fcdc.cpp
@@ -5,15 +5,60 @@ using namespace Arinc429Utils;
 
 Fcdc::Fcdc(bool isUnit1) : isUnit1(isUnit1) {}
 
-FcdcBus Fcdc::update(base_prim_out_bus primsBusOutputs, bool spoilersArmed) {
+// Perform the startup sequence, i.e.: Clear the memory, and initialize the self-test sequence.
+// If the power supply outage was lower than 3 seconds, or the aircraft is in the air or on ground an moving,
+// perform a short self-test.
+// Else, perform a long self-test.
+void Fcdc::startup() {
+  if (powerSupplyOutageTime <= 3.0 || !discreteInputs.noseGearPressed) {
+    selfTestTimer = 0.5;
+  } else {
+    selfTestTimer = 3;
+  }
+  powerSupplyOutageTime = 0.0;
+}
+
+FcdcBus Fcdc::update(double deltaTime, bool faultActive, bool isPowered) {
+  monitorPowerSupply(deltaTime, isPowered);
+
+  updateSelfTest(deltaTime);
+  monitorSelf(faultActive);
+
   FcdcBus output = {};
 
-  LateralLaw systemLateralLaw = getLateralLawStatusFromBits(bitFromValue(primsBusOutputs.fctl_law_status_word, 19),
-                                                            bitFromValue(primsBusOutputs.fctl_law_status_word, 20));
+  if (!monitoringHealthy) {
+    output.efcsStatus1.setSsm(Arinc429SignStatus::FailureWarning);
+    output.efcsStatus2.setSsm(Arinc429SignStatus::FailureWarning);
+    output.efcsStatus3.setSsm(Arinc429SignStatus::FailureWarning);
+    output.efcsStatus4.setSsm(Arinc429SignStatus::FailureWarning);
+    output.efcsStatus5.setSsm(Arinc429SignStatus::FailureWarning);
+    return output;
+  }
+
+  // Phase 1 of refactoring: Populate FCDC discrete words as per a32nx spec, disregarding the obvious differences.
+  // Target: Should behave unsuspiciously in normal ops
+  // Select master PRIM, use it for population of FCDC discrete words
+  int masterPrim = 0;
+  bool allPrimsDead = true;
+  for (int i = 0; i < 3; i++) {
+    if (discreteInputs.primHealthy[i]) {
+      allPrimsDead = false;
+      masterPrim = i;
+      break;
+    }
+  }
+  Arinc429SignStatus ssm = allPrimsDead ? Arinc429SignStatus::FailureWarning : Arinc429SignStatus::NormalOperation;
 
-  PitchLaw systemPitchLaw = getPitchLawStatusFromBits(bitFromValue(primsBusOutputs.fctl_law_status_word, 16),
-                                                      bitFromValue(primsBusOutputs.fctl_law_status_word, 17),
-                                                      bitFromValue(primsBusOutputs.fctl_law_status_word, 18));
+  LateralLaw systemLateralLaw = allPrimsDead == true
+                                    ? LateralLaw::DirectLaw
+                                    : getLateralLawStatusFromBits(bitFromValue(busInputs.prims[masterPrim].fctl_law_status_word, 19),
+                                                                  bitFromValue(busInputs.prims[masterPrim].fctl_law_status_word, 20));
+
+  PitchLaw systemPitchLaw = allPrimsDead == true
+                                ? PitchLaw::DirectLaw
+                                : getPitchLawStatusFromBits(bitFromValue(busInputs.prims[masterPrim].fctl_law_status_word, 16),
+                                                            bitFromValue(busInputs.prims[masterPrim].fctl_law_status_word, 17),
+                                                            bitFromValue(busInputs.prims[masterPrim].fctl_law_status_word, 18));
 
   output.efcsStatus1.setData(0);
   output.efcsStatus1.setSsm(Arinc429SignStatus::NormalOperation);
@@ -24,45 +69,64 @@ FcdcBus Fcdc::update(base_prim_out_bus primsBusOutputs, bool spoilersArmed) {
   output.efcsStatus1.setBit(15, systemPitchLaw == PitchLaw::DirectLaw);
   output.efcsStatus1.setBit(16, systemLateralLaw == LateralLaw::NormalLaw);
   output.efcsStatus1.setBit(17, systemLateralLaw == LateralLaw::DirectLaw);
+  output.efcsStatus3.setBit(19, allPrimsDead);
+  output.efcsStatus3.setBit(20, allPrimsDead);
+  output.efcsStatus3.setBit(21, allPrimsDead);
+  output.efcsStatus3.setBit(22, allPrimsDead);
+  output.efcsStatus3.setBit(23, allPrimsDead);
+  output.efcsStatus3.setBit(24, allPrimsDead);
+  output.efcsStatus3.setBit(25, allPrimsDead);
+  output.efcsStatus3.setBit(26, allPrimsDead);
+  output.efcsStatus3.setBit(29, allPrimsDead);
 
   output.efcsStatus2.setData(0);
   output.efcsStatus2.setSsm(Arinc429SignStatus::NormalOperation);
+  output.efcsStatus2.setBit(11, !bitFromValueOr(busInputs.prims[masterPrim].aileron_status_word, 11, false));
+  output.efcsStatus2.setBit(12, !bitFromValueOr(busInputs.prims[masterPrim].aileron_status_word, 11, false));
+  output.efcsStatus2.setBit(13, !bitFromValueOr(busInputs.prims[masterPrim].aileron_status_word, 14, false));
+  output.efcsStatus2.setBit(14, !bitFromValueOr(busInputs.prims[masterPrim].aileron_status_word, 14, false));
+  output.efcsStatus2.setBit(15, !bitFromValueOr(busInputs.prims[masterPrim].elevator_status_word, 11, false));
+  output.efcsStatus2.setBit(16, !bitFromValueOr(busInputs.prims[masterPrim].elevator_status_word, 11, false));
+  output.efcsStatus2.setBit(17, !bitFromValueOr(busInputs.prims[masterPrim].elevator_status_word, 14, false));
+  output.efcsStatus2.setBit(18, !bitFromValueOr(busInputs.prims[masterPrim].elevator_status_word, 14, false));
 
   output.efcsStatus3.setData(0);
   output.efcsStatus3.setSsm(Arinc429SignStatus::NormalOperation);
-  output.efcsStatus3.setBit(11, bitFromValue(primsBusOutputs.aileron_status_word, 11));
-  output.efcsStatus3.setBit(12, bitFromValue(primsBusOutputs.aileron_status_word, 11));
-  output.efcsStatus3.setBit(13, bitFromValue(primsBusOutputs.aileron_status_word, 14));
-  output.efcsStatus3.setBit(14, bitFromValue(primsBusOutputs.aileron_status_word, 14));
-  output.efcsStatus3.setBit(15, bitFromValue(primsBusOutputs.elevator_status_word, 11));
-  output.efcsStatus3.setBit(16, bitFromValue(primsBusOutputs.elevator_status_word, 11));
-  output.efcsStatus3.setBit(17, bitFromValue(primsBusOutputs.elevator_status_word, 14));
-  output.efcsStatus3.setBit(18, bitFromValue(primsBusOutputs.elevator_status_word, 14));
-  output.efcsStatus3.setBit(21, bitFromValue(primsBusOutputs.spoiler_status_word, 11));
-  output.efcsStatus3.setBit(22, bitFromValue(primsBusOutputs.spoiler_status_word, 11));
-  output.efcsStatus3.setBit(23, bitFromValue(primsBusOutputs.spoiler_status_word, 11));
-  output.efcsStatus3.setBit(24, bitFromValue(primsBusOutputs.spoiler_status_word, 11));
-  output.efcsStatus3.setBit(25, bitFromValue(primsBusOutputs.spoiler_status_word, 11));
+  output.efcsStatus3.setBit(11, bitFromValueOr(busInputs.prims[masterPrim].aileron_status_word, 11, false));
+  output.efcsStatus3.setBit(12, bitFromValueOr(busInputs.prims[masterPrim].aileron_status_word, 11, false));
+  output.efcsStatus3.setBit(13, bitFromValueOr(busInputs.prims[masterPrim].aileron_status_word, 14, false));
+  output.efcsStatus3.setBit(14, bitFromValueOr(busInputs.prims[masterPrim].aileron_status_word, 14, false));
+  output.efcsStatus3.setBit(15, bitFromValueOr(busInputs.prims[masterPrim].elevator_status_word, 11, false));
+  output.efcsStatus3.setBit(16, bitFromValueOr(busInputs.prims[masterPrim].elevator_status_word, 11, false));
+  output.efcsStatus3.setBit(17, bitFromValueOr(busInputs.prims[masterPrim].elevator_status_word, 14, false));
+  output.efcsStatus3.setBit(18, bitFromValueOr(busInputs.prims[masterPrim].elevator_status_word, 14, false));
+  output.efcsStatus3.setBit(21, bitFromValueOr(busInputs.prims[masterPrim].spoiler_status_word, 11, false));
+  output.efcsStatus3.setBit(22, bitFromValueOr(busInputs.prims[masterPrim].spoiler_status_word, 11, false));
+  output.efcsStatus3.setBit(23, bitFromValueOr(busInputs.prims[masterPrim].spoiler_status_word, 11, false));
+  output.efcsStatus3.setBit(24, bitFromValueOr(busInputs.prims[masterPrim].spoiler_status_word, 11, false));
+  output.efcsStatus3.setBit(25, bitFromValueOr(busInputs.prims[masterPrim].spoiler_status_word, 11, false));
 
   output.efcsStatus4.setData(0);
   output.efcsStatus4.setSsm(Arinc429SignStatus::NormalOperation);
-  output.efcsStatus4.setBit(11, valueOr(primsBusOutputs.left_spoiler_1_command_deg, 0) > 0);
-  output.efcsStatus4.setBit(12, valueOr(primsBusOutputs.right_spoiler_1_command_deg, 0) > 0);
-  output.efcsStatus4.setBit(13, valueOr(primsBusOutputs.left_spoiler_2_command_deg, 0) > 0);
-  output.efcsStatus4.setBit(14, valueOr(primsBusOutputs.right_spoiler_2_command_deg, 0) > 0);
-  output.efcsStatus4.setBit(15, valueOr(primsBusOutputs.left_spoiler_3_command_deg, 0) > 0);
-  output.efcsStatus4.setBit(16, valueOr(primsBusOutputs.right_spoiler_3_command_deg, 0) > 0);
-  output.efcsStatus4.setBit(17, valueOr(primsBusOutputs.left_spoiler_4_command_deg, 0) > 0);
-  output.efcsStatus4.setBit(18, valueOr(primsBusOutputs.right_spoiler_4_command_deg, 0) > 0);
-  output.efcsStatus4.setBit(19, valueOr(primsBusOutputs.left_spoiler_5_command_deg, 0) > 0);
-  output.efcsStatus4.setBit(20, valueOr(primsBusOutputs.right_spoiler_5_command_deg, 0) > 0);
-  output.efcsStatus4.setBit(21, true);
-  output.efcsStatus4.setBit(22, true);
-  output.efcsStatus4.setBit(23, true);
-  output.efcsStatus4.setBit(24, true);
-  output.efcsStatus4.setBit(25, true);
-  output.efcsStatus4.setBit(26, valueOr(primsBusOutputs.left_spoiler_1_command_deg, 0) > 10);
-  output.efcsStatus4.setBit(27, spoilersArmed);
+  output.efcsStatus4.setBit(11, valueOr(busInputs.prims[masterPrim].left_spoiler_position_deg, 0) < -2.5);
+  output.efcsStatus4.setBit(12, valueOr(busInputs.prims[masterPrim].right_spoiler_position_deg, 0) < -2.5);
+  output.efcsStatus4.setBit(13, valueOr(busInputs.prims[masterPrim].left_spoiler_position_deg, 0) < -2.5);
+  output.efcsStatus4.setBit(14, valueOr(busInputs.prims[masterPrim].right_spoiler_position_deg, 0) < -2.5);
+  output.efcsStatus4.setBit(15, valueOr(busInputs.prims[masterPrim].left_spoiler_position_deg, 0) < -2.5);
+  output.efcsStatus4.setBit(16, valueOr(busInputs.prims[masterPrim].right_spoiler_position_deg, 0) < -2.5);
+  output.efcsStatus4.setBit(17, valueOr(busInputs.prims[masterPrim].left_spoiler_position_deg, 0) < -2.5);
+  output.efcsStatus4.setBit(18, valueOr(busInputs.prims[masterPrim].right_spoiler_position_deg, 0) < -2.5);
+  output.efcsStatus4.setBit(19, valueOr(busInputs.prims[masterPrim].left_spoiler_position_deg, 0) < -2.5);
+  output.efcsStatus4.setBit(20, valueOr(busInputs.prims[masterPrim].right_spoiler_position_deg, 0) < -2.5);
+  bool spoilerValid =
+      isNo(busInputs.prims[masterPrim].left_spoiler_position_deg) && isNo(busInputs.prims[masterPrim].right_spoiler_position_deg);
+  output.efcsStatus4.setBit(21, spoilerValid);
+  output.efcsStatus4.setBit(22, spoilerValid);
+  output.efcsStatus4.setBit(23, spoilerValid);
+  output.efcsStatus4.setBit(24, spoilerValid);
+  output.efcsStatus4.setBit(25, spoilerValid);
+  output.efcsStatus4.setBit(26, valueOr(busInputs.prims[masterPrim].left_spoiler_position_deg, 0) < -5);
+  output.efcsStatus4.setBit(27, discreteInputs.spoilersArmed);
 
   output.efcsStatus5.setData(0);
   output.efcsStatus5.setSsm(Arinc429SignStatus::NormalOperation);
@@ -70,6 +134,44 @@ FcdcBus Fcdc::update(base_prim_out_bus primsBusOutputs, bool spoilersArmed) {
   return output;
 }
 
+// Perform self monitoring
+void Fcdc::monitorSelf(bool faultActive) {
+  if (faultActive || powerSupplyFault || !selfTestComplete) {
+    monitoringHealthy = false;
+  } else {
+    monitoringHealthy = true;
+  }
+}
+
+// Monitor the power supply and record the outage time (used for self test and healthy logic).
+// If an outage lasts more than 10ms, stop the program execution.
+// If the power has been restored after an outage that lasted longer than 10ms, reset the RAM and
+// perform the startup sequence.
+void Fcdc::monitorPowerSupply(double deltaTime, bool isPowered) {
+  if (!isPowered) {
+    powerSupplyOutageTime += deltaTime;
+  }
+  if (powerSupplyOutageTime > minimumPowerOutageTimeForFailure) {
+    powerSupplyFault = true;
+  }
+  if (isPowered && powerSupplyFault) {
+    powerSupplyFault = false;
+    startup();
+  }
+}
+
+// Update the Self-test-Sequence
+void Fcdc::updateSelfTest(double deltaTime) {
+  if (selfTestTimer > 0) {
+    selfTestTimer -= deltaTime;
+  }
+  if (selfTestTimer <= 0) {
+    selfTestComplete = true;
+  } else {
+    selfTestComplete = false;
+  }
+}
+
 PitchLaw Fcdc::getPitchLawStatusFromBits(bool bit1, bool bit2, bool bit3) {
   if (!bit1 && !bit2 && bit3) {
     return PitchLaw::NormalLaw;
diff --git a/fbw-a380x/src/wasm/fbw_a380/src/fcdc/Fcdc.h b/fbw-a380x/src/wasm/fbw_a380/src/fcdc/Fcdc.h
index 276d5ffe5aa..a9485dbb810 100644
--- a/fbw-a380x/src/wasm/fbw_a380/src/fcdc/Fcdc.h
+++ b/fbw-a380x/src/wasm/fbw_a380/src/fcdc/Fcdc.h
@@ -17,6 +17,18 @@ struct FcdcBus {
   Arinc429DiscreteWord efcsStatus5;
 };
 
+struct FcdcDiscreteInputs {
+  bool spoilersArmed;
+
+  bool noseGearPressed;
+
+  bool primHealthy[3];
+};
+
+struct FcdcBusInputs {
+  base_prim_out_bus prims[3];
+};
+
 enum class LateralLaw {
   NormalLaw,
   DirectLaw,
@@ -37,12 +49,38 @@ class Fcdc {
  public:
   Fcdc(bool isUnit1);
 
-  FcdcBus update(base_prim_out_bus primsBusOutputs, bool spoilersArmed);
+  FcdcBus update(double deltaTime, bool faultActive, bool isPowered);
+
+  FcdcDiscreteInputs discreteInputs;
+
+  FcdcBusInputs busInputs;
 
  private:
+  void startup();
+
+  void monitorPowerSupply(double deltaTime, bool isPowered);
+
+  void monitorSelf(bool faultActive);
+
+  void updateSelfTest(double deltaTime);
+
   PitchLaw getPitchLawStatusFromBits(bool bit1, bool bit2, bool bit3);
 
   LateralLaw getLateralLawStatusFromBits(bool bit1, bool bit2);
 
+  // Computer monitoring and self-test vars
+
+  bool monitoringHealthy;
+
+  double powerSupplyOutageTime;
+
+  bool powerSupplyFault;
+
+  double selfTestTimer;
+
+  bool selfTestComplete;
+
   const bool isUnit1;
+
+  const double minimumPowerOutageTimeForFailure = 0.01;
 };