diff --git a/radio/src/maths.cpp b/radio/src/maths.cpp
index 346a7dba7..93330af1c 100644
--- a/radio/src/maths.cpp
+++ b/radio/src/maths.cpp
@@ -164,14 +164,10 @@ void varioWakeup()
 
     if (verticalSpeed < 0 || (int16_t)(s_varioTmr-tmr10ms) < 0) {
 #if defined(CPUARM)
-      uint16_t SoundVarioBeepTime;
-      uint16_t SoundVarioBeepFreq;
+      int SoundVarioBeepTime;
+      int SoundVarioBeepFreq;
       if (verticalSpeed > 0) {
-        if (verticalSpeed > 1276) {
-          SoundVarioBeepTime=5;
-        } else {
-          SoundVarioBeepTime = 320 - (verticalSpeed >> 2);
-        }
+        SoundVarioBeepTime = min(5, 320 - (verticalSpeed >> 2));
         SoundVarioBeepFreq = 1000 + verticalSpeed;
       }
       else {