Linux Audio

Check our new training course

Loading...
v5.9
  1// SPDX-License-Identifier: GPL-2.0+
  2//
  3//  Copyright (C) 2000-2001 Deep Blue Solutions
  4//  Copyright (C) 2002 Shane Nay (shane@minirl.com)
  5//  Copyright (C) 2006-2007 Pavel Pisa (ppisa@pikron.com)
  6//  Copyright (C) 2008 Juergen Beisert (kernel@pengutronix.de)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
  7
  8#include <linux/interrupt.h>
  9#include <linux/irq.h>
 10#include <linux/clockchips.h>
 11#include <linux/clk.h>
 12#include <linux/delay.h>
 13#include <linux/err.h>
 14#include <linux/sched_clock.h>
 15#include <linux/slab.h>
 16#include <linux/of.h>
 17#include <linux/of_address.h>
 18#include <linux/of_irq.h>
 19#include <soc/imx/timer.h>
 20
 21/*
 22 * There are 4 versions of the timer hardware on Freescale MXC hardware.
 23 *  - MX1/MXL
 24 *  - MX21, MX27.
 25 *  - MX25, MX31, MX35, MX37, MX51, MX6Q(rev1.0)
 26 *  - MX6DL, MX6SX, MX6Q(rev1.1+)
 27 */
 28
 29/* defines common for all i.MX */
 30#define MXC_TCTL		0x00
 31#define MXC_TCTL_TEN		(1 << 0) /* Enable module */
 32#define MXC_TPRER		0x04
 33
 34/* MX1, MX21, MX27 */
 35#define MX1_2_TCTL_CLK_PCLK1	(1 << 1)
 36#define MX1_2_TCTL_IRQEN	(1 << 4)
 37#define MX1_2_TCTL_FRR		(1 << 8)
 38#define MX1_2_TCMP		0x08
 39#define MX1_2_TCN		0x10
 40#define MX1_2_TSTAT		0x14
 41
 42/* MX21, MX27 */
 43#define MX2_TSTAT_CAPT		(1 << 1)
 44#define MX2_TSTAT_COMP		(1 << 0)
 45
 46/* MX31, MX35, MX25, MX5, MX6 */
 47#define V2_TCTL_WAITEN		(1 << 3) /* Wait enable mode */
 48#define V2_TCTL_CLK_IPG		(1 << 6)
 49#define V2_TCTL_CLK_PER		(2 << 6)
 50#define V2_TCTL_CLK_OSC_DIV8	(5 << 6)
 51#define V2_TCTL_FRR		(1 << 9)
 52#define V2_TCTL_24MEN		(1 << 10)
 53#define V2_TPRER_PRE24M		12
 54#define V2_IR			0x0c
 55#define V2_TSTAT		0x08
 56#define V2_TSTAT_OF1		(1 << 0)
 57#define V2_TCN			0x24
 58#define V2_TCMP			0x10
 59
 60#define V2_TIMER_RATE_OSC_DIV8	3000000
 61
 62struct imx_timer {
 63	enum imx_gpt_type type;
 64	void __iomem *base;
 65	int irq;
 66	struct clk *clk_per;
 67	struct clk *clk_ipg;
 68	const struct imx_gpt_data *gpt;
 69	struct clock_event_device ced;
 
 70};
 71
 72struct imx_gpt_data {
 73	int reg_tstat;
 74	int reg_tcn;
 75	int reg_tcmp;
 76	void (*gpt_setup_tctl)(struct imx_timer *imxtm);
 77	void (*gpt_irq_enable)(struct imx_timer *imxtm);
 78	void (*gpt_irq_disable)(struct imx_timer *imxtm);
 79	void (*gpt_irq_acknowledge)(struct imx_timer *imxtm);
 80	int (*set_next_event)(unsigned long evt,
 81			      struct clock_event_device *ced);
 82};
 83
 84static inline struct imx_timer *to_imx_timer(struct clock_event_device *ced)
 85{
 86	return container_of(ced, struct imx_timer, ced);
 87}
 88
 89static void imx1_gpt_irq_disable(struct imx_timer *imxtm)
 90{
 91	unsigned int tmp;
 92
 93	tmp = readl_relaxed(imxtm->base + MXC_TCTL);
 94	writel_relaxed(tmp & ~MX1_2_TCTL_IRQEN, imxtm->base + MXC_TCTL);
 95}
 96#define imx21_gpt_irq_disable imx1_gpt_irq_disable
 97
 98static void imx31_gpt_irq_disable(struct imx_timer *imxtm)
 99{
100	writel_relaxed(0, imxtm->base + V2_IR);
101}
102#define imx6dl_gpt_irq_disable imx31_gpt_irq_disable
103
104static void imx1_gpt_irq_enable(struct imx_timer *imxtm)
105{
106	unsigned int tmp;
107
108	tmp = readl_relaxed(imxtm->base + MXC_TCTL);
109	writel_relaxed(tmp | MX1_2_TCTL_IRQEN, imxtm->base + MXC_TCTL);
110}
111#define imx21_gpt_irq_enable imx1_gpt_irq_enable
112
113static void imx31_gpt_irq_enable(struct imx_timer *imxtm)
114{
115	writel_relaxed(1<<0, imxtm->base + V2_IR);
116}
117#define imx6dl_gpt_irq_enable imx31_gpt_irq_enable
118
119static void imx1_gpt_irq_acknowledge(struct imx_timer *imxtm)
120{
121	writel_relaxed(0, imxtm->base + MX1_2_TSTAT);
122}
123
124static void imx21_gpt_irq_acknowledge(struct imx_timer *imxtm)
125{
126	writel_relaxed(MX2_TSTAT_CAPT | MX2_TSTAT_COMP,
127				imxtm->base + MX1_2_TSTAT);
128}
129
130static void imx31_gpt_irq_acknowledge(struct imx_timer *imxtm)
131{
132	writel_relaxed(V2_TSTAT_OF1, imxtm->base + V2_TSTAT);
133}
134#define imx6dl_gpt_irq_acknowledge imx31_gpt_irq_acknowledge
135
136static void __iomem *sched_clock_reg;
137
138static u64 notrace mxc_read_sched_clock(void)
139{
140	return sched_clock_reg ? readl_relaxed(sched_clock_reg) : 0;
141}
142
143#if defined(CONFIG_ARM)
144static struct delay_timer imx_delay_timer;
145
146static unsigned long imx_read_current_timer(void)
147{
148	return readl_relaxed(sched_clock_reg);
149}
150#endif
151
152static int __init mxc_clocksource_init(struct imx_timer *imxtm)
153{
154	unsigned int c = clk_get_rate(imxtm->clk_per);
155	void __iomem *reg = imxtm->base + imxtm->gpt->reg_tcn;
156
157#if defined(CONFIG_ARM)
158	imx_delay_timer.read_current_timer = &imx_read_current_timer;
159	imx_delay_timer.freq = c;
160	register_current_timer_delay(&imx_delay_timer);
161#endif
162
163	sched_clock_reg = reg;
164
165	sched_clock_register(mxc_read_sched_clock, 32, c);
166	return clocksource_mmio_init(reg, "mxc_timer1", c, 200, 32,
167			clocksource_mmio_readl_up);
168}
169
170/* clock event */
171
172static int mx1_2_set_next_event(unsigned long evt,
173			      struct clock_event_device *ced)
174{
175	struct imx_timer *imxtm = to_imx_timer(ced);
176	unsigned long tcmp;
177
178	tcmp = readl_relaxed(imxtm->base + MX1_2_TCN) + evt;
179
180	writel_relaxed(tcmp, imxtm->base + MX1_2_TCMP);
181
182	return (int)(tcmp - readl_relaxed(imxtm->base + MX1_2_TCN)) < 0 ?
183				-ETIME : 0;
184}
185
186static int v2_set_next_event(unsigned long evt,
187			      struct clock_event_device *ced)
188{
189	struct imx_timer *imxtm = to_imx_timer(ced);
190	unsigned long tcmp;
191
192	tcmp = readl_relaxed(imxtm->base + V2_TCN) + evt;
193
194	writel_relaxed(tcmp, imxtm->base + V2_TCMP);
195
196	return evt < 0x7fffffff &&
197		(int)(tcmp - readl_relaxed(imxtm->base + V2_TCN)) < 0 ?
198				-ETIME : 0;
199}
200
201static int mxc_shutdown(struct clock_event_device *ced)
202{
203	struct imx_timer *imxtm = to_imx_timer(ced);
 
204	u32 tcn;
205
 
 
 
 
 
 
206	/* Disable interrupt in GPT module */
207	imxtm->gpt->gpt_irq_disable(imxtm);
208
209	tcn = readl_relaxed(imxtm->base + imxtm->gpt->reg_tcn);
210	/* Set event time into far-far future */
211	writel_relaxed(tcn - 3, imxtm->base + imxtm->gpt->reg_tcmp);
212
213	/* Clear pending interrupt */
214	imxtm->gpt->gpt_irq_acknowledge(imxtm);
215
216#ifdef DEBUG
217	printk(KERN_INFO "%s: changing mode\n", __func__);
218#endif /* DEBUG */
219
 
 
220	return 0;
221}
222
223static int mxc_set_oneshot(struct clock_event_device *ced)
224{
225	struct imx_timer *imxtm = to_imx_timer(ced);
 
 
 
 
 
 
 
226
227	/* Disable interrupt in GPT module */
228	imxtm->gpt->gpt_irq_disable(imxtm);
229
230	if (!clockevent_state_oneshot(ced)) {
231		u32 tcn = readl_relaxed(imxtm->base + imxtm->gpt->reg_tcn);
232		/* Set event time into far-far future */
233		writel_relaxed(tcn - 3, imxtm->base + imxtm->gpt->reg_tcmp);
234
235		/* Clear pending interrupt */
236		imxtm->gpt->gpt_irq_acknowledge(imxtm);
237	}
238
239#ifdef DEBUG
240	printk(KERN_INFO "%s: changing mode\n", __func__);
241#endif /* DEBUG */
242
243	/*
244	 * Do not put overhead of interrupt enable/disable into
245	 * mxc_set_next_event(), the core has about 4 minutes
246	 * to call mxc_set_next_event() or shutdown clock after
247	 * mode switching
248	 */
249	imxtm->gpt->gpt_irq_enable(imxtm);
 
250
251	return 0;
252}
253
254/*
255 * IRQ handler for the timer
256 */
257static irqreturn_t mxc_timer_interrupt(int irq, void *dev_id)
258{
259	struct clock_event_device *ced = dev_id;
260	struct imx_timer *imxtm = to_imx_timer(ced);
261	uint32_t tstat;
262
263	tstat = readl_relaxed(imxtm->base + imxtm->gpt->reg_tstat);
264
265	imxtm->gpt->gpt_irq_acknowledge(imxtm);
266
267	ced->event_handler(ced);
268
269	return IRQ_HANDLED;
270}
271
272static int __init mxc_clockevent_init(struct imx_timer *imxtm)
273{
274	struct clock_event_device *ced = &imxtm->ced;
 
275
276	ced->name = "mxc_timer1";
277	ced->features = CLOCK_EVT_FEAT_ONESHOT | CLOCK_EVT_FEAT_DYNIRQ;
278	ced->set_state_shutdown = mxc_shutdown;
279	ced->set_state_oneshot = mxc_set_oneshot;
280	ced->tick_resume = mxc_shutdown;
281	ced->set_next_event = imxtm->gpt->set_next_event;
282	ced->rating = 200;
283	ced->cpumask = cpumask_of(0);
284	ced->irq = imxtm->irq;
285	clockevents_config_and_register(ced, clk_get_rate(imxtm->clk_per),
286					0xff, 0xfffffffe);
287
288	return request_irq(imxtm->irq, mxc_timer_interrupt,
289			   IRQF_TIMER | IRQF_IRQPOLL, "i.MX Timer Tick", ced);
 
 
 
 
290}
291
292static void imx1_gpt_setup_tctl(struct imx_timer *imxtm)
293{
294	u32 tctl_val;
295
296	tctl_val = MX1_2_TCTL_FRR | MX1_2_TCTL_CLK_PCLK1 | MXC_TCTL_TEN;
297	writel_relaxed(tctl_val, imxtm->base + MXC_TCTL);
298}
299#define imx21_gpt_setup_tctl imx1_gpt_setup_tctl
300
301static void imx31_gpt_setup_tctl(struct imx_timer *imxtm)
302{
303	u32 tctl_val;
304
305	tctl_val = V2_TCTL_FRR | V2_TCTL_WAITEN | MXC_TCTL_TEN;
306	if (clk_get_rate(imxtm->clk_per) == V2_TIMER_RATE_OSC_DIV8)
307		tctl_val |= V2_TCTL_CLK_OSC_DIV8;
308	else
309		tctl_val |= V2_TCTL_CLK_PER;
310
311	writel_relaxed(tctl_val, imxtm->base + MXC_TCTL);
312}
313
314static void imx6dl_gpt_setup_tctl(struct imx_timer *imxtm)
315{
316	u32 tctl_val;
317
318	tctl_val = V2_TCTL_FRR | V2_TCTL_WAITEN | MXC_TCTL_TEN;
319	if (clk_get_rate(imxtm->clk_per) == V2_TIMER_RATE_OSC_DIV8) {
320		tctl_val |= V2_TCTL_CLK_OSC_DIV8;
321		/* 24 / 8 = 3 MHz */
322		writel_relaxed(7 << V2_TPRER_PRE24M, imxtm->base + MXC_TPRER);
323		tctl_val |= V2_TCTL_24MEN;
324	} else {
325		tctl_val |= V2_TCTL_CLK_PER;
326	}
327
328	writel_relaxed(tctl_val, imxtm->base + MXC_TCTL);
329}
330
331static const struct imx_gpt_data imx1_gpt_data = {
332	.reg_tstat = MX1_2_TSTAT,
333	.reg_tcn = MX1_2_TCN,
334	.reg_tcmp = MX1_2_TCMP,
335	.gpt_irq_enable = imx1_gpt_irq_enable,
336	.gpt_irq_disable = imx1_gpt_irq_disable,
337	.gpt_irq_acknowledge = imx1_gpt_irq_acknowledge,
338	.gpt_setup_tctl = imx1_gpt_setup_tctl,
339	.set_next_event = mx1_2_set_next_event,
340};
341
342static const struct imx_gpt_data imx21_gpt_data = {
343	.reg_tstat = MX1_2_TSTAT,
344	.reg_tcn = MX1_2_TCN,
345	.reg_tcmp = MX1_2_TCMP,
346	.gpt_irq_enable = imx21_gpt_irq_enable,
347	.gpt_irq_disable = imx21_gpt_irq_disable,
348	.gpt_irq_acknowledge = imx21_gpt_irq_acknowledge,
349	.gpt_setup_tctl = imx21_gpt_setup_tctl,
350	.set_next_event = mx1_2_set_next_event,
351};
352
353static const struct imx_gpt_data imx31_gpt_data = {
354	.reg_tstat = V2_TSTAT,
355	.reg_tcn = V2_TCN,
356	.reg_tcmp = V2_TCMP,
357	.gpt_irq_enable = imx31_gpt_irq_enable,
358	.gpt_irq_disable = imx31_gpt_irq_disable,
359	.gpt_irq_acknowledge = imx31_gpt_irq_acknowledge,
360	.gpt_setup_tctl = imx31_gpt_setup_tctl,
361	.set_next_event = v2_set_next_event,
362};
363
364static const struct imx_gpt_data imx6dl_gpt_data = {
365	.reg_tstat = V2_TSTAT,
366	.reg_tcn = V2_TCN,
367	.reg_tcmp = V2_TCMP,
368	.gpt_irq_enable = imx6dl_gpt_irq_enable,
369	.gpt_irq_disable = imx6dl_gpt_irq_disable,
370	.gpt_irq_acknowledge = imx6dl_gpt_irq_acknowledge,
371	.gpt_setup_tctl = imx6dl_gpt_setup_tctl,
372	.set_next_event = v2_set_next_event,
373};
374
375static int __init _mxc_timer_init(struct imx_timer *imxtm)
376{
377	int ret;
378
379	switch (imxtm->type) {
380	case GPT_TYPE_IMX1:
381		imxtm->gpt = &imx1_gpt_data;
382		break;
383	case GPT_TYPE_IMX21:
384		imxtm->gpt = &imx21_gpt_data;
385		break;
386	case GPT_TYPE_IMX31:
387		imxtm->gpt = &imx31_gpt_data;
388		break;
389	case GPT_TYPE_IMX6DL:
390		imxtm->gpt = &imx6dl_gpt_data;
391		break;
392	default:
393		return -EINVAL;
394	}
395
396	if (IS_ERR(imxtm->clk_per)) {
397		pr_err("i.MX timer: unable to get clk\n");
398		return PTR_ERR(imxtm->clk_per);
399	}
400
401	if (!IS_ERR(imxtm->clk_ipg))
402		clk_prepare_enable(imxtm->clk_ipg);
403
404	clk_prepare_enable(imxtm->clk_per);
405
406	/*
407	 * Initialise to a known state (all timers off, and timing reset)
408	 */
409
410	writel_relaxed(0, imxtm->base + MXC_TCTL);
411	writel_relaxed(0, imxtm->base + MXC_TPRER); /* see datasheet note */
412
413	imxtm->gpt->gpt_setup_tctl(imxtm);
414
415	/* init and register the timer to the framework */
416	ret = mxc_clocksource_init(imxtm);
417	if (ret)
418		return ret;
419
420	return mxc_clockevent_init(imxtm);
421}
422
423void __init mxc_timer_init(unsigned long pbase, int irq, enum imx_gpt_type type)
424{
425	struct imx_timer *imxtm;
426
427	imxtm = kzalloc(sizeof(*imxtm), GFP_KERNEL);
428	BUG_ON(!imxtm);
429
430	imxtm->clk_per = clk_get_sys("imx-gpt.0", "per");
431	imxtm->clk_ipg = clk_get_sys("imx-gpt.0", "ipg");
432
433	imxtm->base = ioremap(pbase, SZ_4K);
434	BUG_ON(!imxtm->base);
435
436	imxtm->type = type;
437	imxtm->irq = irq;
438
439	_mxc_timer_init(imxtm);
440}
441
442static int __init mxc_timer_init_dt(struct device_node *np,  enum imx_gpt_type type)
443{
444	struct imx_timer *imxtm;
445	static int initialized;
446	int ret;
447
448	/* Support one instance only */
449	if (initialized)
450		return 0;
451
452	imxtm = kzalloc(sizeof(*imxtm), GFP_KERNEL);
453	if (!imxtm)
454		return -ENOMEM;
455
456	imxtm->base = of_iomap(np, 0);
457	if (!imxtm->base)
458		return -ENXIO;
459
460	imxtm->irq = irq_of_parse_and_map(np, 0);
461	if (imxtm->irq <= 0)
462		return -EINVAL;
463
464	imxtm->clk_ipg = of_clk_get_by_name(np, "ipg");
465
466	/* Try osc_per first, and fall back to per otherwise */
467	imxtm->clk_per = of_clk_get_by_name(np, "osc_per");
468	if (IS_ERR(imxtm->clk_per))
469		imxtm->clk_per = of_clk_get_by_name(np, "per");
470
471	imxtm->type = type;
472
473	ret = _mxc_timer_init(imxtm);
474	if (ret)
475		return ret;
476
477	initialized = 1;
478
479	return 0;
480}
481
482static int __init imx1_timer_init_dt(struct device_node *np)
483{
484	return mxc_timer_init_dt(np, GPT_TYPE_IMX1);
485}
486
487static int __init imx21_timer_init_dt(struct device_node *np)
488{
489	return mxc_timer_init_dt(np, GPT_TYPE_IMX21);
490}
491
492static int __init imx31_timer_init_dt(struct device_node *np)
493{
494	enum imx_gpt_type type = GPT_TYPE_IMX31;
495
496	/*
497	 * We were using the same compatible string for i.MX6Q/D and i.MX6DL/S
498	 * GPT device, while they actually have different programming model.
499	 * This is a workaround to keep the existing i.MX6DL/S DTBs continue
500	 * working with the new kernel.
501	 */
502	if (of_machine_is_compatible("fsl,imx6dl"))
503		type = GPT_TYPE_IMX6DL;
504
505	return mxc_timer_init_dt(np, type);
506}
507
508static int __init imx6dl_timer_init_dt(struct device_node *np)
509{
510	return mxc_timer_init_dt(np, GPT_TYPE_IMX6DL);
511}
512
513TIMER_OF_DECLARE(imx1_timer, "fsl,imx1-gpt", imx1_timer_init_dt);
514TIMER_OF_DECLARE(imx21_timer, "fsl,imx21-gpt", imx21_timer_init_dt);
515TIMER_OF_DECLARE(imx27_timer, "fsl,imx27-gpt", imx21_timer_init_dt);
516TIMER_OF_DECLARE(imx31_timer, "fsl,imx31-gpt", imx31_timer_init_dt);
517TIMER_OF_DECLARE(imx25_timer, "fsl,imx25-gpt", imx31_timer_init_dt);
518TIMER_OF_DECLARE(imx50_timer, "fsl,imx50-gpt", imx31_timer_init_dt);
519TIMER_OF_DECLARE(imx51_timer, "fsl,imx51-gpt", imx31_timer_init_dt);
520TIMER_OF_DECLARE(imx53_timer, "fsl,imx53-gpt", imx31_timer_init_dt);
521TIMER_OF_DECLARE(imx6q_timer, "fsl,imx6q-gpt", imx31_timer_init_dt);
522TIMER_OF_DECLARE(imx6dl_timer, "fsl,imx6dl-gpt", imx6dl_timer_init_dt);
523TIMER_OF_DECLARE(imx6sl_timer, "fsl,imx6sl-gpt", imx6dl_timer_init_dt);
524TIMER_OF_DECLARE(imx6sx_timer, "fsl,imx6sx-gpt", imx6dl_timer_init_dt);
v4.6
  1/*
  2 *  linux/arch/arm/plat-mxc/time.c
  3 *
  4 *  Copyright (C) 2000-2001 Deep Blue Solutions
  5 *  Copyright (C) 2002 Shane Nay (shane@minirl.com)
  6 *  Copyright (C) 2006-2007 Pavel Pisa (ppisa@pikron.com)
  7 *  Copyright (C) 2008 Juergen Beisert (kernel@pengutronix.de)
  8 *
  9 * This program is free software; you can redistribute it and/or
 10 * modify it under the terms of the GNU General Public License
 11 * as published by the Free Software Foundation; either version 2
 12 * of the License, or (at your option) any later version.
 13 * This program is distributed in the hope that it will be useful,
 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 16 * GNU General Public License for more details.
 17 *
 18 * You should have received a copy of the GNU General Public License
 19 * along with this program; if not, write to the Free Software
 20 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
 21 * MA 02110-1301, USA.
 22 */
 23
 24#include <linux/interrupt.h>
 25#include <linux/irq.h>
 26#include <linux/clockchips.h>
 27#include <linux/clk.h>
 28#include <linux/delay.h>
 29#include <linux/err.h>
 30#include <linux/sched_clock.h>
 31#include <linux/slab.h>
 32#include <linux/of.h>
 33#include <linux/of_address.h>
 34#include <linux/of_irq.h>
 35#include <soc/imx/timer.h>
 36
 37/*
 38 * There are 4 versions of the timer hardware on Freescale MXC hardware.
 39 *  - MX1/MXL
 40 *  - MX21, MX27.
 41 *  - MX25, MX31, MX35, MX37, MX51, MX6Q(rev1.0)
 42 *  - MX6DL, MX6SX, MX6Q(rev1.1+)
 43 */
 44
 45/* defines common for all i.MX */
 46#define MXC_TCTL		0x00
 47#define MXC_TCTL_TEN		(1 << 0) /* Enable module */
 48#define MXC_TPRER		0x04
 49
 50/* MX1, MX21, MX27 */
 51#define MX1_2_TCTL_CLK_PCLK1	(1 << 1)
 52#define MX1_2_TCTL_IRQEN	(1 << 4)
 53#define MX1_2_TCTL_FRR		(1 << 8)
 54#define MX1_2_TCMP		0x08
 55#define MX1_2_TCN		0x10
 56#define MX1_2_TSTAT		0x14
 57
 58/* MX21, MX27 */
 59#define MX2_TSTAT_CAPT		(1 << 1)
 60#define MX2_TSTAT_COMP		(1 << 0)
 61
 62/* MX31, MX35, MX25, MX5, MX6 */
 63#define V2_TCTL_WAITEN		(1 << 3) /* Wait enable mode */
 64#define V2_TCTL_CLK_IPG		(1 << 6)
 65#define V2_TCTL_CLK_PER		(2 << 6)
 66#define V2_TCTL_CLK_OSC_DIV8	(5 << 6)
 67#define V2_TCTL_FRR		(1 << 9)
 68#define V2_TCTL_24MEN		(1 << 10)
 69#define V2_TPRER_PRE24M		12
 70#define V2_IR			0x0c
 71#define V2_TSTAT		0x08
 72#define V2_TSTAT_OF1		(1 << 0)
 73#define V2_TCN			0x24
 74#define V2_TCMP			0x10
 75
 76#define V2_TIMER_RATE_OSC_DIV8	3000000
 77
 78struct imx_timer {
 79	enum imx_gpt_type type;
 80	void __iomem *base;
 81	int irq;
 82	struct clk *clk_per;
 83	struct clk *clk_ipg;
 84	const struct imx_gpt_data *gpt;
 85	struct clock_event_device ced;
 86	struct irqaction act;
 87};
 88
 89struct imx_gpt_data {
 90	int reg_tstat;
 91	int reg_tcn;
 92	int reg_tcmp;
 93	void (*gpt_setup_tctl)(struct imx_timer *imxtm);
 94	void (*gpt_irq_enable)(struct imx_timer *imxtm);
 95	void (*gpt_irq_disable)(struct imx_timer *imxtm);
 96	void (*gpt_irq_acknowledge)(struct imx_timer *imxtm);
 97	int (*set_next_event)(unsigned long evt,
 98			      struct clock_event_device *ced);
 99};
100
101static inline struct imx_timer *to_imx_timer(struct clock_event_device *ced)
102{
103	return container_of(ced, struct imx_timer, ced);
104}
105
106static void imx1_gpt_irq_disable(struct imx_timer *imxtm)
107{
108	unsigned int tmp;
109
110	tmp = readl_relaxed(imxtm->base + MXC_TCTL);
111	writel_relaxed(tmp & ~MX1_2_TCTL_IRQEN, imxtm->base + MXC_TCTL);
112}
113#define imx21_gpt_irq_disable imx1_gpt_irq_disable
114
115static void imx31_gpt_irq_disable(struct imx_timer *imxtm)
116{
117	writel_relaxed(0, imxtm->base + V2_IR);
118}
119#define imx6dl_gpt_irq_disable imx31_gpt_irq_disable
120
121static void imx1_gpt_irq_enable(struct imx_timer *imxtm)
122{
123	unsigned int tmp;
124
125	tmp = readl_relaxed(imxtm->base + MXC_TCTL);
126	writel_relaxed(tmp | MX1_2_TCTL_IRQEN, imxtm->base + MXC_TCTL);
127}
128#define imx21_gpt_irq_enable imx1_gpt_irq_enable
129
130static void imx31_gpt_irq_enable(struct imx_timer *imxtm)
131{
132	writel_relaxed(1<<0, imxtm->base + V2_IR);
133}
134#define imx6dl_gpt_irq_enable imx31_gpt_irq_enable
135
136static void imx1_gpt_irq_acknowledge(struct imx_timer *imxtm)
137{
138	writel_relaxed(0, imxtm->base + MX1_2_TSTAT);
139}
140
141static void imx21_gpt_irq_acknowledge(struct imx_timer *imxtm)
142{
143	writel_relaxed(MX2_TSTAT_CAPT | MX2_TSTAT_COMP,
144				imxtm->base + MX1_2_TSTAT);
145}
146
147static void imx31_gpt_irq_acknowledge(struct imx_timer *imxtm)
148{
149	writel_relaxed(V2_TSTAT_OF1, imxtm->base + V2_TSTAT);
150}
151#define imx6dl_gpt_irq_acknowledge imx31_gpt_irq_acknowledge
152
153static void __iomem *sched_clock_reg;
154
155static u64 notrace mxc_read_sched_clock(void)
156{
157	return sched_clock_reg ? readl_relaxed(sched_clock_reg) : 0;
158}
159
 
160static struct delay_timer imx_delay_timer;
161
162static unsigned long imx_read_current_timer(void)
163{
164	return readl_relaxed(sched_clock_reg);
165}
 
166
167static int __init mxc_clocksource_init(struct imx_timer *imxtm)
168{
169	unsigned int c = clk_get_rate(imxtm->clk_per);
170	void __iomem *reg = imxtm->base + imxtm->gpt->reg_tcn;
171
 
172	imx_delay_timer.read_current_timer = &imx_read_current_timer;
173	imx_delay_timer.freq = c;
174	register_current_timer_delay(&imx_delay_timer);
 
175
176	sched_clock_reg = reg;
177
178	sched_clock_register(mxc_read_sched_clock, 32, c);
179	return clocksource_mmio_init(reg, "mxc_timer1", c, 200, 32,
180			clocksource_mmio_readl_up);
181}
182
183/* clock event */
184
185static int mx1_2_set_next_event(unsigned long evt,
186			      struct clock_event_device *ced)
187{
188	struct imx_timer *imxtm = to_imx_timer(ced);
189	unsigned long tcmp;
190
191	tcmp = readl_relaxed(imxtm->base + MX1_2_TCN) + evt;
192
193	writel_relaxed(tcmp, imxtm->base + MX1_2_TCMP);
194
195	return (int)(tcmp - readl_relaxed(imxtm->base + MX1_2_TCN)) < 0 ?
196				-ETIME : 0;
197}
198
199static int v2_set_next_event(unsigned long evt,
200			      struct clock_event_device *ced)
201{
202	struct imx_timer *imxtm = to_imx_timer(ced);
203	unsigned long tcmp;
204
205	tcmp = readl_relaxed(imxtm->base + V2_TCN) + evt;
206
207	writel_relaxed(tcmp, imxtm->base + V2_TCMP);
208
209	return evt < 0x7fffffff &&
210		(int)(tcmp - readl_relaxed(imxtm->base + V2_TCN)) < 0 ?
211				-ETIME : 0;
212}
213
214static int mxc_shutdown(struct clock_event_device *ced)
215{
216	struct imx_timer *imxtm = to_imx_timer(ced);
217	unsigned long flags;
218	u32 tcn;
219
220	/*
221	 * The timer interrupt generation is disabled at least
222	 * for enough time to call mxc_set_next_event()
223	 */
224	local_irq_save(flags);
225
226	/* Disable interrupt in GPT module */
227	imxtm->gpt->gpt_irq_disable(imxtm);
228
229	tcn = readl_relaxed(imxtm->base + imxtm->gpt->reg_tcn);
230	/* Set event time into far-far future */
231	writel_relaxed(tcn - 3, imxtm->base + imxtm->gpt->reg_tcmp);
232
233	/* Clear pending interrupt */
234	imxtm->gpt->gpt_irq_acknowledge(imxtm);
235
236#ifdef DEBUG
237	printk(KERN_INFO "%s: changing mode\n", __func__);
238#endif /* DEBUG */
239
240	local_irq_restore(flags);
241
242	return 0;
243}
244
245static int mxc_set_oneshot(struct clock_event_device *ced)
246{
247	struct imx_timer *imxtm = to_imx_timer(ced);
248	unsigned long flags;
249
250	/*
251	 * The timer interrupt generation is disabled at least
252	 * for enough time to call mxc_set_next_event()
253	 */
254	local_irq_save(flags);
255
256	/* Disable interrupt in GPT module */
257	imxtm->gpt->gpt_irq_disable(imxtm);
258
259	if (!clockevent_state_oneshot(ced)) {
260		u32 tcn = readl_relaxed(imxtm->base + imxtm->gpt->reg_tcn);
261		/* Set event time into far-far future */
262		writel_relaxed(tcn - 3, imxtm->base + imxtm->gpt->reg_tcmp);
263
264		/* Clear pending interrupt */
265		imxtm->gpt->gpt_irq_acknowledge(imxtm);
266	}
267
268#ifdef DEBUG
269	printk(KERN_INFO "%s: changing mode\n", __func__);
270#endif /* DEBUG */
271
272	/*
273	 * Do not put overhead of interrupt enable/disable into
274	 * mxc_set_next_event(), the core has about 4 minutes
275	 * to call mxc_set_next_event() or shutdown clock after
276	 * mode switching
277	 */
278	imxtm->gpt->gpt_irq_enable(imxtm);
279	local_irq_restore(flags);
280
281	return 0;
282}
283
284/*
285 * IRQ handler for the timer
286 */
287static irqreturn_t mxc_timer_interrupt(int irq, void *dev_id)
288{
289	struct clock_event_device *ced = dev_id;
290	struct imx_timer *imxtm = to_imx_timer(ced);
291	uint32_t tstat;
292
293	tstat = readl_relaxed(imxtm->base + imxtm->gpt->reg_tstat);
294
295	imxtm->gpt->gpt_irq_acknowledge(imxtm);
296
297	ced->event_handler(ced);
298
299	return IRQ_HANDLED;
300}
301
302static int __init mxc_clockevent_init(struct imx_timer *imxtm)
303{
304	struct clock_event_device *ced = &imxtm->ced;
305	struct irqaction *act = &imxtm->act;
306
307	ced->name = "mxc_timer1";
308	ced->features = CLOCK_EVT_FEAT_ONESHOT | CLOCK_EVT_FEAT_DYNIRQ;
309	ced->set_state_shutdown = mxc_shutdown;
310	ced->set_state_oneshot = mxc_set_oneshot;
311	ced->tick_resume = mxc_shutdown;
312	ced->set_next_event = imxtm->gpt->set_next_event;
313	ced->rating = 200;
314	ced->cpumask = cpumask_of(0);
315	ced->irq = imxtm->irq;
316	clockevents_config_and_register(ced, clk_get_rate(imxtm->clk_per),
317					0xff, 0xfffffffe);
318
319	act->name = "i.MX Timer Tick";
320	act->flags = IRQF_TIMER | IRQF_IRQPOLL;
321	act->handler = mxc_timer_interrupt;
322	act->dev_id = ced;
323
324	return setup_irq(imxtm->irq, act);
325}
326
327static void imx1_gpt_setup_tctl(struct imx_timer *imxtm)
328{
329	u32 tctl_val;
330
331	tctl_val = MX1_2_TCTL_FRR | MX1_2_TCTL_CLK_PCLK1 | MXC_TCTL_TEN;
332	writel_relaxed(tctl_val, imxtm->base + MXC_TCTL);
333}
334#define imx21_gpt_setup_tctl imx1_gpt_setup_tctl
335
336static void imx31_gpt_setup_tctl(struct imx_timer *imxtm)
337{
338	u32 tctl_val;
339
340	tctl_val = V2_TCTL_FRR | V2_TCTL_WAITEN | MXC_TCTL_TEN;
341	if (clk_get_rate(imxtm->clk_per) == V2_TIMER_RATE_OSC_DIV8)
342		tctl_val |= V2_TCTL_CLK_OSC_DIV8;
343	else
344		tctl_val |= V2_TCTL_CLK_PER;
345
346	writel_relaxed(tctl_val, imxtm->base + MXC_TCTL);
347}
348
349static void imx6dl_gpt_setup_tctl(struct imx_timer *imxtm)
350{
351	u32 tctl_val;
352
353	tctl_val = V2_TCTL_FRR | V2_TCTL_WAITEN | MXC_TCTL_TEN;
354	if (clk_get_rate(imxtm->clk_per) == V2_TIMER_RATE_OSC_DIV8) {
355		tctl_val |= V2_TCTL_CLK_OSC_DIV8;
356		/* 24 / 8 = 3 MHz */
357		writel_relaxed(7 << V2_TPRER_PRE24M, imxtm->base + MXC_TPRER);
358		tctl_val |= V2_TCTL_24MEN;
359	} else {
360		tctl_val |= V2_TCTL_CLK_PER;
361	}
362
363	writel_relaxed(tctl_val, imxtm->base + MXC_TCTL);
364}
365
366static const struct imx_gpt_data imx1_gpt_data = {
367	.reg_tstat = MX1_2_TSTAT,
368	.reg_tcn = MX1_2_TCN,
369	.reg_tcmp = MX1_2_TCMP,
370	.gpt_irq_enable = imx1_gpt_irq_enable,
371	.gpt_irq_disable = imx1_gpt_irq_disable,
372	.gpt_irq_acknowledge = imx1_gpt_irq_acknowledge,
373	.gpt_setup_tctl = imx1_gpt_setup_tctl,
374	.set_next_event = mx1_2_set_next_event,
375};
376
377static const struct imx_gpt_data imx21_gpt_data = {
378	.reg_tstat = MX1_2_TSTAT,
379	.reg_tcn = MX1_2_TCN,
380	.reg_tcmp = MX1_2_TCMP,
381	.gpt_irq_enable = imx21_gpt_irq_enable,
382	.gpt_irq_disable = imx21_gpt_irq_disable,
383	.gpt_irq_acknowledge = imx21_gpt_irq_acknowledge,
384	.gpt_setup_tctl = imx21_gpt_setup_tctl,
385	.set_next_event = mx1_2_set_next_event,
386};
387
388static const struct imx_gpt_data imx31_gpt_data = {
389	.reg_tstat = V2_TSTAT,
390	.reg_tcn = V2_TCN,
391	.reg_tcmp = V2_TCMP,
392	.gpt_irq_enable = imx31_gpt_irq_enable,
393	.gpt_irq_disable = imx31_gpt_irq_disable,
394	.gpt_irq_acknowledge = imx31_gpt_irq_acknowledge,
395	.gpt_setup_tctl = imx31_gpt_setup_tctl,
396	.set_next_event = v2_set_next_event,
397};
398
399static const struct imx_gpt_data imx6dl_gpt_data = {
400	.reg_tstat = V2_TSTAT,
401	.reg_tcn = V2_TCN,
402	.reg_tcmp = V2_TCMP,
403	.gpt_irq_enable = imx6dl_gpt_irq_enable,
404	.gpt_irq_disable = imx6dl_gpt_irq_disable,
405	.gpt_irq_acknowledge = imx6dl_gpt_irq_acknowledge,
406	.gpt_setup_tctl = imx6dl_gpt_setup_tctl,
407	.set_next_event = v2_set_next_event,
408};
409
410static void __init _mxc_timer_init(struct imx_timer *imxtm)
411{
 
 
412	switch (imxtm->type) {
413	case GPT_TYPE_IMX1:
414		imxtm->gpt = &imx1_gpt_data;
415		break;
416	case GPT_TYPE_IMX21:
417		imxtm->gpt = &imx21_gpt_data;
418		break;
419	case GPT_TYPE_IMX31:
420		imxtm->gpt = &imx31_gpt_data;
421		break;
422	case GPT_TYPE_IMX6DL:
423		imxtm->gpt = &imx6dl_gpt_data;
424		break;
425	default:
426		BUG();
427	}
428
429	if (IS_ERR(imxtm->clk_per)) {
430		pr_err("i.MX timer: unable to get clk\n");
431		return;
432	}
433
434	if (!IS_ERR(imxtm->clk_ipg))
435		clk_prepare_enable(imxtm->clk_ipg);
436
437	clk_prepare_enable(imxtm->clk_per);
438
439	/*
440	 * Initialise to a known state (all timers off, and timing reset)
441	 */
442
443	writel_relaxed(0, imxtm->base + MXC_TCTL);
444	writel_relaxed(0, imxtm->base + MXC_TPRER); /* see datasheet note */
445
446	imxtm->gpt->gpt_setup_tctl(imxtm);
447
448	/* init and register the timer to the framework */
449	mxc_clocksource_init(imxtm);
450	mxc_clockevent_init(imxtm);
 
 
 
451}
452
453void __init mxc_timer_init(unsigned long pbase, int irq, enum imx_gpt_type type)
454{
455	struct imx_timer *imxtm;
456
457	imxtm = kzalloc(sizeof(*imxtm), GFP_KERNEL);
458	BUG_ON(!imxtm);
459
460	imxtm->clk_per = clk_get_sys("imx-gpt.0", "per");
461	imxtm->clk_ipg = clk_get_sys("imx-gpt.0", "ipg");
462
463	imxtm->base = ioremap(pbase, SZ_4K);
464	BUG_ON(!imxtm->base);
465
466	imxtm->type = type;
467	imxtm->irq = irq;
468
469	_mxc_timer_init(imxtm);
470}
471
472static void __init mxc_timer_init_dt(struct device_node *np,  enum imx_gpt_type type)
473{
474	struct imx_timer *imxtm;
475	static int initialized;
 
476
477	/* Support one instance only */
478	if (initialized)
479		return;
480
481	imxtm = kzalloc(sizeof(*imxtm), GFP_KERNEL);
482	BUG_ON(!imxtm);
 
483
484	imxtm->base = of_iomap(np, 0);
485	WARN_ON(!imxtm->base);
 
 
486	imxtm->irq = irq_of_parse_and_map(np, 0);
 
 
487
488	imxtm->clk_ipg = of_clk_get_by_name(np, "ipg");
489
490	/* Try osc_per first, and fall back to per otherwise */
491	imxtm->clk_per = of_clk_get_by_name(np, "osc_per");
492	if (IS_ERR(imxtm->clk_per))
493		imxtm->clk_per = of_clk_get_by_name(np, "per");
494
495	imxtm->type = type;
496
497	_mxc_timer_init(imxtm);
 
 
498
499	initialized = 1;
 
 
500}
501
502static void __init imx1_timer_init_dt(struct device_node *np)
503{
504	mxc_timer_init_dt(np, GPT_TYPE_IMX1);
505}
506
507static void __init imx21_timer_init_dt(struct device_node *np)
508{
509	mxc_timer_init_dt(np, GPT_TYPE_IMX21);
510}
511
512static void __init imx31_timer_init_dt(struct device_node *np)
513{
514	enum imx_gpt_type type = GPT_TYPE_IMX31;
515
516	/*
517	 * We were using the same compatible string for i.MX6Q/D and i.MX6DL/S
518	 * GPT device, while they actually have different programming model.
519	 * This is a workaround to keep the existing i.MX6DL/S DTBs continue
520	 * working with the new kernel.
521	 */
522	if (of_machine_is_compatible("fsl,imx6dl"))
523		type = GPT_TYPE_IMX6DL;
524
525	mxc_timer_init_dt(np, type);
526}
527
528static void __init imx6dl_timer_init_dt(struct device_node *np)
529{
530	mxc_timer_init_dt(np, GPT_TYPE_IMX6DL);
531}
532
533CLOCKSOURCE_OF_DECLARE(imx1_timer, "fsl,imx1-gpt", imx1_timer_init_dt);
534CLOCKSOURCE_OF_DECLARE(imx21_timer, "fsl,imx21-gpt", imx21_timer_init_dt);
535CLOCKSOURCE_OF_DECLARE(imx27_timer, "fsl,imx27-gpt", imx21_timer_init_dt);
536CLOCKSOURCE_OF_DECLARE(imx31_timer, "fsl,imx31-gpt", imx31_timer_init_dt);
537CLOCKSOURCE_OF_DECLARE(imx25_timer, "fsl,imx25-gpt", imx31_timer_init_dt);
538CLOCKSOURCE_OF_DECLARE(imx50_timer, "fsl,imx50-gpt", imx31_timer_init_dt);
539CLOCKSOURCE_OF_DECLARE(imx51_timer, "fsl,imx51-gpt", imx31_timer_init_dt);
540CLOCKSOURCE_OF_DECLARE(imx53_timer, "fsl,imx53-gpt", imx31_timer_init_dt);
541CLOCKSOURCE_OF_DECLARE(imx6q_timer, "fsl,imx6q-gpt", imx31_timer_init_dt);
542CLOCKSOURCE_OF_DECLARE(imx6dl_timer, "fsl,imx6dl-gpt", imx6dl_timer_init_dt);
543CLOCKSOURCE_OF_DECLARE(imx6sl_timer, "fsl,imx6sl-gpt", imx6dl_timer_init_dt);
544CLOCKSOURCE_OF_DECLARE(imx6sx_timer, "fsl,imx6sx-gpt", imx6dl_timer_init_dt);