Implemented FMARollEngagedMode plus tests
Implement FMA Pitch Engaged Mode plus tests.