diff options
Diffstat (limited to 'bsps/nios2/nios2_iss/clock/clock.c')
-rw-r--r-- | bsps/nios2/nios2_iss/clock/clock.c | 55 |
1 files changed, 55 insertions, 0 deletions
diff --git a/bsps/nios2/nios2_iss/clock/clock.c b/bsps/nios2/nios2_iss/clock/clock.c new file mode 100644 index 0000000000..0ec0a71c71 --- /dev/null +++ b/bsps/nios2/nios2_iss/clock/clock.c @@ -0,0 +1,55 @@ +/* + * Use SYS_CLK as system clock + * + * Copyright (c) 2005-2006 Kolja Waschk, rtemsdev/ixo.de + */ + +#include <rtems.h> +#include <bsp.h> + +#define CLOCK_REGS ((altera_avalon_timer_regs*)NIOS2_IO_BASE(CLOCK_BASE)) + +/* + * Periodic interval timer interrupt handler + */ +#define Clock_driver_support_at_tick() \ + do { CLOCK_REGS->status = 0; } while(0) + +/* + * Attach clock interrupt handler + */ +#define Clock_driver_support_install_isr(_new) \ + set_vector(_new, CLOCK_VECTOR, 1) + +/* + * Turn off the clock + */ +#define Clock_driver_support_shutdown_hardware() \ + do { \ + CLOCK_REGS->control = ALTERA_AVALON_TIMER_CONTROL_STOP_MSK; \ + } while (0) + +/* + * Set up the clock hardware + */ +static void Clock_driver_support_initialize_hardware(void) +{ + uint32_t period; + + CLOCK_REGS->control = ALTERA_AVALON_TIMER_CONTROL_STOP_MSK; + + period = (CLOCK_FREQ/1000000L)*rtems_configuration_get_microseconds_per_tick() - 1; + CLOCK_REGS->period_hi = period >> 16; + CLOCK_REGS->period_lo = period & 0xFFFF; + + CLOCK_REGS->control = ALTERA_AVALON_TIMER_CONTROL_ITO_MSK | + ALTERA_AVALON_TIMER_CONTROL_CONT_MSK | + ALTERA_AVALON_TIMER_CONTROL_START_MSK; + + NIOS2_IENABLE(1 << CLOCK_VECTOR); +} + +#define CLOCK_DRIVER_USE_DUMMY_TIMECOUNTER + +#include "../../../shared/dev/clock/clockimpl.h" + |