Optimised KF and H2 Integrated - Flies with 12 modules (in a M configuration)
Flies in Vicon for both Param and H2, with Delay Compensation for the KF, and split calculations for the H2
Delay Compensation working, bias correction still needs adjustment