diff --git a/Rover/GCS_Mavlink.cpp b/Rover/GCS_Mavlink.cpp
index a903e591c6..eaa26eee7d 100644
--- a/Rover/GCS_Mavlink.cpp
+++ b/Rover/GCS_Mavlink.cpp
@@ -589,6 +589,7 @@ static const ap_message STREAM_EXTRA3_msgs[] = {
     MSG_WIND,
 #if AP_RANGEFINDER_ENABLED
     MSG_RANGEFINDER,
+    MSG_WATER_DEPTH,
 #endif
     MSG_DISTANCE_SENSOR,
     MSG_SYSTEM_TIME,
diff --git a/Rover/Log.cpp b/Rover/Log.cpp
index f13ad700ad..e474cda125 100644
--- a/Rover/Log.cpp
+++ b/Rover/Log.cpp
@@ -79,10 +79,6 @@ void Rover::Log_Write_Depth()
                             (double)(s->distance()),
                             temp_C);
     }
-#if AP_RANGEFINDER_ENABLED
-    // send water depth and temp to ground station
-    gcs().send_message(MSG_WATER_DEPTH);
-#endif
 }
 #endif