cleanup set_arm_clk() function

diff --git a/arch/arm/cpu/armv7/mx6/clock.c b/arch/arm/cpu/armv7/mx6/clock.c
index 7c95db18471ff310a8bc5a75b537e789fc4e3e3c..b556830547bc5ecda30666b6ed66b9e6df9d784e 100644 (file)
--- a/arch/arm/cpu/armv7/mx6/clock.c
+++ b/arch/arm/cpu/armv7/mx6/clock.c
@@ -601,11 +601,11 @@ static int set_arm_clk(u32 ref, u32 freq_khz)
        u32 min_err = ~0;
        u32 reg;
 
-       if (freq_khz > ref * 108 / 2000 || freq_khz < ref * 54 / 16000) {
+       if (freq_khz > ref / 1000 * 108 / 2 || freq_khz < ref / 1000 * 54 / 8 / 2) {
                printf("Frequency %u.%03uMHz is out of range: %u.%03u..%u.%03u\n",
                        freq_khz / 1000, freq_khz % 1000,
-                       54 * ref / 16000000, 54 * ref / 16000 % 1000,
-                       108 * ref / 2000000, 108 * ref / 2000 % 1000);
+                       54 * ref / 1000000 / 8 / 2, 54 * ref / 1000 / 8 / 2 % 1000,
+                       108 * ref / 1000000 / 2, 108 * ref / 1000 / 2 % 1000);
                return -EINVAL;
        }
 
@@ -614,10 +614,10 @@ static int set_arm_clk(u32 ref, u32 freq_khz)
                u32 f;
                u32 err;
 
-               if (m > 108 || m < 54) {
+               if (m > 108) {
                        debug("%s@%d: d=%d m=%d\n", __func__, __LINE__,
                                d, m);
-                       continue;
+                       break;
                }
 
                f = ref * m / d / 2;