RedBoot Release TX53-v3 2012-02-08

[karo-tx-redboot.git] / packages / hal / arm / mx53 / var / v2_0 / src / cmds.c

diff --git a/packages/hal/arm/mx53/var/v2_0/src/cmds.c b/packages/hal/arm/mx53/var/v2_0/src/cmds.c
index 7ca808aece46813fdc6e534a0e6a9aff09152946..39cf6476914af5be2d6186afc55ee7993732fc96 100644 (file)
--- a/packages/hal/arm/mx53/var/v2_0/src/cmds.c
+++ b/packages/hal/arm/mx53/var/v2_0/src/cmds.c
@@ -324,10 +324,14 @@ int configure_clock(u32 ref, u32 core_clk, u32 emi_clk)
 
                if (core_clk > 800000000) {
                        div_core = 3;
-                       increase_core_voltage(true);
                } else {
                        div_core = 2;
-                       increase_core_voltage(false);
+               }
+               ret = adjust_core_voltage(core_clk / 1000000);
+               if (ret) {
+                       diag_printf("Failed to adjust core voltage for %u MHz\n",
+                                               core_clk / 1000000);
+                       return ret;
                }
                cyg_hal_plf_serial_stop();