diff --git a/libraries/AP_Mount/AP_Mount_Topotek.cpp b/libraries/AP_Mount/AP_Mount_Topotek.cpp
index 1e841d4b12867a..80bd76e02988cc 100755
--- a/libraries/AP_Mount/AP_Mount_Topotek.cpp
+++ b/libraries/AP_Mount/AP_Mount_Topotek.cpp
@@ -455,8 +455,10 @@ bool AP_Mount_Topotek::set_lens(uint8_t lens)
     if (!_initialised) {
         return false;
     }
-
-    return (send_packet(_next_pip_mode, 12));
+    if (lens > 0) {
+        return (send_packet(_next_pip_mode, 12));
+    }
+    return false;
 }
 
 // send camera information message to GCS