Fix config multiwii
Harmonised motor test sketch