Incorrect Velocity

[NicholasLuis]

Velocity magnitude in the NED frame increases over time when it should be constant

[NicholasLuis]

Check if DCM matrices are orthonormal, and adjust it if necessary.