Imagelibrary/rtems
1
0
Fork 1
mirror of https://gitlab.rtems.org/rtems/rtos/rtems.git synced 2025-12-10 01:23:22 +00:00
Code Issues Packages Projects Releases Wiki Activity

2006-05-31 Joel Sherrill <joel@OARcorp.com>

Browse Source 
* clock/clock.c: Switch to using shared clock driver shell.
This commit is contained in:
Joel Sherrill
2006-05-31 13:43:16 +00:00
parent 261e743d66
commit 2ba4b723d0
2 changed files with 11 additions and 172 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
c/src/lib/libbsp/c4x/c4xsim/ChangeLog
View File

@@ -1,3 +1,7 @@
2006-05-31 Joel Sherrill <joel@OARcorp.com>
* clock/clock.c: Switch to using shared clock driver shell.
2006-01-11 Ralf Corsepius <ralf.corsepius@rtems.org> 2006-01-11 Ralf Corsepius <ralf.corsepius@rtems.org>
* Makefile.am: Add preinstall.am. * Makefile.am: Add preinstall.am.

179
c/src/lib/libbsp/c4x/c4xsim/clock/clock.c
View File

@@ -19,106 +19,20 @@
#include <bsp.h> #include <bsp.h>
#include <rtems/c4x/c4xio.h> #include <rtems/c4x/c4xio.h>
void Clock_exit( void );
rtems_isr Clock_isr( rtems_vector_number vector );
uint32_t Clock_counter_register_value;
/*
* The interrupt vector number associated with the clock tick device
* driver.
*/
#define CLOCK_VECTOR 9 #define CLOCK_VECTOR 9
/* #define Clock_driver_support_at_tick()
* Clock_driver_ticks is a monotonically increasing counter of the
* number of clock ticks since the driver was initialized.
*/
volatile uint32_t Clock_driver_ticks; #define Clock_driver_support_install_isr( _new, _old ) \
do { _old = 0; } while(0)
/* void Clock_driver_support_initialize_hardware()
* These are set by clock driver during its init
*/
rtems_device_major_number rtems_clock_major = ~0;
rtems_device_minor_number rtems_clock_minor;
/*
* The previous ISR on this clock tick interrupt vector.
*/
rtems_isr_entry Old_ticker;
void Clock_exit( void );
/*
* Isr Handler
*/
#define FAST_IDLE 1
#if FAST_IDLE
int Clock_in_fast_idle_mode = 0;
#endif
rtems_isr Clock_isr(
rtems_vector_number vector
)
{
/*
* The counter register gets reset automatically as well as the
* interrupt occurred flag so we should not have to do anything
* with the hardware.
*/
/*
* Bump the number of clock driver ticks since initialization
*/
Clock_driver_ticks += 1;
rtems_clock_tick();
#if FAST_IDLE
if ( Clock_in_fast_idle_mode ) {
if ( _Thread_Executing == _Thread_Idle && _Thread_Heir != _Thread_Idle ) {
c4x_timer_stop( C4X_TIMER_0 );
c4x_timer_set_counter( C4X_TIMER_0, 0 );
c4x_timer_set_period( C4X_TIMER_0, Clock_counter_register_value );
c4x_timer_start( C4X_TIMER_0 );
Clock_in_fast_idle_mode = 0;
}
} else {
if ( _Thread_Executing == _Thread_Idle && _Thread_Heir == _Thread_Idle ) {
c4x_timer_stop( C4X_TIMER_0 );
c4x_timer_set_counter( C4X_TIMER_0, 0 );
c4x_timer_set_period( C4X_TIMER_0, Clock_counter_register_value >> 5 );
c4x_timer_start( C4X_TIMER_0 );
}
}
#endif
}
/*
* Install_clock
*
* Install a clock tick handler and reprograms the chip. This
* is used to initially establish the clock tick.
*/
void Install_clock(
rtems_isr_entry clock_isr
)
{ {
extern int _ClockFrequency; extern int _ClockFrequency;
uint32_t Clock_counter_register_value;
float tmp; float tmp;
int tmpi; int tmpi;
/*
* Initialize the clock tick device driver variables
*/
Clock_driver_ticks = 0;
tmpi = ((int) &_ClockFrequency) * 1000000; /* ClockFrequency is in Mhz */ tmpi = ((int) &_ClockFrequency) * 1000000; /* ClockFrequency is in Mhz */
tmp = (float) tmpi / 2.0; tmp = (float) tmpi / 2.0;
@@ -141,88 +55,9 @@ void Install_clock(
c3x_set_ie( c3x_get_ie() | 0x100 ); c3x_set_ie( c3x_get_ie() | 0x100 );
#endif #endif
/*
* If ticks_per_timeslice is configured as non-zero, then the user
* wants a clock tick.
*/
Old_ticker = (rtems_isr_entry) set_vector( clock_isr, CLOCK_VECTOR, 1 ); Old_ticker = (rtems_isr_entry) set_vector( clock_isr, CLOCK_VECTOR, 1 );
/*
* Hardware specific initialize goes here
*/
/* XXX */
/*
* Schedule the clock cleanup routine to execute if the application exits.
*/
atexit( Clock_exit );
} }
/* #define Clock_driver_support_shutdown_hardware()
* Clean up before the application exits
*/
void Clock_exit( void ) #include "../../../shared/clockdrv_shell.c"
{
/* XXX: turn off the timer interrupts */
/* XXX: If necessary, restore the old vector */
}
/*
* Clock_initialize
*
* Device driver entry point for clock tick driver initialization.
*/
rtems_device_driver Clock_initialize(
rtems_device_major_number major,
rtems_device_minor_number minor,
void *pargp
)
{
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;
}
rtems_device_driver Clock_control(
rtems_device_major_number major,
rtems_device_minor_number minor,
void *pargp
)
{
uint32_t isrlevel;
rtems_libio_ioctl_args_t *args = pargp;
if (args == 0)
goto done;
/*
* This is hokey, but until we get a defined interface
* to do this, it will just be this simple...
*/
if (args->command == rtems_build_name('I', 'S', 'R', ' '))
{
Clock_isr(CLOCK_VECTOR);
}
else if (args->command == rtems_build_name('N', 'E', 'W', ' '))
{
rtems_interrupt_disable( isrlevel );
(void) set_vector( args->buffer, CLOCK_VECTOR, 1 );
rtems_interrupt_enable( isrlevel );
}
done:
return RTEMS_SUCCESSFUL;
}