1 files changed, 9 insertions, 0 deletions

diff --git a/firmware/target/coldfire/mpio/hd200/system-hd200.c b/firmware/target/coldfire/mpio/hd200/system-hd200.c
index 27ff0a1966..814cc718d4 100644
--- a/firmware/target/coldfire/mpio/hd200/system-hd200.c
+++ b/firmware/target/coldfire/mpio/hd200/system-hd200.c
@@ -77,6 +77,9 @@ void cf_set_cpu_frequency(long frequency)
         IDECONFIG1 = (1<<28)|(1<<20)|(1<<18)|(1<<13)|(3<<10);
                     /* BUFEN2 enable on /CS2 | CS2Post 1 clock| CS2Pre 3 clocks*/
         IDECONFIG2 = (1<<18)|(1<<16)|(1<<8)|(1<<0); /* TA /CS2 enable + CS2wait */
+
+        and_l(~(0x07<<16), &ADCONFIG);
+        or_l(((1<<7)|(1<<2)|(1<<0))<<16, &ADCONFIG); /* adclk = busclk/32 */
         break;
 
     case CPUFREQ_NORMAL:
@@ -94,6 +97,9 @@ void cf_set_cpu_frequency(long frequency)
         cpu_frequency = CPUFREQ_NORMAL;
         IDECONFIG1 = (1<<28)|(1<<20)|(1<<18)|(1<<13)|(1<<10);
         IDECONFIG2 = (1<<18)|(1<<16);
+
+        and_l(~(0x07<<16), &ADCONFIG);
+        or_l(((1<<7)|(1<<1)|(1<<0))<<16, &ADCONFIG); /* adclk = busclk/8 */
         break;
 
     default:
@@ -109,6 +115,9 @@ void cf_set_cpu_frequency(long frequency)
         cpu_frequency = CPUFREQ_DEFAULT;
         IDECONFIG1 = (1<<28)|(1<<20)|(1<<18)|(1<<13)|(1<<10);
         IDECONFIG2 = (1<<18)|(1<<16);
+
+        and_l(~(0x07<<16), &ADCONFIG);
+        or_l(((1<<7)|(1<<0))<<16, &ADCONFIG); /* adclk = busclk/2 */
         break;
     }
 }