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.
*
* The tick frequency is directly programmed to the configured number of
* microseconds per tick.
*
*/
/*
* COPYRIGHT (c) 1989-2007.
* On-Line Applications Research Corporation (OAR).
*
@@ -17,9 +19,9 @@
* Modifications Copyright (c) 1999 Eric Valette valette@crf.canon.fr
*/
#include <rtems/system.h>
#include <rtems.h>
#include <rtems/libio.h>
#include <rtems/clockdrv.h>
#include <stdlib.h> /* for atexit() */
#include <assert.h>
#include <libcpu/c_clock.h>
@@ -39,25 +41,16 @@ extern int BSP_connect_clock_handler (void);
/*
* Clock ticks since initialization
*/
volatile uint32_t Clock_driver_ticks;
/*
* This is the value programmed into the count down timer.
*/
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)
{
rtems_interrupt_level l;
rtems_interrupt_level l;
if ( ppc_cpu_is_bookE() ) {
rtems_interrupt_disable(l);
@@ -73,7 +66,7 @@ rtems_interrupt_level l;
void clockOn(void* unused)
{
rtems_interrupt_level l;
rtems_interrupt_level l;
PPC_Set_decrementer( Clock_Decrementer_value );
@@ -94,7 +87,6 @@ rtems_interrupt_level l;
static void clockHandler(void)
{
#if (CLOCK_DRIVER_USE_FAST_IDLE == 1)
do {
rtems_clock_tick();
@@ -126,17 +118,20 @@ static void (*clock_handler)(void);
*/
void clockIsr(void *unused)
{
int decr;
int decr;
/*
* The driver has seen another tick.
*/
do {
register uint32_t flags;
rtems_interrupt_disable(flags);
__asm__ volatile (
"mfdec %0; add %0, %0, %1; mtdec %0"
: "=&r"(decr)
: "r"(Clock_Decrementer_value));
: "r"(Clock_Decrementer_value)
);
rtems_interrupt_enable(flags);
Clock_driver_ticks += 1;
@@ -178,12 +173,11 @@ void clockIsrBookE(void *unused)
* Real Time Clock counter/timer is set to automatically reload.
*/
clock_handler();
}
int clockIsOn(void* unused)
{
uint32_t msr_value;
uint32_t msr_value;
_CPU_MSR_GET( msr_value );
@@ -209,13 +203,12 @@ uint32_t msr_value;
* Return values: NONE
*
*/
void Clock_exit( void )
{
(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;
@@ -252,7 +245,7 @@ rtems_device_driver Clock_initialize(
void *pargp
)
{
rtems_interrupt_level l,tcr;
rtems_interrupt_level l,tcr;
Clock_Decrementer_value = (BSP_bus_frequency/BSP_time_base_divisor)*
(rtems_configuration_get_microseconds_per_tick()/1000);
@@ -285,22 +278,18 @@ rtems_interrupt_level l,tcr;
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;
* The next exception will then be taken by our clock handler.
* Clock handler installation initializes the decrementer to
* the correct value.
*/
clock_handler = clockHandler;
if (!BSP_connect_clock_handler ()) {
printk("Unable to initialize system clock\n");
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;
} /* Clock_initialize */