Unscented Kalman Filter and Control in TSE(3) with Applications to Spacecraft Dynamics