forked from Imagelibrary/rtems
libcpu/powerpc/mpc8xx/clock: Fix warnings and clean up
This commit is contained in:
@@ -1,6 +1,9 @@
|
|||||||
|
/**
|
||||||
|
* @file
|
||||||
|
* @brief mbx8xx Clock Tick connection code.
|
||||||
|
*/
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Clock Tick interrupt conexion code.
|
|
||||||
*
|
|
||||||
* COPYRIGHT (c) 1989-1997.
|
* COPYRIGHT (c) 1989-1997.
|
||||||
* On-Line Applications Research Corporation (OAR).
|
* On-Line Applications Research Corporation (OAR).
|
||||||
*
|
*
|
||||||
@@ -21,23 +24,32 @@ extern void clockOff (void*);
|
|||||||
extern int clockIsOn(void*);
|
extern int clockIsOn(void*);
|
||||||
extern void Clock_isr(void*);
|
extern void Clock_isr(void*);
|
||||||
|
|
||||||
static rtems_irq_connect_data clockIrqData = {BSP_PERIODIC_TIMER,
|
static rtems_irq_connect_data clockIrqData = {
|
||||||
|
BSP_PERIODIC_TIMER,
|
||||||
(rtems_irq_hdl)Clock_isr,
|
(rtems_irq_hdl)Clock_isr,
|
||||||
0,
|
0,
|
||||||
(rtems_irq_enable)clockOn,
|
(rtems_irq_enable)clockOn,
|
||||||
(rtems_irq_disable)clockOff,
|
(rtems_irq_disable)clockOff,
|
||||||
(rtems_irq_is_enabled)clockIsOn};
|
(rtems_irq_is_enabled)clockIsOn
|
||||||
|
};
|
||||||
|
|
||||||
|
/*
|
||||||
|
* Prototypes
|
||||||
|
*/
|
||||||
|
int BSP_get_clock_irq_level(void);
|
||||||
|
int BSP_connect_clock_handler(rtems_irq_hdl hdl);
|
||||||
|
int BSP_disconnect_clock_handler(void);
|
||||||
|
|
||||||
int BSP_get_clock_irq_level(void)
|
int BSP_get_clock_irq_level(void)
|
||||||
{
|
{
|
||||||
/*
|
/*
|
||||||
* Caution : if you change this, you must change the
|
* Caution: if you change this, you must change the
|
||||||
* definition of BSP_PERIODIC_TIMER accordingly
|
* definition of BSP_PERIODIC_TIMER accordingly
|
||||||
*/
|
*/
|
||||||
return 6;
|
return 6;
|
||||||
}
|
}
|
||||||
|
|
||||||
int BSP_disconnect_clock_handler (void)
|
int BSP_disconnect_clock_handler(void)
|
||||||
{
|
{
|
||||||
if (!BSP_get_current_rtems_irq_handler(&clockIrqData)) {
|
if (!BSP_get_current_rtems_irq_handler(&clockIrqData)) {
|
||||||
printk("Unable to stop system clock\n");
|
printk("Unable to stop system clock\n");
|
||||||
@@ -46,16 +58,18 @@ int BSP_disconnect_clock_handler (void)
|
|||||||
return BSP_remove_rtems_irq_handler (&clockIrqData);
|
return BSP_remove_rtems_irq_handler (&clockIrqData);
|
||||||
}
|
}
|
||||||
|
|
||||||
int BSP_connect_clock_handler (rtems_irq_hdl hdl)
|
int BSP_connect_clock_handler(rtems_irq_hdl hdl)
|
||||||
{
|
{
|
||||||
if (!BSP_get_current_rtems_irq_handler(&clockIrqData)) {
|
if (!BSP_get_current_rtems_irq_handler(&clockIrqData)) {
|
||||||
printk("Unable to get system clock handler\n");
|
printk("Unable to get system clock handler\n");
|
||||||
rtems_fatal_error_occurred(1);
|
rtems_fatal_error_occurred(1);
|
||||||
}
|
}
|
||||||
if (!BSP_remove_rtems_irq_handler (&clockIrqData)) {
|
|
||||||
|
if (!BSP_remove_rtems_irq_handler(&clockIrqData)) {
|
||||||
printk("Unable to remove current system clock handler\n");
|
printk("Unable to remove current system clock handler\n");
|
||||||
rtems_fatal_error_occurred(1);
|
rtems_fatal_error_occurred(1);
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Reinit structure
|
* Reinit structure
|
||||||
*/
|
*/
|
||||||
|
|||||||
@@ -2,7 +2,9 @@
|
|||||||
*
|
*
|
||||||
* This routine initializes the PIT on the MPC8xx.
|
* This routine initializes the PIT on the MPC8xx.
|
||||||
* The tick frequency is specified by the bsp.
|
* The tick frequency is specified by the bsp.
|
||||||
*
|
*/
|
||||||
|
|
||||||
|
/*
|
||||||
* Author: Jay Monkman (jmonkman@frasca.com)
|
* Author: Jay Monkman (jmonkman@frasca.com)
|
||||||
* Copyright (C) 1998 by Frasca International, Inc.
|
* Copyright (C) 1998 by Frasca International, Inc.
|
||||||
*
|
*
|
||||||
@@ -49,14 +51,16 @@ extern int BSP_disconnect_clock_handler(void);
|
|||||||
extern uint32_t bsp_clicks_per_usec;
|
extern uint32_t bsp_clicks_per_usec;
|
||||||
extern uint32_t bsp_clock_speed;
|
extern uint32_t bsp_clock_speed;
|
||||||
|
|
||||||
void Clock_exit( void );
|
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* These are set by clock driver during its init
|
* Prototypes
|
||||||
*/
|
*/
|
||||||
|
rtems_isr Clock_isr(rtems_vector_number vector);
|
||||||
rtems_device_major_number rtems_clock_major = ~0;
|
void Clock_exit( void );
|
||||||
rtems_device_minor_number rtems_clock_minor;
|
void clockOn(void* unused);
|
||||||
|
void clockOff(void* unused);
|
||||||
|
int clockIsOn(void* unused);
|
||||||
|
void Install_clock(rtems_isr_entry clock_isr);
|
||||||
|
void ReInstall_clock(rtems_isr_entry new_clock_isr);
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* ISR Handler
|
* ISR Handler
|
||||||
@@ -129,7 +133,8 @@ void clockOn(void* unused)
|
|||||||
|
|
||||||
m8xx.sccr &= ~(1<<23);
|
m8xx.sccr &= ~(1<<23);
|
||||||
}
|
}
|
||||||
if ((pit_value > 0xffff) || force_prescaler){
|
|
||||||
|
if ((pit_value > 0xffff) || force_prescaler) {
|
||||||
/*
|
/*
|
||||||
* try to activate prescaler
|
* try to activate prescaler
|
||||||
* NOTE: divider generates odd values now...
|
* NOTE: divider generates odd values now...
|
||||||
@@ -152,12 +157,12 @@ if ((pit_value > 0xffff) || force_prescaler){
|
|||||||
m8xx.piscr = M8xx_PISCR_PIRQ(desiredLevel) |
|
m8xx.piscr = M8xx_PISCR_PIRQ(desiredLevel) |
|
||||||
M8xx_PISCR_PTE | M8xx_PISCR_PS | M8xx_PISCR_PIE;
|
M8xx_PISCR_PTE | M8xx_PISCR_PS | M8xx_PISCR_PIE;
|
||||||
}
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Called via atexit()
|
* Called via atexit()
|
||||||
* Remove the clock interrupt handler by setting handler to NULL
|
* Remove the clock interrupt handler by setting handler to NULL
|
||||||
*/
|
*/
|
||||||
void
|
void clockOff(void* unused)
|
||||||
clockOff(void* unused)
|
|
||||||
{
|
{
|
||||||
/* disable PIT and PIT interrupts */
|
/* disable PIT and PIT interrupts */
|
||||||
m8xx.piscr &= ~(M8xx_PISCR_PTE | M8xx_PISCR_PIE);
|
m8xx.piscr &= ~(M8xx_PISCR_PTE | M8xx_PISCR_PIE);
|
||||||
@@ -165,7 +170,8 @@ clockOff(void* unused)
|
|||||||
|
|
||||||
int clockIsOn(void* unused)
|
int clockIsOn(void* unused)
|
||||||
{
|
{
|
||||||
if (m8xx.piscr & M8xx_PISCR_PIE) return 1;
|
if (m8xx.piscr & M8xx_PISCR_PIE)
|
||||||
|
return 1;
|
||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -173,8 +179,7 @@ int clockIsOn(void* unused)
|
|||||||
* Called via atexit()
|
* Called via atexit()
|
||||||
* Remove the clock interrupt handler by setting handler to NULL
|
* Remove the clock interrupt handler by setting handler to NULL
|
||||||
*/
|
*/
|
||||||
void
|
void Clock_exit(void)
|
||||||
Clock_exit(void)
|
|
||||||
{
|
{
|
||||||
(void) BSP_disconnect_clock_handler ();
|
(void) BSP_disconnect_clock_handler ();
|
||||||
}
|
}
|
||||||
@@ -187,13 +192,11 @@ void Install_clock(rtems_isr_entry clock_isr)
|
|||||||
atexit(Clock_exit);
|
atexit(Clock_exit);
|
||||||
}
|
}
|
||||||
|
|
||||||
void
|
void ReInstall_clock(rtems_isr_entry new_clock_isr)
|
||||||
ReInstall_clock(rtems_isr_entry new_clock_isr)
|
|
||||||
{
|
{
|
||||||
BSP_connect_clock_handler (new_clock_isr);
|
BSP_connect_clock_handler (new_clock_isr);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
rtems_device_driver Clock_initialize(
|
rtems_device_driver Clock_initialize(
|
||||||
rtems_device_major_number major,
|
rtems_device_major_number major,
|
||||||
rtems_device_minor_number minor,
|
rtems_device_minor_number minor,
|
||||||
@@ -202,12 +205,5 @@ rtems_device_driver Clock_initialize(
|
|||||||
{
|
{
|
||||||
Install_clock( Clock_isr );
|
Install_clock( Clock_isr );
|
||||||
|
|
||||||
/*
|
|
||||||
* 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;
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user