fixed roll and pitch
Merge branch 'master' into more_ms5_functions
ms5