static inline void delay_loop(void)
{
    asm volatile(
        "0:\n"
        "  add %0, %0, #1\n"
        "  cmp %1, %0\n"
        "  bne 0b"
        : : "r"(0), "r"(FREQ >> 22));
}
#define DELAY delay_loop()