diff --git a/src/maths.cpp b/src/maths.cpp index f79e09932..a00b005a7 100644 --- a/src/maths.cpp +++ b/src/maths.cpp @@ -151,8 +151,8 @@ void varioWakeup() #if defined(PCBSTD) tmr10ms_t tmr10ms = get_tmr10ms(); if (tmr10ms > s_varioTmr) { - uint8_t SoundVarioBeepTime = (1600 - verticalSpeed) / 100; - uint8_t SoundVarioBeepFreq = max(40, (verticalSpeed * 10 + 20000) >> 8); + uint8_t SoundVarioBeepTime = limit((uint8_t)5, (uint8_t)((1600 - verticalSpeed) / 100), (uint8_t)30); + uint8_t SoundVarioBeepFreq = limit((uint8_t)40, (uint8_t)((verticalSpeed * 10 + 20000) >> 8), (uint8_t)120); if (verticalSpeed >= 0) s_varioTmr = tmr10ms + (SoundVarioBeepTime*2); else