3D Water Quality Mapping using Invariant Extended Kalman Filtering for Underwater Robot Localization