Modeling INS/GPS/Star-Tracker in 6 DoF: Simulating N&G&C of a Three-Stage Rocket Booster in CADAC++