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. static LIST_HEAD(omap_timer_list);
  44. static DEFINE_SPINLOCK(dm_timer_lock);
  45. /**
  46. * omap_dm_timer_read_reg - read timer registers in posted and non-posted mode
  47. * @timer: timer pointer over which read operation to perform
  48. * @reg: lowest byte holds the register offset
  49. *
  50. * The posted mode bit is encoded in reg. Note that in posted mode write
  51. * pending bit must be checked. Otherwise a read of a non completed write
  52. * will produce an error.
  53. */
  54. static inline u32 omap_dm_timer_read_reg(struct omap_dm_timer *timer, u32 reg)
  55. {
  56. WARN_ON((reg & 0xff) < _OMAP_TIMER_WAKEUP_EN_OFFSET);
  57. return __omap_dm_timer_read(timer, reg, timer->posted);
  58. }
  59. /**
  60. * omap_dm_timer_write_reg - write timer registers in posted and non-posted mode
  61. * @timer: timer pointer over which write operation is to perform
  62. * @reg: lowest byte holds the register offset
  63. * @value: data to write into the register
  64. *
  65. * The posted mode bit is encoded in reg. Note that in posted mode the write
  66. * pending bit must be checked. Otherwise a write on a register which has a
  67. * pending write will be lost.
  68. */
  69. static void omap_dm_timer_write_reg(struct omap_dm_timer *timer, u32 reg,
  70. u32 value)
  71. {
  72. WARN_ON((reg & 0xff) < _OMAP_TIMER_WAKEUP_EN_OFFSET);
  73. __omap_dm_timer_write(timer, reg, value, timer->posted);
  74. }
  75. static void omap_timer_restore_context(struct omap_dm_timer *timer)
  76. {
  77. __raw_writel(timer->context.tiocp_cfg,
  78. timer->io_base + OMAP_TIMER_OCP_CFG_OFFSET);
  79. if (timer->revision == 1)
  80. __raw_writel(timer->context.tistat, timer->sys_stat);
  81. __raw_writel(timer->context.tisr, timer->irq_stat);
  82. omap_dm_timer_write_reg(timer, OMAP_TIMER_WAKEUP_EN_REG,
  83. timer->context.twer);
  84. omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG,
  85. timer->context.tcrr);
  86. omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG,
  87. timer->context.tldr);
  88. omap_dm_timer_write_reg(timer, OMAP_TIMER_MATCH_REG,
  89. timer->context.tmar);
  90. omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG,
  91. timer->context.tsicr);
  92. __raw_writel(timer->context.tier, timer->irq_ena);
  93. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG,
  94. timer->context.tclr);
  95. }
  96. static void omap_dm_timer_wait_for_reset(struct omap_dm_timer *timer)
  97. {
  98. int c;
  99. if (!timer->sys_stat)
  100. return;
  101. c = 0;
  102. while (!(__raw_readl(timer->sys_stat) & 1)) {
  103. c++;
  104. if (c > 100000) {
  105. printk(KERN_ERR "Timer failed to reset\n");
  106. return;
  107. }
  108. }
  109. }
  110. static void omap_dm_timer_reset(struct omap_dm_timer *timer)
  111. {
  112. omap_dm_timer_enable(timer);
  113. if (timer->pdev->id != 1) {
  114. omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG, 0x06);
  115. omap_dm_timer_wait_for_reset(timer);
  116. }
  117. __omap_dm_timer_reset(timer, 0, 0);
  118. omap_dm_timer_disable(timer);
  119. timer->posted = 1;
  120. }
  121. int omap_dm_timer_prepare(struct omap_dm_timer *timer)
  122. {
  123. struct dmtimer_platform_data *pdata = timer->pdev->dev.platform_data;
  124. int ret;
  125. timer->fclk = clk_get(&timer->pdev->dev, "fck");
  126. if (WARN_ON_ONCE(IS_ERR_OR_NULL(timer->fclk))) {
  127. timer->fclk = NULL;
  128. dev_err(&timer->pdev->dev, ": No fclk handle.\n");
  129. return -EINVAL;
  130. }
  131. if (pdata->needs_manual_reset)
  132. omap_dm_timer_reset(timer);
  133. ret = omap_dm_timer_set_source(timer, OMAP_TIMER_SRC_32_KHZ);
  134. timer->posted = 1;
  135. return ret;
  136. }
  137. struct omap_dm_timer *omap_dm_timer_request(void)
  138. {
  139. struct omap_dm_timer *timer = NULL, *t;
  140. unsigned long flags;
  141. int ret = 0;
  142. spin_lock_irqsave(&dm_timer_lock, flags);
  143. list_for_each_entry(t, &omap_timer_list, node) {
  144. if (t->reserved)
  145. continue;
  146. timer = t;
  147. timer->reserved = 1;
  148. break;
  149. }
  150. if (timer) {
  151. ret = omap_dm_timer_prepare(timer);
  152. if (ret) {
  153. timer->reserved = 0;
  154. timer = NULL;
  155. }
  156. }
  157. spin_unlock_irqrestore(&dm_timer_lock, flags);
  158. if (!timer)
  159. pr_debug("%s: timer request failed!\n", __func__);
  160. return timer;
  161. }
  162. EXPORT_SYMBOL_GPL(omap_dm_timer_request);
  163. struct omap_dm_timer *omap_dm_timer_request_specific(int id)
  164. {
  165. struct omap_dm_timer *timer = NULL, *t;
  166. unsigned long flags;
  167. int ret = 0;
  168. spin_lock_irqsave(&dm_timer_lock, flags);
  169. list_for_each_entry(t, &omap_timer_list, node) {
  170. if (t->pdev->id == id && !t->reserved) {
  171. timer = t;
  172. timer->reserved = 1;
  173. break;
  174. }
  175. }
  176. if (timer) {
  177. ret = omap_dm_timer_prepare(timer);
  178. if (ret) {
  179. timer->reserved = 0;
  180. timer = NULL;
  181. }
  182. }
  183. spin_unlock_irqrestore(&dm_timer_lock, flags);
  184. if (!timer)
  185. pr_debug("%s: timer%d request failed!\n", __func__, id);
  186. return timer;
  187. }
  188. EXPORT_SYMBOL_GPL(omap_dm_timer_request_specific);
  189. int omap_dm_timer_free(struct omap_dm_timer *timer)
  190. {
  191. if (unlikely(!timer))
  192. return -EINVAL;
  193. clk_put(timer->fclk);
  194. WARN_ON(!timer->reserved);
  195. timer->reserved = 0;
  196. return 0;
  197. }
  198. EXPORT_SYMBOL_GPL(omap_dm_timer_free);
  199. void omap_dm_timer_enable(struct omap_dm_timer *timer)
  200. {
  201. pm_runtime_get_sync(&timer->pdev->dev);
  202. }
  203. EXPORT_SYMBOL_GPL(omap_dm_timer_enable);
  204. void omap_dm_timer_disable(struct omap_dm_timer *timer)
  205. {
  206. pm_runtime_put(&timer->pdev->dev);
  207. }
  208. EXPORT_SYMBOL_GPL(omap_dm_timer_disable);
  209. int omap_dm_timer_get_irq(struct omap_dm_timer *timer)
  210. {
  211. if (timer)
  212. return timer->irq;
  213. return -EINVAL;
  214. }
  215. EXPORT_SYMBOL_GPL(omap_dm_timer_get_irq);
  216. #if defined(CONFIG_ARCH_OMAP1)
  217. /**
  218. * omap_dm_timer_modify_idlect_mask - Check if any running timers use ARMXOR
  219. * @inputmask: current value of idlect mask
  220. */
  221. __u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
  222. {
  223. int i = 0;
  224. struct omap_dm_timer *timer = NULL;
  225. unsigned long flags;
  226. /* If ARMXOR cannot be idled this function call is unnecessary */
  227. if (!(inputmask & (1 << 1)))
  228. return inputmask;
  229. /* If any active timer is using ARMXOR return modified mask */
  230. spin_lock_irqsave(&dm_timer_lock, flags);
  231. list_for_each_entry(timer, &omap_timer_list, node) {
  232. u32 l;
  233. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  234. if (l & OMAP_TIMER_CTRL_ST) {
  235. if (((omap_readl(MOD_CONF_CTRL_1) >> (i * 2)) & 0x03) == 0)
  236. inputmask &= ~(1 << 1);
  237. else
  238. inputmask &= ~(1 << 2);
  239. }
  240. i++;
  241. }
  242. spin_unlock_irqrestore(&dm_timer_lock, flags);
  243. return inputmask;
  244. }
  245. EXPORT_SYMBOL_GPL(omap_dm_timer_modify_idlect_mask);
  246. #else
  247. struct clk *omap_dm_timer_get_fclk(struct omap_dm_timer *timer)
  248. {
  249. if (timer)
  250. return timer->fclk;
  251. return NULL;
  252. }
  253. EXPORT_SYMBOL_GPL(omap_dm_timer_get_fclk);
  254. __u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
  255. {
  256. BUG();
  257. return 0;
  258. }
  259. EXPORT_SYMBOL_GPL(omap_dm_timer_modify_idlect_mask);
  260. #endif
  261. int omap_dm_timer_trigger(struct omap_dm_timer *timer)
  262. {
  263. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  264. pr_err("%s: timer not available or enabled.\n", __func__);
  265. return -EINVAL;
  266. }
  267. omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
  268. return 0;
  269. }
  270. EXPORT_SYMBOL_GPL(omap_dm_timer_trigger);
  271. int omap_dm_timer_start(struct omap_dm_timer *timer)
  272. {
  273. u32 l;
  274. if (unlikely(!timer))
  275. return -EINVAL;
  276. omap_dm_timer_enable(timer);
  277. if (timer->loses_context) {
  278. u32 ctx_loss_cnt_after =
  279. timer->get_context_loss_count(&timer->pdev->dev);
  280. if (ctx_loss_cnt_after != timer->ctx_loss_count)
  281. omap_timer_restore_context(timer);
  282. }
  283. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  284. if (!(l & OMAP_TIMER_CTRL_ST)) {
  285. l |= OMAP_TIMER_CTRL_ST;
  286. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  287. }
  288. /* Save the context */
  289. timer->context.tclr = l;
  290. return 0;
  291. }
  292. EXPORT_SYMBOL_GPL(omap_dm_timer_start);
  293. int omap_dm_timer_stop(struct omap_dm_timer *timer)
  294. {
  295. unsigned long rate = 0;
  296. struct dmtimer_platform_data *pdata = timer->pdev->dev.platform_data;
  297. if (unlikely(!timer))
  298. return -EINVAL;
  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");