Magnetometer Aided Inertial Navigation System: MODELING AND SIMULATION OF A NAVIGATION SYSTEM WITH AN IMU AND A MAGNETOMETER