irq.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823
  1. /* linux/arch/arm/mach-s3c2410/irq.c
  2. *
  3. * Copyright (c) 2003,2004 Simtec Electronics
  4. * Ben Dooks <ben@simtec.co.uk>
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation; either version 2 of the License, or
  9. * (at your option) any later version.
  10. *
  11. * This program is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program; if not, write to the Free Software
  18. * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
  19. *
  20. * Changelog:
  21. *
  22. * 22-Jul-2004 Ben Dooks <ben@simtec.co.uk>
  23. * Fixed compile warnings
  24. *
  25. * 22-Jul-2004 Roc Wu <cooloney@yahoo.com.cn>
  26. * Fixed s3c_extirq_type
  27. *
  28. * 21-Jul-2004 Arnaud Patard (Rtp) <arnaud.patard@rtp-net.org>
  29. * Addition of ADC/TC demux
  30. *
  31. * 04-Oct-2004 Klaus Fetscher <k.fetscher@fetron.de>
  32. * Fix for set_irq_type() on low EINT numbers
  33. *
  34. * 05-Oct-2004 Ben Dooks <ben@simtec.co.uk>
  35. * Tidy up KF's patch and sort out new release
  36. *
  37. * 05-Oct-2004 Ben Dooks <ben@simtec.co.uk>
  38. * Add support for power management controls
  39. *
  40. * 04-Nov-2004 Ben Dooks
  41. * Fix standard IRQ wake for EINT0..4 and RTC
  42. *
  43. * 22-Feb-2005 Ben Dooks
  44. * Fixed edge-triggering on ADC IRQ
  45. *
  46. * 28-Jun-2005 Ben Dooks
  47. * Mark IRQ_LCD valid
  48. *
  49. * 25-Jul-2005 Ben Dooks
  50. * Split the S3C2440 IRQ code to seperate file
  51. */
  52. #include <linux/init.h>
  53. #include <linux/module.h>
  54. #include <linux/interrupt.h>
  55. #include <linux/ioport.h>
  56. #include <linux/ptrace.h>
  57. #include <linux/sysdev.h>
  58. #include <asm/hardware.h>
  59. #include <asm/irq.h>
  60. #include <asm/io.h>
  61. #include <asm/mach/irq.h>
  62. #include <asm/arch/regs-irq.h>
  63. #include <asm/arch/regs-gpio.h>
  64. #include "cpu.h"
  65. #include "pm.h"
  66. #include "irq.h"
  67. /* wakeup irq control */
  68. #ifdef CONFIG_PM
  69. /* state for IRQs over sleep */
  70. /* default is to allow for EINT0..EINT15, and IRQ_RTC as wakeup sources
  71. *
  72. * set bit to 1 in allow bitfield to enable the wakeup settings on it
  73. */
  74. unsigned long s3c_irqwake_intallow = 1L << (IRQ_RTC - IRQ_EINT0) | 0xfL;
  75. unsigned long s3c_irqwake_intmask = 0xffffffffL;
  76. unsigned long s3c_irqwake_eintallow = 0x0000fff0L;
  77. unsigned long s3c_irqwake_eintmask = 0xffffffffL;
  78. int
  79. s3c_irq_wake(unsigned int irqno, unsigned int state)
  80. {
  81. unsigned long irqbit = 1 << (irqno - IRQ_EINT0);
  82. if (!(s3c_irqwake_intallow & irqbit))
  83. return -ENOENT;
  84. printk(KERN_INFO "wake %s for irq %d\n",
  85. state ? "enabled" : "disabled", irqno);
  86. if (!state)
  87. s3c_irqwake_intmask |= irqbit;
  88. else
  89. s3c_irqwake_intmask &= ~irqbit;
  90. return 0;
  91. }
  92. static int
  93. s3c_irqext_wake(unsigned int irqno, unsigned int state)
  94. {
  95. unsigned long bit = 1L << (irqno - EXTINT_OFF);
  96. if (!(s3c_irqwake_eintallow & bit))
  97. return -ENOENT;
  98. printk(KERN_INFO "wake %s for irq %d\n",
  99. state ? "enabled" : "disabled", irqno);
  100. if (!state)
  101. s3c_irqwake_eintmask |= bit;
  102. else
  103. s3c_irqwake_eintmask &= ~bit;
  104. return 0;
  105. }
  106. #else
  107. #define s3c_irqext_wake NULL
  108. #define s3c_irq_wake NULL
  109. #endif
  110. static void
  111. s3c_irq_mask(unsigned int irqno)
  112. {
  113. unsigned long mask;
  114. irqno -= IRQ_EINT0;
  115. mask = __raw_readl(S3C2410_INTMSK);
  116. mask |= 1UL << irqno;
  117. __raw_writel(mask, S3C2410_INTMSK);
  118. }
  119. static inline void
  120. s3c_irq_ack(unsigned int irqno)
  121. {
  122. unsigned long bitval = 1UL << (irqno - IRQ_EINT0);
  123. __raw_writel(bitval, S3C2410_SRCPND);
  124. __raw_writel(bitval, S3C2410_INTPND);
  125. }
  126. static inline void
  127. s3c_irq_maskack(unsigned int irqno)
  128. {
  129. unsigned long bitval = 1UL << (irqno - IRQ_EINT0);
  130. unsigned long mask;
  131. mask = __raw_readl(S3C2410_INTMSK);
  132. __raw_writel(mask|bitval, S3C2410_INTMSK);
  133. __raw_writel(bitval, S3C2410_SRCPND);
  134. __raw_writel(bitval, S3C2410_INTPND);
  135. }
  136. static void
  137. s3c_irq_unmask(unsigned int irqno)
  138. {
  139. unsigned long mask;
  140. if (irqno != IRQ_TIMER4 && irqno != IRQ_EINT8t23)
  141. irqdbf2("s3c_irq_unmask %d\n", irqno);
  142. irqno -= IRQ_EINT0;
  143. mask = __raw_readl(S3C2410_INTMSK);
  144. mask &= ~(1UL << irqno);
  145. __raw_writel(mask, S3C2410_INTMSK);
  146. }
  147. struct irqchip s3c_irq_level_chip = {
  148. .name = "s3c-level",
  149. .ack = s3c_irq_maskack,
  150. .mask = s3c_irq_mask,
  151. .unmask = s3c_irq_unmask,
  152. .set_wake = s3c_irq_wake
  153. };
  154. static struct irqchip s3c_irq_chip = {
  155. .name = "s3c",
  156. .ack = s3c_irq_ack,
  157. .mask = s3c_irq_mask,
  158. .unmask = s3c_irq_unmask,
  159. .set_wake = s3c_irq_wake
  160. };
  161. static void
  162. s3c_irqext_mask(unsigned int irqno)
  163. {
  164. unsigned long mask;
  165. irqno -= EXTINT_OFF;
  166. mask = __raw_readl(S3C24XX_EINTMASK);
  167. mask |= ( 1UL << irqno);
  168. __raw_writel(mask, S3C24XX_EINTMASK);
  169. if (irqno <= (IRQ_EINT7 - EXTINT_OFF)) {
  170. /* check to see if all need masking */
  171. if ((mask & (0xf << 4)) == (0xf << 4)) {
  172. /* all masked, mask the parent */
  173. s3c_irq_mask(IRQ_EINT4t7);
  174. }
  175. } else {
  176. /* todo: the same check as above for the rest of the irq regs...*/
  177. }
  178. }
  179. static void
  180. s3c_irqext_ack(unsigned int irqno)
  181. {
  182. unsigned long req;
  183. unsigned long bit;
  184. unsigned long mask;
  185. bit = 1UL << (irqno - EXTINT_OFF);
  186. mask = __raw_readl(S3C24XX_EINTMASK);
  187. __raw_writel(bit, S3C24XX_EINTPEND);
  188. req = __raw_readl(S3C24XX_EINTPEND);
  189. req &= ~mask;
  190. /* not sure if we should be acking the parent irq... */
  191. if (irqno <= IRQ_EINT7 ) {
  192. if ((req & 0xf0) == 0)
  193. s3c_irq_ack(IRQ_EINT4t7);
  194. } else {
  195. if ((req >> 8) == 0)
  196. s3c_irq_ack(IRQ_EINT8t23);
  197. }
  198. }
  199. static void
  200. s3c_irqext_unmask(unsigned int irqno)
  201. {
  202. unsigned long mask;
  203. irqno -= EXTINT_OFF;
  204. mask = __raw_readl(S3C24XX_EINTMASK);
  205. mask &= ~( 1UL << irqno);
  206. __raw_writel(mask, S3C24XX_EINTMASK);
  207. s3c_irq_unmask((irqno <= (IRQ_EINT7 - EXTINT_OFF)) ? IRQ_EINT4t7 : IRQ_EINT8t23);
  208. }
  209. int
  210. s3c_irqext_type(unsigned int irq, unsigned int type)
  211. {
  212. void __iomem *extint_reg;
  213. void __iomem *gpcon_reg;
  214. unsigned long gpcon_offset, extint_offset;
  215. unsigned long newvalue = 0, value;
  216. if ((irq >= IRQ_EINT0) && (irq <= IRQ_EINT3))
  217. {
  218. gpcon_reg = S3C2410_GPFCON;
  219. extint_reg = S3C24XX_EXTINT0;
  220. gpcon_offset = (irq - IRQ_EINT0) * 2;
  221. extint_offset = (irq - IRQ_EINT0) * 4;
  222. }
  223. else if ((irq >= IRQ_EINT4) && (irq <= IRQ_EINT7))
  224. {
  225. gpcon_reg = S3C2410_GPFCON;
  226. extint_reg = S3C24XX_EXTINT0;
  227. gpcon_offset = (irq - (EXTINT_OFF)) * 2;
  228. extint_offset = (irq - (EXTINT_OFF)) * 4;
  229. }
  230. else if ((irq >= IRQ_EINT8) && (irq <= IRQ_EINT15))
  231. {
  232. gpcon_reg = S3C2410_GPGCON;
  233. extint_reg = S3C24XX_EXTINT1;
  234. gpcon_offset = (irq - IRQ_EINT8) * 2;
  235. extint_offset = (irq - IRQ_EINT8) * 4;
  236. }
  237. else if ((irq >= IRQ_EINT16) && (irq <= IRQ_EINT23))
  238. {
  239. gpcon_reg = S3C2410_GPGCON;
  240. extint_reg = S3C24XX_EXTINT2;
  241. gpcon_offset = (irq - IRQ_EINT8) * 2;
  242. extint_offset = (irq - IRQ_EINT16) * 4;
  243. } else
  244. return -1;
  245. /* Set the GPIO to external interrupt mode */
  246. value = __raw_readl(gpcon_reg);
  247. value = (value & ~(3 << gpcon_offset)) | (0x02 << gpcon_offset);
  248. __raw_writel(value, gpcon_reg);
  249. /* Set the external interrupt to pointed trigger type */
  250. switch (type)
  251. {
  252. case IRQT_NOEDGE:
  253. printk(KERN_WARNING "No edge setting!\n");
  254. break;
  255. case IRQT_RISING:
  256. newvalue = S3C2410_EXTINT_RISEEDGE;
  257. break;
  258. case IRQT_FALLING:
  259. newvalue = S3C2410_EXTINT_FALLEDGE;
  260. break;
  261. case IRQT_BOTHEDGE:
  262. newvalue = S3C2410_EXTINT_BOTHEDGE;
  263. break;
  264. case IRQT_LOW:
  265. newvalue = S3C2410_EXTINT_LOWLEV;
  266. break;
  267. case IRQT_HIGH:
  268. newvalue = S3C2410_EXTINT_HILEV;
  269. break;
  270. default:
  271. printk(KERN_ERR "No such irq type %d", type);
  272. return -1;
  273. }
  274. value = __raw_readl(extint_reg);
  275. value = (value & ~(7 << extint_offset)) | (newvalue << extint_offset);
  276. __raw_writel(value, extint_reg);
  277. return 0;
  278. }
  279. static struct irqchip s3c_irqext_chip = {
  280. .name = "s3c-ext",
  281. .mask = s3c_irqext_mask,
  282. .unmask = s3c_irqext_unmask,
  283. .ack = s3c_irqext_ack,
  284. .set_type = s3c_irqext_type,
  285. .set_wake = s3c_irqext_wake
  286. };
  287. static struct irqchip s3c_irq_eint0t4 = {
  288. .name = "s3c-ext0",
  289. .ack = s3c_irq_ack,
  290. .mask = s3c_irq_mask,
  291. .unmask = s3c_irq_unmask,
  292. .set_wake = s3c_irq_wake,
  293. .set_type = s3c_irqext_type,
  294. };
  295. /* mask values for the parent registers for each of the interrupt types */
  296. #define INTMSK_UART0 (1UL << (IRQ_UART0 - IRQ_EINT0))
  297. #define INTMSK_UART1 (1UL << (IRQ_UART1 - IRQ_EINT0))
  298. #define INTMSK_UART2 (1UL << (IRQ_UART2 - IRQ_EINT0))
  299. #define INTMSK_ADCPARENT (1UL << (IRQ_ADCPARENT - IRQ_EINT0))
  300. /* UART0 */
  301. static void
  302. s3c_irq_uart0_mask(unsigned int irqno)
  303. {
  304. s3c_irqsub_mask(irqno, INTMSK_UART0, 7);
  305. }
  306. static void
  307. s3c_irq_uart0_unmask(unsigned int irqno)
  308. {
  309. s3c_irqsub_unmask(irqno, INTMSK_UART0);
  310. }
  311. static void
  312. s3c_irq_uart0_ack(unsigned int irqno)
  313. {
  314. s3c_irqsub_maskack(irqno, INTMSK_UART0, 7);
  315. }
  316. static struct irqchip s3c_irq_uart0 = {
  317. .name = "s3c-uart0",
  318. .mask = s3c_irq_uart0_mask,
  319. .unmask = s3c_irq_uart0_unmask,
  320. .ack = s3c_irq_uart0_ack,
  321. };
  322. /* UART1 */
  323. static void
  324. s3c_irq_uart1_mask(unsigned int irqno)
  325. {
  326. s3c_irqsub_mask(irqno, INTMSK_UART1, 7 << 3);
  327. }
  328. static void
  329. s3c_irq_uart1_unmask(unsigned int irqno)
  330. {
  331. s3c_irqsub_unmask(irqno, INTMSK_UART1);
  332. }
  333. static void
  334. s3c_irq_uart1_ack(unsigned int irqno)
  335. {
  336. s3c_irqsub_maskack(irqno, INTMSK_UART1, 7 << 3);
  337. }
  338. static struct irqchip s3c_irq_uart1 = {
  339. .name = "s3c-uart1",
  340. .mask = s3c_irq_uart1_mask,
  341. .unmask = s3c_irq_uart1_unmask,
  342. .ack = s3c_irq_uart1_ack,
  343. };
  344. /* UART2 */
  345. static void
  346. s3c_irq_uart2_mask(unsigned int irqno)
  347. {
  348. s3c_irqsub_mask(irqno, INTMSK_UART2, 7 << 6);
  349. }
  350. static void
  351. s3c_irq_uart2_unmask(unsigned int irqno)
  352. {
  353. s3c_irqsub_unmask(irqno, INTMSK_UART2);
  354. }
  355. static void
  356. s3c_irq_uart2_ack(unsigned int irqno)
  357. {
  358. s3c_irqsub_maskack(irqno, INTMSK_UART2, 7 << 6);
  359. }
  360. static struct irqchip s3c_irq_uart2 = {
  361. .name = "s3c-uart2",
  362. .mask = s3c_irq_uart2_mask,
  363. .unmask = s3c_irq_uart2_unmask,
  364. .ack = s3c_irq_uart2_ack,
  365. };
  366. /* ADC and Touchscreen */
  367. static void
  368. s3c_irq_adc_mask(unsigned int irqno)
  369. {
  370. s3c_irqsub_mask(irqno, INTMSK_ADCPARENT, 3 << 9);
  371. }
  372. static void
  373. s3c_irq_adc_unmask(unsigned int irqno)
  374. {
  375. s3c_irqsub_unmask(irqno, INTMSK_ADCPARENT);
  376. }
  377. static void
  378. s3c_irq_adc_ack(unsigned int irqno)
  379. {
  380. s3c_irqsub_ack(irqno, INTMSK_ADCPARENT, 3 << 9);
  381. }
  382. static struct irqchip s3c_irq_adc = {
  383. .name = "s3c-adc",
  384. .mask = s3c_irq_adc_mask,
  385. .unmask = s3c_irq_adc_unmask,
  386. .ack = s3c_irq_adc_ack,
  387. };
  388. /* irq demux for adc */
  389. static void s3c_irq_demux_adc(unsigned int irq,
  390. struct irqdesc *desc,
  391. struct pt_regs *regs)
  392. {
  393. unsigned int subsrc, submsk;
  394. unsigned int offset = 9;
  395. struct irqdesc *mydesc;
  396. /* read the current pending interrupts, and the mask
  397. * for what it is available */
  398. subsrc = __raw_readl(S3C2410_SUBSRCPND);
  399. submsk = __raw_readl(S3C2410_INTSUBMSK);
  400. subsrc &= ~submsk;
  401. subsrc >>= offset;
  402. subsrc &= 3;
  403. if (subsrc != 0) {
  404. if (subsrc & 1) {
  405. mydesc = irq_desc + IRQ_TC;
  406. desc_handle_irq(IRQ_TC, mydesc, regs);
  407. }
  408. if (subsrc & 2) {
  409. mydesc = irq_desc + IRQ_ADC;
  410. desc_handle_irq(IRQ_ADC, mydesc, regs);
  411. }
  412. }
  413. }
  414. static void s3c_irq_demux_uart(unsigned int start,
  415. struct pt_regs *regs)
  416. {
  417. unsigned int subsrc, submsk;
  418. unsigned int offset = start - IRQ_S3CUART_RX0;
  419. struct irqdesc *desc;
  420. /* read the current pending interrupts, and the mask
  421. * for what it is available */
  422. subsrc = __raw_readl(S3C2410_SUBSRCPND);
  423. submsk = __raw_readl(S3C2410_INTSUBMSK);
  424. irqdbf2("s3c_irq_demux_uart: start=%d (%d), subsrc=0x%08x,0x%08x\n",
  425. start, offset, subsrc, submsk);
  426. subsrc &= ~submsk;
  427. subsrc >>= offset;
  428. subsrc &= 7;
  429. if (subsrc != 0) {
  430. desc = irq_desc + start;
  431. if (subsrc & 1)
  432. desc_handle_irq(start, desc, regs);
  433. desc++;
  434. if (subsrc & 2)
  435. desc_handle_irq(start+1, desc, regs);
  436. desc++;
  437. if (subsrc & 4)
  438. desc_handle_irq(start+2, desc, regs);
  439. }
  440. }
  441. /* uart demux entry points */
  442. static void
  443. s3c_irq_demux_uart0(unsigned int irq,
  444. struct irqdesc *desc,
  445. struct pt_regs *regs)
  446. {
  447. irq = irq;
  448. s3c_irq_demux_uart(IRQ_S3CUART_RX0, regs);
  449. }
  450. static void
  451. s3c_irq_demux_uart1(unsigned int irq,
  452. struct irqdesc *desc,
  453. struct pt_regs *regs)
  454. {
  455. irq = irq;
  456. s3c_irq_demux_uart(IRQ_S3CUART_RX1, regs);
  457. }
  458. static void
  459. s3c_irq_demux_uart2(unsigned int irq,
  460. struct irqdesc *desc,
  461. struct pt_regs *regs)
  462. {
  463. irq = irq;
  464. s3c_irq_demux_uart(IRQ_S3CUART_RX2, regs);
  465. }
  466. static void
  467. s3c_irq_demux_extint8(unsigned int irq,
  468. struct irqdesc *desc,
  469. struct pt_regs *regs)
  470. {
  471. unsigned long eintpnd = __raw_readl(S3C24XX_EINTPEND);
  472. unsigned long eintmsk = __raw_readl(S3C24XX_EINTMASK);
  473. eintpnd &= ~eintmsk;
  474. eintpnd &= ~0xff; /* ignore lower irqs */
  475. /* we may as well handle all the pending IRQs here */
  476. while (eintpnd) {
  477. irq = __ffs(eintpnd);
  478. eintpnd &= ~(1<<irq);
  479. irq += (IRQ_EINT4 - 4);
  480. desc_handle_irq(irq, irq_desc + irq, regs);
  481. }
  482. }
  483. static void
  484. s3c_irq_demux_extint4t7(unsigned int irq,
  485. struct irqdesc *desc,
  486. struct pt_regs *regs)
  487. {
  488. unsigned long eintpnd = __raw_readl(S3C24XX_EINTPEND);
  489. unsigned long eintmsk = __raw_readl(S3C24XX_EINTMASK);
  490. eintpnd &= ~eintmsk;
  491. eintpnd &= 0xff; /* only lower irqs */
  492. /* we may as well handle all the pending IRQs here */
  493. while (eintpnd) {
  494. irq = __ffs(eintpnd);
  495. eintpnd &= ~(1<<irq);
  496. irq += (IRQ_EINT4 - 4);
  497. desc_handle_irq(irq, irq_desc + irq, regs);
  498. }
  499. }
  500. #ifdef CONFIG_PM
  501. static struct sleep_save irq_save[] = {
  502. SAVE_ITEM(S3C2410_INTMSK),
  503. SAVE_ITEM(S3C2410_INTSUBMSK),
  504. };
  505. /* the extint values move between the s3c2410/s3c2440 and the s3c2412
  506. * so we use an array to hold them, and to calculate the address of
  507. * the register at run-time
  508. */
  509. static unsigned long save_extint[3];
  510. static unsigned long save_eintflt[4];
  511. static unsigned long save_eintmask;
  512. int s3c24xx_irq_suspend(struct sys_device *dev, pm_message_t state)
  513. {
  514. unsigned int i;
  515. for (i = 0; i < ARRAY_SIZE(save_extint); i++)
  516. save_extint[i] = __raw_readl(S3C24XX_EXTINT0 + (i*4));
  517. for (i = 0; i < ARRAY_SIZE(save_eintflt); i++)
  518. save_eintflt[i] = __raw_readl(S3C24XX_EINFLT0 + (i*4));
  519. s3c2410_pm_do_save(irq_save, ARRAY_SIZE(irq_save));
  520. save_eintmask = __raw_readl(S3C24XX_EINTMASK);
  521. return 0;
  522. }
  523. int s3c24xx_irq_resume(struct sys_device *dev)
  524. {
  525. unsigned int i;
  526. for (i = 0; i < ARRAY_SIZE(save_extint); i++)
  527. __raw_writel(save_extint[i], S3C24XX_EXTINT0 + (i*4));
  528. for (i = 0; i < ARRAY_SIZE(save_eintflt); i++)
  529. __raw_writel(save_eintflt[i], S3C24XX_EINFLT0 + (i*4));
  530. s3c2410_pm_do_restore(irq_save, ARRAY_SIZE(irq_save));
  531. __raw_writel(save_eintmask, S3C24XX_EINTMASK);
  532. return 0;
  533. }
  534. #else
  535. #define s3c24xx_irq_suspend NULL
  536. #define s3c24xx_irq_resume NULL
  537. #endif
  538. /* s3c24xx_init_irq
  539. *
  540. * Initialise S3C2410 IRQ system
  541. */
  542. void __init s3c24xx_init_irq(void)
  543. {
  544. unsigned long pend;
  545. unsigned long last;
  546. int irqno;
  547. int i;
  548. irqdbf("s3c2410_init_irq: clearing interrupt status flags\n");
  549. /* first, clear all interrupts pending... */
  550. last = 0;
  551. for (i = 0; i < 4; i++) {
  552. pend = __raw_readl(S3C24XX_EINTPEND);
  553. if (pend == 0 || pend == last)
  554. break;
  555. __raw_writel(pend, S3C24XX_EINTPEND);
  556. printk("irq: clearing pending ext status %08x\n", (int)pend);
  557. last = pend;
  558. }
  559. last = 0;
  560. for (i = 0; i < 4; i++) {
  561. pend = __raw_readl(S3C2410_INTPND);
  562. if (pend == 0 || pend == last)
  563. break;
  564. __raw_writel(pend, S3C2410_SRCPND);
  565. __raw_writel(pend, S3C2410_INTPND);
  566. printk("irq: clearing pending status %08x\n", (int)pend);
  567. last = pend;
  568. }
  569. last = 0;
  570. for (i = 0; i < 4; i++) {
  571. pend = __raw_readl(S3C2410_SUBSRCPND);
  572. if (pend == 0 || pend == last)
  573. break;
  574. printk("irq: clearing subpending status %08x\n", (int)pend);
  575. __raw_writel(pend, S3C2410_SUBSRCPND);
  576. last = pend;
  577. }
  578. /* register the main interrupts */
  579. irqdbf("s3c2410_init_irq: registering s3c2410 interrupt handlers\n");
  580. for (irqno = IRQ_EINT4t7; irqno <= IRQ_ADCPARENT; irqno++) {
  581. /* set all the s3c2410 internal irqs */
  582. switch (irqno) {
  583. /* deal with the special IRQs (cascaded) */
  584. case IRQ_EINT4t7:
  585. case IRQ_EINT8t23:
  586. case IRQ_UART0:
  587. case IRQ_UART1:
  588. case IRQ_UART2:
  589. case IRQ_ADCPARENT:
  590. set_irq_chip(irqno, &s3c_irq_level_chip);
  591. set_irq_handler(irqno, do_level_IRQ);
  592. break;
  593. case IRQ_RESERVED6:
  594. case IRQ_RESERVED24:
  595. /* no IRQ here */
  596. break;
  597. default:
  598. //irqdbf("registering irq %d (s3c irq)\n", irqno);
  599. set_irq_chip(irqno, &s3c_irq_chip);
  600. set_irq_handler(irqno, do_edge_IRQ);
  601. set_irq_flags(irqno, IRQF_VALID);
  602. }
  603. }
  604. /* setup the cascade irq handlers */
  605. set_irq_chained_handler(IRQ_EINT4t7, s3c_irq_demux_extint4t7);
  606. set_irq_chained_handler(IRQ_EINT8t23, s3c_irq_demux_extint8);
  607. set_irq_chained_handler(IRQ_UART0, s3c_irq_demux_uart0);
  608. set_irq_chained_handler(IRQ_UART1, s3c_irq_demux_uart1);
  609. set_irq_chained_handler(IRQ_UART2, s3c_irq_demux_uart2);
  610. set_irq_chained_handler(IRQ_ADCPARENT, s3c_irq_demux_adc);
  611. /* external interrupts */
  612. for (irqno = IRQ_EINT0; irqno <= IRQ_EINT3; irqno++) {
  613. irqdbf("registering irq %d (ext int)\n", irqno);
  614. set_irq_chip(irqno, &s3c_irq_eint0t4);
  615. set_irq_handler(irqno, do_edge_IRQ);
  616. set_irq_flags(irqno, IRQF_VALID);
  617. }
  618. for (irqno = IRQ_EINT4; irqno <= IRQ_EINT23; irqno++) {
  619. irqdbf("registering irq %d (extended s3c irq)\n", irqno);
  620. set_irq_chip(irqno, &s3c_irqext_chip);
  621. set_irq_handler(irqno, do_edge_IRQ);
  622. set_irq_flags(irqno, IRQF_VALID);
  623. }
  624. /* register the uart interrupts */
  625. irqdbf("s3c2410: registering external interrupts\n");
  626. for (irqno = IRQ_S3CUART_RX0; irqno <= IRQ_S3CUART_ERR0; irqno++) {
  627. irqdbf("registering irq %d (s3c uart0 irq)\n", irqno);
  628. set_irq_chip(irqno, &s3c_irq_uart0);
  629. set_irq_handler(irqno, do_level_IRQ);
  630. set_irq_flags(irqno, IRQF_VALID);
  631. }
  632. for (irqno = IRQ_S3CUART_RX1; irqno <= IRQ_S3CUART_ERR1; irqno++) {
  633. irqdbf("registering irq %d (s3c uart1 irq)\n", irqno);
  634. set_irq_chip(irqno, &s3c_irq_uart1);
  635. set_irq_handler(irqno, do_level_IRQ);
  636. set_irq_flags(irqno, IRQF_VALID);
  637. }
  638. for (irqno = IRQ_S3CUART_RX2; irqno <= IRQ_S3CUART_ERR2; irqno++) {
  639. irqdbf("registering irq %d (s3c uart2 irq)\n", irqno);
  640. set_irq_chip(irqno, &s3c_irq_uart2);
  641. set_irq_handler(irqno, do_level_IRQ);
  642. set_irq_flags(irqno, IRQF_VALID);
  643. }
  644. for (irqno = IRQ_TC; irqno <= IRQ_ADC; irqno++) {
  645. irqdbf("registering irq %d (s3c adc irq)\n", irqno);
  646. set_irq_chip(irqno, &s3c_irq_adc);
  647. set_irq_handler(irqno, do_edge_IRQ);
  648. set_irq_flags(irqno, IRQF_VALID);
  649. }
  650. irqdbf("s3c2410: registered interrupt handlers\n");
  651. }