diff mbox

[U-Boot,06/13,v4] imx: system counter driver for imx7d and mx6ul

Message ID 1438295726-2156-6-git-send-email-aalonso@freescale.com
State Superseded
Delegated to: Stefano Babic
Headers show

Commit Message

Adrian Alonso July 30, 2015, 10:35 p.m. UTC
* The system counter driver for imx7d abd mx6ul, move
  this timer driver to imx-common and rename it as syscounter.c

  For mx6ul and mx7, configurations are used for choose the GPT timer
  or system counter timer (default).

  GPT timer:              CONFIG_GPT_TIMER
  System counter timer:   CONFIG_SYSCOUNTER_TIMER

  For mx6dqp GPT timer is the default setting.

Signed-off-by: Adrian Alonso <aalonso@freescale.com>
Signed-off-by: Ye.Li <B37916@freescale.com>
---
Changes for V2: Resend
Changes for V3: Resend
Changes for V4: Resend

 arch/arm/imx-common/syscounter.c             | 126 +++++++++++++++++++++++++++
 arch/arm/include/asm/imx-common/syscounter.h |  29 ++++++
 include/configs/mx6_common.h                 |   1 +
 3 files changed, 156 insertions(+)
 create mode 100644 arch/arm/imx-common/syscounter.c
 create mode 100644 arch/arm/include/asm/imx-common/syscounter.h

Comments

Nikolay Dimitrov July 31, 2015, 12:41 p.m. UTC | #1
Hi Adrian,

On 07/31/2015 01:35 AM, Adrian Alonso wrote:
> * The system counter driver for imx7d abd mx6ul, move
>    this timer driver to imx-common and rename it as syscounter.c
>
>    For mx6ul and mx7, configurations are used for choose the GPT timer
>    or system counter timer (default).
>
>    GPT timer:              CONFIG_GPT_TIMER
>    System counter timer:   CONFIG_SYSCOUNTER_TIMER
>
>    For mx6dqp GPT timer is the default setting.
>
> Signed-off-by: Adrian Alonso <aalonso@freescale.com>
> Signed-off-by: Ye.Li <B37916@freescale.com>
> ---
> Changes for V2: Resend
> Changes for V3: Resend
> Changes for V4: Resend
>
>   arch/arm/imx-common/syscounter.c             | 126 +++++++++++++++++++++++++++
>   arch/arm/include/asm/imx-common/syscounter.h |  29 ++++++
>   include/configs/mx6_common.h                 |   1 +
>   3 files changed, 156 insertions(+)
>   create mode 100644 arch/arm/imx-common/syscounter.c
>   create mode 100644 arch/arm/include/asm/imx-common/syscounter.h
>
> diff --git a/arch/arm/imx-common/syscounter.c b/arch/arm/imx-common/syscounter.c
> new file mode 100644
> index 0000000..f5e5cdc
> --- /dev/null
> +++ b/arch/arm/imx-common/syscounter.c
> @@ -0,0 +1,126 @@
> +/*
> + * Copyright (C) 2014-2015 Freescale Semiconductor, Inc.

Don't want to play "license police", but the file is created in 2015, 
and the copyright says 2014-2015. Can you please check this out? Thanks.

> + *
> + * SPDX-License-Identifier:	GPL-2.0+
> + *
> + * The file use ls102xa/timer.c as a reference.
> + */
> +
> +#include <common.h>
> +#include <asm/io.h>
> +#include <div64.h>
> +#include <asm/arch/imx-regs.h>
> +#include <asm/arch/sys_proto.h>
> +#include <asm/imx-common/syscounter.h>
> +
> +DECLARE_GLOBAL_DATA_PTR;
> +
> +/*
> + * This function is intended for SHORT delays only.
> + * It will overflow at around 10 seconds @ 400MHz,
> + * or 20 seconds @ 200MHz.
> + */
> +unsigned long usec2ticks(unsigned long usec)
> +{
> +	ulong ticks;
> +
> +	if (usec < 1000)
> +		ticks = ((usec * (get_tbclk()/1000)) + 500) / 1000;
> +	else
> +		ticks = ((usec / 10) * (get_tbclk() / 100000));
> +
> +	return ticks;
> +}
> +
> +static inline unsigned long long tick_to_time(unsigned long long tick)
> +{
> +	unsigned long freq;
> +
> +	asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (freq));
> +
> +	tick *= CONFIG_SYS_HZ;
> +	do_div(tick, freq);
> +
> +	return tick;
> +}
> +
> +static inline unsigned long long us_to_tick(unsigned long long usec)
> +{
> +	unsigned long freq;
> +
> +	asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (freq));
> +
> +	usec = usec * freq  + 999999;
> +	do_div(usec, 1000000);
> +
> +	return usec;
> +}
> +
> +int timer_init(void)
> +{
> +	struct sctr_regs *sctr = (struct sctr_regs *)SCTR_BASE_ADDR;
> +	unsigned long val, freq;
> +
> +	freq = CONFIG_SC_TIMER_CLK;
> +	asm("mcr p15, 0, %0, c14, c0, 0" : : "r" (freq));
> +
> +	writel(freq, &sctr->cntfid0);
> +
> +	/* Enable system counter */
> +	val = readl(&sctr->cntcr);
> +	val &= ~(SC_CNTCR_FREQ0 | SC_CNTCR_FREQ1);
> +	val |= SC_CNTCR_FREQ0 | SC_CNTCR_ENABLE | SC_CNTCR_HDBG;
> +	writel(val, &sctr->cntcr);
> +
> +	gd->arch.tbl = 0;
> +	gd->arch.tbu = 0;
> +
> +	return 0;
> +}
> +
> +unsigned long long get_ticks(void)
> +{
> +	unsigned long long now;
> +
> +	asm("mrrc p15, 0, %Q0, %R0, c14" : "=r" (now));
> +
> +	gd->arch.tbl = (unsigned long)(now & 0xffffffff);
> +	gd->arch.tbu = (unsigned long)(now >> 32);
> +
> +	return now;
> +}
> +
> +ulong get_timer_masked(void)
> +{
> +	return tick_to_time(get_ticks());
> +}
> +
> +ulong get_timer(ulong base)
> +{
> +	return get_timer_masked() - base;
> +}
> +
> +void __udelay(unsigned long usec)
> +{
> +	unsigned long long tmp;
> +	ulong tmo;
> +
> +	tmo = us_to_tick(usec);
> +	tmp = get_ticks() + tmo;	/* get current timestamp */
> +
> +	while (get_ticks() < tmp)	/* loop till event */
> +		 /*NOP*/;
> +}
> +
> +/*
> + * This function is derived from PowerPC code (timebase clock frequency).
> + * On ARM it returns the number of timer ticks per second.
> + */
> +ulong get_tbclk(void)
> +{
> +	unsigned long freq;
> +
> +	asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (freq));
> +
> +	return freq;
> +}
> diff --git a/arch/arm/include/asm/imx-common/syscounter.h b/arch/arm/include/asm/imx-common/syscounter.h
> new file mode 100644
> index 0000000..ddb412e
> --- /dev/null
> +++ b/arch/arm/include/asm/imx-common/syscounter.h
> @@ -0,0 +1,29 @@
> +/*
> + * Copyright (C) 2014-2015 Freescale Semiconductor, Inc.

Same here.

> + *
> + * SPDX-License-Identifier:	GPL-2.0+
> + */
> +
> +#ifndef _ASM_ARCH_SYSTEM_COUNTER_H
> +#define _ASM_ARCH_SYSTEM_COUNTER_H
> +
> +/* System Counter */
> +struct sctr_regs {
> +	u32 cntcr;
> +	u32 cntsr;
> +	u32 cntcv1;
> +	u32 cntcv2;
> +	u32 resv1[4];
> +	u32 cntfid0;
> +	u32 cntfid1;
> +	u32 cntfid2;
> +	u32 resv2[1001];
> +	u32 counterid[1];
> +};
> +
> +#define SC_CNTCR_ENABLE		(1 << 0)
> +#define SC_CNTCR_HDBG		(1 << 1)
> +#define SC_CNTCR_FREQ0		(1 << 8)
> +#define SC_CNTCR_FREQ1		(1 << 9)
> +
> +#endif
> diff --git a/include/configs/mx6_common.h b/include/configs/mx6_common.h
> index 54ab890..ed9f8fe 100644
> --- a/include/configs/mx6_common.h
> +++ b/include/configs/mx6_common.h
> @@ -30,6 +30,7 @@
>
>   #define CONFIG_MP
>   #define CONFIG_MXC_GPT_HCLK
> +#define CONFIG_GPT_TIMER
>
>   #define CONFIG_SYS_NO_FLASH
>
>

Kind regards,
Nikolay
Adrian Alonso Aug. 3, 2015, 8:50 p.m. UTC | #2
Hi Nikolay,

> -----Original Message-----
> From: Nikolay Dimitrov [mailto:picmaster@mail.bg]
> Sent: Friday, July 31, 2015 7:41 AM
> To: Alonso Lazcano Adrian-B38018
> Cc: u-boot
> Subject: Re: [U-Boot] [PATCH 06/13][v4] imx: system counter driver for imx7d
> and mx6ul
> 
> Hi Adrian,
> 
> On 07/31/2015 01:35 AM, Adrian Alonso wrote:
> > * The system counter driver for imx7d abd mx6ul, move
> >    this timer driver to imx-common and rename it as syscounter.c
> >
> >    For mx6ul and mx7, configurations are used for choose the GPT timer
> >    or system counter timer (default).
> >
> >    GPT timer:              CONFIG_GPT_TIMER
> >    System counter timer:   CONFIG_SYSCOUNTER_TIMER
> >
> >    For mx6dqp GPT timer is the default setting.
> >
> > Signed-off-by: Adrian Alonso <aalonso@freescale.com>
> > Signed-off-by: Ye.Li <B37916@freescale.com>
> > ---
> > Changes for V2: Resend
> > Changes for V3: Resend
> > Changes for V4: Resend
> >
> >   arch/arm/imx-common/syscounter.c             | 126
> +++++++++++++++++++++++++++
> >   arch/arm/include/asm/imx-common/syscounter.h |  29 ++++++
> >   include/configs/mx6_common.h                 |   1 +
> >   3 files changed, 156 insertions(+)
> >   create mode 100644 arch/arm/imx-common/syscounter.c
> >   create mode 100644 arch/arm/include/asm/imx-common/syscounter.h
> >
> > diff --git a/arch/arm/imx-common/syscounter.c
> > b/arch/arm/imx-common/syscounter.c
> > new file mode 100644
> > index 0000000..f5e5cdc
> > --- /dev/null
> > +++ b/arch/arm/imx-common/syscounter.c
> > @@ -0,0 +1,126 @@
> > +/*
> > + * Copyright (C) 2014-2015 Freescale Semiconductor, Inc.
> 
> Don't want to play "license police", but the file is created in 2015, and the
> copyright says 2014-2015. Can you please check this out? Thanks.
[Adrian] Thanks for pointing that, will be corrected.
> 
> > + *
> > + * SPDX-License-Identifier:	GPL-2.0+
> > + *
> > + * The file use ls102xa/timer.c as a reference.
> > + */
> > +
> > +#include <common.h>
> > +#include <asm/io.h>
> > +#include <div64.h>
> > +#include <asm/arch/imx-regs.h>
> > +#include <asm/arch/sys_proto.h>
> > +#include <asm/imx-common/syscounter.h>
> > +
> > +DECLARE_GLOBAL_DATA_PTR;
> > +
> > +/*
> > + * This function is intended for SHORT delays only.
> > + * It will overflow at around 10 seconds @ 400MHz,
> > + * or 20 seconds @ 200MHz.
> > + */
> > +unsigned long usec2ticks(unsigned long usec) {
> > +	ulong ticks;
> > +
> > +	if (usec < 1000)
> > +		ticks = ((usec * (get_tbclk()/1000)) + 500) / 1000;
> > +	else
> > +		ticks = ((usec / 10) * (get_tbclk() / 100000));
> > +
> > +	return ticks;
> > +}
> > +
> > +static inline unsigned long long tick_to_time(unsigned long long
> > +tick) {
> > +	unsigned long freq;
> > +
> > +	asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (freq));
> > +
> > +	tick *= CONFIG_SYS_HZ;
> > +	do_div(tick, freq);
> > +
> > +	return tick;
> > +}
> > +
> > +static inline unsigned long long us_to_tick(unsigned long long usec)
> > +{
> > +	unsigned long freq;
> > +
> > +	asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (freq));
> > +
> > +	usec = usec * freq  + 999999;
> > +	do_div(usec, 1000000);
> > +
> > +	return usec;
> > +}
> > +
> > +int timer_init(void)
> > +{
> > +	struct sctr_regs *sctr = (struct sctr_regs *)SCTR_BASE_ADDR;
> > +	unsigned long val, freq;
> > +
> > +	freq = CONFIG_SC_TIMER_CLK;
> > +	asm("mcr p15, 0, %0, c14, c0, 0" : : "r" (freq));
> > +
> > +	writel(freq, &sctr->cntfid0);
> > +
> > +	/* Enable system counter */
> > +	val = readl(&sctr->cntcr);
> > +	val &= ~(SC_CNTCR_FREQ0 | SC_CNTCR_FREQ1);
> > +	val |= SC_CNTCR_FREQ0 | SC_CNTCR_ENABLE | SC_CNTCR_HDBG;
> > +	writel(val, &sctr->cntcr);
> > +
> > +	gd->arch.tbl = 0;
> > +	gd->arch.tbu = 0;
> > +
> > +	return 0;
> > +}
> > +
> > +unsigned long long get_ticks(void)
> > +{
> > +	unsigned long long now;
> > +
> > +	asm("mrrc p15, 0, %Q0, %R0, c14" : "=r" (now));
> > +
> > +	gd->arch.tbl = (unsigned long)(now & 0xffffffff);
> > +	gd->arch.tbu = (unsigned long)(now >> 32);
> > +
> > +	return now;
> > +}
> > +
> > +ulong get_timer_masked(void)
> > +{
> > +	return tick_to_time(get_ticks());
> > +}
> > +
> > +ulong get_timer(ulong base)
> > +{
> > +	return get_timer_masked() - base;
> > +}
> > +
> > +void __udelay(unsigned long usec)
> > +{
> > +	unsigned long long tmp;
> > +	ulong tmo;
> > +
> > +	tmo = us_to_tick(usec);
> > +	tmp = get_ticks() + tmo;	/* get current timestamp */
> > +
> > +	while (get_ticks() < tmp)	/* loop till event */
> > +		 /*NOP*/;
> > +}
> > +
> > +/*
> > + * This function is derived from PowerPC code (timebase clock frequency).
> > + * On ARM it returns the number of timer ticks per second.
> > + */
> > +ulong get_tbclk(void)
> > +{
> > +	unsigned long freq;
> > +
> > +	asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (freq));
> > +
> > +	return freq;
> > +}
> > diff --git a/arch/arm/include/asm/imx-common/syscounter.h
> > b/arch/arm/include/asm/imx-common/syscounter.h
> > new file mode 100644
> > index 0000000..ddb412e
> > --- /dev/null
> > +++ b/arch/arm/include/asm/imx-common/syscounter.h
> > @@ -0,0 +1,29 @@
> > +/*
> > + * Copyright (C) 2014-2015 Freescale Semiconductor, Inc.
> 
> Same here.
> 
> > + *
> > + * SPDX-License-Identifier:	GPL-2.0+
> > + */
> > +
> > +#ifndef _ASM_ARCH_SYSTEM_COUNTER_H
> > +#define _ASM_ARCH_SYSTEM_COUNTER_H
> > +
> > +/* System Counter */
> > +struct sctr_regs {
> > +	u32 cntcr;
> > +	u32 cntsr;
> > +	u32 cntcv1;
> > +	u32 cntcv2;
> > +	u32 resv1[4];
> > +	u32 cntfid0;
> > +	u32 cntfid1;
> > +	u32 cntfid2;
> > +	u32 resv2[1001];
> > +	u32 counterid[1];
> > +};
> > +
> > +#define SC_CNTCR_ENABLE		(1 << 0)
> > +#define SC_CNTCR_HDBG		(1 << 1)
> > +#define SC_CNTCR_FREQ0		(1 << 8)
> > +#define SC_CNTCR_FREQ1		(1 << 9)
> > +
> > +#endif
> > diff --git a/include/configs/mx6_common.h
> > b/include/configs/mx6_common.h index 54ab890..ed9f8fe 100644
> > --- a/include/configs/mx6_common.h
> > +++ b/include/configs/mx6_common.h
> > @@ -30,6 +30,7 @@
> >
> >   #define CONFIG_MP
> >   #define CONFIG_MXC_GPT_HCLK
> > +#define CONFIG_GPT_TIMER
> >
> >   #define CONFIG_SYS_NO_FLASH
> >
> >
> 
> Kind regards,
> Nikolay
diff mbox

Patch

diff --git a/arch/arm/imx-common/syscounter.c b/arch/arm/imx-common/syscounter.c
new file mode 100644
index 0000000..f5e5cdc
--- /dev/null
+++ b/arch/arm/imx-common/syscounter.c
@@ -0,0 +1,126 @@ 
+/*
+ * Copyright (C) 2014-2015 Freescale Semiconductor, Inc.
+ *
+ * SPDX-License-Identifier:	GPL-2.0+
+ *
+ * The file use ls102xa/timer.c as a reference.
+ */
+
+#include <common.h>
+#include <asm/io.h>
+#include <div64.h>
+#include <asm/arch/imx-regs.h>
+#include <asm/arch/sys_proto.h>
+#include <asm/imx-common/syscounter.h>
+
+DECLARE_GLOBAL_DATA_PTR;
+
+/*
+ * This function is intended for SHORT delays only.
+ * It will overflow at around 10 seconds @ 400MHz,
+ * or 20 seconds @ 200MHz.
+ */
+unsigned long usec2ticks(unsigned long usec)
+{
+	ulong ticks;
+
+	if (usec < 1000)
+		ticks = ((usec * (get_tbclk()/1000)) + 500) / 1000;
+	else
+		ticks = ((usec / 10) * (get_tbclk() / 100000));
+
+	return ticks;
+}
+
+static inline unsigned long long tick_to_time(unsigned long long tick)
+{
+	unsigned long freq;
+
+	asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (freq));
+
+	tick *= CONFIG_SYS_HZ;
+	do_div(tick, freq);
+
+	return tick;
+}
+
+static inline unsigned long long us_to_tick(unsigned long long usec)
+{
+	unsigned long freq;
+
+	asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (freq));
+
+	usec = usec * freq  + 999999;
+	do_div(usec, 1000000);
+
+	return usec;
+}
+
+int timer_init(void)
+{
+	struct sctr_regs *sctr = (struct sctr_regs *)SCTR_BASE_ADDR;
+	unsigned long val, freq;
+
+	freq = CONFIG_SC_TIMER_CLK;
+	asm("mcr p15, 0, %0, c14, c0, 0" : : "r" (freq));
+
+	writel(freq, &sctr->cntfid0);
+
+	/* Enable system counter */
+	val = readl(&sctr->cntcr);
+	val &= ~(SC_CNTCR_FREQ0 | SC_CNTCR_FREQ1);
+	val |= SC_CNTCR_FREQ0 | SC_CNTCR_ENABLE | SC_CNTCR_HDBG;
+	writel(val, &sctr->cntcr);
+
+	gd->arch.tbl = 0;
+	gd->arch.tbu = 0;
+
+	return 0;
+}
+
+unsigned long long get_ticks(void)
+{
+	unsigned long long now;
+
+	asm("mrrc p15, 0, %Q0, %R0, c14" : "=r" (now));
+
+	gd->arch.tbl = (unsigned long)(now & 0xffffffff);
+	gd->arch.tbu = (unsigned long)(now >> 32);
+
+	return now;
+}
+
+ulong get_timer_masked(void)
+{
+	return tick_to_time(get_ticks());
+}
+
+ulong get_timer(ulong base)
+{
+	return get_timer_masked() - base;
+}
+
+void __udelay(unsigned long usec)
+{
+	unsigned long long tmp;
+	ulong tmo;
+
+	tmo = us_to_tick(usec);
+	tmp = get_ticks() + tmo;	/* get current timestamp */
+
+	while (get_ticks() < tmp)	/* loop till event */
+		 /*NOP*/;
+}
+
+/*
+ * This function is derived from PowerPC code (timebase clock frequency).
+ * On ARM it returns the number of timer ticks per second.
+ */
+ulong get_tbclk(void)
+{
+	unsigned long freq;
+
+	asm volatile("mrc p15, 0, %0, c14, c0, 0" : "=r" (freq));
+
+	return freq;
+}
diff --git a/arch/arm/include/asm/imx-common/syscounter.h b/arch/arm/include/asm/imx-common/syscounter.h
new file mode 100644
index 0000000..ddb412e
--- /dev/null
+++ b/arch/arm/include/asm/imx-common/syscounter.h
@@ -0,0 +1,29 @@ 
+/*
+ * Copyright (C) 2014-2015 Freescale Semiconductor, Inc.
+ *
+ * SPDX-License-Identifier:	GPL-2.0+
+ */
+
+#ifndef _ASM_ARCH_SYSTEM_COUNTER_H
+#define _ASM_ARCH_SYSTEM_COUNTER_H
+
+/* System Counter */
+struct sctr_regs {
+	u32 cntcr;
+	u32 cntsr;
+	u32 cntcv1;
+	u32 cntcv2;
+	u32 resv1[4];
+	u32 cntfid0;
+	u32 cntfid1;
+	u32 cntfid2;
+	u32 resv2[1001];
+	u32 counterid[1];
+};
+
+#define SC_CNTCR_ENABLE		(1 << 0)
+#define SC_CNTCR_HDBG		(1 << 1)
+#define SC_CNTCR_FREQ0		(1 << 8)
+#define SC_CNTCR_FREQ1		(1 << 9)
+
+#endif
diff --git a/include/configs/mx6_common.h b/include/configs/mx6_common.h
index 54ab890..ed9f8fe 100644
--- a/include/configs/mx6_common.h
+++ b/include/configs/mx6_common.h
@@ -30,6 +30,7 @@ 
 
 #define CONFIG_MP
 #define CONFIG_MXC_GPT_HCLK
+#define CONFIG_GPT_TIMER
 
 #define CONFIG_SYS_NO_FLASH