Blame view
arch/arm/plat-omap/counter_32k.c
3.3 KB
aa218dafd
|
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 |
/* * OMAP 32ksynctimer/counter_32k-related code * * Copyright (C) 2009 Texas Instruments * Copyright (C) 2010 Nokia Corporation * Tony Lindgren <tony@atomide.com> * Added OMAP4 support - Santosh Shilimkar <santosh.shilimkar@ti.com> * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License version 2 as * published by the Free Software Foundation. * * NOTE: This timer is not the same timer as the old OMAP1 MPU timer. */ #include <linux/kernel.h> #include <linux/init.h> #include <linux/clk.h> |
cb9675f32
|
18 |
#include <linux/err.h> |
aa218dafd
|
19 |
#include <linux/io.h> |
354a183f5
|
20 |
#include <linux/clocksource.h> |
aa218dafd
|
21 |
|
dc548fbbd
|
22 |
#include <asm/sched_clock.h> |
aa218dafd
|
23 24 25 26 27 |
#include <plat/common.h> #include <plat/board.h> #include <plat/clock.h> |
aa218dafd
|
28 29 30 31 32 33 |
/* * 32KHz clocksource ... always available, on pretty most chips except * OMAP 730 and 1510. Other timers could be used as clocksources, with * higher resolution in free-running counter modes (e.g. 12 MHz xtal), * but systems won't necessarily want to spend resources that way. */ |
354a183f5
|
34 |
static void __iomem *timer_32k_base; |
aa218dafd
|
35 36 |
#define OMAP16XX_TIMER_32K_SYNCHRONIZED 0xfffbc410 |
2f0778afa
|
37 |
static u32 notrace omap_32k_read_sched_clock(void) |
aa218dafd
|
38 |
{ |
2f0778afa
|
39 |
return timer_32k_base ? __raw_readl(timer_32k_base) : 0; |
aa218dafd
|
40 41 42 43 44 45 46 47 48 49 50 |
} /** * read_persistent_clock - Return time from a persistent clock. * * Reads the time from a source which isn't disabled during PM, the * 32k sync timer. Convert the cycles elapsed since last read into * nsecs and adds to a monotonically increasing timespec. */ static struct timespec persistent_ts; static cycles_t cycles, last_cycles; |
354a183f5
|
51 |
static unsigned int persistent_mult, persistent_shift; |
aa218dafd
|
52 53 54 55 56 57 58 |
void read_persistent_clock(struct timespec *ts) { unsigned long long nsecs; cycles_t delta; struct timespec *tsp = &persistent_ts; last_cycles = cycles; |
354a183f5
|
59 |
cycles = timer_32k_base ? __raw_readl(timer_32k_base) : 0; |
aa218dafd
|
60 |
delta = cycles - last_cycles; |
354a183f5
|
61 |
nsecs = clocksource_cyc2ns(delta, persistent_mult, persistent_shift); |
aa218dafd
|
62 63 64 65 |
timespec_add_ns(tsp, nsecs); *ts = *tsp; } |
d8328f3b8
|
66 |
int __init omap_init_clocksource_32k(void) |
aa218dafd
|
67 68 69 70 71 72 |
{ static char err[] __initdata = KERN_ERR "%s: can't register clocksource! "; if (cpu_is_omap16xx() || cpu_class_is_omap2()) { |
354a183f5
|
73 74 75 |
u32 pbase; unsigned long size = SZ_4K; void __iomem *base; |
aa218dafd
|
76 |
struct clk *sync_32k_ick; |
354a183f5
|
77 78 79 80 81 |
if (cpu_is_omap16xx()) { pbase = OMAP16XX_TIMER_32K_SYNCHRONIZED; size = SZ_1K; } else if (cpu_is_omap2420()) pbase = OMAP2420_32KSYNCT_BASE + 0x10; |
aa218dafd
|
82 |
else if (cpu_is_omap2430()) |
354a183f5
|
83 |
pbase = OMAP2430_32KSYNCT_BASE + 0x10; |
aa218dafd
|
84 |
else if (cpu_is_omap34xx()) |
354a183f5
|
85 |
pbase = OMAP3430_32KSYNCT_BASE + 0x10; |
aa218dafd
|
86 |
else if (cpu_is_omap44xx()) |
354a183f5
|
87 |
pbase = OMAP4430_32KSYNCT_BASE + 0x10; |
aa218dafd
|
88 89 |
else return -ENODEV; |
354a183f5
|
90 91 92 93 |
/* For this to work we must have a static mapping in io.c for this area */ base = ioremap(pbase, size); if (!base) return -ENODEV; |
aa218dafd
|
94 |
sync_32k_ick = clk_get(NULL, "omap_32ksync_ick"); |
cb9675f32
|
95 |
if (!IS_ERR(sync_32k_ick)) |
aa218dafd
|
96 |
clk_enable(sync_32k_ick); |
354a183f5
|
97 98 99 100 101 102 103 104 |
timer_32k_base = base; /* * 120000 rough estimate from the calculations in * __clocksource_updatefreq_scale. */ clocks_calc_mult_shift(&persistent_mult, &persistent_shift, 32768, NSEC_PER_SEC, 120000); |
aa218dafd
|
105 |
|
354a183f5
|
106 107 108 |
if (clocksource_mmio_init(base, "32k_counter", 32768, 250, 32, clocksource_mmio_readl_up)) printk(err, "32k_counter"); |
dc548fbbd
|
109 |
|
2f0778afa
|
110 |
setup_sched_clock(omap_32k_read_sched_clock, 32, 32768); |
aa218dafd
|
111 112 113 |
} return 0; } |