dmtimer.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764
  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;
  296. if (unlikely(!timer))
  297. return -EINVAL;
  298. pdata = timer->pdev->dev.platform_data;
  299. if (!pdata->needs_manual_reset)
  300. rate = clk_get_rate(timer->fclk);
  301. __omap_dm_timer_stop(timer, timer->posted, rate);
  302. if (timer->loses_context && timer->get_context_loss_count)
  303. timer->ctx_loss_count =
  304. timer->get_context_loss_count(&timer->pdev->dev);
  305. /*
  306. * Since the register values are computed and written within
  307. * __omap_dm_timer_stop, we need to use read to retrieve the
  308. * context.
  309. */
  310. timer->context.tclr =
  311. omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  312. timer->context.tisr = __raw_readl(timer->irq_stat);
  313. omap_dm_timer_disable(timer);
  314. return 0;
  315. }
  316. EXPORT_SYMBOL_GPL(omap_dm_timer_stop);
  317. int omap_dm_timer_set_source(struct omap_dm_timer *timer, int source)
  318. {
  319. int ret;
  320. struct dmtimer_platform_data *pdata;
  321. if (unlikely(!timer))
  322. return -EINVAL;
  323. pdata = timer->pdev->dev.platform_data;
  324. if (source < 0 || source >= 3)
  325. return -EINVAL;
  326. ret = pdata->set_timer_src(timer->pdev, source);
  327. return ret;
  328. }
  329. EXPORT_SYMBOL_GPL(omap_dm_timer_set_source);
  330. int omap_dm_timer_set_load(struct omap_dm_timer *timer, int autoreload,
  331. unsigned int load)
  332. {
  333. u32 l;
  334. if (unlikely(!timer))
  335. return -EINVAL;
  336. omap_dm_timer_enable(timer);
  337. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  338. if (autoreload)
  339. l |= OMAP_TIMER_CTRL_AR;
  340. else
  341. l &= ~OMAP_TIMER_CTRL_AR;
  342. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  343. omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
  344. omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
  345. /* Save the context */
  346. timer->context.tclr = l;
  347. timer->context.tldr = load;
  348. omap_dm_timer_disable(timer);
  349. return 0;
  350. }
  351. EXPORT_SYMBOL_GPL(omap_dm_timer_set_load);
  352. /* Optimized set_load which removes costly spin wait in timer_start */
  353. int omap_dm_timer_set_load_start(struct omap_dm_timer *timer, int autoreload,
  354. unsigned int load)
  355. {
  356. u32 l;
  357. if (unlikely(!timer))
  358. return -EINVAL;
  359. omap_dm_timer_enable(timer);
  360. if (timer->loses_context) {
  361. u32 ctx_loss_cnt_after =
  362. timer->get_context_loss_count(&timer->pdev->dev);
  363. if (ctx_loss_cnt_after != timer->ctx_loss_count)
  364. omap_timer_restore_context(timer);
  365. }
  366. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  367. if (autoreload) {
  368. l |= OMAP_TIMER_CTRL_AR;
  369. omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
  370. } else {
  371. l &= ~OMAP_TIMER_CTRL_AR;
  372. }
  373. l |= OMAP_TIMER_CTRL_ST;
  374. __omap_dm_timer_load_start(timer, l, load, timer->posted);
  375. /* Save the context */
  376. timer->context.tclr = l;
  377. timer->context.tldr = load;
  378. timer->context.tcrr = load;
  379. return 0;
  380. }
  381. EXPORT_SYMBOL_GPL(omap_dm_timer_set_load_start);
  382. int omap_dm_timer_set_match(struct omap_dm_timer *timer, int enable,
  383. unsigned int match)
  384. {
  385. u32 l;
  386. if (unlikely(!timer))
  387. return -EINVAL;
  388. omap_dm_timer_enable(timer);
  389. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  390. if (enable)
  391. l |= OMAP_TIMER_CTRL_CE;
  392. else
  393. l &= ~OMAP_TIMER_CTRL_CE;
  394. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  395. omap_dm_timer_write_reg(timer, OMAP_TIMER_MATCH_REG, match);
  396. /* Save the context */
  397. timer->context.tclr = l;
  398. timer->context.tmar = match;
  399. omap_dm_timer_disable(timer);
  400. return 0;
  401. }
  402. EXPORT_SYMBOL_GPL(omap_dm_timer_set_match);
  403. int omap_dm_timer_set_pwm(struct omap_dm_timer *timer, int def_on,
  404. int toggle, int trigger)
  405. {
  406. u32 l;
  407. if (unlikely(!timer))
  408. return -EINVAL;
  409. omap_dm_timer_enable(timer);
  410. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  411. l &= ~(OMAP_TIMER_CTRL_GPOCFG | OMAP_TIMER_CTRL_SCPWM |
  412. OMAP_TIMER_CTRL_PT | (0x03 << 10));
  413. if (def_on)
  414. l |= OMAP_TIMER_CTRL_SCPWM;
  415. if (toggle)
  416. l |= OMAP_TIMER_CTRL_PT;
  417. l |= trigger << 10;
  418. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  419. /* Save the context */
  420. timer->context.tclr = l;
  421. omap_dm_timer_disable(timer);
  422. return 0;
  423. }
  424. EXPORT_SYMBOL_GPL(omap_dm_timer_set_pwm);
  425. int omap_dm_timer_set_prescaler(struct omap_dm_timer *timer, int prescaler)
  426. {
  427. u32 l;
  428. if (unlikely(!timer))
  429. return -EINVAL;
  430. omap_dm_timer_enable(timer);
  431. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  432. l &= ~(OMAP_TIMER_CTRL_PRE | (0x07 << 2));
  433. if (prescaler >= 0x00 && prescaler <= 0x07) {
  434. l |= OMAP_TIMER_CTRL_PRE;
  435. l |= prescaler << 2;
  436. }
  437. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  438. /* Save the context */
  439. timer->context.tclr = l;
  440. omap_dm_timer_disable(timer);
  441. return 0;
  442. }
  443. EXPORT_SYMBOL_GPL(omap_dm_timer_set_prescaler);
  444. int omap_dm_timer_set_int_enable(struct omap_dm_timer *timer,
  445. unsigned int value)
  446. {
  447. if (unlikely(!timer))
  448. return -EINVAL;
  449. omap_dm_timer_enable(timer);
  450. __omap_dm_timer_int_enable(timer, value);
  451. /* Save the context */
  452. timer->context.tier = value;
  453. timer->context.twer = value;
  454. omap_dm_timer_disable(timer);
  455. return 0;
  456. }
  457. EXPORT_SYMBOL_GPL(omap_dm_timer_set_int_enable);
  458. unsigned int omap_dm_timer_read_status(struct omap_dm_timer *timer)
  459. {
  460. unsigned int l;
  461. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  462. pr_err("%s: timer not available or enabled.\n", __func__);
  463. return 0;
  464. }
  465. l = __raw_readl(timer->irq_stat);
  466. return l;
  467. }
  468. EXPORT_SYMBOL_GPL(omap_dm_timer_read_status);
  469. int omap_dm_timer_write_status(struct omap_dm_timer *timer, unsigned int value)
  470. {
  471. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev)))
  472. return -EINVAL;
  473. __omap_dm_timer_write_status(timer, value);
  474. /* Save the context */
  475. timer->context.tisr = value;
  476. return 0;
  477. }
  478. EXPORT_SYMBOL_GPL(omap_dm_timer_write_status);
  479. unsigned int omap_dm_timer_read_counter(struct omap_dm_timer *timer)
  480. {
  481. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  482. pr_err("%s: timer not iavailable or enabled.\n", __func__);
  483. return 0;
  484. }
  485. return __omap_dm_timer_read_counter(timer, timer->posted);
  486. }
  487. EXPORT_SYMBOL_GPL(omap_dm_timer_read_counter);
  488. int omap_dm_timer_write_counter(struct omap_dm_timer *timer, unsigned int value)
  489. {
  490. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  491. pr_err("%s: timer not available or enabled.\n", __func__);
  492. return -EINVAL;
  493. }
  494. omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG, value);
  495. /* Save the context */
  496. timer->context.tcrr = value;
  497. return 0;
  498. }
  499. EXPORT_SYMBOL_GPL(omap_dm_timer_write_counter);
  500. int omap_dm_timers_active(void)
  501. {
  502. struct omap_dm_timer *timer;
  503. list_for_each_entry(timer, &omap_timer_list, node) {
  504. if (!timer->reserved)
  505. continue;
  506. if (omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG) &
  507. OMAP_TIMER_CTRL_ST) {
  508. return 1;
  509. }
  510. }
  511. return 0;
  512. }
  513. EXPORT_SYMBOL_GPL(omap_dm_timers_active);
  514. /**
  515. * omap_dm_timer_probe - probe function called for every registered device
  516. * @pdev: pointer to current timer platform device
  517. *
  518. * Called by driver framework at the end of device registration for all
  519. * timer devices.
  520. */
  521. static int __devinit omap_dm_timer_probe(struct platform_device *pdev)
  522. {
  523. int ret;
  524. unsigned long flags;
  525. struct omap_dm_timer *timer;
  526. struct resource *mem, *irq, *ioarea;
  527. struct dmtimer_platform_data *pdata = pdev->dev.platform_data;
  528. if (!pdata) {
  529. dev_err(&pdev->dev, "%s: no platform data.\n", __func__);
  530. return -ENODEV;
  531. }
  532. irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
  533. if (unlikely(!irq)) {
  534. dev_err(&pdev->dev, "%s: no IRQ resource.\n", __func__);
  535. return -ENODEV;
  536. }
  537. mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  538. if (unlikely(!mem)) {
  539. dev_err(&pdev->dev, "%s: no memory resource.\n", __func__);
  540. return -ENODEV;
  541. }
  542. ioarea = request_mem_region(mem->start, resource_size(mem),
  543. pdev->name);
  544. if (!ioarea) {
  545. dev_err(&pdev->dev, "%s: region already claimed.\n", __func__);
  546. return -EBUSY;
  547. }
  548. timer = kzalloc(sizeof(struct omap_dm_timer), GFP_KERNEL);
  549. if (!timer) {
  550. dev_err(&pdev->dev, "%s: no memory for omap_dm_timer.\n",
  551. __func__);
  552. ret = -ENOMEM;
  553. goto err_free_ioregion;
  554. }
  555. timer->io_base = ioremap(mem->start, resource_size(mem));
  556. if (!timer->io_base) {
  557. dev_err(&pdev->dev, "%s: ioremap failed.\n", __func__);
  558. ret = -ENOMEM;
  559. goto err_free_mem;
  560. }
  561. timer->id = pdev->id;
  562. timer->irq = irq->start;
  563. timer->reserved = pdata->reserved;
  564. timer->pdev = pdev;
  565. timer->loses_context = pdata->loses_context;
  566. timer->get_context_loss_count = pdata->get_context_loss_count;
  567. /* Skip pm_runtime_enable for OMAP1 */
  568. if (!pdata->needs_manual_reset) {
  569. pm_runtime_enable(&pdev->dev);
  570. pm_runtime_irq_safe(&pdev->dev);
  571. }
  572. if (!timer->reserved) {
  573. pm_runtime_get_sync(&pdev->dev);
  574. __omap_dm_timer_init_regs(timer);
  575. pm_runtime_put(&pdev->dev);
  576. }
  577. /* add the timer element to the list */
  578. spin_lock_irqsave(&dm_timer_lock, flags);
  579. list_add_tail(&timer->node, &omap_timer_list);
  580. spin_unlock_irqrestore(&dm_timer_lock, flags);
  581. dev_dbg(&pdev->dev, "Device Probed.\n");
  582. return 0;
  583. err_free_mem:
  584. kfree(timer);
  585. err_free_ioregion:
  586. release_mem_region(mem->start, resource_size(mem));
  587. return ret;
  588. }
  589. /**
  590. * omap_dm_timer_remove - cleanup a registered timer device
  591. * @pdev: pointer to current timer platform device
  592. *
  593. * Called by driver framework whenever a timer device is unregistered.
  594. * In addition to freeing platform resources it also deletes the timer
  595. * entry from the local list.
  596. */
  597. static int __devexit omap_dm_timer_remove(struct platform_device *pdev)
  598. {
  599. struct omap_dm_timer *timer;
  600. unsigned long flags;
  601. int ret = -EINVAL;
  602. spin_lock_irqsave(&dm_timer_lock, flags);
  603. list_for_each_entry(timer, &omap_timer_list, node)
  604. if (timer->pdev->id == pdev->id) {
  605. list_del(&timer->node);
  606. kfree(timer);
  607. ret = 0;
  608. break;
  609. }
  610. spin_unlock_irqrestore(&dm_timer_lock, flags);
  611. return ret;
  612. }
  613. static struct platform_driver omap_dm_timer_driver = {
  614. .probe = omap_dm_timer_probe,
  615. .remove = __devexit_p(omap_dm_timer_remove),
  616. .driver = {
  617. .name = "omap_timer",
  618. },
  619. };
  620. static int __init omap_dm_timer_driver_init(void)
  621. {
  622. return platform_driver_register(&omap_dm_timer_driver);
  623. }
  624. static void __exit omap_dm_timer_driver_exit(void)
  625. {
  626. platform_driver_unregister(&omap_dm_timer_driver);
  627. }
  628. early_platform_init("earlytimer", &omap_dm_timer_driver);
  629. module_init(omap_dm_timer_driver_init);
  630. module_exit(omap_dm_timer_driver_exit);
  631. MODULE_DESCRIPTION("OMAP Dual-Mode Timer Driver");
  632. MODULE_LICENSE("GPL");
  633. MODULE_ALIAS("platform:" DRIVER_NAME);
  634. MODULE_AUTHOR("Texas Instruments Inc");