timer.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415
  1. /*
  2. *
  3. * arch/arm/mach-u300/timer.c
  4. *
  5. *
  6. * Copyright (C) 2007-2009 ST-Ericsson AB
  7. * License terms: GNU General Public License (GPL) version 2
  8. * Timer COH 901 328, runs the OS timer interrupt.
  9. * Author: Linus Walleij <linus.walleij@stericsson.com>
  10. */
  11. #include <linux/interrupt.h>
  12. #include <linux/time.h>
  13. #include <linux/timex.h>
  14. #include <linux/clockchips.h>
  15. #include <linux/clocksource.h>
  16. #include <linux/types.h>
  17. #include <linux/io.h>
  18. #include <linux/clk.h>
  19. #include <linux/err.h>
  20. #include <linux/irq.h>
  21. #include <mach/hardware.h>
  22. #include <mach/irqs.h>
  23. /* Generic stuff */
  24. #include <asm/sched_clock.h>
  25. #include <asm/mach/map.h>
  26. #include <asm/mach/time.h>
  27. #include "timer.h"
  28. /*
  29. * APP side special timer registers
  30. * This timer contains four timers which can fire an interrupt each.
  31. * OS (operating system) timer @ 32768 Hz
  32. * DD (device driver) timer @ 1 kHz
  33. * GP1 (general purpose 1) timer @ 1MHz
  34. * GP2 (general purpose 2) timer @ 1MHz
  35. */
  36. /* Reset OS Timer 32bit (-/W) */
  37. #define U300_TIMER_APP_ROST (0x0000)
  38. #define U300_TIMER_APP_ROST_TIMER_RESET (0x00000000)
  39. /* Enable OS Timer 32bit (-/W) */
  40. #define U300_TIMER_APP_EOST (0x0004)
  41. #define U300_TIMER_APP_EOST_TIMER_ENABLE (0x00000000)
  42. /* Disable OS Timer 32bit (-/W) */
  43. #define U300_TIMER_APP_DOST (0x0008)
  44. #define U300_TIMER_APP_DOST_TIMER_DISABLE (0x00000000)
  45. /* OS Timer Mode Register 32bit (-/W) */
  46. #define U300_TIMER_APP_SOSTM (0x000c)
  47. #define U300_TIMER_APP_SOSTM_MODE_CONTINUOUS (0x00000000)
  48. #define U300_TIMER_APP_SOSTM_MODE_ONE_SHOT (0x00000001)
  49. /* OS Timer Status Register 32bit (R/-) */
  50. #define U300_TIMER_APP_OSTS (0x0010)
  51. #define U300_TIMER_APP_OSTS_TIMER_STATE_MASK (0x0000000F)
  52. #define U300_TIMER_APP_OSTS_TIMER_STATE_IDLE (0x00000001)
  53. #define U300_TIMER_APP_OSTS_TIMER_STATE_ACTIVE (0x00000002)
  54. #define U300_TIMER_APP_OSTS_ENABLE_IND (0x00000010)
  55. #define U300_TIMER_APP_OSTS_MODE_MASK (0x00000020)
  56. #define U300_TIMER_APP_OSTS_MODE_CONTINUOUS (0x00000000)
  57. #define U300_TIMER_APP_OSTS_MODE_ONE_SHOT (0x00000020)
  58. #define U300_TIMER_APP_OSTS_IRQ_ENABLED_IND (0x00000040)
  59. #define U300_TIMER_APP_OSTS_IRQ_PENDING_IND (0x00000080)
  60. /* OS Timer Current Count Register 32bit (R/-) */
  61. #define U300_TIMER_APP_OSTCC (0x0014)
  62. /* OS Timer Terminal Count Register 32bit (R/W) */
  63. #define U300_TIMER_APP_OSTTC (0x0018)
  64. /* OS Timer Interrupt Enable Register 32bit (-/W) */
  65. #define U300_TIMER_APP_OSTIE (0x001c)
  66. #define U300_TIMER_APP_OSTIE_IRQ_DISABLE (0x00000000)
  67. #define U300_TIMER_APP_OSTIE_IRQ_ENABLE (0x00000001)
  68. /* OS Timer Interrupt Acknowledge Register 32bit (-/W) */
  69. #define U300_TIMER_APP_OSTIA (0x0020)
  70. #define U300_TIMER_APP_OSTIA_IRQ_ACK (0x00000080)
  71. /* Reset DD Timer 32bit (-/W) */
  72. #define U300_TIMER_APP_RDDT (0x0040)
  73. #define U300_TIMER_APP_RDDT_TIMER_RESET (0x00000000)
  74. /* Enable DD Timer 32bit (-/W) */
  75. #define U300_TIMER_APP_EDDT (0x0044)
  76. #define U300_TIMER_APP_EDDT_TIMER_ENABLE (0x00000000)
  77. /* Disable DD Timer 32bit (-/W) */
  78. #define U300_TIMER_APP_DDDT (0x0048)
  79. #define U300_TIMER_APP_DDDT_TIMER_DISABLE (0x00000000)
  80. /* DD Timer Mode Register 32bit (-/W) */
  81. #define U300_TIMER_APP_SDDTM (0x004c)
  82. #define U300_TIMER_APP_SDDTM_MODE_CONTINUOUS (0x00000000)
  83. #define U300_TIMER_APP_SDDTM_MODE_ONE_SHOT (0x00000001)
  84. /* DD Timer Status Register 32bit (R/-) */
  85. #define U300_TIMER_APP_DDTS (0x0050)
  86. #define U300_TIMER_APP_DDTS_TIMER_STATE_MASK (0x0000000F)
  87. #define U300_TIMER_APP_DDTS_TIMER_STATE_IDLE (0x00000001)
  88. #define U300_TIMER_APP_DDTS_TIMER_STATE_ACTIVE (0x00000002)
  89. #define U300_TIMER_APP_DDTS_ENABLE_IND (0x00000010)
  90. #define U300_TIMER_APP_DDTS_MODE_MASK (0x00000020)
  91. #define U300_TIMER_APP_DDTS_MODE_CONTINUOUS (0x00000000)
  92. #define U300_TIMER_APP_DDTS_MODE_ONE_SHOT (0x00000020)
  93. #define U300_TIMER_APP_DDTS_IRQ_ENABLED_IND (0x00000040)
  94. #define U300_TIMER_APP_DDTS_IRQ_PENDING_IND (0x00000080)
  95. /* DD Timer Current Count Register 32bit (R/-) */
  96. #define U300_TIMER_APP_DDTCC (0x0054)
  97. /* DD Timer Terminal Count Register 32bit (R/W) */
  98. #define U300_TIMER_APP_DDTTC (0x0058)
  99. /* DD Timer Interrupt Enable Register 32bit (-/W) */
  100. #define U300_TIMER_APP_DDTIE (0x005c)
  101. #define U300_TIMER_APP_DDTIE_IRQ_DISABLE (0x00000000)
  102. #define U300_TIMER_APP_DDTIE_IRQ_ENABLE (0x00000001)
  103. /* DD Timer Interrupt Acknowledge Register 32bit (-/W) */
  104. #define U300_TIMER_APP_DDTIA (0x0060)
  105. #define U300_TIMER_APP_DDTIA_IRQ_ACK (0x00000080)
  106. /* Reset GP1 Timer 32bit (-/W) */
  107. #define U300_TIMER_APP_RGPT1 (0x0080)
  108. #define U300_TIMER_APP_RGPT1_TIMER_RESET (0x00000000)
  109. /* Enable GP1 Timer 32bit (-/W) */
  110. #define U300_TIMER_APP_EGPT1 (0x0084)
  111. #define U300_TIMER_APP_EGPT1_TIMER_ENABLE (0x00000000)
  112. /* Disable GP1 Timer 32bit (-/W) */
  113. #define U300_TIMER_APP_DGPT1 (0x0088)
  114. #define U300_TIMER_APP_DGPT1_TIMER_DISABLE (0x00000000)
  115. /* GP1 Timer Mode Register 32bit (-/W) */
  116. #define U300_TIMER_APP_SGPT1M (0x008c)
  117. #define U300_TIMER_APP_SGPT1M_MODE_CONTINUOUS (0x00000000)
  118. #define U300_TIMER_APP_SGPT1M_MODE_ONE_SHOT (0x00000001)
  119. /* GP1 Timer Status Register 32bit (R/-) */
  120. #define U300_TIMER_APP_GPT1S (0x0090)
  121. #define U300_TIMER_APP_GPT1S_TIMER_STATE_MASK (0x0000000F)
  122. #define U300_TIMER_APP_GPT1S_TIMER_STATE_IDLE (0x00000001)
  123. #define U300_TIMER_APP_GPT1S_TIMER_STATE_ACTIVE (0x00000002)
  124. #define U300_TIMER_APP_GPT1S_ENABLE_IND (0x00000010)
  125. #define U300_TIMER_APP_GPT1S_MODE_MASK (0x00000020)
  126. #define U300_TIMER_APP_GPT1S_MODE_CONTINUOUS (0x00000000)
  127. #define U300_TIMER_APP_GPT1S_MODE_ONE_SHOT (0x00000020)
  128. #define U300_TIMER_APP_GPT1S_IRQ_ENABLED_IND (0x00000040)
  129. #define U300_TIMER_APP_GPT1S_IRQ_PENDING_IND (0x00000080)
  130. /* GP1 Timer Current Count Register 32bit (R/-) */
  131. #define U300_TIMER_APP_GPT1CC (0x0094)
  132. /* GP1 Timer Terminal Count Register 32bit (R/W) */
  133. #define U300_TIMER_APP_GPT1TC (0x0098)
  134. /* GP1 Timer Interrupt Enable Register 32bit (-/W) */
  135. #define U300_TIMER_APP_GPT1IE (0x009c)
  136. #define U300_TIMER_APP_GPT1IE_IRQ_DISABLE (0x00000000)
  137. #define U300_TIMER_APP_GPT1IE_IRQ_ENABLE (0x00000001)
  138. /* GP1 Timer Interrupt Acknowledge Register 32bit (-/W) */
  139. #define U300_TIMER_APP_GPT1IA (0x00a0)
  140. #define U300_TIMER_APP_GPT1IA_IRQ_ACK (0x00000080)
  141. /* Reset GP2 Timer 32bit (-/W) */
  142. #define U300_TIMER_APP_RGPT2 (0x00c0)
  143. #define U300_TIMER_APP_RGPT2_TIMER_RESET (0x00000000)
  144. /* Enable GP2 Timer 32bit (-/W) */
  145. #define U300_TIMER_APP_EGPT2 (0x00c4)
  146. #define U300_TIMER_APP_EGPT2_TIMER_ENABLE (0x00000000)
  147. /* Disable GP2 Timer 32bit (-/W) */
  148. #define U300_TIMER_APP_DGPT2 (0x00c8)
  149. #define U300_TIMER_APP_DGPT2_TIMER_DISABLE (0x00000000)
  150. /* GP2 Timer Mode Register 32bit (-/W) */
  151. #define U300_TIMER_APP_SGPT2M (0x00cc)
  152. #define U300_TIMER_APP_SGPT2M_MODE_CONTINUOUS (0x00000000)
  153. #define U300_TIMER_APP_SGPT2M_MODE_ONE_SHOT (0x00000001)
  154. /* GP2 Timer Status Register 32bit (R/-) */
  155. #define U300_TIMER_APP_GPT2S (0x00d0)
  156. #define U300_TIMER_APP_GPT2S_TIMER_STATE_MASK (0x0000000F)
  157. #define U300_TIMER_APP_GPT2S_TIMER_STATE_IDLE (0x00000001)
  158. #define U300_TIMER_APP_GPT2S_TIMER_STATE_ACTIVE (0x00000002)
  159. #define U300_TIMER_APP_GPT2S_ENABLE_IND (0x00000010)
  160. #define U300_TIMER_APP_GPT2S_MODE_MASK (0x00000020)
  161. #define U300_TIMER_APP_GPT2S_MODE_CONTINUOUS (0x00000000)
  162. #define U300_TIMER_APP_GPT2S_MODE_ONE_SHOT (0x00000020)
  163. #define U300_TIMER_APP_GPT2S_IRQ_ENABLED_IND (0x00000040)
  164. #define U300_TIMER_APP_GPT2S_IRQ_PENDING_IND (0x00000080)
  165. /* GP2 Timer Current Count Register 32bit (R/-) */
  166. #define U300_TIMER_APP_GPT2CC (0x00d4)
  167. /* GP2 Timer Terminal Count Register 32bit (R/W) */
  168. #define U300_TIMER_APP_GPT2TC (0x00d8)
  169. /* GP2 Timer Interrupt Enable Register 32bit (-/W) */
  170. #define U300_TIMER_APP_GPT2IE (0x00dc)
  171. #define U300_TIMER_APP_GPT2IE_IRQ_DISABLE (0x00000000)
  172. #define U300_TIMER_APP_GPT2IE_IRQ_ENABLE (0x00000001)
  173. /* GP2 Timer Interrupt Acknowledge Register 32bit (-/W) */
  174. #define U300_TIMER_APP_GPT2IA (0x00e0)
  175. #define U300_TIMER_APP_GPT2IA_IRQ_ACK (0x00000080)
  176. /* Clock request control register - all four timers */
  177. #define U300_TIMER_APP_CRC (0x100)
  178. #define U300_TIMER_APP_CRC_CLOCK_REQUEST_ENABLE (0x00000001)
  179. #define TICKS_PER_JIFFY ((CLOCK_TICK_RATE + (HZ/2)) / HZ)
  180. #define US_PER_TICK ((1000000 + (HZ/2)) / HZ)
  181. /*
  182. * The u300_set_mode() function is always called first, if we
  183. * have oneshot timer active, the oneshot scheduling function
  184. * u300_set_next_event() is called immediately after.
  185. */
  186. static void u300_set_mode(enum clock_event_mode mode,
  187. struct clock_event_device *evt)
  188. {
  189. switch (mode) {
  190. case CLOCK_EVT_MODE_PERIODIC:
  191. /* Disable interrupts on GPT1 */
  192. writel(U300_TIMER_APP_GPT1IE_IRQ_DISABLE,
  193. U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1IE);
  194. /* Disable GP1 while we're reprogramming it. */
  195. writel(U300_TIMER_APP_DGPT1_TIMER_DISABLE,
  196. U300_TIMER_APP_VBASE + U300_TIMER_APP_DGPT1);
  197. /*
  198. * Set the periodic mode to a certain number of ticks per
  199. * jiffy.
  200. */
  201. writel(TICKS_PER_JIFFY,
  202. U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1TC);
  203. /*
  204. * Set continuous mode, so the timer keeps triggering
  205. * interrupts.
  206. */
  207. writel(U300_TIMER_APP_SGPT1M_MODE_CONTINUOUS,
  208. U300_TIMER_APP_VBASE + U300_TIMER_APP_SGPT1M);
  209. /* Enable timer interrupts */
  210. writel(U300_TIMER_APP_GPT1IE_IRQ_ENABLE,
  211. U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1IE);
  212. /* Then enable the OS timer again */
  213. writel(U300_TIMER_APP_EGPT1_TIMER_ENABLE,
  214. U300_TIMER_APP_VBASE + U300_TIMER_APP_EGPT1);
  215. break;
  216. case CLOCK_EVT_MODE_ONESHOT:
  217. /* Just break; here? */
  218. /*
  219. * The actual event will be programmed by the next event hook,
  220. * so we just set a dummy value somewhere at the end of the
  221. * universe here.
  222. */
  223. /* Disable interrupts on GPT1 */
  224. writel(U300_TIMER_APP_GPT1IE_IRQ_DISABLE,
  225. U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1IE);
  226. /* Disable GP1 while we're reprogramming it. */
  227. writel(U300_TIMER_APP_DGPT1_TIMER_DISABLE,
  228. U300_TIMER_APP_VBASE + U300_TIMER_APP_DGPT1);
  229. /*
  230. * Expire far in the future, u300_set_next_event() will be
  231. * called soon...
  232. */
  233. writel(0xFFFFFFFF, U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1TC);
  234. /* We run one shot per tick here! */
  235. writel(U300_TIMER_APP_SGPT1M_MODE_ONE_SHOT,
  236. U300_TIMER_APP_VBASE + U300_TIMER_APP_SGPT1M);
  237. /* Enable interrupts for this timer */
  238. writel(U300_TIMER_APP_GPT1IE_IRQ_ENABLE,
  239. U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1IE);
  240. /* Enable timer */
  241. writel(U300_TIMER_APP_EGPT1_TIMER_ENABLE,
  242. U300_TIMER_APP_VBASE + U300_TIMER_APP_EGPT1);
  243. break;
  244. case CLOCK_EVT_MODE_UNUSED:
  245. case CLOCK_EVT_MODE_SHUTDOWN:
  246. /* Disable interrupts on GP1 */
  247. writel(U300_TIMER_APP_GPT1IE_IRQ_DISABLE,
  248. U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1IE);
  249. /* Disable GP1 */
  250. writel(U300_TIMER_APP_DGPT1_TIMER_DISABLE,
  251. U300_TIMER_APP_VBASE + U300_TIMER_APP_DGPT1);
  252. break;
  253. case CLOCK_EVT_MODE_RESUME:
  254. /* Ignore this call */
  255. break;
  256. }
  257. }
  258. /*
  259. * The app timer in one shot mode obviously has to be reprogrammed
  260. * in EXACTLY this sequence to work properly. Do NOT try to e.g. replace
  261. * the interrupt disable + timer disable commands with a reset command,
  262. * it will fail miserably. Apparently (and I found this the hard way)
  263. * the timer is very sensitive to the instruction order, though you don't
  264. * get that impression from the data sheet.
  265. */
  266. static int u300_set_next_event(unsigned long cycles,
  267. struct clock_event_device *evt)
  268. {
  269. /* Disable interrupts on GPT1 */
  270. writel(U300_TIMER_APP_GPT1IE_IRQ_DISABLE,
  271. U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1IE);
  272. /* Disable GP1 while we're reprogramming it. */
  273. writel(U300_TIMER_APP_DGPT1_TIMER_DISABLE,
  274. U300_TIMER_APP_VBASE + U300_TIMER_APP_DGPT1);
  275. /* Reset the General Purpose timer 1. */
  276. writel(U300_TIMER_APP_RGPT1_TIMER_RESET,
  277. U300_TIMER_APP_VBASE + U300_TIMER_APP_RGPT1);
  278. /* IRQ in n * cycles */
  279. writel(cycles, U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1TC);
  280. /*
  281. * We run one shot per tick here! (This is necessary to reconfigure,
  282. * the timer will tilt if you don't!)
  283. */
  284. writel(U300_TIMER_APP_SGPT1M_MODE_ONE_SHOT,
  285. U300_TIMER_APP_VBASE + U300_TIMER_APP_SGPT1M);
  286. /* Enable timer interrupts */
  287. writel(U300_TIMER_APP_GPT1IE_IRQ_ENABLE,
  288. U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1IE);
  289. /* Then enable the OS timer again */
  290. writel(U300_TIMER_APP_EGPT1_TIMER_ENABLE,
  291. U300_TIMER_APP_VBASE + U300_TIMER_APP_EGPT1);
  292. return 0;
  293. }
  294. /* Use general purpose timer 1 as clock event */
  295. static struct clock_event_device clockevent_u300_1mhz = {
  296. .name = "GPT1",
  297. .rating = 300, /* Reasonably fast and accurate clock event */
  298. .features = CLOCK_EVT_FEAT_PERIODIC | CLOCK_EVT_FEAT_ONESHOT,
  299. .set_next_event = u300_set_next_event,
  300. .set_mode = u300_set_mode,
  301. };
  302. /* Clock event timer interrupt handler */
  303. static irqreturn_t u300_timer_interrupt(int irq, void *dev_id)
  304. {
  305. struct clock_event_device *evt = &clockevent_u300_1mhz;
  306. /* ACK/Clear timer IRQ for the APP GPT1 Timer */
  307. writel(U300_TIMER_APP_GPT1IA_IRQ_ACK,
  308. U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT1IA);
  309. evt->event_handler(evt);
  310. return IRQ_HANDLED;
  311. }
  312. static struct irqaction u300_timer_irq = {
  313. .name = "U300 Timer Tick",
  314. .flags = IRQF_DISABLED | IRQF_TIMER | IRQF_IRQPOLL,
  315. .handler = u300_timer_interrupt,
  316. };
  317. /*
  318. * Override the global weak sched_clock symbol with this
  319. * local implementation which uses the clocksource to get some
  320. * better resolution when scheduling the kernel. We accept that
  321. * this wraps around for now, since it is just a relative time
  322. * stamp. (Inspired by OMAP implementation.)
  323. */
  324. static u32 notrace u300_read_sched_clock(void)
  325. {
  326. return readl(U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT2CC);
  327. }
  328. /*
  329. * This sets up the system timers, clock source and clock event.
  330. */
  331. void __init u300_timer_init(void)
  332. {
  333. struct clk *clk;
  334. unsigned long rate;
  335. /* Clock the interrupt controller */
  336. clk = clk_get_sys("apptimer", NULL);
  337. BUG_ON(IS_ERR(clk));
  338. clk_prepare_enable(clk);
  339. rate = clk_get_rate(clk);
  340. setup_sched_clock(u300_read_sched_clock, 32, rate);
  341. /*
  342. * Disable the "OS" and "DD" timers - these are designed for Symbian!
  343. * Example usage in cnh1601578 cpu subsystem pd_timer_app.c
  344. */
  345. writel(U300_TIMER_APP_CRC_CLOCK_REQUEST_ENABLE,
  346. U300_TIMER_APP_VBASE + U300_TIMER_APP_CRC);
  347. writel(U300_TIMER_APP_ROST_TIMER_RESET,
  348. U300_TIMER_APP_VBASE + U300_TIMER_APP_ROST);
  349. writel(U300_TIMER_APP_DOST_TIMER_DISABLE,
  350. U300_TIMER_APP_VBASE + U300_TIMER_APP_DOST);
  351. writel(U300_TIMER_APP_RDDT_TIMER_RESET,
  352. U300_TIMER_APP_VBASE + U300_TIMER_APP_RDDT);
  353. writel(U300_TIMER_APP_DDDT_TIMER_DISABLE,
  354. U300_TIMER_APP_VBASE + U300_TIMER_APP_DDDT);
  355. /* Reset the General Purpose timer 1. */
  356. writel(U300_TIMER_APP_RGPT1_TIMER_RESET,
  357. U300_TIMER_APP_VBASE + U300_TIMER_APP_RGPT1);
  358. /* Set up the IRQ handler */
  359. setup_irq(IRQ_U300_TIMER_APP_GP1, &u300_timer_irq);
  360. /* Reset the General Purpose timer 2 */
  361. writel(U300_TIMER_APP_RGPT2_TIMER_RESET,
  362. U300_TIMER_APP_VBASE + U300_TIMER_APP_RGPT2);
  363. /* Set this timer to run around forever */
  364. writel(0xFFFFFFFFU, U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT2TC);
  365. /* Set continuous mode so it wraps around */
  366. writel(U300_TIMER_APP_SGPT2M_MODE_CONTINUOUS,
  367. U300_TIMER_APP_VBASE + U300_TIMER_APP_SGPT2M);
  368. /* Disable timer interrupts */
  369. writel(U300_TIMER_APP_GPT2IE_IRQ_DISABLE,
  370. U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT2IE);
  371. /* Then enable the GP2 timer to use as a free running us counter */
  372. writel(U300_TIMER_APP_EGPT2_TIMER_ENABLE,
  373. U300_TIMER_APP_VBASE + U300_TIMER_APP_EGPT2);
  374. /* Use general purpose timer 2 as clock source */
  375. if (clocksource_mmio_init(U300_TIMER_APP_VBASE + U300_TIMER_APP_GPT2CC,
  376. "GPT2", rate, 300, 32, clocksource_mmio_readl_up))
  377. pr_err("timer: failed to initialize U300 clock source\n");
  378. /* Configure and register the clockevent */
  379. clockevents_config_and_register(&clockevent_u300_1mhz, rate,
  380. 1, 0xffffffff);
  381. /*
  382. * TODO: init and register the rest of the timers too, they can be
  383. * used by hrtimers!
  384. */
  385. }