NMPC-Based Orbit and Formation Control for an Earth-Gravity Monitoring Mission