diff options
Diffstat (limited to 'firmware/target/arm/i2c-telechips.c')
-rw-r--r-- | firmware/target/arm/i2c-telechips.c | 7 |
1 files changed, 4 insertions, 3 deletions
diff --git a/firmware/target/arm/i2c-telechips.c b/firmware/target/arm/i2c-telechips.c index 35f4cd41c5..511bbe8865 100644 --- a/firmware/target/arm/i2c-telechips.c +++ b/firmware/target/arm/i2c-telechips.c | |||
@@ -27,9 +27,10 @@ | |||
27 | /* Delay loop based on CPU frequency (FREQ>>22 is 7..45 for 32MHz..192MHz) */ | 27 | /* Delay loop based on CPU frequency (FREQ>>22 is 7..45 for 32MHz..192MHz) */ |
28 | static inline void delay_loop(void) | 28 | static inline void delay_loop(void) |
29 | { | 29 | { |
30 | unsigned long x; | 30 | asm volatile (" mov %[freq], %[freq], asr#22 \n\t" |
31 | for (x = (unsigned)(FREQ>>22); x; x--) | 31 | "1: subs %[freq], %[freq], #1 \n\t" |
32 | asm volatile("nop"); | 32 | " bne 1b" |
33 | : : [freq] "r" (cpu_frequency) : "memory"); | ||
33 | } | 34 | } |
34 | 35 | ||
35 | #define DELAY delay_loop() | 36 | #define DELAY delay_loop() |