diff --git a/APMrover2/test.pde b/APMrover2/test.pde
index 297922a8140f9a2d0cff468331cd165641b5da6b..284e7222243c907582e0a3046bab1e573fec28f8 100644
--- a/APMrover2/test.pde
+++ b/APMrover2/test.pde
@@ -371,9 +371,9 @@ test_ins(uint8_t argc, const Menu::arg *argv)
                             (uint16_t)ahrs.yaw_sensor / 100,
                             gyros.x, gyros.y, gyros.z,
                             accels.x, accels.y, accels.z);
-    }
-    if(cliSerial->available() > 0){
-        return (0);
+        if(cliSerial->available() > 0){
+            return (0);
+        }
     }
 }