libcpu/powerpc/mpc6xx/clock/c_clock.c: Fix warning and clean up

This commit is contained in:
Joel Sherrill
2014-10-07 10:02:29 -05:00
parent 9073f554f8
commit 4e8de7e72a

View File

@@ -1,11 +1,13 @@
/* /**
* Clock Tick Device Driver * @brief Clock Tick Device Driver
* *
* This routine utilizes the Decrementer Register common to the PPC family. * This routine utilizes the Decrementer Register common to the PPC family.
* *
* The tick frequency is directly programmed to the configured number of * The tick frequency is directly programmed to the configured number of
* microseconds per tick. * microseconds per tick.
* */
/*
* COPYRIGHT (c) 1989-2007. * COPYRIGHT (c) 1989-2007.
* On-Line Applications Research Corporation (OAR). * On-Line Applications Research Corporation (OAR).
* *
@@ -17,9 +19,9 @@
* Modifications Copyright (c) 1999 Eric Valette valette@crf.canon.fr * Modifications Copyright (c) 1999 Eric Valette valette@crf.canon.fr
*/ */
#include <rtems/system.h>
#include <rtems.h> #include <rtems.h>
#include <rtems/libio.h> #include <rtems/libio.h>
#include <rtems/clockdrv.h>
#include <stdlib.h> /* for atexit() */ #include <stdlib.h> /* for atexit() */
#include <assert.h> #include <assert.h>
#include <libcpu/c_clock.h> #include <libcpu/c_clock.h>
@@ -39,22 +41,13 @@ extern int BSP_connect_clock_handler (void);
/* /*
* Clock ticks since initialization * Clock ticks since initialization
*/ */
volatile uint32_t Clock_driver_ticks; volatile uint32_t Clock_driver_ticks;
/* /*
* This is the value programmed into the count down timer. * This is the value programmed into the count down timer.
*/ */
uint32_t Clock_Decrementer_value; uint32_t Clock_Decrementer_value;
/*
* These are set by clock driver during its init
*/
rtems_device_major_number rtems_clock_major = ~0;
rtems_device_minor_number rtems_clock_minor;
void clockOff(void* unused) void clockOff(void* unused)
{ {
rtems_interrupt_level l; rtems_interrupt_level l;
@@ -94,7 +87,6 @@ rtems_interrupt_level l;
static void clockHandler(void) static void clockHandler(void)
{ {
#if (CLOCK_DRIVER_USE_FAST_IDLE == 1) #if (CLOCK_DRIVER_USE_FAST_IDLE == 1)
do { do {
rtems_clock_tick(); rtems_clock_tick();
@@ -127,16 +119,19 @@ static void (*clock_handler)(void);
void clockIsr(void *unused) void clockIsr(void *unused)
{ {
int decr; int decr;
/* /*
* The driver has seen another tick. * The driver has seen another tick.
*/ */
do { do {
register uint32_t flags; register uint32_t flags;
rtems_interrupt_disable(flags); rtems_interrupt_disable(flags);
__asm__ volatile ( __asm__ volatile (
"mfdec %0; add %0, %0, %1; mtdec %0" "mfdec %0; add %0, %0, %1; mtdec %0"
: "=&r"(decr) : "=&r"(decr)
: "r"(Clock_Decrementer_value)); : "r"(Clock_Decrementer_value)
);
rtems_interrupt_enable(flags); rtems_interrupt_enable(flags);
Clock_driver_ticks += 1; Clock_driver_ticks += 1;
@@ -178,7 +173,6 @@ void clockIsrBookE(void *unused)
* Real Time Clock counter/timer is set to automatically reload. * Real Time Clock counter/timer is set to automatically reload.
*/ */
clock_handler(); clock_handler();
} }
int clockIsOn(void* unused) int clockIsOn(void* unused)
@@ -209,13 +203,12 @@ uint32_t msr_value;
* Return values: NONE * Return values: NONE
* *
*/ */
void Clock_exit( void ) void Clock_exit( void )
{ {
(void) BSP_disconnect_clock_handler (); (void) BSP_disconnect_clock_handler ();
} }
uint32_t Clock_driver_nanoseconds_since_last_tick(void) static uint32_t Clock_driver_nanoseconds_since_last_tick(void)
{ {
uint32_t clicks, tmp; uint32_t clicks, tmp;
@@ -285,22 +278,18 @@ rtems_interrupt_level l,tcr;
Clock_driver_nanoseconds_since_last_tick Clock_driver_nanoseconds_since_last_tick
); );
/* if a decrementer exception was pending, it is cleared by /*
* If a decrementer exception was pending, it is cleared by
* executing the default (nop) handler at this point; * executing the default (nop) handler at this point;
* The next exception will then be taken by our clock handler. * The next exception will then be taken by our clock handler.
* Clock handler installation initializes the decrementer to * Clock handler installation initializes the decrementer to
* the correct value. * the correct value.
*/ */
clock_handler = clockHandler; clock_handler = clockHandler;
if (!BSP_connect_clock_handler ()) { if (!BSP_connect_clock_handler ()) {
printk("Unable to initialize system clock\n"); printk("Unable to initialize system clock\n");
rtems_fatal_error_occurred(1); rtems_fatal_error_occurred(1);
} }
/* make major/minor avail to others such as shared memory driver */
rtems_clock_major = major;
rtems_clock_minor = minor;
return RTEMS_SUCCESSFUL; return RTEMS_SUCCESSFUL;
} /* Clock_initialize */ } /* Clock_initialize */