120 lines
		
	
	
		
			3.1 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			120 lines
		
	
	
		
			3.1 KiB
		
	
	
	
		
			C
		
	
	
	
// SPDX-License-Identifier: GPL-2.0+
 | 
						|
/*
 | 
						|
 * ARM Cortex M3/M4/M7 SysTick timer driver
 | 
						|
 * (C) Copyright 2017 Renesas Electronics Europe Ltd
 | 
						|
 *
 | 
						|
 * Based on arch/arm/mach-stm32/stm32f1/timer.c
 | 
						|
 * (C) Copyright 2015
 | 
						|
 * Kamil Lulko, <kamil.lulko@gmail.com>
 | 
						|
 *
 | 
						|
 * Copyright 2015 ATS Advanced Telematics Systems GmbH
 | 
						|
 * Copyright 2015 Konsulko Group, Matt Porter <mporter@konsulko.com>
 | 
						|
 *
 | 
						|
 * The SysTick timer is a 24-bit count down timer. The clock can be either the
 | 
						|
 * CPU clock or a reference clock. Since the timer will wrap around very quickly
 | 
						|
 * when using the CPU clock, and we do not handle the timer interrupts, it is
 | 
						|
 * expected that this driver is only ever used with a slow reference clock.
 | 
						|
 *
 | 
						|
 * The number of reference clock ticks that correspond to 10ms is normally
 | 
						|
 * defined in the SysTick Calibration register's TENMS field. However, on some
 | 
						|
 * devices this is wrong, so this driver allows the clock rate to be defined
 | 
						|
 * using CONFIG_SYS_HZ_CLOCK.
 | 
						|
 */
 | 
						|
 | 
						|
#include <common.h>
 | 
						|
#include <init.h>
 | 
						|
#include <time.h>
 | 
						|
#include <asm/global_data.h>
 | 
						|
#include <asm/io.h>
 | 
						|
#include <linux/bitops.h>
 | 
						|
 | 
						|
DECLARE_GLOBAL_DATA_PTR;
 | 
						|
 | 
						|
/* SysTick Base Address - fixed for all Cortex M3, M4 and M7 devices */
 | 
						|
#define SYSTICK_BASE		0xE000E010
 | 
						|
 | 
						|
struct cm3_systick {
 | 
						|
	uint32_t ctrl;
 | 
						|
	uint32_t reload_val;
 | 
						|
	uint32_t current_val;
 | 
						|
	uint32_t calibration;
 | 
						|
};
 | 
						|
 | 
						|
#define TIMER_MAX_VAL		0x00FFFFFF
 | 
						|
#define SYSTICK_CTRL_EN		BIT(0)
 | 
						|
/* Clock source: 0 = Ref clock, 1 = CPU clock */
 | 
						|
#define SYSTICK_CTRL_CPU_CLK	BIT(2)
 | 
						|
#define SYSTICK_CAL_NOREF	BIT(31)
 | 
						|
#define SYSTICK_CAL_SKEW	BIT(30)
 | 
						|
#define SYSTICK_CAL_TENMS_MASK	0x00FFFFFF
 | 
						|
 | 
						|
/* read the 24-bit timer */
 | 
						|
static ulong read_timer(void)
 | 
						|
{
 | 
						|
	struct cm3_systick *systick = (struct cm3_systick *)SYSTICK_BASE;
 | 
						|
 | 
						|
	/* The timer counts down, therefore convert to an incrementing timer */
 | 
						|
	return TIMER_MAX_VAL - readl(&systick->current_val);
 | 
						|
}
 | 
						|
 | 
						|
int timer_init(void)
 | 
						|
{
 | 
						|
	struct cm3_systick *systick = (struct cm3_systick *)SYSTICK_BASE;
 | 
						|
	u32 cal;
 | 
						|
 | 
						|
	writel(TIMER_MAX_VAL, &systick->reload_val);
 | 
						|
	/* Any write to current_val reg clears it to 0 */
 | 
						|
	writel(0, &systick->current_val);
 | 
						|
 | 
						|
	cal = readl(&systick->calibration);
 | 
						|
	if (cal & SYSTICK_CAL_NOREF)
 | 
						|
		/* Use CPU clock, no interrupts */
 | 
						|
		writel(SYSTICK_CTRL_EN | SYSTICK_CTRL_CPU_CLK, &systick->ctrl);
 | 
						|
	else
 | 
						|
		/* Use external clock, no interrupts */
 | 
						|
		writel(SYSTICK_CTRL_EN, &systick->ctrl);
 | 
						|
 | 
						|
	/*
 | 
						|
	 * If the TENMS field is inexact or wrong, specify the clock rate using
 | 
						|
	 * CONFIG_SYS_HZ_CLOCK.
 | 
						|
	 */
 | 
						|
#if defined(CONFIG_SYS_HZ_CLOCK)
 | 
						|
	gd->arch.timer_rate_hz = CONFIG_SYS_HZ_CLOCK;
 | 
						|
#else
 | 
						|
	gd->arch.timer_rate_hz = (cal & SYSTICK_CAL_TENMS_MASK) * 100;
 | 
						|
#endif
 | 
						|
 | 
						|
	gd->arch.tbl = 0;
 | 
						|
	gd->arch.tbu = 0;
 | 
						|
	gd->arch.lastinc = read_timer();
 | 
						|
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
/* return milli-seconds timer value */
 | 
						|
ulong get_timer(ulong base)
 | 
						|
{
 | 
						|
	unsigned long long t = get_ticks() * 1000;
 | 
						|
 | 
						|
	return (ulong)((t / gd->arch.timer_rate_hz)) - base;
 | 
						|
}
 | 
						|
 | 
						|
unsigned long long get_ticks(void)
 | 
						|
{
 | 
						|
	u32 now = read_timer();
 | 
						|
 | 
						|
	if (now >= gd->arch.lastinc)
 | 
						|
		gd->arch.tbl += (now - gd->arch.lastinc);
 | 
						|
	else
 | 
						|
		gd->arch.tbl += (TIMER_MAX_VAL - gd->arch.lastinc) + now;
 | 
						|
 | 
						|
	gd->arch.lastinc = now;
 | 
						|
 | 
						|
	return gd->arch.tbl;
 | 
						|
}
 | 
						|
 | 
						|
ulong get_tbclk(void)
 | 
						|
{
 | 
						|
	return gd->arch.timer_rate_hz;
 | 
						|
}
 |