diff --git a/src/main/drivers/system.c b/src/main/drivers/system.c index 13c7a04152..6fa44a1c96 100644 --- a/src/main/drivers/system.c +++ b/src/main/drivers/system.c @@ -122,6 +122,7 @@ uint32_t micros(void) */ asm volatile("\tnop\n"); } while (ms != sysTickUptime); + return (ms * 1000) + (usTicks * 1000 - cycle_cnt) / usTicks; }