timer.c 20 KB

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