Optimization of a Strapdown Inertial Navigation System