diff --git a/c/src/p2fa.c b/c/src/p2fa.c index 51f99f1..bab30ab 100644 --- a/c/src/p2fa.c +++ b/c/src/p2fa.c @@ -56,13 +56,20 @@ int draw() { Paint_DrawRectangle(10, 112, 240, 92, BLACK, DOT_PIXEL_1X1, DRAW_FILL_EMPTY); EPD_2in13_V4_Display_Base(BlackImage); - uint64_t timeLeft = getTimeRemainingMS(30); + clock_t startTime; + clock_t endTime; + double elapsedTime; for (int j = 0; j < 3; ++j) { for (int i = getTimeRemainingMS(30); i > 200; i = getTimeRemainingMS(30)) { - Debug("Time Left: %dms", getTimeRemainingMS(30)); - Paint_DrawRectangle(10, 112, (timeLeft / (30 * 1000)) * 240, 92, BLACK, DOT_PIXEL_1X1, DRAW_FILL_FULL); + startTime = clock(); + Debug("Time Left: %dms\n", i); + Paint_DrawRectangle(10, 112, (i / (30 * 1000)) * 240, 92, BLACK, DOT_PIXEL_1X1, DRAW_FILL_FULL); EPD_2in13_V4_Display_Partial(BlackImage); - DEV_Delay_ms(100); + endTime = clock(); + elapsedTime = (double)(endTime - startTime) / CLOCKS_PER_SEC; + if (elapsedTime < 200) { + DEV_Delay_ms(200 - (elapsedTime * 1000)); + } } }