Visual-Inertial Filter implemented in Simulink/MATLAB