dmtimer.c 18 KB

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