arm: mx53: karo: select core voltage according to frequency range rather than single...

[karo-tx-redboot.git] / packages / hal / arm / mx53 / karo / v1_0 / src / tx53_misc.c

diff --git a/packages/hal/arm/mx53/karo/v1_0/src/tx53_misc.c b/packages/hal/arm/mx53/karo/v1_0/src/tx53_misc.c
index c3e537f72c456d8aafd5e0a02b2f2aff8eec7172..7b88f2c9e232334e8cb6b0cd67482112b4bde424 100644 (file)
--- a/packages/hal/arm/mx53/karo/v1_0/src/tx53_misc.c
+++ b/packages/hal/arm/mx53/karo/v1_0/src/tx53_misc.c
@@ -733,26 +733,16 @@ int adjust_core_voltage(unsigned int clock)
        int volt;
        int retries = 0;
 
-       switch (clock) {
-       case 1200:
-               volt = CORE_VOLTAGE_1200;
-               break;
-
-       case 1000:
-               volt = CORE_VOLTAGE_1000;
-               break;
-
-       case 800:
-               volt = CORE_VOLTAGE_800;
-               break;
-
-       default:
-               if (clock > 1200) {
-                       diag_printf("No core voltage assigned for %u MHz core clock\n",
-                                               clock);
-                       return -EINVAL;
-               }
+       if (clock <= 800) {
                volt = CORE_VOLTAGE_800;
+       } else if (clock <= 1000) {
+               volt = CORE_VOLTAGE_1000;
+       } else if (clock <= 1200) {
+               volt = CORE_VOLTAGE_1200;
+       } else {
+               diag_printf("No core voltage assigned for %u MHz core clock\n",
+                       clock);
+               return -EINVAL;
        }
 
        ret = pmic_reg_read(0x23);