dmtimer.c 19 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766
  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. __raw_writel(timer->context.tiocp_cfg,
  79. timer->io_base + OMAP_TIMER_OCP_CFG_OFFSET);
  80. if (timer->revision == 1)
  81. __raw_writel(timer->context.tistat, timer->sys_stat);
  82. __raw_writel(timer->context.tisr, timer->irq_stat);
  83. omap_dm_timer_write_reg(timer, OMAP_TIMER_WAKEUP_EN_REG,
  84. timer->context.twer);
  85. omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG,
  86. timer->context.tcrr);
  87. omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG,
  88. timer->context.tldr);
  89. omap_dm_timer_write_reg(timer, OMAP_TIMER_MATCH_REG,
  90. timer->context.tmar);
  91. omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG,
  92. timer->context.tsicr);
  93. __raw_writel(timer->context.tier, timer->irq_ena);
  94. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG,
  95. timer->context.tclr);
  96. }
  97. static void omap_dm_timer_wait_for_reset(struct omap_dm_timer *timer)
  98. {
  99. int c;
  100. if (!timer->sys_stat)
  101. return;
  102. c = 0;
  103. while (!(__raw_readl(timer->sys_stat) & 1)) {
  104. c++;
  105. if (c > 100000) {
  106. printk(KERN_ERR "Timer failed to reset\n");
  107. return;
  108. }
  109. }
  110. }
  111. static void omap_dm_timer_reset(struct omap_dm_timer *timer)
  112. {
  113. omap_dm_timer_enable(timer);
  114. if (timer->pdev->id != 1) {
  115. omap_dm_timer_write_reg(timer, OMAP_TIMER_IF_CTRL_REG, 0x06);
  116. omap_dm_timer_wait_for_reset(timer);
  117. }
  118. __omap_dm_timer_reset(timer, 0, 0);
  119. omap_dm_timer_disable(timer);
  120. timer->posted = 1;
  121. }
  122. int omap_dm_timer_prepare(struct omap_dm_timer *timer)
  123. {
  124. struct dmtimer_platform_data *pdata = timer->pdev->dev.platform_data;
  125. int ret;
  126. timer->fclk = clk_get(&timer->pdev->dev, "fck");
  127. if (WARN_ON_ONCE(IS_ERR_OR_NULL(timer->fclk))) {
  128. timer->fclk = NULL;
  129. dev_err(&timer->pdev->dev, ": No fclk handle.\n");
  130. return -EINVAL;
  131. }
  132. if (pdata->needs_manual_reset)
  133. omap_dm_timer_reset(timer);
  134. ret = omap_dm_timer_set_source(timer, OMAP_TIMER_SRC_32_KHZ);
  135. timer->posted = 1;
  136. return ret;
  137. }
  138. struct omap_dm_timer *omap_dm_timer_request(void)
  139. {
  140. struct omap_dm_timer *timer = NULL, *t;
  141. unsigned long flags;
  142. int ret = 0;
  143. spin_lock_irqsave(&dm_timer_lock, flags);
  144. list_for_each_entry(t, &omap_timer_list, node) {
  145. if (t->reserved)
  146. continue;
  147. timer = t;
  148. timer->reserved = 1;
  149. break;
  150. }
  151. if (timer) {
  152. ret = omap_dm_timer_prepare(timer);
  153. if (ret) {
  154. timer->reserved = 0;
  155. timer = NULL;
  156. }
  157. }
  158. spin_unlock_irqrestore(&dm_timer_lock, flags);
  159. if (!timer)
  160. pr_debug("%s: timer request failed!\n", __func__);
  161. return timer;
  162. }
  163. EXPORT_SYMBOL_GPL(omap_dm_timer_request);
  164. struct omap_dm_timer *omap_dm_timer_request_specific(int id)
  165. {
  166. struct omap_dm_timer *timer = NULL, *t;
  167. unsigned long flags;
  168. int ret = 0;
  169. spin_lock_irqsave(&dm_timer_lock, flags);
  170. list_for_each_entry(t, &omap_timer_list, node) {
  171. if (t->pdev->id == id && !t->reserved) {
  172. timer = t;
  173. timer->reserved = 1;
  174. break;
  175. }
  176. }
  177. if (timer) {
  178. ret = omap_dm_timer_prepare(timer);
  179. if (ret) {
  180. timer->reserved = 0;
  181. timer = NULL;
  182. }
  183. }
  184. spin_unlock_irqrestore(&dm_timer_lock, flags);
  185. if (!timer)
  186. pr_debug("%s: timer%d request failed!\n", __func__, id);
  187. return timer;
  188. }
  189. EXPORT_SYMBOL_GPL(omap_dm_timer_request_specific);
  190. int omap_dm_timer_free(struct omap_dm_timer *timer)
  191. {
  192. if (unlikely(!timer))
  193. return -EINVAL;
  194. clk_put(timer->fclk);
  195. WARN_ON(!timer->reserved);
  196. timer->reserved = 0;
  197. return 0;
  198. }
  199. EXPORT_SYMBOL_GPL(omap_dm_timer_free);
  200. void omap_dm_timer_enable(struct omap_dm_timer *timer)
  201. {
  202. pm_runtime_get_sync(&timer->pdev->dev);
  203. }
  204. EXPORT_SYMBOL_GPL(omap_dm_timer_enable);
  205. void omap_dm_timer_disable(struct omap_dm_timer *timer)
  206. {
  207. pm_runtime_put(&timer->pdev->dev);
  208. }
  209. EXPORT_SYMBOL_GPL(omap_dm_timer_disable);
  210. int omap_dm_timer_get_irq(struct omap_dm_timer *timer)
  211. {
  212. if (timer)
  213. return timer->irq;
  214. return -EINVAL;
  215. }
  216. EXPORT_SYMBOL_GPL(omap_dm_timer_get_irq);
  217. #if defined(CONFIG_ARCH_OMAP1)
  218. /**
  219. * omap_dm_timer_modify_idlect_mask - Check if any running timers use ARMXOR
  220. * @inputmask: current value of idlect mask
  221. */
  222. __u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
  223. {
  224. int i = 0;
  225. struct omap_dm_timer *timer = NULL;
  226. unsigned long flags;
  227. /* If ARMXOR cannot be idled this function call is unnecessary */
  228. if (!(inputmask & (1 << 1)))
  229. return inputmask;
  230. /* If any active timer is using ARMXOR return modified mask */
  231. spin_lock_irqsave(&dm_timer_lock, flags);
  232. list_for_each_entry(timer, &omap_timer_list, node) {
  233. u32 l;
  234. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  235. if (l & OMAP_TIMER_CTRL_ST) {
  236. if (((omap_readl(MOD_CONF_CTRL_1) >> (i * 2)) & 0x03) == 0)
  237. inputmask &= ~(1 << 1);
  238. else
  239. inputmask &= ~(1 << 2);
  240. }
  241. i++;
  242. }
  243. spin_unlock_irqrestore(&dm_timer_lock, flags);
  244. return inputmask;
  245. }
  246. EXPORT_SYMBOL_GPL(omap_dm_timer_modify_idlect_mask);
  247. #else
  248. struct clk *omap_dm_timer_get_fclk(struct omap_dm_timer *timer)
  249. {
  250. if (timer)
  251. return timer->fclk;
  252. return NULL;
  253. }
  254. EXPORT_SYMBOL_GPL(omap_dm_timer_get_fclk);
  255. __u32 omap_dm_timer_modify_idlect_mask(__u32 inputmask)
  256. {
  257. BUG();
  258. return 0;
  259. }
  260. EXPORT_SYMBOL_GPL(omap_dm_timer_modify_idlect_mask);
  261. #endif
  262. int omap_dm_timer_trigger(struct omap_dm_timer *timer)
  263. {
  264. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  265. pr_err("%s: timer not available or enabled.\n", __func__);
  266. return -EINVAL;
  267. }
  268. omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
  269. return 0;
  270. }
  271. EXPORT_SYMBOL_GPL(omap_dm_timer_trigger);
  272. int omap_dm_timer_start(struct omap_dm_timer *timer)
  273. {
  274. u32 l;
  275. if (unlikely(!timer))
  276. return -EINVAL;
  277. omap_dm_timer_enable(timer);
  278. if (timer->loses_context) {
  279. u32 ctx_loss_cnt_after =
  280. timer->get_context_loss_count(&timer->pdev->dev);
  281. if (ctx_loss_cnt_after != timer->ctx_loss_count)
  282. omap_timer_restore_context(timer);
  283. }
  284. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  285. if (!(l & OMAP_TIMER_CTRL_ST)) {
  286. l |= OMAP_TIMER_CTRL_ST;
  287. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  288. }
  289. /* Save the context */
  290. timer->context.tclr = l;
  291. return 0;
  292. }
  293. EXPORT_SYMBOL_GPL(omap_dm_timer_start);
  294. int omap_dm_timer_stop(struct omap_dm_timer *timer)
  295. {
  296. unsigned long rate = 0;
  297. struct dmtimer_platform_data *pdata;
  298. if (unlikely(!timer))
  299. return -EINVAL;
  300. pdata = timer->pdev->dev.platform_data;
  301. if (!pdata->needs_manual_reset)
  302. rate = clk_get_rate(timer->fclk);
  303. __omap_dm_timer_stop(timer, timer->posted, rate);
  304. if (timer->loses_context && timer->get_context_loss_count)
  305. timer->ctx_loss_count =
  306. timer->get_context_loss_count(&timer->pdev->dev);
  307. /*
  308. * Since the register values are computed and written within
  309. * __omap_dm_timer_stop, we need to use read to retrieve the
  310. * context.
  311. */
  312. timer->context.tclr =
  313. omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  314. timer->context.tisr = __raw_readl(timer->irq_stat);
  315. omap_dm_timer_disable(timer);
  316. return 0;
  317. }
  318. EXPORT_SYMBOL_GPL(omap_dm_timer_stop);
  319. int omap_dm_timer_set_source(struct omap_dm_timer *timer, int source)
  320. {
  321. int ret;
  322. struct dmtimer_platform_data *pdata;
  323. if (unlikely(!timer))
  324. return -EINVAL;
  325. pdata = timer->pdev->dev.platform_data;
  326. if (source < 0 || source >= 3)
  327. return -EINVAL;
  328. ret = pdata->set_timer_src(timer->pdev, source);
  329. return ret;
  330. }
  331. EXPORT_SYMBOL_GPL(omap_dm_timer_set_source);
  332. int omap_dm_timer_set_load(struct omap_dm_timer *timer, int autoreload,
  333. unsigned int load)
  334. {
  335. u32 l;
  336. if (unlikely(!timer))
  337. return -EINVAL;
  338. omap_dm_timer_enable(timer);
  339. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  340. if (autoreload)
  341. l |= OMAP_TIMER_CTRL_AR;
  342. else
  343. l &= ~OMAP_TIMER_CTRL_AR;
  344. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  345. omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
  346. omap_dm_timer_write_reg(timer, OMAP_TIMER_TRIGGER_REG, 0);
  347. /* Save the context */
  348. timer->context.tclr = l;
  349. timer->context.tldr = load;
  350. omap_dm_timer_disable(timer);
  351. return 0;
  352. }
  353. EXPORT_SYMBOL_GPL(omap_dm_timer_set_load);
  354. /* Optimized set_load which removes costly spin wait in timer_start */
  355. int omap_dm_timer_set_load_start(struct omap_dm_timer *timer, int autoreload,
  356. unsigned int load)
  357. {
  358. u32 l;
  359. if (unlikely(!timer))
  360. return -EINVAL;
  361. omap_dm_timer_enable(timer);
  362. if (timer->loses_context) {
  363. u32 ctx_loss_cnt_after =
  364. timer->get_context_loss_count(&timer->pdev->dev);
  365. if (ctx_loss_cnt_after != timer->ctx_loss_count)
  366. omap_timer_restore_context(timer);
  367. }
  368. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  369. if (autoreload) {
  370. l |= OMAP_TIMER_CTRL_AR;
  371. omap_dm_timer_write_reg(timer, OMAP_TIMER_LOAD_REG, load);
  372. } else {
  373. l &= ~OMAP_TIMER_CTRL_AR;
  374. }
  375. l |= OMAP_TIMER_CTRL_ST;
  376. __omap_dm_timer_load_start(timer, l, load, timer->posted);
  377. /* Save the context */
  378. timer->context.tclr = l;
  379. timer->context.tldr = load;
  380. timer->context.tcrr = load;
  381. return 0;
  382. }
  383. EXPORT_SYMBOL_GPL(omap_dm_timer_set_load_start);
  384. int omap_dm_timer_set_match(struct omap_dm_timer *timer, int enable,
  385. unsigned int match)
  386. {
  387. u32 l;
  388. if (unlikely(!timer))
  389. return -EINVAL;
  390. omap_dm_timer_enable(timer);
  391. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  392. if (enable)
  393. l |= OMAP_TIMER_CTRL_CE;
  394. else
  395. l &= ~OMAP_TIMER_CTRL_CE;
  396. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  397. omap_dm_timer_write_reg(timer, OMAP_TIMER_MATCH_REG, match);
  398. /* Save the context */
  399. timer->context.tclr = l;
  400. timer->context.tmar = match;
  401. omap_dm_timer_disable(timer);
  402. return 0;
  403. }
  404. EXPORT_SYMBOL_GPL(omap_dm_timer_set_match);
  405. int omap_dm_timer_set_pwm(struct omap_dm_timer *timer, int def_on,
  406. int toggle, int trigger)
  407. {
  408. u32 l;
  409. if (unlikely(!timer))
  410. return -EINVAL;
  411. omap_dm_timer_enable(timer);
  412. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  413. l &= ~(OMAP_TIMER_CTRL_GPOCFG | OMAP_TIMER_CTRL_SCPWM |
  414. OMAP_TIMER_CTRL_PT | (0x03 << 10));
  415. if (def_on)
  416. l |= OMAP_TIMER_CTRL_SCPWM;
  417. if (toggle)
  418. l |= OMAP_TIMER_CTRL_PT;
  419. l |= trigger << 10;
  420. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  421. /* Save the context */
  422. timer->context.tclr = l;
  423. omap_dm_timer_disable(timer);
  424. return 0;
  425. }
  426. EXPORT_SYMBOL_GPL(omap_dm_timer_set_pwm);
  427. int omap_dm_timer_set_prescaler(struct omap_dm_timer *timer, int prescaler)
  428. {
  429. u32 l;
  430. if (unlikely(!timer))
  431. return -EINVAL;
  432. omap_dm_timer_enable(timer);
  433. l = omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG);
  434. l &= ~(OMAP_TIMER_CTRL_PRE | (0x07 << 2));
  435. if (prescaler >= 0x00 && prescaler <= 0x07) {
  436. l |= OMAP_TIMER_CTRL_PRE;
  437. l |= prescaler << 2;
  438. }
  439. omap_dm_timer_write_reg(timer, OMAP_TIMER_CTRL_REG, l);
  440. /* Save the context */
  441. timer->context.tclr = l;
  442. omap_dm_timer_disable(timer);
  443. return 0;
  444. }
  445. EXPORT_SYMBOL_GPL(omap_dm_timer_set_prescaler);
  446. int omap_dm_timer_set_int_enable(struct omap_dm_timer *timer,
  447. unsigned int value)
  448. {
  449. if (unlikely(!timer))
  450. return -EINVAL;
  451. omap_dm_timer_enable(timer);
  452. __omap_dm_timer_int_enable(timer, value);
  453. /* Save the context */
  454. timer->context.tier = value;
  455. timer->context.twer = value;
  456. omap_dm_timer_disable(timer);
  457. return 0;
  458. }
  459. EXPORT_SYMBOL_GPL(omap_dm_timer_set_int_enable);
  460. unsigned int omap_dm_timer_read_status(struct omap_dm_timer *timer)
  461. {
  462. unsigned int l;
  463. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  464. pr_err("%s: timer not available or enabled.\n", __func__);
  465. return 0;
  466. }
  467. l = __raw_readl(timer->irq_stat);
  468. return l;
  469. }
  470. EXPORT_SYMBOL_GPL(omap_dm_timer_read_status);
  471. int omap_dm_timer_write_status(struct omap_dm_timer *timer, unsigned int value)
  472. {
  473. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev)))
  474. return -EINVAL;
  475. __omap_dm_timer_write_status(timer, value);
  476. /* Save the context */
  477. timer->context.tisr = value;
  478. return 0;
  479. }
  480. EXPORT_SYMBOL_GPL(omap_dm_timer_write_status);
  481. unsigned int omap_dm_timer_read_counter(struct omap_dm_timer *timer)
  482. {
  483. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  484. pr_err("%s: timer not iavailable or enabled.\n", __func__);
  485. return 0;
  486. }
  487. return __omap_dm_timer_read_counter(timer, timer->posted);
  488. }
  489. EXPORT_SYMBOL_GPL(omap_dm_timer_read_counter);
  490. int omap_dm_timer_write_counter(struct omap_dm_timer *timer, unsigned int value)
  491. {
  492. if (unlikely(!timer || pm_runtime_suspended(&timer->pdev->dev))) {
  493. pr_err("%s: timer not available or enabled.\n", __func__);
  494. return -EINVAL;
  495. }
  496. omap_dm_timer_write_reg(timer, OMAP_TIMER_COUNTER_REG, value);
  497. /* Save the context */
  498. timer->context.tcrr = value;
  499. return 0;
  500. }
  501. EXPORT_SYMBOL_GPL(omap_dm_timer_write_counter);
  502. int omap_dm_timers_active(void)
  503. {
  504. struct omap_dm_timer *timer;
  505. list_for_each_entry(timer, &omap_timer_list, node) {
  506. if (!timer->reserved)
  507. continue;
  508. if (omap_dm_timer_read_reg(timer, OMAP_TIMER_CTRL_REG) &
  509. OMAP_TIMER_CTRL_ST) {
  510. return 1;
  511. }
  512. }
  513. return 0;
  514. }
  515. EXPORT_SYMBOL_GPL(omap_dm_timers_active);
  516. /**
  517. * omap_dm_timer_probe - probe function called for every registered device
  518. * @pdev: pointer to current timer platform device
  519. *
  520. * Called by driver framework at the end of device registration for all
  521. * timer devices.
  522. */
  523. static int __devinit omap_dm_timer_probe(struct platform_device *pdev)
  524. {
  525. int ret;
  526. unsigned long flags;
  527. struct omap_dm_timer *timer;
  528. struct resource *mem, *irq, *ioarea;
  529. struct dmtimer_platform_data *pdata = pdev->dev.platform_data;
  530. if (!pdata) {
  531. dev_err(&pdev->dev, "%s: no platform data.\n", __func__);
  532. return -ENODEV;
  533. }
  534. irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
  535. if (unlikely(!irq)) {
  536. dev_err(&pdev->dev, "%s: no IRQ resource.\n", __func__);
  537. return -ENODEV;
  538. }
  539. mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  540. if (unlikely(!mem)) {
  541. dev_err(&pdev->dev, "%s: no memory resource.\n", __func__);
  542. return -ENODEV;
  543. }
  544. ioarea = request_mem_region(mem->start, resource_size(mem),
  545. pdev->name);
  546. if (!ioarea) {
  547. dev_err(&pdev->dev, "%s: region already claimed.\n", __func__);
  548. return -EBUSY;
  549. }
  550. timer = kzalloc(sizeof(struct omap_dm_timer), GFP_KERNEL);
  551. if (!timer) {
  552. dev_err(&pdev->dev, "%s: no memory for omap_dm_timer.\n",
  553. __func__);
  554. ret = -ENOMEM;
  555. goto err_free_ioregion;
  556. }
  557. timer->io_base = ioremap(mem->start, resource_size(mem));
  558. if (!timer->io_base) {
  559. dev_err(&pdev->dev, "%s: ioremap failed.\n", __func__);
  560. ret = -ENOMEM;
  561. goto err_free_mem;
  562. }
  563. timer->id = pdev->id;
  564. timer->irq = irq->start;
  565. timer->reserved = pdata->reserved;
  566. timer->pdev = pdev;
  567. timer->loses_context = pdata->loses_context;
  568. timer->get_context_loss_count = pdata->get_context_loss_count;
  569. /* Skip pm_runtime_enable for OMAP1 */
  570. if (!pdata->needs_manual_reset) {
  571. pm_runtime_enable(&pdev->dev);
  572. pm_runtime_irq_safe(&pdev->dev);
  573. }
  574. if (!timer->reserved) {
  575. pm_runtime_get_sync(&pdev->dev);
  576. __omap_dm_timer_init_regs(timer);
  577. pm_runtime_put(&pdev->dev);
  578. }
  579. /* add the timer element to the list */
  580. spin_lock_irqsave(&dm_timer_lock, flags);
  581. list_add_tail(&timer->node, &omap_timer_list);
  582. spin_unlock_irqrestore(&dm_timer_lock, flags);
  583. dev_dbg(&pdev->dev, "Device Probed.\n");
  584. return 0;
  585. err_free_mem:
  586. kfree(timer);
  587. err_free_ioregion:
  588. release_mem_region(mem->start, resource_size(mem));
  589. return ret;
  590. }
  591. /**
  592. * omap_dm_timer_remove - cleanup a registered timer device
  593. * @pdev: pointer to current timer platform device
  594. *
  595. * Called by driver framework whenever a timer device is unregistered.
  596. * In addition to freeing platform resources it also deletes the timer
  597. * entry from the local list.
  598. */
  599. static int __devexit omap_dm_timer_remove(struct platform_device *pdev)
  600. {
  601. struct omap_dm_timer *timer;
  602. unsigned long flags;
  603. int ret = -EINVAL;
  604. spin_lock_irqsave(&dm_timer_lock, flags);
  605. list_for_each_entry(timer, &omap_timer_list, node)
  606. if (timer->pdev->id == pdev->id) {
  607. list_del(&timer->node);
  608. kfree(timer);
  609. ret = 0;
  610. break;
  611. }
  612. spin_unlock_irqrestore(&dm_timer_lock, flags);
  613. return ret;
  614. }
  615. static struct platform_driver omap_dm_timer_driver = {
  616. .probe = omap_dm_timer_probe,
  617. .remove = __devexit_p(omap_dm_timer_remove),
  618. .driver = {
  619. .name = "omap_timer",
  620. },
  621. };
  622. static int __init omap_dm_timer_driver_init(void)
  623. {
  624. return platform_driver_register(&omap_dm_timer_driver);
  625. }
  626. static void __exit omap_dm_timer_driver_exit(void)
  627. {
  628. platform_driver_unregister(&omap_dm_timer_driver);
  629. }
  630. early_platform_init("earlytimer", &omap_dm_timer_driver);
  631. module_init(omap_dm_timer_driver_init);
  632. module_exit(omap_dm_timer_driver_exit);
  633. MODULE_DESCRIPTION("OMAP Dual-Mode Timer Driver");
  634. MODULE_LICENSE("GPL");
  635. MODULE_ALIAS("platform:" DRIVER_NAME);
  636. MODULE_AUTHOR("Texas Instruments Inc");