Create test config for FMUv1
Improved mount test
Merge branch 'mount_tests' of github.com:PX4/Firmware into mount_tests