Add arch/nios2/lib/clock.c
PATCH 12/54 Add arch/nios2/lib/clock.c
From: Franck JULLIEN <[email protected]>
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
arch/nios2/lib/clock.c new file +57 -0
@@ -0,0 +1,57 @@ +/* +* (C) Copyright 2011 - Franck JULLIEN <[email protected]> +* +* 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); +
Signature · 7 lines
1.7.3.4 _______________________________________________ barebox mailing list [email protected] http://lists.infradead.org/mailman/listinfo/barebox