Needs better fusion of GPS and SLAM #80
Description
State machine is a little fragile about this. SLAM doesn't require GPS, but the system won't initialize without it (no?). Conversely for UUVs, you might have GPS at the surface/start, but not begin SLAM until closer to seafloor. Needs to handle either one starting first.