2008-07-16 Joel Sherrill <joel.sherrill@oarcorp.com>

* mpc6xx/clock/c_clock.c: Add fast idle.
This commit is contained in:
Joel Sherrill
2008-07-16 20:22:20 +00:00
parent 10f095c83f
commit 9c325fb254
2 changed files with 35 additions and 17 deletions

View File

@@ -1,3 +1,7 @@
2008-07-16 Joel Sherrill <joel.sherrill@oarcorp.com>
* mpc6xx/clock/c_clock.c: Add fast idle.
2008-07-14 Sebastian Huber <sebastian.huber@embedded-brains.de> 2008-07-14 Sebastian Huber <sebastian.huber@embedded-brains.de>
* configure.ac: Support for MPC55XX. Changed comment format to * configure.ac: Support for MPC55XX. Changed comment format to

View File

@@ -29,6 +29,8 @@
#include <libcpu/spr.h> #include <libcpu/spr.h>
#include <rtems/bspIo.h> /* for printk() */ #include <rtems/bspIo.h> /* for printk() */
#include <bspopts.h> /* for CLOCK_DRIVER_USE_FAST_IDLE */
SPR_RW(BOOKE_TCR) SPR_RW(BOOKE_TCR)
SPR_RW(BOOKE_TSR) SPR_RW(BOOKE_TSR)
SPR_RW(BOOKE_DECAR) SPR_RW(BOOKE_DECAR)
@@ -94,7 +96,16 @@ rtems_interrupt_level l;
static void clockHandler(void) static void clockHandler(void)
{ {
#if defined(CLOCK_DRIVER_USE_FAST_IDLE)
do {
rtems_clock_tick(); rtems_clock_tick();
} while ( _Thread_Executing == _Thread_Idle &&
_Thread_Heir == _Thread_Executing);
#else
rtems_clock_tick();
#endif
} }
static void (*clock_handler)(void); static void (*clock_handler)(void);
@@ -121,7 +132,10 @@ int decr;
do { do {
register uint32_t flags; register uint32_t flags;
rtems_interrupt_disable(flags); rtems_interrupt_disable(flags);
asm volatile ("mfdec %0; add %0, %0, %1; mtdec %0":"=&r"(decr):"r"(Clock_Decrementer_value)); asm volatile (
"mfdec %0; add %0, %0, %1; mtdec %0"
: "=&r"(decr)
: "r"(Clock_Decrementer_value));
rtems_interrupt_enable(flags); rtems_interrupt_enable(flags);
Clock_driver_ticks += 1; Clock_driver_ticks += 1;