dmtimer.c 19 KB

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