dmtimer.c 22.4 KB
Newer Older
1 2 3 4 5 6
/*
 * linux/arch/arm/plat-omap/dmtimer.c
 *
 * OMAP Dual-Mode Timers
 *
 * Copyright (C) 2005 Nokia Corporation
7 8
 * OMAP2 support by Juha Yrjola
 * API improvements and OMAP2 clock framework support by Timo Teras
9
 *
10 11 12
 * Copyright (C) 2009 Texas Instruments
 * Added OMAP4 support - Santosh Shilimkar <santosh.shilimkar@ti.com>
 *
13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32
 * 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 SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
 * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
 * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 *
 * 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.,
 * 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/init.h>
33 34 35 36 37
#include <linux/spinlock.h>
#include <linux/errno.h>
#include <linux/list.h>
#include <linux/clk.h>
#include <linux/delay.h>
38
#include <linux/io.h>
39
#include <linux/module.h>
40
#include <mach/hardware.h>
41
#include <plat/dmtimer.h>
42
#include <mach/irqs.h>
43

44
/* register offsets */
45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151
#define _OMAP_TIMER_ID_OFFSET		0x00
#define _OMAP_TIMER_OCP_CFG_OFFSET	0x10
#define _OMAP_TIMER_SYS_STAT_OFFSET	0x14
#define _OMAP_TIMER_STAT_OFFSET		0x18
#define _OMAP_TIMER_INT_EN_OFFSET	0x1c
#define _OMAP_TIMER_WAKEUP_EN_OFFSET	0x20
#define _OMAP_TIMER_CTRL_OFFSET		0x24
#define		OMAP_TIMER_CTRL_GPOCFG		(1 << 14)
#define		OMAP_TIMER_CTRL_CAPTMODE	(1 << 13)
#define		OMAP_TIMER_CTRL_PT		(1 << 12)
#define		OMAP_TIMER_CTRL_TCM_LOWTOHIGH	(0x1 << 8)
#define		OMAP_TIMER_CTRL_TCM_HIGHTOLOW	(0x2 << 8)
#define		OMAP_TIMER_CTRL_TCM_BOTHEDGES	(0x3 << 8)
#define		OMAP_TIMER_CTRL_SCPWM		(1 << 7)
#define		OMAP_TIMER_CTRL_CE		(1 << 6) /* compare enable */
#define		OMAP_TIMER_CTRL_PRE		(1 << 5) /* prescaler enable */
#define		OMAP_TIMER_CTRL_PTV_SHIFT	2 /* prescaler value shift */
#define		OMAP_TIMER_CTRL_POSTED		(1 << 2)
#define		OMAP_TIMER_CTRL_AR		(1 << 1) /* auto-reload enable */
#define		OMAP_TIMER_CTRL_ST		(1 << 0) /* start timer */
#define _OMAP_TIMER_COUNTER_OFFSET	0x28
#define _OMAP_TIMER_LOAD_OFFSET		0x2c
#define _OMAP_TIMER_TRIGGER_OFFSET	0x30
#define _OMAP_TIMER_WRITE_PEND_OFFSET	0x34
#define		WP_NONE			0	/* no write pending bit */
#define		WP_TCLR			(1 << 0)
#define		WP_TCRR			(1 << 1)
#define		WP_TLDR			(1 << 2)
#define		WP_TTGR			(1 << 3)
#define		WP_TMAR			(1 << 4)
#define		WP_TPIR			(1 << 5)
#define		WP_TNIR			(1 << 6)
#define		WP_TCVR			(1 << 7)
#define		WP_TOCR			(1 << 8)
#define		WP_TOWR			(1 << 9)
#define _OMAP_TIMER_MATCH_OFFSET	0x38
#define _OMAP_TIMER_CAPTURE_OFFSET	0x3c
#define _OMAP_TIMER_IF_CTRL_OFFSET	0x40
#define _OMAP_TIMER_CAPTURE2_OFFSET		0x44	/* TCAR2, 34xx only */
#define _OMAP_TIMER_TICK_POS_OFFSET		0x48	/* TPIR, 34xx only */
#define _OMAP_TIMER_TICK_NEG_OFFSET		0x4c	/* TNIR, 34xx only */
#define _OMAP_TIMER_TICK_COUNT_OFFSET		0x50	/* TCVR, 34xx only */
#define _OMAP_TIMER_TICK_INT_MASK_SET_OFFSET	0x54	/* TOCR, 34xx only */
#define _OMAP_TIMER_TICK_INT_MASK_COUNT_OFFSET	0x58	/* TOWR, 34xx only */

/* register offsets with the write pending bit encoded */
#define	WPSHIFT					16

#define OMAP_TIMER_ID_REG			(_OMAP_TIMER_ID_OFFSET \
							| (WP_NONE << WPSHIFT))

#define OMAP_TIMER_OCP_CFG_REG			(_OMAP_TIMER_OCP_CFG_OFFSET \
							| (WP_NONE << WPSHIFT))

#define OMAP_TIMER_SYS_STAT_REG			(_OMAP_TIMER_SYS_STAT_OFFSET \
							| (WP_NONE << WPSHIFT))

#define OMAP_TIMER_STAT_REG			(_OMAP_TIMER_STAT_OFFSET \
							| (WP_NONE << WPSHIFT))

#define OMAP_TIMER_INT_EN_REG			(_OMAP_TIMER_INT_EN_OFFSET \
							| (WP_NONE << WPSHIFT))

#define OMAP_TIMER_WAKEUP_EN_REG		(_OMAP_TIMER_WAKEUP_EN_OFFSET \
							| (WP_NONE << WPSHIFT))

#define OMAP_TIMER_CTRL_REG			(_OMAP_TIMER_CTRL_OFFSET \
							| (WP_TCLR << WPSHIFT))

#define OMAP_TIMER_COUNTER_REG			(_OMAP_TIMER_COUNTER_OFFSET \
							| (WP_TCRR << WPSHIFT))

#define OMAP_TIMER_LOAD_REG			(_OMAP_TIMER_LOAD_OFFSET \
							| (WP_TLDR << WPSHIFT))

#define OMAP_TIMER_TRIGGER_REG			(_OMAP_TIMER_TRIGGER_OFFSET \
							| (WP_TTGR << WPSHIFT))

#define OMAP_TIMER_WRITE_PEND_REG		(_OMAP_TIMER_WRITE_PEND_OFFSET \
							| (WP_NONE << WPSHIFT))

#define OMAP_TIMER_MATCH_REG			(_OMAP_TIMER_MATCH_OFFSET \
							| (WP_TMAR << WPSHIFT))

#define OMAP_TIMER_CAPTURE_REG			(_OMAP_TIMER_CAPTURE_OFFSET \
							| (WP_NONE << WPSHIFT))

#define OMAP_TIMER_IF_CTRL_REG			(_OMAP_TIMER_IF_CTRL_OFFSET \
							| (WP_NONE << WPSHIFT))

#define OMAP_TIMER_CAPTURE2_REG			(_OMAP_TIMER_CAPTURE2_OFFSET \
							| (WP_NONE << WPSHIFT))

#define OMAP_TIMER_TICK_POS_REG			(_OMAP_TIMER_TICK_POS_OFFSET \
							| (WP_TPIR << WPSHIFT))

#define OMAP_TIMER_TICK_NEG_REG			(_OMAP_TIMER_TICK_NEG_OFFSET \
							| (WP_TNIR << WPSHIFT))

#define OMAP_TIMER_TICK_COUNT_REG		(_OMAP_TIMER_TICK_COUNT_OFFSET \
							| (WP_TCVR << WPSHIFT))

#define OMAP_TIMER_TICK_INT_MASK_SET_REG				\
		(_OMAP_TIMER_TICK_INT_MASK_SET_OFFSET | (WP_TOCR << WPSHIFT))

#define OMAP_TIMER_TICK_INT_MASK_COUNT_REG				\
		(_OMAP_TIMER_TICK_INT_MASK_COUNT_OFFSET | (WP_TOWR << WPSHIFT))
152 153 154 155

struct omap_dm_timer {
	unsigned long phys_base;
	int irq;
156 157
#if defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3) || \
			defined(CONFIG_ARCH_OMAP4)
158 159 160 161
	struct clk *iclk, *fclk;
#endif
	void __iomem *io_base;
	unsigned reserved:1;
162
	unsigned enabled:1;
163
	unsigned posted:1;
164 165
};

166
static int dm_timer_count;
167

168
#ifdef CONFIG_ARCH_OMAP1
169
static struct omap_dm_timer omap1_dm_timers[] = {
170 171 172 173 174 175
	{ .phys_base = 0xfffb1400, .irq = INT_1610_GPTIMER1 },
	{ .phys_base = 0xfffb1c00, .irq = INT_1610_GPTIMER2 },
	{ .phys_base = 0xfffb2400, .irq = INT_1610_GPTIMER3 },
	{ .phys_base = 0xfffb2c00, .irq = INT_1610_GPTIMER4 },
	{ .phys_base = 0xfffb3400, .irq = INT_1610_GPTIMER5 },
	{ .phys_base = 0xfffb3c00, .irq = INT_1610_GPTIMER6 },
176 177
	{ .phys_base = 0xfffb7400, .irq = INT_1610_GPTIMER7 },
	{ .phys_base = 0xfffbd400, .irq = INT_1610_GPTIMER8 },
178
};
179

180
static const int omap1_dm_timer_count = ARRAY_SIZE(omap1_dm_timers);
181

182
#else
183
#define omap1_dm_timers			NULL
184 185
#define omap1_dm_timer_count		0
#endif	/* CONFIG_ARCH_OMAP1 */
186

187
#ifdef CONFIG_ARCH_OMAP2
188
static struct omap_dm_timer omap2_dm_timers[] = {
189 190 191 192 193 194 195 196 197 198 199 200
	{ .phys_base = 0x48028000, .irq = INT_24XX_GPTIMER1 },
	{ .phys_base = 0x4802a000, .irq = INT_24XX_GPTIMER2 },
	{ .phys_base = 0x48078000, .irq = INT_24XX_GPTIMER3 },
	{ .phys_base = 0x4807a000, .irq = INT_24XX_GPTIMER4 },
	{ .phys_base = 0x4807c000, .irq = INT_24XX_GPTIMER5 },
	{ .phys_base = 0x4807e000, .irq = INT_24XX_GPTIMER6 },
	{ .phys_base = 0x48080000, .irq = INT_24XX_GPTIMER7 },
	{ .phys_base = 0x48082000, .irq = INT_24XX_GPTIMER8 },
	{ .phys_base = 0x48084000, .irq = INT_24XX_GPTIMER9 },
	{ .phys_base = 0x48086000, .irq = INT_24XX_GPTIMER10 },
	{ .phys_base = 0x48088000, .irq = INT_24XX_GPTIMER11 },
	{ .phys_base = 0x4808a000, .irq = INT_24XX_GPTIMER12 },
201 202
};

203
static const char *omap2_dm_source_names[] __initdata = {
T
Timo Teras 已提交
204 205
	"sys_ck",
	"func_32k_ck",
206 207
	"alt_ck",
	NULL
T
Timo Teras 已提交
208 209
};

210
static struct clk *omap2_dm_source_clocks[3];
211
static const int omap2_dm_timer_count = ARRAY_SIZE(omap2_dm_timers);
212

213
#else
214
#define omap2_dm_timers			NULL
215
#define omap2_dm_timer_count		0
216 217
#define omap2_dm_source_names		NULL
#define omap2_dm_source_clocks		NULL
218
#endif	/* CONFIG_ARCH_OMAP2 */
219

220
#ifdef CONFIG_ARCH_OMAP3
221 222 223 224 225 226 227 228 229 230 231 232
static struct omap_dm_timer omap3_dm_timers[] = {
	{ .phys_base = 0x48318000, .irq = INT_24XX_GPTIMER1 },
	{ .phys_base = 0x49032000, .irq = INT_24XX_GPTIMER2 },
	{ .phys_base = 0x49034000, .irq = INT_24XX_GPTIMER3 },
	{ .phys_base = 0x49036000, .irq = INT_24XX_GPTIMER4 },
	{ .phys_base = 0x49038000, .irq = INT_24XX_GPTIMER5 },
	{ .phys_base = 0x4903A000, .irq = INT_24XX_GPTIMER6 },
	{ .phys_base = 0x4903C000, .irq = INT_24XX_GPTIMER7 },
	{ .phys_base = 0x4903E000, .irq = INT_24XX_GPTIMER8 },
	{ .phys_base = 0x49040000, .irq = INT_24XX_GPTIMER9 },
	{ .phys_base = 0x48086000, .irq = INT_24XX_GPTIMER10 },
	{ .phys_base = 0x48088000, .irq = INT_24XX_GPTIMER11 },
P
Paul Walmsley 已提交
233
	{ .phys_base = 0x48304000, .irq = INT_34XX_GPT12_IRQ },
234 235 236 237 238 239 240 241
};

static const char *omap3_dm_source_names[] __initdata = {
	"sys_ck",
	"omap_32k_fck",
	NULL
};

242
static struct clk *omap3_dm_source_clocks[2];
243
static const int omap3_dm_timer_count = ARRAY_SIZE(omap3_dm_timers);
244

245
#else
246
#define omap3_dm_timers			NULL
247
#define omap3_dm_timer_count		0
248 249
#define omap3_dm_source_names		NULL
#define omap3_dm_source_clocks		NULL
250
#endif	/* CONFIG_ARCH_OMAP3 */
251

252
#ifdef CONFIG_ARCH_OMAP4
253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272
static struct omap_dm_timer omap4_dm_timers[] = {
	{ .phys_base = 0x4a318000, .irq = INT_44XX_GPTIMER1 },
	{ .phys_base = 0x48032000, .irq = INT_44XX_GPTIMER2 },
	{ .phys_base = 0x48034000, .irq = INT_44XX_GPTIMER3 },
	{ .phys_base = 0x48036000, .irq = INT_44XX_GPTIMER4 },
	{ .phys_base = 0x40138000, .irq = INT_44XX_GPTIMER5 },
	{ .phys_base = 0x4013a000, .irq = INT_44XX_GPTIMER6 },
	{ .phys_base = 0x4013a000, .irq = INT_44XX_GPTIMER7 },
	{ .phys_base = 0x4013e000, .irq = INT_44XX_GPTIMER8 },
	{ .phys_base = 0x4803e000, .irq = INT_44XX_GPTIMER9 },
	{ .phys_base = 0x48086000, .irq = INT_44XX_GPTIMER10 },
	{ .phys_base = 0x48088000, .irq = INT_44XX_GPTIMER11 },
	{ .phys_base = 0x4a320000, .irq = INT_44XX_GPTIMER12 },
};
static const char *omap4_dm_source_names[] __initdata = {
	"sys_ck",
	"omap_32k_fck",
	NULL
};
static struct clk *omap4_dm_source_clocks[2];
273
static const int omap4_dm_timer_count = ARRAY_SIZE(omap4_dm_timers);
274

275
#else
276 277 278 279 280
#define omap4_dm_timers			NULL
#define omap4_dm_timer_count		0
#define omap4_dm_source_names		NULL
#define omap4_dm_source_clocks		NULL
#endif	/* CONFIG_ARCH_OMAP4 */
281

282
static struct omap_dm_timer *dm_timers;
283
static const char **dm_source_names;
284 285
static struct clk **dm_source_clocks;

286 287
static spinlock_t dm_timer_lock;

288 289 290 291 292 293
/*
 * Reads timer registers in posted and non-posted mode. The posted mode bit
 * is encoded in reg. Note that in posted mode write pending bit must be
 * checked. Otherwise a read of a non completed write will produce an error.
 */
static inline u32 omap_dm_timer_read_reg(struct omap_dm_timer *timer, u32 reg)
294
{
295 296 297 298 299
	if (timer->posted)
		while (readl(timer->io_base + (OMAP_TIMER_WRITE_PEND_REG & 0xff))
				& (reg >> WPSHIFT))
			cpu_relax();
	return readl(timer->io_base + (reg & 0xff));
300
}
301

302 303 304 305 306 307 308 309
/*
 * Writes timer registers in posted and non-posted mode. The posted mode bit
 * is encoded in reg. Note that in posted mode the write pending bit must be
 * checked. Otherwise a write on a register which has a pending write will be
 * lost.
 */
static void omap_dm_timer_write_reg(struct omap_dm_timer *timer, u32 reg,
						u32 value)
310
{
311 312 313 314 315
	if (timer->posted)
		while (readl(timer->io_base + (OMAP_TIMER_WRITE_PEND_REG & 0xff))
				& (reg >> WPSHIFT))
			cpu_relax();
	writel(value, timer->io_base + (reg & 0xff));
316 317
}

318
static void omap_dm_timer_wait_for_reset(struct omap_dm_timer *timer)
319
{
320 321 322 323 324 325 326 327 328 329
	int c;

	c = 0;
	while (!(omap_dm_timer_read_reg(timer, OMAP_TIMER_SYS_STAT_REG) & 1)) {
		c++;
		if (c > 100000) {
			printk(KERN_ERR "Timer failed to reset\n");
			return;
		}
	}
330 331
}

332 333 334 335
static void omap_dm_timer_reset(struct omap_dm_timer *timer)
{
	u32 l;

336
	if (!cpu_class_is_omap2() || timer != &dm_timers[0]) {
337 338 339
		omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG, 0x06);
		omap_dm_timer_wait_for_reset(timer);
	}
340
	omap_dm_timer_set_source(timer, OMAP_TIMER_SRC_32_KHZ);
341 342

	l = omap_dm_timer_read_reg(timer, OMAP_TIMER_OCP_CFG_REG);
343 344 345 346
	l |= 0x02 << 3;  /* Set to smart-idle mode */
	l |= 0x2 << 8;   /* Set clock activity to perserve f-clock on idle */

	/*
347
	 * Enable wake-up on OMAP2 CPUs.
348
	 */
349
	if (cpu_class_is_omap2())
350
		l |= 1 << 2;
351
	omap_dm_timer_write_reg(timer, OMAP_TIMER_OCP_CFG_REG, l);
352 353 354 355 356

	/* Match hardware reset default of posted mode */
	omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG,
			OMAP_TIMER_CTRL_POSTED);
	timer->posted = 1;
357 358
}

T
Timo Teras 已提交
359
static void omap_dm_timer_prepare(struct omap_dm_timer *timer)
360
{
361
	omap_dm_timer_enable(timer);
362 363 364 365 366 367 368 369 370 371 372 373 374 375 376
	omap_dm_timer_reset(timer);
}

struct omap_dm_timer *omap_dm_timer_request(void)
{
	struct omap_dm_timer *timer = NULL;
	unsigned long flags;
	int i;

	spin_lock_irqsave(&dm_timer_lock, flags);
	for (i = 0; i < dm_timer_count; i++) {
		if (dm_timers[i].reserved)
			continue;

		timer = &dm_timers[i];
T
Timo Teras 已提交
377
		timer->reserved = 1;
378 379 380 381
		break;
	}
	spin_unlock_irqrestore(&dm_timer_lock, flags);

T
Timo Teras 已提交
382 383 384
	if (timer != NULL)
		omap_dm_timer_prepare(timer);

385 386
	return timer;
}
387
EXPORT_SYMBOL_GPL(omap_dm_timer_request);
388 389

struct omap_dm_timer *omap_dm_timer_request_specific(int id)
390 391
{
	struct omap_dm_timer *timer;
392
	unsigned long flags;
393

394 395 396 397
	spin_lock_irqsave(&dm_timer_lock, flags);
	if (id <= 0 || id > dm_timer_count || dm_timers[id-1].reserved) {
		spin_unlock_irqrestore(&dm_timer_lock, flags);
		printk("BUG: warning at %s:%d/%s(): unable to get timer %d\n",
398
		       __FILE__, __LINE__, __func__, id);
399 400 401
		dump_stack();
		return NULL;
	}
402

403
	timer = &dm_timers[id-1];
T
Timo Teras 已提交
404
	timer->reserved = 1;
405 406
	spin_unlock_irqrestore(&dm_timer_lock, flags);

T
Timo Teras 已提交
407 408
	omap_dm_timer_prepare(timer);

409
	return timer;
410
}
411
EXPORT_SYMBOL_GPL(omap_dm_timer_request_specific);
412

413 414
void omap_dm_timer_free(struct omap_dm_timer *timer)
{
415
	omap_dm_timer_enable(timer);
416
	omap_dm_timer_reset(timer);
417
	omap_dm_timer_disable(timer);
418

419 420 421
	WARN_ON(!timer->reserved);
	timer->reserved = 0;
}
422
EXPORT_SYMBOL_GPL(omap_dm_timer_free);
423

424 425 426 427 428
void omap_dm_timer_enable(struct omap_dm_timer *timer)
{
	if (timer->enabled)
		return;

429 430 431 432 433 434
#ifdef CONFIG_ARCH_OMAP2PLUS
	if (cpu_class_is_omap2()) {
		clk_enable(timer->fclk);
		clk_enable(timer->iclk);
	}
#endif
435 436 437

	timer->enabled = 1;
}
438
EXPORT_SYMBOL_GPL(omap_dm_timer_enable);
439 440 441 442 443 444

void omap_dm_timer_disable(struct omap_dm_timer *timer)
{
	if (!timer->enabled)
		return;

445 446 447 448 449 450
#ifdef CONFIG_ARCH_OMAP2PLUS
	if (cpu_class_is_omap2()) {
		clk_disable(timer->iclk);
		clk_disable(timer->fclk);
	}
#endif
451 452 453

	timer->enabled = 0;
}
454
EXPORT_SYMBOL_GPL(omap_dm_timer_disable);
455

456 457 458 459
int omap_dm_timer_get_irq(struct omap_dm_timer *timer)
{
	return timer->irq;
}
460
EXPORT_SYMBOL_GPL(omap_dm_timer_get_irq);
461 462 463

#if defined(CONFIG_ARCH_OMAP1)

464 465 466 467 468 469
/**
 * omap_dm_timer_modify_idlect_mask - Check if any running timers use ARMXOR
 * @inputmask: current value of idlect mask
 */
__u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
{
470
	int i;
471 472 473 474 475 476

	/* If ARMXOR cannot be idled this function call is unnecessary */
	if (!(inputmask & (1 << 1)))
		return inputmask;

	/* If any active timer is using ARMXOR return modified mask */
477 478 479
	for (i = 0; i < dm_timer_count; i++) {
		u32 l;

480
		l = omap_dm_timer_read_reg(&dm_timers[i], OMAP_TIMER_CTRL_REG);
481 482
		if (l & OMAP_TIMER_CTRL_ST) {
			if (((omap_readl(MOD_CONF_CTRL_1) >> (i * 2)) & 0x03) == 0)
483 484 485 486
				inputmask &= ~(1 << 1);
			else
				inputmask &= ~(1 << 2);
		}
487
	}
488 489 490

	return inputmask;
}
491
EXPORT_SYMBOL_GPL(omap_dm_timer_modify_idlect_mask);
492

493 494
#elif defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3) || \
				defined(CONFIG_ARCH_OMAP4)
495

496
struct clk *omap_dm_timer_get_fclk(struct omap_dm_timer *timer)
497
{
498
	return timer->fclk;
499
}
500
EXPORT_SYMBOL_GPL(omap_dm_timer_get_fclk);
501

502 503 504
__u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
{
	BUG();
505 506

	return 0;
507
}
508
EXPORT_SYMBOL_GPL(omap_dm_timer_modify_idlect_mask);
509

510
#endif
511

512
void omap_dm_timer_trigger(struct omap_dm_timer *timer)
513
{
514
	omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
515
}
516
EXPORT_SYMBOL_GPL(omap_dm_timer_trigger);
517

518 519 520
void omap_dm_timer_start(struct omap_dm_timer *timer)
{
	u32 l;
521

522 523 524 525 526 527
	l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
	if (!(l & OMAP_TIMER_CTRL_ST)) {
		l |= OMAP_TIMER_CTRL_ST;
		omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
	}
}
528
EXPORT_SYMBOL_GPL(omap_dm_timer_start);
529

530
void omap_dm_timer_stop(struct omap_dm_timer *timer)
531
{
532
	u32 l;
533

534 535 536 537
	l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
	if (l & OMAP_TIMER_CTRL_ST) {
		l &= ~0x1;
		omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
538 539 540 541 542 543 544 545 546 547 548 549 550
#if defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3) || \
			defined(CONFIG_ARCH_OMAP4)
		/* Readback to make sure write has completed */
		omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
		 /*
		  * Wait for functional clock period x 3.5 to make sure that
		  * timer is stopped
		  */
		udelay(3500000 / clk_get_rate(timer->fclk) + 1);
		/* Ack possibly pending interrupt */
		omap_dm_timer_write_reg(timer, OMAP_TIMER_STAT_REG,
				OMAP_TIMER_INT_OVERFLOW);
#endif
551 552
	}
}
553
EXPORT_SYMBOL_GPL(omap_dm_timer_stop);
554

555
#ifdef CONFIG_ARCH_OMAP1
556

557
int omap_dm_timer_set_source(struct omap_dm_timer *timer, int source)
558
{
559 560
	int n = (timer - dm_timers) << 1;
	u32 l;
561

562 563 564
	l = omap_readl(MOD_CONF_CTRL_1) & ~(0x03 << n);
	l |= source << n;
	omap_writel(l, MOD_CONF_CTRL_1);
565 566

	return 0;
567
}
568
EXPORT_SYMBOL_GPL(omap_dm_timer_set_source);
569

570
#else
571

572
int omap_dm_timer_set_source(struct omap_dm_timer *timer, int source)
573
{
574 575
	int ret = -EINVAL;

576
	if (source < 0 || source >= 3)
577
		return -EINVAL;
578 579

	clk_disable(timer->fclk);
580
	ret = clk_set_parent(timer->fclk, dm_source_clocks[source]);
581 582
	clk_enable(timer->fclk);

583 584 585 586
	/*
	 * When the functional clock disappears, too quick writes seem
	 * to cause an abort. XXX Is this still necessary?
	 */
587
	__delay(150000);
588 589

	return ret;
590
}
591
EXPORT_SYMBOL_GPL(omap_dm_timer_set_source);
592

593
#endif
594

595 596
void omap_dm_timer_set_load(struct omap_dm_timer *timer, int autoreload,
			    unsigned int load)
597 598
{
	u32 l;
599

600
	l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
601 602 603 604
	if (autoreload)
		l |= OMAP_TIMER_CTRL_AR;
	else
		l &= ~OMAP_TIMER_CTRL_AR;
605
	omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
606
	omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
607

608
	omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
609
}
610
EXPORT_SYMBOL_GPL(omap_dm_timer_set_load);
611

612 613 614 615 616 617 618
/* Optimized set_load which removes costly spin wait in timer_start */
void omap_dm_timer_set_load_start(struct omap_dm_timer *timer, int autoreload,
                            unsigned int load)
{
	u32 l;

	l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
619
	if (autoreload) {
620
		l |= OMAP_TIMER_CTRL_AR;
621 622
		omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
	} else {
623
		l &= ~OMAP_TIMER_CTRL_AR;
624
	}
625 626 627 628 629
	l |= OMAP_TIMER_CTRL_ST;

	omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG, load);
	omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
}
630
EXPORT_SYMBOL_GPL(omap_dm_timer_set_load_start);
631

632 633
void omap_dm_timer_set_match(struct omap_dm_timer *timer, int enable,
			     unsigned int match)
634 635 636 637
{
	u32 l;

	l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
T
Timo Teras 已提交
638
	if (enable)
639 640 641
		l |= OMAP_TIMER_CTRL_CE;
	else
		l &= ~OMAP_TIMER_CTRL_CE;
642
	omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
643
	omap_dm_timer_write_reg(timer, OMAP_TIMER_MATCH_REG, match);
644
}
645
EXPORT_SYMBOL_GPL(omap_dm_timer_set_match);
646

647 648
void omap_dm_timer_set_pwm(struct omap_dm_timer *timer, int def_on,
			   int toggle, int trigger)
649 650 651 652
{
	u32 l;

	l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
653 654 655 656 657 658 659
	l &= ~(OMAP_TIMER_CTRL_GPOCFG | OMAP_TIMER_CTRL_SCPWM |
	       OMAP_TIMER_CTRL_PT | (0x03 << 10));
	if (def_on)
		l |= OMAP_TIMER_CTRL_SCPWM;
	if (toggle)
		l |= OMAP_TIMER_CTRL_PT;
	l |= trigger << 10;
660 661
	omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
}
662
EXPORT_SYMBOL_GPL(omap_dm_timer_set_pwm);
663

664
void omap_dm_timer_set_prescaler(struct omap_dm_timer *timer, int prescaler)
665 666 667 668
{
	u32 l;

	l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
669 670 671 672 673
	l &= ~(OMAP_TIMER_CTRL_PRE | (0x07 << 2));
	if (prescaler >= 0x00 && prescaler <= 0x07) {
		l |= OMAP_TIMER_CTRL_PRE;
		l |= prescaler << 2;
	}
674 675
	omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
}
676
EXPORT_SYMBOL_GPL(omap_dm_timer_set_prescaler);
677

678 679
void omap_dm_timer_set_int_enable(struct omap_dm_timer *timer,
				  unsigned int value)
680
{
681
	omap_dm_timer_write_reg(timer, OMAP_TIMER_INT_EN_REG, value);
682
	omap_dm_timer_write_reg(timer, OMAP_TIMER_WAKEUP_EN_REG, value);
683
}
684
EXPORT_SYMBOL_GPL(omap_dm_timer_set_int_enable);
685

686
unsigned int omap_dm_timer_read_status(struct omap_dm_timer *timer)
687
{
688 689 690 691 692
	unsigned int l;

	l = omap_dm_timer_read_reg(timer, OMAP_TIMER_STAT_REG);

	return l;
693
}
694
EXPORT_SYMBOL_GPL(omap_dm_timer_read_status);
695

696
void omap_dm_timer_write_status(struct omap_dm_timer *timer, unsigned int value)
697
{
698
	omap_dm_timer_write_reg(timer, OMAP_TIMER_STAT_REG, value);
699
}
700
EXPORT_SYMBOL_GPL(omap_dm_timer_write_status);
701

702
unsigned int omap_dm_timer_read_counter(struct omap_dm_timer *timer)
703
{
704 705 706 707 708
	unsigned int l;

	l = omap_dm_timer_read_reg(timer, OMAP_TIMER_COUNTER_REG);

	return l;
709
}
710
EXPORT_SYMBOL_GPL(omap_dm_timer_read_counter);
711

T
Timo Teras 已提交
712 713
void omap_dm_timer_write_counter(struct omap_dm_timer *timer, unsigned int value)
{
714
	omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG, value);
T
Timo Teras 已提交
715
}
716
EXPORT_SYMBOL_GPL(omap_dm_timer_write_counter);
T
Timo Teras 已提交
717

718
int omap_dm_timers_active(void)
719
{
720
	int i;
721

722 723
	for (i = 0; i < dm_timer_count; i++) {
		struct omap_dm_timer *timer;
724

725
		timer = &dm_timers[i];
726 727 728 729

		if (!timer->enabled)
			continue;

730
		if (omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG) &
731
		    OMAP_TIMER_CTRL_ST) {
732
			return 1;
733
		}
734 735 736
	}
	return 0;
}
737
EXPORT_SYMBOL_GPL(omap_dm_timers_active);
738

739
int __init omap_dm_timer_init(void)
740 741
{
	struct omap_dm_timer *timer;
T
Tony Lindgren 已提交
742
	int i, map_size = SZ_8K;	/* Module 4KB + L4 4KB except on omap1 */
743

744
	if (!(cpu_is_omap16xx() || cpu_class_is_omap2()))
745
		return -ENODEV;
746 747

	spin_lock_init(&dm_timer_lock);
748

T
Tony Lindgren 已提交
749
	if (cpu_class_is_omap1()) {
750
		dm_timers = omap1_dm_timers;
751
		dm_timer_count = omap1_dm_timer_count;
T
Tony Lindgren 已提交
752 753
		map_size = SZ_2K;
	} else if (cpu_is_omap24xx()) {
754
		dm_timers = omap2_dm_timers;
755
		dm_timer_count = omap2_dm_timer_count;
756 757
		dm_source_names = omap2_dm_source_names;
		dm_source_clocks = omap2_dm_source_clocks;
758 759
	} else if (cpu_is_omap34xx()) {
		dm_timers = omap3_dm_timers;
760
		dm_timer_count = omap3_dm_timer_count;
761 762
		dm_source_names = omap3_dm_source_names;
		dm_source_clocks = omap3_dm_source_clocks;
763 764
	} else if (cpu_is_omap44xx()) {
		dm_timers = omap4_dm_timers;
765
		dm_timer_count = omap4_dm_timer_count;
766 767
		dm_source_names = omap4_dm_source_names;
		dm_source_clocks = omap4_dm_source_clocks;
T
Timo Teras 已提交
768
	}
769 770 771 772 773

	if (cpu_class_is_omap2())
		for (i = 0; dm_source_names[i] != NULL; i++)
			dm_source_clocks[i] = clk_get(NULL, dm_source_names[i]);

774 775
	if (cpu_is_omap243x())
		dm_timers[0].phys_base = 0x49018000;
T
Timo Teras 已提交
776

777 778
	for (i = 0; i < dm_timer_count; i++) {
		timer = &dm_timers[i];
T
Tony Lindgren 已提交
779 780 781 782 783

		/* Static mapping, never released */
		timer->io_base = ioremap(timer->phys_base, map_size);
		BUG_ON(!timer->io_base);

784 785
#if defined(CONFIG_ARCH_OMAP2) || defined(CONFIG_ARCH_OMAP3) || \
					defined(CONFIG_ARCH_OMAP4)
786 787 788 789 790 791 792
		if (cpu_class_is_omap2()) {
			char clk_name[16];
			sprintf(clk_name, "gpt%d_ick", i + 1);
			timer->iclk = clk_get(NULL, clk_name);
			sprintf(clk_name, "gpt%d_fck", i + 1);
			timer->fclk = clk_get(NULL, clk_name);
		}
793
#endif
794 795 796 797
	}

	return 0;
}