mirrors/uv-k5-firmware-custom
0
Fork 0
mirror of https://github.com/OneOfEleven/uv-k5-firmware-custom.git synced 2025-06-19 06:39:49 +03:00
Code Issues Releases Activity

fix sqrt, turn mic off before mdc bot starts, adjust bot timing

Browse Source
This commit is contained in:
OneOfEleven
2023-10-28 16:17:40 +01:00
parent 4153389778
commit 9eb3f765e0
6 changed files with 116 additions and 132 deletions
Download Patch File Download Diff File Expand all files Collapse all files

27
ui/main.c
View File

@ -158,22 +158,19 @@ void UI_drawBars(uint8_t *p, const unsigned int level)
#ifdef ENABLE_TX_AUDIO_BAR
uint32_t sqrt16(uint32_t value)
{ // return square root of 'value'
unsigned int shift = 16; // this is the number of bits supplied in 'value' .. 2 ~ 32
uint32_t bit = 1u << --shift;
uint32_t sqrti = 0;
while (bit)
// linear search, ascending, using addition
uint16_t isqrt(const uint32_t y)
{
uint16_t L = 0;
uint32_t a = 1;
uint32_t d = 3;
while (a <= y)
{
const uint32_t temp = ((sqrti << 1) | bit) << shift--;
if (value >= temp)
{
value -= temp;
sqrti |= bit;
}
bit >>= 1;
a += d; // (a + 1) ^ 2
d += 2;
L += 1;
}
return sqrti;
return L;
}
bool UI_DisplayAudioBar(const bool now)
@ -223,7 +220,7 @@ void UI_drawBars(uint8_t *p, const unsigned int level)
// make non-linear to make more sensitive at low values
const unsigned int level = voice_amp * 8;
const unsigned int sqrt_level = sqrt16((level < 65535) ? level : 65535);
const unsigned int sqrt_level = isqrt((level < 65535) ? level : 65535);
const unsigned int len = (sqrt_level <= bar_width) ? sqrt_level : bar_width;
draw_bar(p_line + bar_x, len, bar_width);