Strapdown inertial navigation simulation program - MATLAB source code