From 24b6d2f9a868e6f68aebb231f4177c84b4759319 Mon Sep 17 00:00:00 2001 From: Joel Sherrill Date: Wed, 5 Oct 2005 02:34:17 +0000 Subject: [PATCH] 2005-09-12 Thomas Doerfler PR 527/bsps PR 822/bsps * mpc8xx/clock/clock.c: Currently the MBX8xx BSP does not boot, because some logical errors are in the startup code. Additionally, the mpc8xx shared clock driver does not support the clocking scheme of some of the board variants, which are clocked from a 32768Hz (!) external crystal. --- c/src/lib/libcpu/powerpc/ChangeLog | 10 ++++++ c/src/lib/libcpu/powerpc/mpc8xx/clock/clock.c | 34 ++++++++++++++++--- 2 files changed, 39 insertions(+), 5 deletions(-) diff --git a/c/src/lib/libcpu/powerpc/ChangeLog b/c/src/lib/libcpu/powerpc/ChangeLog index 2655f889fb..d461593caf 100644 --- a/c/src/lib/libcpu/powerpc/ChangeLog +++ b/c/src/lib/libcpu/powerpc/ChangeLog @@ -1,3 +1,13 @@ +2005-09-12 Thomas Doerfler + + PR 527/bsps + PR 822/bsps + * mpc8xx/clock/clock.c: Currently the MBX8xx BSP does not boot, + because some logical errors are in the startup code. Additionally, + the mpc8xx shared clock driver does not support the clocking scheme + of some of the board variants, which are clocked from a + 32768Hz (!) external crystal. + 2005-08-12 Phil Torre PR 816/bsps diff --git a/c/src/lib/libcpu/powerpc/mpc8xx/clock/clock.c b/c/src/lib/libcpu/powerpc/mpc8xx/clock/clock.c index 37dbc80f2c..61ae4e3ed8 100644 --- a/c/src/lib/libcpu/powerpc/mpc8xx/clock/clock.c +++ b/c/src/lib/libcpu/powerpc/mpc8xx/clock/clock.c @@ -71,15 +71,39 @@ void clockOn(void* unused) { unsigned desiredLevel; rtems_unsigned32 pit_value; + rtems_unsigned32 mf_value; + rtems_unsigned32 extclk_value; - pit_value = (rtems_configuration_get_microseconds_per_tick() * - rtems_cpu_configuration_get_clicks_per_usec()) - 1 ; + if (rtems_cpu_configuration_get_clicks_per_usec() == 0) { + /* + * oscclk is too low for PIT, compute extclk and derive PIT from there + */ + mf_value = m8xx.plprcr >> 20; + pit_value = (_CPU_Table.clock_speed + / (mf_value+1) + / 4 + * rtems_configuration_get_microseconds_per_tick() + / 1000000); + m8xx.sccr |= (1<<24); + } + else { + pit_value = (rtems_configuration_get_microseconds_per_tick() * + rtems_cpu_configuration_get_clicks_per_usec()); - if (pit_value > 0xffff) { /* pit is only 16 bits long */ + m8xx.sccr &= ~(1<<24); + } + if (pit_value > (0xffff+1)) { + /* + * try to activate prescaler + * NOTE: divider generates odd values now... + */ + pit_value = pit_value / 128; + m8xx.sccr |= (1<<25); + } + if (pit_value > (0xffff+1)) { /* pit is only 16 bits long */ rtems_fatal_error_occurred(-1); } - m8xx.sccr &= ~(1<<24); - m8xx.pitc = pit_value; + m8xx.pitc = pit_value - 1; desiredLevel = BSP_get_clock_irq_level(); /* set PIT irq level, enable PIT, PIT interrupts */