timer.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775
  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 <linux/sched_clock.h>
  45. #include <asm/mach/time.h>
  46. #include <asm/smp_twd.h>
  47. #include "omap_hwmod.h"
  48. #include "omap_device.h"
  49. #include <plat/counter-32k.h>
  50. #include <plat/dmtimer.h>
  51. #include "omap-pm.h"
  52. #include "soc.h"
  53. #include "common.h"
  54. #include "control.h"
  55. #include "powerdomain.h"
  56. #include "omap-secure.h"
  57. #define REALTIME_COUNTER_BASE 0x48243200
  58. #define INCREMENTER_NUMERATOR_OFFSET 0x10
  59. #define INCREMENTER_DENUMERATOR_RELOAD_OFFSET 0x14
  60. #define NUMERATOR_DENUMERATOR_MASK 0xfffff000
  61. /* Clockevent code */
  62. static struct omap_dm_timer clkev;
  63. static struct clock_event_device clockevent_gpt;
  64. #ifdef CONFIG_SOC_HAS_REALTIME_COUNTER
  65. static unsigned long arch_timer_freq;
  66. void set_cntfreq(void)
  67. {
  68. omap_smc1(OMAP5_DRA7_MON_SET_CNTFRQ_INDEX, arch_timer_freq);
  69. }
  70. #endif
  71. static irqreturn_t omap2_gp_timer_interrupt(int irq, void *dev_id)
  72. {
  73. struct clock_event_device *evt = &clockevent_gpt;
  74. __omap_dm_timer_write_status(&clkev, OMAP_TIMER_INT_OVERFLOW);
  75. evt->event_handler(evt);
  76. return IRQ_HANDLED;
  77. }
  78. static struct irqaction omap2_gp_timer_irq = {
  79. .name = "gp_timer",
  80. .flags = IRQF_TIMER | IRQF_IRQPOLL,
  81. .handler = omap2_gp_timer_interrupt,
  82. };
  83. static int omap2_gp_timer_set_next_event(unsigned long cycles,
  84. struct clock_event_device *evt)
  85. {
  86. __omap_dm_timer_load_start(&clkev, OMAP_TIMER_CTRL_ST,
  87. 0xffffffff - cycles, OMAP_TIMER_POSTED);
  88. return 0;
  89. }
  90. static int omap2_gp_timer_shutdown(struct clock_event_device *evt)
  91. {
  92. __omap_dm_timer_stop(&clkev, OMAP_TIMER_POSTED, clkev.rate);
  93. return 0;
  94. }
  95. static int omap2_gp_timer_set_periodic(struct clock_event_device *evt)
  96. {
  97. u32 period;
  98. __omap_dm_timer_stop(&clkev, OMAP_TIMER_POSTED, clkev.rate);
  99. period = clkev.rate / HZ;
  100. period -= 1;
  101. /* Looks like we need to first set the load value separately */
  102. __omap_dm_timer_write(&clkev, OMAP_TIMER_LOAD_REG, 0xffffffff - period,
  103. OMAP_TIMER_POSTED);
  104. __omap_dm_timer_load_start(&clkev,
  105. OMAP_TIMER_CTRL_AR | OMAP_TIMER_CTRL_ST,
  106. 0xffffffff - period, OMAP_TIMER_POSTED);
  107. return 0;
  108. }
  109. static struct clock_event_device clockevent_gpt = {
  110. .features = CLOCK_EVT_FEAT_PERIODIC |
  111. CLOCK_EVT_FEAT_ONESHOT,
  112. .rating = 300,
  113. .set_next_event = omap2_gp_timer_set_next_event,
  114. .set_state_shutdown = omap2_gp_timer_shutdown,
  115. .set_state_periodic = omap2_gp_timer_set_periodic,
  116. .set_state_oneshot = omap2_gp_timer_shutdown,
  117. .tick_resume = omap2_gp_timer_shutdown,
  118. };
  119. static struct property device_disabled = {
  120. .name = "status",
  121. .length = sizeof("disabled"),
  122. .value = "disabled",
  123. };
  124. static const struct of_device_id omap_timer_match[] __initconst = {
  125. { .compatible = "ti,omap2420-timer", },
  126. { .compatible = "ti,omap3430-timer", },
  127. { .compatible = "ti,omap4430-timer", },
  128. { .compatible = "ti,omap5430-timer", },
  129. { .compatible = "ti,dm814-timer", },
  130. { .compatible = "ti,dm816-timer", },
  131. { .compatible = "ti,am335x-timer", },
  132. { .compatible = "ti,am335x-timer-1ms", },
  133. { }
  134. };
  135. /**
  136. * omap_get_timer_dt - get a timer using device-tree
  137. * @match - device-tree match structure for matching a device type
  138. * @property - optional timer property to match
  139. *
  140. * Helper function to get a timer during early boot using device-tree for use
  141. * as kernel system timer. Optionally, the property argument can be used to
  142. * select a timer with a specific property. Once a timer is found then mark
  143. * the timer node in device-tree as disabled, to prevent the kernel from
  144. * registering this timer as a platform device and so no one else can use it.
  145. */
  146. static struct device_node * __init omap_get_timer_dt(const struct of_device_id *match,
  147. const char *property)
  148. {
  149. struct device_node *np;
  150. for_each_matching_node(np, match) {
  151. if (!of_device_is_available(np))
  152. continue;
  153. if (property && !of_get_property(np, property, NULL))
  154. continue;
  155. if (!property && (of_get_property(np, "ti,timer-alwon", NULL) ||
  156. of_get_property(np, "ti,timer-dsp", NULL) ||
  157. of_get_property(np, "ti,timer-pwm", NULL) ||
  158. of_get_property(np, "ti,timer-secure", NULL)))
  159. continue;
  160. if (!of_device_is_compatible(np, "ti,omap-counter32k"))
  161. of_add_property(np, &device_disabled);
  162. return np;
  163. }
  164. return NULL;
  165. }
  166. /**
  167. * omap_dmtimer_init - initialisation function when device tree is used
  168. *
  169. * For secure OMAP3/DRA7xx devices, timers with device type "timer-secure"
  170. * cannot be used by the kernel as they are reserved. Therefore, to prevent the
  171. * kernel registering these devices remove them dynamically from the device
  172. * tree on boot.
  173. */
  174. static void __init omap_dmtimer_init(void)
  175. {
  176. struct device_node *np;
  177. if (!cpu_is_omap34xx() && !soc_is_dra7xx())
  178. return;
  179. /* If we are a secure device, remove any secure timer nodes */
  180. if ((omap_type() != OMAP2_DEVICE_TYPE_GP)) {
  181. np = omap_get_timer_dt(omap_timer_match, "ti,timer-secure");
  182. of_node_put(np);
  183. }
  184. }
  185. /**
  186. * omap_dm_timer_get_errata - get errata flags for a timer
  187. *
  188. * Get the timer errata flags that are specific to the OMAP device being used.
  189. */
  190. static u32 __init omap_dm_timer_get_errata(void)
  191. {
  192. if (cpu_is_omap24xx())
  193. return 0;
  194. return OMAP_TIMER_ERRATA_I103_I767;
  195. }
  196. static int __init omap_dm_timer_init_one(struct omap_dm_timer *timer,
  197. const char *fck_source,
  198. const char *property,
  199. const char **timer_name,
  200. int posted)
  201. {
  202. char name[10]; /* 10 = sizeof("gptXX_Xck0") */
  203. const char *oh_name = NULL;
  204. struct device_node *np;
  205. struct omap_hwmod *oh;
  206. struct resource irq, mem;
  207. struct clk *src;
  208. int r = 0;
  209. if (of_have_populated_dt()) {
  210. np = omap_get_timer_dt(omap_timer_match, property);
  211. if (!np)
  212. return -ENODEV;
  213. of_property_read_string_index(np, "ti,hwmods", 0, &oh_name);
  214. if (!oh_name)
  215. return -ENODEV;
  216. timer->irq = irq_of_parse_and_map(np, 0);
  217. if (!timer->irq)
  218. return -ENXIO;
  219. timer->io_base = of_iomap(np, 0);
  220. of_node_put(np);
  221. } else {
  222. if (omap_dm_timer_reserve_systimer(timer->id))
  223. return -ENODEV;
  224. sprintf(name, "timer%d", timer->id);
  225. oh_name = name;
  226. }
  227. oh = omap_hwmod_lookup(oh_name);
  228. if (!oh)
  229. return -ENODEV;
  230. *timer_name = oh->name;
  231. if (!of_have_populated_dt()) {
  232. r = omap_hwmod_get_resource_byname(oh, IORESOURCE_IRQ, NULL,
  233. &irq);
  234. if (r)
  235. return -ENXIO;
  236. timer->irq = irq.start;
  237. r = omap_hwmod_get_resource_byname(oh, IORESOURCE_MEM, NULL,
  238. &mem);
  239. if (r)
  240. return -ENXIO;
  241. /* Static mapping, never released */
  242. timer->io_base = ioremap(mem.start, mem.end - mem.start);
  243. }
  244. if (!timer->io_base)
  245. return -ENXIO;
  246. omap_hwmod_setup_one(oh_name);
  247. /* After the dmtimer is using hwmod these clocks won't be needed */
  248. timer->fclk = clk_get(NULL, omap_hwmod_get_main_clk(oh));
  249. if (IS_ERR(timer->fclk))
  250. return PTR_ERR(timer->fclk);
  251. src = clk_get(NULL, fck_source);
  252. if (IS_ERR(src))
  253. return PTR_ERR(src);
  254. WARN(clk_set_parent(timer->fclk, src) < 0,
  255. "Cannot set timer parent clock, no PLL clock driver?");
  256. clk_put(src);
  257. omap_hwmod_enable(oh);
  258. __omap_dm_timer_init_regs(timer);
  259. if (posted)
  260. __omap_dm_timer_enable_posted(timer);
  261. /* Check that the intended posted configuration matches the actual */
  262. if (posted != timer->posted)
  263. return -EINVAL;
  264. timer->rate = clk_get_rate(timer->fclk);
  265. timer->reserved = 1;
  266. return r;
  267. }
  268. #if !defined(CONFIG_SMP) && defined(CONFIG_GENERIC_CLOCKEVENTS_BROADCAST)
  269. void tick_broadcast(const struct cpumask *mask)
  270. {
  271. }
  272. #endif
  273. static void __init omap2_gp_clockevent_init(int gptimer_id,
  274. const char *fck_source,
  275. const char *property)
  276. {
  277. int res;
  278. clkev.id = gptimer_id;
  279. clkev.errata = omap_dm_timer_get_errata();
  280. /*
  281. * For clock-event timers we never read the timer counter and
  282. * so we are not impacted by errata i103 and i767. Therefore,
  283. * we can safely ignore this errata for clock-event timers.
  284. */
  285. __omap_dm_timer_override_errata(&clkev, OMAP_TIMER_ERRATA_I103_I767);
  286. res = omap_dm_timer_init_one(&clkev, fck_source, property,
  287. &clockevent_gpt.name, OMAP_TIMER_POSTED);
  288. BUG_ON(res);
  289. omap2_gp_timer_irq.dev_id = &clkev;
  290. setup_irq(clkev.irq, &omap2_gp_timer_irq);
  291. __omap_dm_timer_int_enable(&clkev, OMAP_TIMER_INT_OVERFLOW);
  292. clockevent_gpt.cpumask = cpu_possible_mask;
  293. clockevent_gpt.irq = omap_dm_timer_get_irq(&clkev);
  294. clockevents_config_and_register(&clockevent_gpt, clkev.rate,
  295. 3, /* Timer internal resynch latency */
  296. 0xffffffff);
  297. pr_info("OMAP clockevent source: %s at %lu Hz\n", clockevent_gpt.name,
  298. clkev.rate);
  299. }
  300. /* Clocksource code */
  301. static struct omap_dm_timer clksrc;
  302. static bool use_gptimer_clksrc __initdata;
  303. /*
  304. * clocksource
  305. */
  306. static u64 clocksource_read_cycles(struct clocksource *cs)
  307. {
  308. return (u64)__omap_dm_timer_read_counter(&clksrc,
  309. OMAP_TIMER_NONPOSTED);
  310. }
  311. static struct clocksource clocksource_gpt = {
  312. .rating = 300,
  313. .read = clocksource_read_cycles,
  314. .mask = CLOCKSOURCE_MASK(32),
  315. .flags = CLOCK_SOURCE_IS_CONTINUOUS,
  316. };
  317. static u64 notrace dmtimer_read_sched_clock(void)
  318. {
  319. if (clksrc.reserved)
  320. return __omap_dm_timer_read_counter(&clksrc,
  321. OMAP_TIMER_NONPOSTED);
  322. return 0;
  323. }
  324. static const struct of_device_id omap_counter_match[] __initconst = {
  325. { .compatible = "ti,omap-counter32k", },
  326. { }
  327. };
  328. /* Setup free-running counter for clocksource */
  329. static int __init __maybe_unused omap2_sync32k_clocksource_init(void)
  330. {
  331. int ret;
  332. struct device_node *np = NULL;
  333. struct omap_hwmod *oh;
  334. const char *oh_name = "counter_32k";
  335. /*
  336. * If device-tree is present, then search the DT blob
  337. * to see if the 32kHz counter is supported.
  338. */
  339. if (of_have_populated_dt()) {
  340. np = omap_get_timer_dt(omap_counter_match, NULL);
  341. if (!np)
  342. return -ENODEV;
  343. of_property_read_string_index(np, "ti,hwmods", 0, &oh_name);
  344. if (!oh_name)
  345. return -ENODEV;
  346. }
  347. /*
  348. * First check hwmod data is available for sync32k counter
  349. */
  350. oh = omap_hwmod_lookup(oh_name);
  351. if (!oh || oh->slaves_cnt == 0)
  352. return -ENODEV;
  353. omap_hwmod_setup_one(oh_name);
  354. ret = omap_hwmod_enable(oh);
  355. if (ret) {
  356. pr_warn("%s: failed to enable counter_32k module (%d)\n",
  357. __func__, ret);
  358. return ret;
  359. }
  360. if (!of_have_populated_dt()) {
  361. void __iomem *vbase;
  362. vbase = omap_hwmod_get_mpu_rt_va(oh);
  363. ret = omap_init_clocksource_32k(vbase);
  364. if (ret) {
  365. pr_warn("%s: failed to initialize counter_32k as a clocksource (%d)\n",
  366. __func__, ret);
  367. omap_hwmod_idle(oh);
  368. }
  369. }
  370. return ret;
  371. }
  372. static void __init omap2_gptimer_clocksource_init(int gptimer_id,
  373. const char *fck_source,
  374. const char *property)
  375. {
  376. int res;
  377. clksrc.id = gptimer_id;
  378. clksrc.errata = omap_dm_timer_get_errata();
  379. res = omap_dm_timer_init_one(&clksrc, fck_source, property,
  380. &clocksource_gpt.name,
  381. OMAP_TIMER_NONPOSTED);
  382. BUG_ON(res);
  383. __omap_dm_timer_load_start(&clksrc,
  384. OMAP_TIMER_CTRL_ST | OMAP_TIMER_CTRL_AR, 0,
  385. OMAP_TIMER_NONPOSTED);
  386. sched_clock_register(dmtimer_read_sched_clock, 32, clksrc.rate);
  387. if (clocksource_register_hz(&clocksource_gpt, clksrc.rate))
  388. pr_err("Could not register clocksource %s\n",
  389. clocksource_gpt.name);
  390. else
  391. pr_info("OMAP clocksource: %s at %lu Hz\n",
  392. clocksource_gpt.name, clksrc.rate);
  393. }
  394. static void __init __omap_sync32k_timer_init(int clkev_nr, const char *clkev_src,
  395. const char *clkev_prop, int clksrc_nr, const char *clksrc_src,
  396. const char *clksrc_prop, bool gptimer)
  397. {
  398. omap_clk_init();
  399. omap_dmtimer_init();
  400. omap2_gp_clockevent_init(clkev_nr, clkev_src, clkev_prop);
  401. /* Enable the use of clocksource="gp_timer" kernel parameter */
  402. if (use_gptimer_clksrc || gptimer)
  403. omap2_gptimer_clocksource_init(clksrc_nr, clksrc_src,
  404. clksrc_prop);
  405. else
  406. omap2_sync32k_clocksource_init();
  407. }
  408. void __init omap_init_time(void)
  409. {
  410. __omap_sync32k_timer_init(1, "timer_32k_ck", "ti,timer-alwon",
  411. 2, "timer_sys_ck", NULL, false);
  412. clocksource_probe();
  413. }
  414. #if defined(CONFIG_ARCH_OMAP3) || defined(CONFIG_SOC_AM43XX)
  415. void __init omap3_secure_sync32k_timer_init(void)
  416. {
  417. __omap_sync32k_timer_init(12, "secure_32k_fck", "ti,timer-secure",
  418. 2, "timer_sys_ck", NULL, false);
  419. clocksource_probe();
  420. }
  421. #endif /* CONFIG_ARCH_OMAP3 */
  422. #if defined(CONFIG_ARCH_OMAP3) || defined(CONFIG_SOC_AM33XX)
  423. void __init omap3_gptimer_timer_init(void)
  424. {
  425. __omap_sync32k_timer_init(2, "timer_sys_ck", NULL,
  426. 1, "timer_sys_ck", "ti,timer-alwon", true);
  427. clocksource_probe();
  428. }
  429. #endif
  430. #if defined(CONFIG_ARCH_OMAP4) || defined(CONFIG_SOC_OMAP5) || \
  431. defined(CONFIG_SOC_DRA7XX) || defined(CONFIG_SOC_AM43XX)
  432. static void __init omap4_sync32k_timer_init(void)
  433. {
  434. __omap_sync32k_timer_init(1, "timer_32k_ck", "ti,timer-alwon",
  435. 2, "sys_clkin_ck", NULL, false);
  436. }
  437. void __init omap4_local_timer_init(void)
  438. {
  439. omap4_sync32k_timer_init();
  440. clocksource_probe();
  441. }
  442. #endif
  443. #if defined(CONFIG_SOC_OMAP5) || defined(CONFIG_SOC_DRA7XX)
  444. /*
  445. * The realtime counter also called master counter, is a free-running
  446. * counter, which is related to real time. It produces the count used
  447. * by the CPU local timer peripherals in the MPU cluster. The timer counts
  448. * at a rate of 6.144 MHz. Because the device operates on different clocks
  449. * in different power modes, the master counter shifts operation between
  450. * clocks, adjusting the increment per clock in hardware accordingly to
  451. * maintain a constant count rate.
  452. */
  453. static void __init realtime_counter_init(void)
  454. {
  455. #ifdef CONFIG_SOC_HAS_REALTIME_COUNTER
  456. void __iomem *base;
  457. static struct clk *sys_clk;
  458. unsigned long rate;
  459. unsigned int reg;
  460. unsigned long long num, den;
  461. base = ioremap(REALTIME_COUNTER_BASE, SZ_32);
  462. if (!base) {
  463. pr_err("%s: ioremap failed\n", __func__);
  464. return;
  465. }
  466. sys_clk = clk_get(NULL, "sys_clkin");
  467. if (IS_ERR(sys_clk)) {
  468. pr_err("%s: failed to get system clock handle\n", __func__);
  469. iounmap(base);
  470. return;
  471. }
  472. rate = clk_get_rate(sys_clk);
  473. if (soc_is_dra7xx()) {
  474. /*
  475. * Errata i856 says the 32.768KHz crystal does not start at
  476. * power on, so the CPU falls back to an emulated 32KHz clock
  477. * based on sysclk / 610 instead. This causes the master counter
  478. * frequency to not be 6.144MHz but at sysclk / 610 * 375 / 2
  479. * (OR sysclk * 75 / 244)
  480. *
  481. * This affects at least the DRA7/AM572x 1.0, 1.1 revisions.
  482. * Of course any board built without a populated 32.768KHz
  483. * crystal would also need this fix even if the CPU is fixed
  484. * later.
  485. *
  486. * Either case can be detected by using the two speedselect bits
  487. * If they are not 0, then the 32.768KHz clock driving the
  488. * coarse counter that corrects the fine counter every time it
  489. * ticks is actually rate/610 rather than 32.768KHz and we
  490. * should compensate to avoid the 570ppm (at 20MHz, much worse
  491. * at other rates) too fast system time.
  492. */
  493. reg = omap_ctrl_readl(DRA7_CTRL_CORE_BOOTSTRAP);
  494. if (reg & DRA7_SPEEDSELECT_MASK) {
  495. num = 75;
  496. den = 244;
  497. goto sysclk1_based;
  498. }
  499. }
  500. /* Numerator/denumerator values refer TRM Realtime Counter section */
  501. switch (rate) {
  502. case 12000000:
  503. num = 64;
  504. den = 125;
  505. break;
  506. case 13000000:
  507. num = 768;
  508. den = 1625;
  509. break;
  510. case 19200000:
  511. num = 8;
  512. den = 25;
  513. break;
  514. case 20000000:
  515. num = 192;
  516. den = 625;
  517. break;
  518. case 26000000:
  519. num = 384;
  520. den = 1625;
  521. break;
  522. case 27000000:
  523. num = 256;
  524. den = 1125;
  525. break;
  526. case 38400000:
  527. default:
  528. /* Program it for 38.4 MHz */
  529. num = 4;
  530. den = 25;
  531. break;
  532. }
  533. sysclk1_based:
  534. /* Program numerator and denumerator registers */
  535. reg = readl_relaxed(base + INCREMENTER_NUMERATOR_OFFSET) &
  536. NUMERATOR_DENUMERATOR_MASK;
  537. reg |= num;
  538. writel_relaxed(reg, base + INCREMENTER_NUMERATOR_OFFSET);
  539. reg = readl_relaxed(base + INCREMENTER_DENUMERATOR_RELOAD_OFFSET) &
  540. NUMERATOR_DENUMERATOR_MASK;
  541. reg |= den;
  542. writel_relaxed(reg, base + INCREMENTER_DENUMERATOR_RELOAD_OFFSET);
  543. arch_timer_freq = DIV_ROUND_UP_ULL(rate * num, den);
  544. set_cntfreq();
  545. iounmap(base);
  546. #endif
  547. }
  548. void __init omap5_realtime_timer_init(void)
  549. {
  550. omap4_sync32k_timer_init();
  551. realtime_counter_init();
  552. clocksource_probe();
  553. }
  554. #endif /* CONFIG_SOC_OMAP5 || CONFIG_SOC_DRA7XX */
  555. /**
  556. * omap_timer_init - build and register timer device with an
  557. * associated timer hwmod
  558. * @oh: timer hwmod pointer to be used to build timer device
  559. * @user: parameter that can be passed from calling hwmod API
  560. *
  561. * Called by omap_hwmod_for_each_by_class to register each of the timer
  562. * devices present in the system. The number of timer devices is known
  563. * by parsing through the hwmod database for a given class name. At the
  564. * end of function call memory is allocated for timer device and it is
  565. * registered to the framework ready to be proved by the driver.
  566. */
  567. static int __init omap_timer_init(struct omap_hwmod *oh, void *unused)
  568. {
  569. int id;
  570. int ret = 0;
  571. char *name = "omap_timer";
  572. struct dmtimer_platform_data *pdata;
  573. struct platform_device *pdev;
  574. struct omap_timer_capability_dev_attr *timer_dev_attr;
  575. pr_debug("%s: %s\n", __func__, oh->name);
  576. /* on secure device, do not register secure timer */
  577. timer_dev_attr = oh->dev_attr;
  578. if (omap_type() != OMAP2_DEVICE_TYPE_GP && timer_dev_attr)
  579. if (timer_dev_attr->timer_capability == OMAP_TIMER_SECURE)
  580. return ret;
  581. pdata = kzalloc(sizeof(*pdata), GFP_KERNEL);
  582. if (!pdata) {
  583. pr_err("%s: No memory for [%s]\n", __func__, oh->name);
  584. return -ENOMEM;
  585. }
  586. /*
  587. * Extract the IDs from name field in hwmod database
  588. * and use the same for constructing ids' for the
  589. * timer devices. In a way, we are avoiding usage of
  590. * static variable witin the function to do the same.
  591. * CAUTION: We have to be careful and make sure the
  592. * name in hwmod database does not change in which case
  593. * we might either make corresponding change here or
  594. * switch back static variable mechanism.
  595. */
  596. sscanf(oh->name, "timer%2d", &id);
  597. if (timer_dev_attr)
  598. pdata->timer_capability = timer_dev_attr->timer_capability;
  599. pdata->timer_errata = omap_dm_timer_get_errata();
  600. pdata->get_context_loss_count = omap_pm_get_dev_context_loss_count;
  601. pdev = omap_device_build(name, id, oh, pdata, sizeof(*pdata));
  602. if (IS_ERR(pdev)) {
  603. pr_err("%s: Can't build omap_device for %s: %s.\n",
  604. __func__, name, oh->name);
  605. ret = -EINVAL;
  606. }
  607. kfree(pdata);
  608. return ret;
  609. }
  610. /**
  611. * omap2_dm_timer_init - top level regular device initialization
  612. *
  613. * Uses dedicated hwmod api to parse through hwmod database for
  614. * given class name and then build and register the timer device.
  615. */
  616. static int __init omap2_dm_timer_init(void)
  617. {
  618. int ret;
  619. /* If dtb is there, the devices will be created dynamically */
  620. if (of_have_populated_dt())
  621. return -ENODEV;
  622. ret = omap_hwmod_for_each_by_class("timer", omap_timer_init, NULL);
  623. if (unlikely(ret)) {
  624. pr_err("%s: device registration failed.\n", __func__);
  625. return -EINVAL;
  626. }
  627. return 0;
  628. }
  629. omap_arch_initcall(omap2_dm_timer_init);
  630. /**
  631. * omap2_override_clocksource - clocksource override with user configuration
  632. *
  633. * Allows user to override default clocksource, using kernel parameter
  634. * clocksource="gp_timer" (For all OMAP2PLUS architectures)
  635. *
  636. * Note that, here we are using same standard kernel parameter "clocksource=",
  637. * and not introducing any OMAP specific interface.
  638. */
  639. static int __init omap2_override_clocksource(char *str)
  640. {
  641. if (!str)
  642. return 0;
  643. /*
  644. * For OMAP architecture, we only have two options
  645. * - sync_32k (default)
  646. * - gp_timer (sys_clk based)
  647. */
  648. if (!strcmp(str, "gp_timer"))
  649. use_gptimer_clksrc = true;
  650. return 0;
  651. }
  652. early_param("clocksource", omap2_override_clocksource);