dmtimer.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763
  1. /*
  2. * linux/arch/arm/plat-omap/dmtimer.c
  3. *
  4. * OMAP Dual-Mode Timers
  5. *
  6. * Copyright (C) 2010 Texas Instruments Incorporated - http://www.ti.com/
  7. * Tarun Kanti DebBarma <tarun.kanti@ti.com>
  8. * Thara Gopinath <thara@ti.com>
  9. *
  10. * dmtimer adaptation to platform_driver.
  11. *
  12. * Copyright (C) 2005 Nokia Corporation
  13. * OMAP2 support by Juha Yrjola
  14. * API improvements and OMAP2 clock framework support by Timo Teras
  15. *
  16. * Copyright (C) 2009 Texas Instruments
  17. * Added OMAP4 support - Santosh Shilimkar <santosh.shilimkar@ti.com>
  18. *
  19. * This program is free software; you can redistribute it and/or modify it
  20. * under the terms of the GNU General Public License as published by the
  21. * Free Software Foundation; either version 2 of the License, or (at your
  22. * option) any later version.
  23. *
  24. * THIS SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
  25. * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
  26. * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
  27. * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  28. * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  29. * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  30. * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  31. * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  32. *
  33. * You should have received a copy of the GNU General Public License along
  34. * with this program; if not, write to the Free Software Foundation, Inc.,
  35. * 675 Mass Ave, Cambridge, MA 02139, USA.
  36. */
  37. #include <linux/module.h>
  38. #include <linux/io.h>
  39. #include <linux/slab.h>
  40. #include <linux/err.h>
  41. #include <linux/pm_runtime.h>
  42. #include <plat/dmtimer.h>
  43. #include <mach/hardware.h>
  44. static LIST_HEAD(omap_timer_list);
  45. static DEFINE_SPINLOCK(dm_timer_lock);
  46. /**
  47. * omap_dm_timer_read_reg - read timer registers in posted and non-posted mode
  48. * @timer: timer pointer over which read operation to perform
  49. * @reg: lowest byte holds the register offset
  50. *
  51. * The posted mode bit is encoded in reg. Note that in posted mode write
  52. * pending bit must be checked. Otherwise a read of a non completed write
  53. * will produce an error.
  54. */
  55. static inline u32 omap_dm_timer_read_reg(struct omap_dm_timer *timer, u32 reg)
  56. {
  57. WARN_ON((reg & 0xff) < _OMAP_TIMER_WAKEUP_EN_OFFSET);
  58. return __omap_dm_timer_read(timer, reg, timer->posted);
  59. }
  60. /**
  61. * omap_dm_timer_write_reg - write timer registers in posted and non-posted mode
  62. * @timer: timer pointer over which write operation is to perform
  63. * @reg: lowest byte holds the register offset
  64. * @value: data to write into the register
  65. *
  66. * The posted mode bit is encoded in reg. Note that in posted mode the write
  67. * pending bit must be checked. Otherwise a write on a register which has a
  68. * pending write will be lost.
  69. */
  70. static void omap_dm_timer_write_reg(struct omap_dm_timer *timer, u32 reg,
  71. u32 value)
  72. {
  73. WARN_ON((reg & 0xff) < _OMAP_TIMER_WAKEUP_EN_OFFSET);
  74. __omap_dm_timer_write(timer, reg, value, timer->posted);
  75. }
  76. static void omap_timer_restore_context(struct omap_dm_timer *timer)
  77. {
  78. if (timer->revision == 1)
  79. __raw_writel(timer->context.tistat, timer->sys_stat);
  80. __raw_writel(timer->context.tisr, timer->irq_stat);
  81. omap_dm_timer_write_reg(timer, OMAP_TIMER_WAKEUP_EN_REG,
  82. timer->context.twer);
  83. omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG,
  84. timer->context.tcrr);
  85. omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG,
  86. timer->context.tldr);
  87. omap_dm_timer_write_reg(timer, OMAP_TIMER_MATCH_REG,
  88. timer->context.tmar);
  89. omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG,
  90. timer->context.tsicr);
  91. __raw_writel(timer->context.tier, timer->irq_ena);
  92. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG,
  93. timer->context.tclr);
  94. }
  95. static void omap_dm_timer_wait_for_reset(struct omap_dm_timer *timer)
  96. {
  97. int c;
  98. if (!timer->sys_stat)
  99. return;
  100. c = 0;
  101. while (!(__raw_readl(timer->sys_stat) & 1)) {
  102. c++;
  103. if (c > 100000) {
  104. printk(KERN_ERR "Timer failed to reset\n");
  105. return;
  106. }
  107. }
  108. }
  109. static void omap_dm_timer_reset(struct omap_dm_timer *timer)
  110. {
  111. omap_dm_timer_enable(timer);
  112. if (timer->pdev->id != 1) {
  113. omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG, 0x06);
  114. omap_dm_timer_wait_for_reset(timer);
  115. }
  116. __omap_dm_timer_reset(timer, 0, 0);
  117. omap_dm_timer_disable(timer);
  118. timer->posted = 1;
  119. }
  120. int omap_dm_timer_prepare(struct omap_dm_timer *timer)
  121. {
  122. struct dmtimer_platform_data *pdata = timer->pdev->dev.platform_data;
  123. int ret;
  124. timer->fclk = clk_get(&timer->pdev->dev, "fck");
  125. if (WARN_ON_ONCE(IS_ERR_OR_NULL(timer->fclk))) {
  126. timer->fclk = NULL;
  127. dev_err(&timer->pdev->dev, ": No fclk handle.\n");
  128. return -EINVAL;
  129. }
  130. if (pdata->needs_manual_reset)
  131. omap_dm_timer_reset(timer);
  132. ret = omap_dm_timer_set_source(timer, OMAP_TIMER_SRC_32_KHZ);
  133. timer->posted = 1;
  134. return ret;
  135. }
  136. struct omap_dm_timer *omap_dm_timer_request(void)
  137. {
  138. struct omap_dm_timer *timer = NULL, *t;
  139. unsigned long flags;
  140. int ret = 0;
  141. spin_lock_irqsave(&dm_timer_lock, flags);
  142. list_for_each_entry(t, &omap_timer_list, node) {
  143. if (t->reserved)
  144. continue;
  145. timer = t;
  146. timer->reserved = 1;
  147. break;
  148. }
  149. if (timer) {
  150. ret = omap_dm_timer_prepare(timer);
  151. if (ret) {
  152. timer->reserved = 0;
  153. timer = NULL;
  154. }
  155. }
  156. spin_unlock_irqrestore(&dm_timer_lock, flags);
  157. if (!timer)
  158. pr_debug("%s: timer request failed!\n", __func__);
  159. return timer;
  160. }
  161. EXPORT_SYMBOL_GPL(omap_dm_timer_request);
  162. struct omap_dm_timer *omap_dm_timer_request_specific(int id)
  163. {
  164. struct omap_dm_timer *timer = NULL, *t;
  165. unsigned long flags;
  166. int ret = 0;
  167. spin_lock_irqsave(&dm_timer_lock, flags);
  168. list_for_each_entry(t, &omap_timer_list, node) {
  169. if (t->pdev->id == id && !t->reserved) {
  170. timer = t;
  171. timer->reserved = 1;
  172. break;
  173. }
  174. }
  175. if (timer) {
  176. ret = omap_dm_timer_prepare(timer);
  177. if (ret) {
  178. timer->reserved = 0;
  179. timer = NULL;
  180. }
  181. }
  182. spin_unlock_irqrestore(&dm_timer_lock, flags);
  183. if (!timer)
  184. pr_debug("%s: timer%d request failed!\n", __func__, id);
  185. return timer;
  186. }
  187. EXPORT_SYMBOL_GPL(omap_dm_timer_request_specific);
  188. int omap_dm_timer_free(struct omap_dm_timer *timer)
  189. {
  190. if (unlikely(!timer))
  191. return -EINVAL;
  192. clk_put(timer->fclk);
  193. WARN_ON(!timer->reserved);
  194. timer->reserved = 0;
  195. return 0;
  196. }
  197. EXPORT_SYMBOL_GPL(omap_dm_timer_free);
  198. void omap_dm_timer_enable(struct omap_dm_timer *timer)
  199. {
  200. pm_runtime_get_sync(&timer->pdev->dev);
  201. }
  202. EXPORT_SYMBOL_GPL(omap_dm_timer_enable);
  203. void omap_dm_timer_disable(struct omap_dm_timer *timer)
  204. {
  205. pm_runtime_put(&timer->pdev->dev);
  206. }
  207. EXPORT_SYMBOL_GPL(omap_dm_timer_disable);
  208. int omap_dm_timer_get_irq(struct omap_dm_timer *timer)
  209. {
  210. if (timer)
  211. return timer->irq;
  212. return -EINVAL;
  213. }
  214. EXPORT_SYMBOL_GPL(omap_dm_timer_get_irq);
  215. #if defined(CONFIG_ARCH_OMAP1)
  216. /**
  217. * omap_dm_timer_modify_idlect_mask - Check if any running timers use ARMXOR
  218. * @inputmask: current value of idlect mask
  219. */
  220. __u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
  221. {
  222. int i = 0;
  223. struct omap_dm_timer *timer = NULL;
  224. unsigned long flags;
  225. /* If ARMXOR cannot be idled this function call is unnecessary */
  226. if (!(inputmask & (1 << 1)))
  227. return inputmask;
  228. /* If any active timer is using ARMXOR return modified mask */
  229. spin_lock_irqsave(&dm_timer_lock, flags);
  230. list_for_each_entry(timer, &omap_timer_list, node) {
  231. u32 l;
  232. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  233. if (l & OMAP_TIMER_CTRL_ST) {
  234. if (((omap_readl(MOD_CONF_CTRL_1) >> (i * 2)) & 0x03) == 0)
  235. inputmask &= ~(1 << 1);
  236. else
  237. inputmask &= ~(1 << 2);
  238. }
  239. i++;
  240. }
  241. spin_unlock_irqrestore(&dm_timer_lock, flags);
  242. return inputmask;
  243. }
  244. EXPORT_SYMBOL_GPL(omap_dm_timer_modify_idlect_mask);
  245. #else
  246. struct clk *omap_dm_timer_get_fclk(struct omap_dm_timer *timer)
  247. {
  248. if (timer)
  249. return timer->fclk;
  250. return NULL;
  251. }
  252. EXPORT_SYMBOL_GPL(omap_dm_timer_get_fclk);
  253. __u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
  254. {
  255. BUG();
  256. return 0;
  257. }
  258. EXPORT_SYMBOL_GPL(omap_dm_timer_modify_idlect_mask);
  259. #endif
  260. int omap_dm_timer_trigger(struct omap_dm_timer *timer)
  261. {
  262. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  263. pr_err("%s: timer not available or enabled.\n", __func__);
  264. return -EINVAL;
  265. }
  266. omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
  267. return 0;
  268. }
  269. EXPORT_SYMBOL_GPL(omap_dm_timer_trigger);
  270. int omap_dm_timer_start(struct omap_dm_timer *timer)
  271. {
  272. u32 l;
  273. if (unlikely(!timer))
  274. return -EINVAL;
  275. omap_dm_timer_enable(timer);
  276. if (timer->loses_context) {
  277. u32 ctx_loss_cnt_after =
  278. timer->get_context_loss_count(&timer->pdev->dev);
  279. if (ctx_loss_cnt_after != timer->ctx_loss_count)
  280. omap_timer_restore_context(timer);
  281. }
  282. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  283. if (!(l & OMAP_TIMER_CTRL_ST)) {
  284. l |= OMAP_TIMER_CTRL_ST;
  285. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  286. }
  287. /* Save the context */
  288. timer->context.tclr = l;
  289. return 0;
  290. }
  291. EXPORT_SYMBOL_GPL(omap_dm_timer_start);
  292. int omap_dm_timer_stop(struct omap_dm_timer *timer)
  293. {
  294. unsigned long rate = 0;
  295. struct dmtimer_platform_data *pdata = timer->pdev->dev.platform_data;
  296. if (unlikely(!timer))
  297. return -EINVAL;
  298. if (!pdata->needs_manual_reset)
  299. rate = clk_get_rate(timer->fclk);
  300. __omap_dm_timer_stop(timer, timer->posted, rate);
  301. if (timer->loses_context && timer->get_context_loss_count)
  302. timer->ctx_loss_count =
  303. timer->get_context_loss_count(&timer->pdev->dev);
  304. /*
  305. * Since the register values are computed and written within
  306. * __omap_dm_timer_stop, we need to use read to retrieve the
  307. * context.
  308. */
  309. timer->context.tclr =
  310. omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  311. timer->context.tisr = __raw_readl(timer->irq_stat);
  312. omap_dm_timer_disable(timer);
  313. return 0;
  314. }
  315. EXPORT_SYMBOL_GPL(omap_dm_timer_stop);
  316. int omap_dm_timer_set_source(struct omap_dm_timer *timer, int source)
  317. {
  318. int ret;
  319. struct dmtimer_platform_data *pdata;
  320. if (unlikely(!timer))
  321. return -EINVAL;
  322. pdata = timer->pdev->dev.platform_data;
  323. if (source < 0 || source >= 3)
  324. return -EINVAL;
  325. ret = pdata->set_timer_src(timer->pdev, source);
  326. return ret;
  327. }
  328. EXPORT_SYMBOL_GPL(omap_dm_timer_set_source);
  329. int omap_dm_timer_set_load(struct omap_dm_timer *timer, int autoreload,
  330. unsigned int load)
  331. {
  332. u32 l;
  333. if (unlikely(!timer))
  334. return -EINVAL;
  335. omap_dm_timer_enable(timer);
  336. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  337. if (autoreload)
  338. l |= OMAP_TIMER_CTRL_AR;
  339. else
  340. l &= ~OMAP_TIMER_CTRL_AR;
  341. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  342. omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
  343. omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
  344. /* Save the context */
  345. timer->context.tclr = l;
  346. timer->context.tldr = load;
  347. omap_dm_timer_disable(timer);
  348. return 0;
  349. }
  350. EXPORT_SYMBOL_GPL(omap_dm_timer_set_load);
  351. /* Optimized set_load which removes costly spin wait in timer_start */
  352. int omap_dm_timer_set_load_start(struct omap_dm_timer *timer, int autoreload,
  353. unsigned int load)
  354. {
  355. u32 l;
  356. if (unlikely(!timer))
  357. return -EINVAL;
  358. omap_dm_timer_enable(timer);
  359. if (timer->loses_context) {
  360. u32 ctx_loss_cnt_after =
  361. timer->get_context_loss_count(&timer->pdev->dev);
  362. if (ctx_loss_cnt_after != timer->ctx_loss_count)
  363. omap_timer_restore_context(timer);
  364. }
  365. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  366. if (autoreload) {
  367. l |= OMAP_TIMER_CTRL_AR;
  368. omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
  369. } else {
  370. l &= ~OMAP_TIMER_CTRL_AR;
  371. }
  372. l |= OMAP_TIMER_CTRL_ST;
  373. __omap_dm_timer_load_start(timer, l, load, timer->posted);
  374. /* Save the context */
  375. timer->context.tclr = l;
  376. timer->context.tldr = load;
  377. timer->context.tcrr = load;
  378. return 0;
  379. }
  380. EXPORT_SYMBOL_GPL(omap_dm_timer_set_load_start);
  381. int omap_dm_timer_set_match(struct omap_dm_timer *timer, int enable,
  382. unsigned int match)
  383. {
  384. u32 l;
  385. if (unlikely(!timer))
  386. return -EINVAL;
  387. omap_dm_timer_enable(timer);
  388. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  389. if (enable)
  390. l |= OMAP_TIMER_CTRL_CE;
  391. else
  392. l &= ~OMAP_TIMER_CTRL_CE;
  393. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  394. omap_dm_timer_write_reg(timer, OMAP_TIMER_MATCH_REG, match);
  395. /* Save the context */
  396. timer->context.tclr = l;
  397. timer->context.tmar = match;
  398. omap_dm_timer_disable(timer);
  399. return 0;
  400. }
  401. EXPORT_SYMBOL_GPL(omap_dm_timer_set_match);
  402. int omap_dm_timer_set_pwm(struct omap_dm_timer *timer, int def_on,
  403. int toggle, int trigger)
  404. {
  405. u32 l;
  406. if (unlikely(!timer))
  407. return -EINVAL;
  408. omap_dm_timer_enable(timer);
  409. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  410. l &= ~(OMAP_TIMER_CTRL_GPOCFG | OMAP_TIMER_CTRL_SCPWM |
  411. OMAP_TIMER_CTRL_PT | (0x03 << 10));
  412. if (def_on)
  413. l |= OMAP_TIMER_CTRL_SCPWM;
  414. if (toggle)
  415. l |= OMAP_TIMER_CTRL_PT;
  416. l |= trigger << 10;
  417. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  418. /* Save the context */
  419. timer->context.tclr = l;
  420. omap_dm_timer_disable(timer);
  421. return 0;
  422. }
  423. EXPORT_SYMBOL_GPL(omap_dm_timer_set_pwm);
  424. int omap_dm_timer_set_prescaler(struct omap_dm_timer *timer, int prescaler)
  425. {
  426. u32 l;
  427. if (unlikely(!timer))
  428. return -EINVAL;
  429. omap_dm_timer_enable(timer);
  430. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  431. l &= ~(OMAP_TIMER_CTRL_PRE | (0x07 << 2));
  432. if (prescaler >= 0x00 && prescaler <= 0x07) {
  433. l |= OMAP_TIMER_CTRL_PRE;
  434. l |= prescaler << 2;
  435. }
  436. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  437. /* Save the context */
  438. timer->context.tclr = l;
  439. omap_dm_timer_disable(timer);
  440. return 0;
  441. }
  442. EXPORT_SYMBOL_GPL(omap_dm_timer_set_prescaler);
  443. int omap_dm_timer_set_int_enable(struct omap_dm_timer *timer,
  444. unsigned int value)
  445. {
  446. if (unlikely(!timer))
  447. return -EINVAL;
  448. omap_dm_timer_enable(timer);
  449. __omap_dm_timer_int_enable(timer, value);
  450. /* Save the context */
  451. timer->context.tier = value;
  452. timer->context.twer = value;
  453. omap_dm_timer_disable(timer);
  454. return 0;
  455. }
  456. EXPORT_SYMBOL_GPL(omap_dm_timer_set_int_enable);
  457. unsigned int omap_dm_timer_read_status(struct omap_dm_timer *timer)
  458. {
  459. unsigned int l;
  460. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  461. pr_err("%s: timer not available or enabled.\n", __func__);
  462. return 0;
  463. }
  464. l = __raw_readl(timer->irq_stat);
  465. return l;
  466. }
  467. EXPORT_SYMBOL_GPL(omap_dm_timer_read_status);
  468. int omap_dm_timer_write_status(struct omap_dm_timer *timer, unsigned int value)
  469. {
  470. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev)))
  471. return -EINVAL;
  472. __omap_dm_timer_write_status(timer, value);
  473. /* Save the context */
  474. timer->context.tisr = value;
  475. return 0;
  476. }
  477. EXPORT_SYMBOL_GPL(omap_dm_timer_write_status);
  478. unsigned int omap_dm_timer_read_counter(struct omap_dm_timer *timer)
  479. {
  480. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  481. pr_err("%s: timer not iavailable or enabled.\n", __func__);
  482. return 0;
  483. }
  484. return __omap_dm_timer_read_counter(timer, timer->posted);
  485. }
  486. EXPORT_SYMBOL_GPL(omap_dm_timer_read_counter);
  487. int omap_dm_timer_write_counter(struct omap_dm_timer *timer, unsigned int value)
  488. {
  489. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  490. pr_err("%s: timer not available or enabled.\n", __func__);
  491. return -EINVAL;
  492. }
  493. omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG, value);
  494. /* Save the context */
  495. timer->context.tcrr = value;
  496. return 0;
  497. }
  498. EXPORT_SYMBOL_GPL(omap_dm_timer_write_counter);
  499. int omap_dm_timers_active(void)
  500. {
  501. struct omap_dm_timer *timer;
  502. list_for_each_entry(timer, &omap_timer_list, node) {
  503. if (!timer->reserved)
  504. continue;
  505. if (omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG) &
  506. OMAP_TIMER_CTRL_ST) {
  507. return 1;
  508. }
  509. }
  510. return 0;
  511. }
  512. EXPORT_SYMBOL_GPL(omap_dm_timers_active);
  513. /**
  514. * omap_dm_timer_probe - probe function called for every registered device
  515. * @pdev: pointer to current timer platform device
  516. *
  517. * Called by driver framework at the end of device registration for all
  518. * timer devices.
  519. */
  520. static int __devinit omap_dm_timer_probe(struct platform_device *pdev)
  521. {
  522. int ret;
  523. unsigned long flags;
  524. struct omap_dm_timer *timer;
  525. struct resource *mem, *irq, *ioarea;
  526. struct dmtimer_platform_data *pdata = pdev->dev.platform_data;
  527. if (!pdata) {
  528. dev_err(&pdev->dev, "%s: no platform data.\n", __func__);
  529. return -ENODEV;
  530. }
  531. irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
  532. if (unlikely(!irq)) {
  533. dev_err(&pdev->dev, "%s: no IRQ resource.\n", __func__);
  534. return -ENODEV;
  535. }
  536. mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  537. if (unlikely(!mem)) {
  538. dev_err(&pdev->dev, "%s: no memory resource.\n", __func__);
  539. return -ENODEV;
  540. }
  541. ioarea = request_mem_region(mem->start, resource_size(mem),
  542. pdev->name);
  543. if (!ioarea) {
  544. dev_err(&pdev->dev, "%s: region already claimed.\n", __func__);
  545. return -EBUSY;
  546. }
  547. timer = kzalloc(sizeof(struct omap_dm_timer), GFP_KERNEL);
  548. if (!timer) {
  549. dev_err(&pdev->dev, "%s: no memory for omap_dm_timer.\n",
  550. __func__);
  551. ret = -ENOMEM;
  552. goto err_free_ioregion;
  553. }
  554. timer->io_base = ioremap(mem->start, resource_size(mem));
  555. if (!timer->io_base) {
  556. dev_err(&pdev->dev, "%s: ioremap failed.\n", __func__);
  557. ret = -ENOMEM;
  558. goto err_free_mem;
  559. }
  560. timer->id = pdev->id;
  561. timer->irq = irq->start;
  562. timer->reserved = pdata->reserved;
  563. timer->pdev = pdev;
  564. timer->loses_context = pdata->loses_context;
  565. timer->get_context_loss_count = pdata->get_context_loss_count;
  566. /* Skip pm_runtime_enable for OMAP1 */
  567. if (!pdata->needs_manual_reset) {
  568. pm_runtime_enable(&pdev->dev);
  569. pm_runtime_irq_safe(&pdev->dev);
  570. }
  571. if (!timer->reserved) {
  572. pm_runtime_get_sync(&pdev->dev);
  573. __omap_dm_timer_init_regs(timer);
  574. pm_runtime_put(&pdev->dev);
  575. }
  576. /* add the timer element to the list */
  577. spin_lock_irqsave(&dm_timer_lock, flags);
  578. list_add_tail(&timer->node, &omap_timer_list);
  579. spin_unlock_irqrestore(&dm_timer_lock, flags);
  580. dev_dbg(&pdev->dev, "Device Probed.\n");
  581. return 0;
  582. err_free_mem:
  583. kfree(timer);
  584. err_free_ioregion:
  585. release_mem_region(mem->start, resource_size(mem));
  586. return ret;
  587. }
  588. /**
  589. * omap_dm_timer_remove - cleanup a registered timer device
  590. * @pdev: pointer to current timer platform device
  591. *
  592. * Called by driver framework whenever a timer device is unregistered.
  593. * In addition to freeing platform resources it also deletes the timer
  594. * entry from the local list.
  595. */
  596. static int __devexit omap_dm_timer_remove(struct platform_device *pdev)
  597. {
  598. struct omap_dm_timer *timer;
  599. unsigned long flags;
  600. int ret = -EINVAL;
  601. spin_lock_irqsave(&dm_timer_lock, flags);
  602. list_for_each_entry(timer, &omap_timer_list, node)
  603. if (timer->pdev->id == pdev->id) {
  604. list_del(&timer->node);
  605. kfree(timer);
  606. ret = 0;
  607. break;
  608. }
  609. spin_unlock_irqrestore(&dm_timer_lock, flags);
  610. return ret;
  611. }
  612. static struct platform_driver omap_dm_timer_driver = {
  613. .probe = omap_dm_timer_probe,
  614. .remove = __devexit_p(omap_dm_timer_remove),
  615. .driver = {
  616. .name = "omap_timer",
  617. },
  618. };
  619. static int __init omap_dm_timer_driver_init(void)
  620. {
  621. return platform_driver_register(&omap_dm_timer_driver);
  622. }
  623. static void __exit omap_dm_timer_driver_exit(void)
  624. {
  625. platform_driver_unregister(&omap_dm_timer_driver);
  626. }
  627. early_platform_init("earlytimer", &omap_dm_timer_driver);
  628. module_init(omap_dm_timer_driver_init);
  629. module_exit(omap_dm_timer_driver_exit);
  630. MODULE_DESCRIPTION("OMAP Dual-Mode Timer Driver");
  631. MODULE_LICENSE("GPL");
  632. MODULE_ALIAS("platform:" DRIVER_NAME);
  633. MODULE_AUTHOR("Texas Instruments Inc");