forked from Imagelibrary/rtems
82 lines
1.7 KiB
C
82 lines
1.7 KiB
C
/* RTEMS Clock Tick Driver for Blackfin. Uses Blackfin Core Timer.
|
|
*/
|
|
|
|
/*
|
|
* Copyright (c) 2008 Kallisti Labs, Los Gatos, CA, USA
|
|
* written by Allan Hessenflow <allanh@kallisti.com>
|
|
*
|
|
* The license and distribution terms for this file may be
|
|
* found in the file LICENSE in this distribution or at
|
|
* http://www.rtems.org/license/LICENSE.
|
|
*/
|
|
|
|
|
|
#include <rtems.h>
|
|
#include <stdlib.h>
|
|
#include <rtems/libio.h>
|
|
#include <rtems/score/percpu.h>
|
|
#include <bsp.h>
|
|
#include <rtems/clockdrv.h>
|
|
|
|
|
|
#include <libcpu/cecRegs.h>
|
|
#include <libcpu/coreTimerRegs.h>
|
|
|
|
#if (BFIN_ON_SKYEYE)
|
|
#define CLOCK_DRIVER_USE_FAST_IDLE 1
|
|
#endif
|
|
|
|
volatile uint32_t Clock_driver_ticks;
|
|
|
|
void Clock_exit(void);
|
|
|
|
static rtems_isr clockISR(rtems_vector_number vector) {
|
|
|
|
Clock_driver_ticks += 1;
|
|
|
|
#if CLOCK_DRIVER_USE_FAST_IDLE
|
|
do {
|
|
rtems_clock_tick();
|
|
} while ( _Thread_Heir == _Thread_Executing && _Thread_Executing->is_idle );
|
|
#else
|
|
rtems_clock_tick();
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* Clock_exit
|
|
*
|
|
* This routine allows the clock driver to exit by masking the interrupt and
|
|
* disabling the clock's counter.
|
|
*/
|
|
void Clock_exit(void)
|
|
{
|
|
*(uint32_t volatile *) TCNTL = 0;
|
|
}
|
|
|
|
/*
|
|
* Clock_initialize
|
|
*
|
|
* This routine initializes the clock driver.
|
|
*/
|
|
rtems_device_driver Clock_initialize(
|
|
rtems_device_major_number major,
|
|
rtems_device_minor_number minor,
|
|
void *pargp
|
|
)
|
|
{
|
|
Clock_driver_ticks = 0;
|
|
|
|
set_vector(clockISR, CEC_CORE_TIMER_VECTOR, 1);
|
|
|
|
*(uint32_t volatile *) TCNTL = TCNTL_TMPWR | TCNTL_TAUTORLD;
|
|
*(uint32_t volatile *) TSCALE = 0;
|
|
*(uint32_t volatile *) TPERIOD = CCLK / 1000000 *
|
|
rtems_configuration_get_microseconds_per_tick();
|
|
*(uint32_t volatile *) TCNTL = TCNTL_TMPWR | TCNTL_TAUTORLD | TCNTL_TMREN;
|
|
|
|
atexit(Clock_exit);
|
|
|
|
return RTEMS_SUCCESSFUL;
|
|
}
|