branch _mw4fbw: bench test project Cub-auav3 and fix problems introduced with SILSIM changes