General additions, fixes and bugfixes

This commit is contained in:
Kostas Missos
2018-06-18 09:04:13 +03:00
parent 9d50a13ef0
commit e76c2b4cb6
10 changed files with 159 additions and 57 deletions

View File

@@ -58,17 +58,15 @@ u32 btn_wait()
return res;
}
u32 btn_wait_timeout(u32 time_ms)
u32 btn_wait_timeout(u32 time_ms, u32 mask)
{
u32 timeout = get_tmr() + (time_ms * 1000);
u32 res = btn_read();
u32 btn = res;
u32 res = btn_read() & mask;
do
{
//Keep the new value until timeout is reached
if (btn == res)
res = btn_read();
if (!(res & mask))
res = btn_read() & mask;
} while (get_tmr() < timeout);
return res;