1 files changed, 5 insertions, 2 deletions

diff --git a/firmware/target/arm/tcc780x/cowond2/lcd-cowond2.c b/firmware/target/arm/tcc780x/cowond2/lcd-cowond2.c
index 3f1e2e0312..ab50769983 100644
--- a/firmware/target/arm/tcc780x/cowond2/lcd-cowond2.c
+++ b/firmware/target/arm/tcc780x/cowond2/lcd-cowond2.c
@@ -77,9 +77,12 @@ void lcd_set_contrast(int val)
 /* Delay loop based on CPU frequency (FREQ>>23 is 3..22 for 32MHz..192MHz) */
 static void delay_loop(void)
 {
-    unsigned long x;
-    for (x = (unsigned)(FREQ>>23); x; x--);
+    asm volatile ("   mov  %[freq], %[freq], asr#23 \n\t"
+                  "1: subs %[freq], %[freq], #1     \n\t"
+                  "   bne  1b"
+                  : : [freq] "r" (cpu_frequency) : "memory");
 }
+
 #define DELAY delay_loop()
 
 static void ltv250qv_write(unsigned int command)