forked from Imagelibrary/rtems
libcpu/powerpc/mpc6xx/clock/c_clock.c: Fix warning and clean up
This commit is contained in:
@@ -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 */
|
||||||
|
|||||||
Reference in New Issue
Block a user