void busyWait(long ms) {
    TickType_t currentTick = xTaskGetTickCount();
    TickType_t goalTick = currentTick + pdMS_TO_TICKS(ms);
    while (currentTick < goalTick) {
        currentTick = xTaskGetTickCount();
    }
}

void testTask(void *args) {
    for (;;) {
        printf("test\n");
        busyWait(500);
    }
}

extern int setup(void);
int main() {
    setup();
    xTaskCreate(testTask, "busyWait", 100, NULL, 1, NULL);



    vTaskStartScheduler();
}