From: Franck JULLIEN <franck.jullien@xxxxxxxxx> Add arch/nios2/lib/clock.c --- arch/nios2/lib/clock.c | 57 ++++++++++++++++++++++++++++++++++++++++++++++++ 1 files changed, 57 insertions(+), 0 deletions(-) create mode 100644 arch/nios2/lib/clock.c diff --git a/arch/nios2/lib/clock.c b/arch/nios2/lib/clock.c new file mode 100644 index 0000000..dd08be7 --- /dev/null +++ b/arch/nios2/lib/clock.c @@ -0,0 +1,57 @@ +/* + * (C) Copyright 2011 - Franck JULLIEN <elec4fun@xxxxxxxxx> + * + * See file CREDITS for list of people who contributed to this + * project. + * + * This program is free software; you can redistribute it and/or + * modify it under the terms of the GNU General Public License as + * published by the Free Software Foundation; either version 2 of + * the License, or (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 59 Temple Place, Suite 330, Boston, + * MA 02111-1307 USA + */ + +#include <common.h> +#include <clock.h> +#include <init.h> +#include <asm/nios2-io.h> + +static nios_timer_t *timer = (nios_timer_t *) NIOS_SOPC_TIMER_BASE; + +static uint64_t nios_clocksource_read(void) +{ + timer->snapl = 0x55; /* Dummy value*/ + return (uint64_t)(~((((uint64_t)timer->snaph) << (uint64_t)16) + (uint64_t)timer->snapl)); +} + +static struct clocksource cs = { + .read = nios_clocksource_read, + .mask = CLOCKSOURCE_MASK(32), + .shift = 12, +}; + +static int clocksource_init (void) +{ + timer->control = 0; + timer->periodl = 0xFFFF; + timer->periodh = 0xFFFF; + timer->control = NIOS_TIMER_CONT | NIOS_TIMER_START; + + cs.mult = clocksource_hz2mult(NIOS_SOPC_TIMER_FREQ, cs.shift); + + init_clock(&cs); + + return 0; +} + +core_initcall(clocksource_init); + -- 1.7.3.4 _______________________________________________ barebox mailing list barebox@xxxxxxxxxxxxxxxxxxx http://lists.infradead.org/mailman/listinfo/barebox