timer.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756
  1. /*
  2. * linux/arch/arm/mach-omap2/timer.c
  3. *
  4. * OMAP2 GP timer support.
  5. *
  6. * Copyright (C) 2009 Nokia Corporation
  7. *
  8. * Update to use new clocksource/clockevent layers
  9. * Author: Kevin Hilman, MontaVista Software, Inc. <source@mvista.com>
  10. * Copyright (C) 2007 MontaVista Software, Inc.
  11. *
  12. * Original driver:
  13. * Copyright (C) 2005 Nokia Corporation
  14. * Author: Paul Mundt <paul.mundt@nokia.com>
  15. * Juha Yrjölä <juha.yrjola@nokia.com>
  16. * OMAP Dual-mode timer framework support by Timo Teras
  17. *
  18. * Some parts based off of TI's 24xx code:
  19. *
  20. * Copyright (C) 2004-2009 Texas Instruments, Inc.
  21. *
  22. * Roughly modelled after the OMAP1 MPU timer code.
  23. * Added OMAP4 support - Santosh Shilimkar <santosh.shilimkar@ti.com>
  24. *
  25. * This file is subject to the terms and conditions of the GNU General Public
  26. * License. See the file "COPYING" in the main directory of this archive
  27. * for more details.
  28. */
  29. #include <linux/init.h>
  30. #include <linux/time.h>
  31. #include <linux/interrupt.h>
  32. #include <linux/err.h>
  33. #include <linux/clk.h>
  34. #include <linux/delay.h>
  35. #include <linux/irq.h>
  36. #include <linux/clocksource.h>
  37. #include <linux/clockchips.h>
  38. #include <linux/slab.h>
  39. #include <linux/of.h>
  40. #include <linux/of_address.h>
  41. #include <linux/of_irq.h>
  42. #include <linux/platform_device.h>
  43. #include <linux/platform_data/dmtimer-omap.h>
  44. #include <asm/mach/time.h>
  45. #include <asm/smp_twd.h>
  46. #include <asm/sched_clock.h>
  47. #include <asm/arch_timer.h>
  48. #include "omap_hwmod.h"
  49. #include "omap_device.h"
  50. #include <plat/counter-32k.h>
  51. #include <plat/dmtimer.h>
  52. #include "omap-pm.h"
  53. #include "soc.h"
  54. #include "common.h"
  55. #include "powerdomain.h"
  56. /* Parent clocks, eventually these will come from the clock framework */
  57. #define OMAP2_MPU_SOURCE "sys_ck"
  58. #define OMAP3_MPU_SOURCE OMAP2_MPU_SOURCE
  59. #define OMAP4_MPU_SOURCE "sys_clkin_ck"
  60. #define OMAP2_32K_SOURCE "func_32k_ck"
  61. #define OMAP3_32K_SOURCE "omap_32k_fck"
  62. #define OMAP4_32K_SOURCE "sys_32k_ck"
  63. #define REALTIME_COUNTER_BASE 0x48243200
  64. #define INCREMENTER_NUMERATOR_OFFSET 0x10
  65. #define INCREMENTER_DENUMERATOR_RELOAD_OFFSET 0x14
  66. #define NUMERATOR_DENUMERATOR_MASK 0xfffff000
  67. /* Clockevent code */
  68. static struct omap_dm_timer clkev;
  69. static struct clock_event_device clockevent_gpt;
  70. static irqreturn_t omap2_gp_timer_interrupt(int irq, void *dev_id)
  71. {
  72. struct clock_event_device *evt = &clockevent_gpt;
  73. __omap_dm_timer_write_status(&clkev, OMAP_TIMER_INT_OVERFLOW);
  74. evt->event_handler(evt);
  75. return IRQ_HANDLED;
  76. }
  77. static struct irqaction omap2_gp_timer_irq = {
  78. .name = "gp_timer",
  79. .flags = IRQF_DISABLED | IRQF_TIMER | IRQF_IRQPOLL,
  80. .handler = omap2_gp_timer_interrupt,
  81. };
  82. static int omap2_gp_timer_set_next_event(unsigned long cycles,
  83. struct clock_event_device *evt)
  84. {
  85. __omap_dm_timer_load_start(&clkev, OMAP_TIMER_CTRL_ST,
  86. 0xffffffff - cycles, OMAP_TIMER_POSTED);
  87. return 0;
  88. }
  89. static void omap2_gp_timer_set_mode(enum clock_event_mode mode,
  90. struct clock_event_device *evt)
  91. {
  92. u32 period;
  93. __omap_dm_timer_stop(&clkev, OMAP_TIMER_POSTED, clkev.rate);
  94. switch (mode) {
  95. case CLOCK_EVT_MODE_PERIODIC:
  96. period = clkev.rate / HZ;
  97. period -= 1;
  98. /* Looks like we need to first set the load value separately */
  99. __omap_dm_timer_write(&clkev, OMAP_TIMER_LOAD_REG,
  100. 0xffffffff - period, OMAP_TIMER_POSTED);
  101. __omap_dm_timer_load_start(&clkev,
  102. OMAP_TIMER_CTRL_AR | OMAP_TIMER_CTRL_ST,
  103. 0xffffffff - period, OMAP_TIMER_POSTED);
  104. break;
  105. case CLOCK_EVT_MODE_ONESHOT:
  106. break;
  107. case CLOCK_EVT_MODE_UNUSED:
  108. case CLOCK_EVT_MODE_SHUTDOWN:
  109. case CLOCK_EVT_MODE_RESUME:
  110. break;
  111. }
  112. }
  113. static struct clock_event_device clockevent_gpt = {
  114. .features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT,
  115. .shift = 32,
  116. .rating = 300,
  117. .set_next_event = omap2_gp_timer_set_next_event,
  118. .set_mode = omap2_gp_timer_set_mode,
  119. };
  120. static struct property device_disabled = {
  121. .name = "status",
  122. .length = sizeof("disabled"),
  123. .value = "disabled",
  124. };
  125. static struct of_device_id omap_timer_match[] __initdata = {
  126. { .compatible = "ti,omap2-timer", },
  127. { }
  128. };
  129. /**
  130. * omap_get_timer_dt - get a timer using device-tree
  131. * @match - device-tree match structure for matching a device type
  132. * @property - optional timer property to match
  133. *
  134. * Helper function to get a timer during early boot using device-tree for use
  135. * as kernel system timer. Optionally, the property argument can be used to
  136. * select a timer with a specific property. Once a timer is found then mark
  137. * the timer node in device-tree as disabled, to prevent the kernel from
  138. * registering this timer as a platform device and so no one else can use it.
  139. */
  140. static struct device_node * __init omap_get_timer_dt(struct of_device_id *match,
  141. const char *property)
  142. {
  143. struct device_node *np;
  144. for_each_matching_node(np, match) {
  145. if (!of_device_is_available(np))
  146. continue;
  147. if (property && !of_get_property(np, property, NULL))
  148. continue;
  149. of_add_property(np, &device_disabled);
  150. return np;
  151. }
  152. return NULL;
  153. }
  154. /**
  155. * omap_dmtimer_init - initialisation function when device tree is used
  156. *
  157. * For secure OMAP3 devices, timers with device type "timer-secure" cannot
  158. * be used by the kernel as they are reserved. Therefore, to prevent the
  159. * kernel registering these devices remove them dynamically from the device
  160. * tree on boot.
  161. */
  162. static void __init omap_dmtimer_init(void)
  163. {
  164. struct device_node *np;
  165. if (!cpu_is_omap34xx())
  166. return;
  167. /* If we are a secure device, remove any secure timer nodes */
  168. if ((omap_type() != OMAP2_DEVICE_TYPE_GP)) {
  169. np = omap_get_timer_dt(omap_timer_match, "ti,timer-secure");
  170. if (np)
  171. of_node_put(np);
  172. }
  173. }
  174. /**
  175. * omap_dm_timer_get_errata - get errata flags for a timer
  176. *
  177. * Get the timer errata flags that are specific to the OMAP device being used.
  178. */
  179. static u32 __init omap_dm_timer_get_errata(void)
  180. {
  181. if (cpu_is_omap24xx())
  182. return 0;
  183. return OMAP_TIMER_ERRATA_I103_I767;
  184. }
  185. static int __init omap_dm_timer_init_one(struct omap_dm_timer *timer,
  186. int gptimer_id,
  187. const char *fck_source,
  188. const char *property,
  189. const char **timer_name,
  190. int posted)
  191. {
  192. char name[10]; /* 10 = sizeof("gptXX_Xck0") */
  193. const char *oh_name;
  194. struct device_node *np;
  195. struct omap_hwmod *oh;
  196. struct resource irq, mem;
  197. int r = 0;
  198. if (of_have_populated_dt()) {
  199. np = omap_get_timer_dt(omap_timer_match, NULL);
  200. if (!np)
  201. return -ENODEV;
  202. of_property_read_string_index(np, "ti,hwmods", 0, &oh_name);
  203. if (!oh_name)
  204. return -ENODEV;
  205. timer->irq = irq_of_parse_and_map(np, 0);
  206. if (!timer->irq)
  207. return -ENXIO;
  208. timer->io_base = of_iomap(np, 0);
  209. of_node_put(np);
  210. } else {
  211. if (omap_dm_timer_reserve_systimer(gptimer_id))
  212. return -ENODEV;
  213. sprintf(name, "timer%d", gptimer_id);
  214. oh_name = name;
  215. }
  216. oh = omap_hwmod_lookup(oh_name);
  217. if (!oh)
  218. return -ENODEV;
  219. *timer_name = oh->name;
  220. if (!of_have_populated_dt()) {
  221. r = omap_hwmod_get_resource_byname(oh, IORESOURCE_IRQ, NULL,
  222. &irq);
  223. if (r)
  224. return -ENXIO;
  225. timer->irq = irq.start;
  226. r = omap_hwmod_get_resource_byname(oh, IORESOURCE_MEM, NULL,
  227. &mem);
  228. if (r)
  229. return -ENXIO;
  230. /* Static mapping, never released */
  231. timer->io_base = ioremap(mem.start, mem.end - mem.start);
  232. }
  233. if (!timer->io_base)
  234. return -ENXIO;
  235. /* After the dmtimer is using hwmod these clocks won't be needed */
  236. timer->fclk = clk_get(NULL, omap_hwmod_get_main_clk(oh));
  237. if (IS_ERR(timer->fclk))
  238. return -ENODEV;
  239. /* FIXME: Need to remove hard-coded test on timer ID */
  240. if (gptimer_id != 12) {
  241. struct clk *src;
  242. src = clk_get(NULL, fck_source);
  243. if (IS_ERR(src)) {
  244. r = -EINVAL;
  245. } else {
  246. r = clk_set_parent(timer->fclk, src);
  247. if (r < 0)
  248. pr_warn("%s: %s cannot set source\n",
  249. __func__, oh->name);
  250. clk_put(src);
  251. }
  252. }
  253. omap_hwmod_setup_one(oh_name);
  254. omap_hwmod_enable(oh);
  255. __omap_dm_timer_init_regs(timer);
  256. if (posted)
  257. __omap_dm_timer_enable_posted(timer);
  258. /* Check that the intended posted configuration matches the actual */
  259. if (posted != timer->posted)
  260. return -EINVAL;
  261. timer->rate = clk_get_rate(timer->fclk);
  262. timer->reserved = 1;
  263. return r;
  264. }
  265. static void __init omap2_gp_clockevent_init(int gptimer_id,
  266. const char *fck_source,
  267. const char *property)
  268. {
  269. int res;
  270. clkev.errata = omap_dm_timer_get_errata();
  271. /*
  272. * For clock-event timers we never read the timer counter and
  273. * so we are not impacted by errata i103 and i767. Therefore,
  274. * we can safely ignore this errata for clock-event timers.
  275. */
  276. __omap_dm_timer_override_errata(&clkev, OMAP_TIMER_ERRATA_I103_I767);
  277. res = omap_dm_timer_init_one(&clkev, gptimer_id, fck_source, property,
  278. &clockevent_gpt.name, OMAP_TIMER_POSTED);
  279. BUG_ON(res);
  280. omap2_gp_timer_irq.dev_id = &clkev;
  281. setup_irq(clkev.irq, &omap2_gp_timer_irq);
  282. __omap_dm_timer_int_enable(&clkev, OMAP_TIMER_INT_OVERFLOW);
  283. clockevent_gpt.mult = div_sc(clkev.rate, NSEC_PER_SEC,
  284. clockevent_gpt.shift);
  285. clockevent_gpt.max_delta_ns =
  286. clockevent_delta2ns(0xffffffff, &clockevent_gpt);
  287. clockevent_gpt.min_delta_ns =
  288. clockevent_delta2ns(3, &clockevent_gpt);
  289. /* Timer internal resynch latency. */
  290. clockevent_gpt.cpumask = cpu_possible_mask;
  291. clockevent_gpt.irq = omap_dm_timer_get_irq(&clkev);
  292. clockevents_register_device(&clockevent_gpt);
  293. pr_info("OMAP clockevent source: %s at %lu Hz\n", clockevent_gpt.name,
  294. clkev.rate);
  295. }
  296. /* Clocksource code */
  297. static struct omap_dm_timer clksrc;
  298. static bool use_gptimer_clksrc;
  299. /*
  300. * clocksource
  301. */
  302. static cycle_t clocksource_read_cycles(struct clocksource *cs)
  303. {
  304. return (cycle_t)__omap_dm_timer_read_counter(&clksrc,
  305. OMAP_TIMER_NONPOSTED);
  306. }
  307. static struct clocksource clocksource_gpt = {
  308. .rating = 300,
  309. .read = clocksource_read_cycles,
  310. .mask = CLOCKSOURCE_MASK(32),
  311. .flags = CLOCK_SOURCE_IS_CONTINUOUS,
  312. };
  313. static u32 notrace dmtimer_read_sched_clock(void)
  314. {
  315. if (clksrc.reserved)
  316. return __omap_dm_timer_read_counter(&clksrc,
  317. OMAP_TIMER_NONPOSTED);
  318. return 0;
  319. }
  320. static struct of_device_id omap_counter_match[] __initdata = {
  321. { .compatible = "ti,omap-counter32k", },
  322. { }
  323. };
  324. /* Setup free-running counter for clocksource */
  325. static int __init __maybe_unused omap2_sync32k_clocksource_init(void)
  326. {
  327. int ret;
  328. struct device_node *np = NULL;
  329. struct omap_hwmod *oh;
  330. void __iomem *vbase;
  331. const char *oh_name = "counter_32k";
  332. /*
  333. * If device-tree is present, then search the DT blob
  334. * to see if the 32kHz counter is supported.
  335. */
  336. if (of_have_populated_dt()) {
  337. np = omap_get_timer_dt(omap_counter_match, NULL);
  338. if (!np)
  339. return -ENODEV;
  340. of_property_read_string_index(np, "ti,hwmods", 0, &oh_name);
  341. if (!oh_name)
  342. return -ENODEV;
  343. }
  344. /*
  345. * First check hwmod data is available for sync32k counter
  346. */
  347. oh = omap_hwmod_lookup(oh_name);
  348. if (!oh || oh->slaves_cnt == 0)
  349. return -ENODEV;
  350. omap_hwmod_setup_one(oh_name);
  351. if (np) {
  352. vbase = of_iomap(np, 0);
  353. of_node_put(np);
  354. } else {
  355. vbase = omap_hwmod_get_mpu_rt_va(oh);
  356. }
  357. if (!vbase) {
  358. pr_warn("%s: failed to get counter_32k resource\n", __func__);
  359. return -ENXIO;
  360. }
  361. ret = omap_hwmod_enable(oh);
  362. if (ret) {
  363. pr_warn("%s: failed to enable counter_32k module (%d)\n",
  364. __func__, ret);
  365. return ret;
  366. }
  367. ret = omap_init_clocksource_32k(vbase);
  368. if (ret) {
  369. pr_warn("%s: failed to initialize counter_32k as a clocksource (%d)\n",
  370. __func__, ret);
  371. omap_hwmod_idle(oh);
  372. }
  373. return ret;
  374. }
  375. static void __init omap2_gptimer_clocksource_init(int gptimer_id,
  376. const char *fck_source)
  377. {
  378. int res;
  379. clksrc.errata = omap_dm_timer_get_errata();
  380. res = omap_dm_timer_init_one(&clksrc, gptimer_id, fck_source, NULL,
  381. &clocksource_gpt.name,
  382. OMAP_TIMER_NONPOSTED);
  383. BUG_ON(res);
  384. __omap_dm_timer_load_start(&clksrc,
  385. OMAP_TIMER_CTRL_ST | OMAP_TIMER_CTRL_AR, 0,
  386. OMAP_TIMER_NONPOSTED);
  387. setup_sched_clock(dmtimer_read_sched_clock, 32, clksrc.rate);
  388. if (clocksource_register_hz(&clocksource_gpt, clksrc.rate))
  389. pr_err("Could not register clocksource %s\n",
  390. clocksource_gpt.name);
  391. else
  392. pr_info("OMAP clocksource: %s at %lu Hz\n",
  393. clocksource_gpt.name, clksrc.rate);
  394. }
  395. #ifdef CONFIG_SOC_HAS_REALTIME_COUNTER
  396. /*
  397. * The realtime counter also called master counter, is a free-running
  398. * counter, which is related to real time. It produces the count used
  399. * by the CPU local timer peripherals in the MPU cluster. The timer counts
  400. * at a rate of 6.144 MHz. Because the device operates on different clocks
  401. * in different power modes, the master counter shifts operation between
  402. * clocks, adjusting the increment per clock in hardware accordingly to
  403. * maintain a constant count rate.
  404. */
  405. static void __init realtime_counter_init(void)
  406. {
  407. void __iomem *base;
  408. static struct clk *sys_clk;
  409. unsigned long rate;
  410. unsigned int reg, num, den;
  411. base = ioremap(REALTIME_COUNTER_BASE, SZ_32);
  412. if (!base) {
  413. pr_err("%s: ioremap failed\n", __func__);
  414. return;
  415. }
  416. sys_clk = clk_get(NULL, "sys_clkin_ck");
  417. if (IS_ERR(sys_clk)) {
  418. pr_err("%s: failed to get system clock handle\n", __func__);
  419. iounmap(base);
  420. return;
  421. }
  422. rate = clk_get_rate(sys_clk);
  423. /* Numerator/denumerator values refer TRM Realtime Counter section */
  424. switch (rate) {
  425. case 1200000:
  426. num = 64;
  427. den = 125;
  428. break;
  429. case 1300000:
  430. num = 768;
  431. den = 1625;
  432. break;
  433. case 19200000:
  434. num = 8;
  435. den = 25;
  436. break;
  437. case 2600000:
  438. num = 384;
  439. den = 1625;
  440. break;
  441. case 2700000:
  442. num = 256;
  443. den = 1125;
  444. break;
  445. case 38400000:
  446. default:
  447. /* Program it for 38.4 MHz */
  448. num = 4;
  449. den = 25;
  450. break;
  451. }
  452. /* Program numerator and denumerator registers */
  453. reg = __raw_readl(base + INCREMENTER_NUMERATOR_OFFSET) &
  454. NUMERATOR_DENUMERATOR_MASK;
  455. reg |= num;
  456. __raw_writel(reg, base + INCREMENTER_NUMERATOR_OFFSET);
  457. reg = __raw_readl(base + INCREMENTER_NUMERATOR_OFFSET) &
  458. NUMERATOR_DENUMERATOR_MASK;
  459. reg |= den;
  460. __raw_writel(reg, base + INCREMENTER_DENUMERATOR_RELOAD_OFFSET);
  461. iounmap(base);
  462. }
  463. #else
  464. static inline void __init realtime_counter_init(void)
  465. {}
  466. #endif
  467. #define OMAP_SYS_GP_TIMER_INIT(name, clkev_nr, clkev_src, clkev_prop, \
  468. clksrc_nr, clksrc_src) \
  469. void __init omap##name##_gptimer_timer_init(void) \
  470. { \
  471. omap_dmtimer_init(); \
  472. omap2_gp_clockevent_init((clkev_nr), clkev_src, clkev_prop); \
  473. omap2_gptimer_clocksource_init((clksrc_nr), clksrc_src); \
  474. }
  475. #define OMAP_SYS_32K_TIMER_INIT(name, clkev_nr, clkev_src, clkev_prop, \
  476. clksrc_nr, clksrc_src) \
  477. void __init omap##name##_sync32k_timer_init(void) \
  478. { \
  479. omap_dmtimer_init(); \
  480. omap2_gp_clockevent_init((clkev_nr), clkev_src, clkev_prop); \
  481. /* Enable the use of clocksource="gp_timer" kernel parameter */ \
  482. if (use_gptimer_clksrc) \
  483. omap2_gptimer_clocksource_init((clksrc_nr), clksrc_src);\
  484. else \
  485. omap2_sync32k_clocksource_init(); \
  486. }
  487. #ifdef CONFIG_ARCH_OMAP2
  488. OMAP_SYS_32K_TIMER_INIT(2, 1, OMAP2_32K_SOURCE, "ti,timer-alwon",
  489. 2, OMAP2_MPU_SOURCE);
  490. #endif /* CONFIG_ARCH_OMAP2 */
  491. #ifdef CONFIG_ARCH_OMAP3
  492. OMAP_SYS_32K_TIMER_INIT(3, 1, OMAP3_32K_SOURCE, "ti,timer-alwon",
  493. 2, OMAP3_MPU_SOURCE);
  494. OMAP_SYS_32K_TIMER_INIT(3_secure, 12, OMAP3_32K_SOURCE, "ti,timer-secure",
  495. 2, OMAP3_MPU_SOURCE);
  496. OMAP_SYS_GP_TIMER_INIT(3_gp, 1, OMAP3_MPU_SOURCE, "ti,timer-alwon",
  497. 2, OMAP3_MPU_SOURCE);
  498. #endif /* CONFIG_ARCH_OMAP3 */
  499. #ifdef CONFIG_SOC_AM33XX
  500. OMAP_SYS_GP_TIMER_INIT(3_am33xx, 1, OMAP4_MPU_SOURCE, "ti,timer-alwon",
  501. 2, OMAP4_MPU_SOURCE);
  502. #endif /* CONFIG_SOC_AM33XX */
  503. #ifdef CONFIG_ARCH_OMAP4
  504. OMAP_SYS_32K_TIMER_INIT(4, 1, OMAP4_32K_SOURCE, "ti,timer-alwon",
  505. 2, OMAP4_MPU_SOURCE);
  506. #ifdef CONFIG_LOCAL_TIMERS
  507. static DEFINE_TWD_LOCAL_TIMER(twd_local_timer, OMAP44XX_LOCAL_TWD_BASE, 29);
  508. void __init omap4_local_timer_init(void)
  509. {
  510. omap4_sync32k_timer_init();
  511. /* Local timers are not supprted on OMAP4430 ES1.0 */
  512. if (omap_rev() != OMAP4430_REV_ES1_0) {
  513. int err;
  514. if (of_have_populated_dt()) {
  515. twd_local_timer_of_register();
  516. return;
  517. }
  518. err = twd_local_timer_register(&twd_local_timer);
  519. if (err)
  520. pr_err("twd_local_timer_register failed %d\n", err);
  521. }
  522. }
  523. #else /* CONFIG_LOCAL_TIMERS */
  524. void __init omap4_local_timer_init(void)
  525. {
  526. omap4_sync32k_timer_init();
  527. }
  528. #endif /* CONFIG_LOCAL_TIMERS */
  529. #endif /* CONFIG_ARCH_OMAP4 */
  530. #ifdef CONFIG_SOC_OMAP5
  531. OMAP_SYS_32K_TIMER_INIT(5, 1, OMAP4_32K_SOURCE, "ti,timer-alwon",
  532. 2, OMAP4_MPU_SOURCE);
  533. void __init omap5_realtime_timer_init(void)
  534. {
  535. int err;
  536. omap5_sync32k_timer_init();
  537. realtime_counter_init();
  538. err = arch_timer_of_register();
  539. if (err)
  540. pr_err("%s: arch_timer_register failed %d\n", __func__, err);
  541. }
  542. #endif /* CONFIG_SOC_OMAP5 */
  543. /**
  544. * omap_timer_init - build and register timer device with an
  545. * associated timer hwmod
  546. * @oh: timer hwmod pointer to be used to build timer device
  547. * @user: parameter that can be passed from calling hwmod API
  548. *
  549. * Called by omap_hwmod_for_each_by_class to register each of the timer
  550. * devices present in the system. The number of timer devices is known
  551. * by parsing through the hwmod database for a given class name. At the
  552. * end of function call memory is allocated for timer device and it is
  553. * registered to the framework ready to be proved by the driver.
  554. */
  555. static int __init omap_timer_init(struct omap_hwmod *oh, void *unused)
  556. {
  557. int id;
  558. int ret = 0;
  559. char *name = "omap_timer";
  560. struct dmtimer_platform_data *pdata;
  561. struct platform_device *pdev;
  562. struct omap_timer_capability_dev_attr *timer_dev_attr;
  563. pr_debug("%s: %s\n", __func__, oh->name);
  564. /* on secure device, do not register secure timer */
  565. timer_dev_attr = oh->dev_attr;
  566. if (omap_type() != OMAP2_DEVICE_TYPE_GP && timer_dev_attr)
  567. if (timer_dev_attr->timer_capability == OMAP_TIMER_SECURE)
  568. return ret;
  569. pdata = kzalloc(sizeof(*pdata), GFP_KERNEL);
  570. if (!pdata) {
  571. pr_err("%s: No memory for [%s]\n", __func__, oh->name);
  572. return -ENOMEM;
  573. }
  574. /*
  575. * Extract the IDs from name field in hwmod database
  576. * and use the same for constructing ids' for the
  577. * timer devices. In a way, we are avoiding usage of
  578. * static variable witin the function to do the same.
  579. * CAUTION: We have to be careful and make sure the
  580. * name in hwmod database does not change in which case
  581. * we might either make corresponding change here or
  582. * switch back static variable mechanism.
  583. */
  584. sscanf(oh->name, "timer%2d", &id);
  585. if (timer_dev_attr)
  586. pdata->timer_capability = timer_dev_attr->timer_capability;
  587. pdata->timer_errata = omap_dm_timer_get_errata();
  588. pdata->get_context_loss_count = omap_pm_get_dev_context_loss_count;
  589. pdev = omap_device_build(name, id, oh, pdata, sizeof(*pdata),
  590. NULL, 0, 0);
  591. if (IS_ERR(pdev)) {
  592. pr_err("%s: Can't build omap_device for %s: %s.\n",
  593. __func__, name, oh->name);
  594. ret = -EINVAL;
  595. }
  596. kfree(pdata);
  597. return ret;
  598. }
  599. /**
  600. * omap2_dm_timer_init - top level regular device initialization
  601. *
  602. * Uses dedicated hwmod api to parse through hwmod database for
  603. * given class name and then build and register the timer device.
  604. */
  605. static int __init omap2_dm_timer_init(void)
  606. {
  607. int ret;
  608. /* If dtb is there, the devices will be created dynamically */
  609. if (of_have_populated_dt())
  610. return -ENODEV;
  611. ret = omap_hwmod_for_each_by_class("timer", omap_timer_init, NULL);
  612. if (unlikely(ret)) {
  613. pr_err("%s: device registration failed.\n", __func__);
  614. return -EINVAL;
  615. }
  616. return 0;
  617. }
  618. arch_initcall(omap2_dm_timer_init);
  619. /**
  620. * omap2_override_clocksource - clocksource override with user configuration
  621. *
  622. * Allows user to override default clocksource, using kernel parameter
  623. * clocksource="gp_timer" (For all OMAP2PLUS architectures)
  624. *
  625. * Note that, here we are using same standard kernel parameter "clocksource=",
  626. * and not introducing any OMAP specific interface.
  627. */
  628. static int __init omap2_override_clocksource(char *str)
  629. {
  630. if (!str)
  631. return 0;
  632. /*
  633. * For OMAP architecture, we only have two options
  634. * - sync_32k (default)
  635. * - gp_timer (sys_clk based)
  636. */
  637. if (!strcmp(str, "gp_timer"))
  638. use_gptimer_clksrc = true;
  639. return 0;
  640. }
  641. early_param("clocksource", omap2_override_clocksource);