irq.c 18 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816
  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. {
  392. unsigned int subsrc, submsk;
  393. unsigned int offset = 9;
  394. struct irqdesc *mydesc;
  395. /* read the current pending interrupts, and the mask
  396. * for what it is available */
  397. subsrc = __raw_readl(S3C2410_SUBSRCPND);
  398. submsk = __raw_readl(S3C2410_INTSUBMSK);
  399. subsrc &= ~submsk;
  400. subsrc >>= offset;
  401. subsrc &= 3;
  402. if (subsrc != 0) {
  403. if (subsrc & 1) {
  404. mydesc = irq_desc + IRQ_TC;
  405. desc_handle_irq(IRQ_TC, mydesc);
  406. }
  407. if (subsrc & 2) {
  408. mydesc = irq_desc + IRQ_ADC;
  409. desc_handle_irq(IRQ_ADC, mydesc);
  410. }
  411. }
  412. }
  413. static void s3c_irq_demux_uart(unsigned int start)
  414. {
  415. unsigned int subsrc, submsk;
  416. unsigned int offset = start - IRQ_S3CUART_RX0;
  417. struct irqdesc *desc;
  418. /* read the current pending interrupts, and the mask
  419. * for what it is available */
  420. subsrc = __raw_readl(S3C2410_SUBSRCPND);
  421. submsk = __raw_readl(S3C2410_INTSUBMSK);
  422. irqdbf2("s3c_irq_demux_uart: start=%d (%d), subsrc=0x%08x,0x%08x\n",
  423. start, offset, subsrc, submsk);
  424. subsrc &= ~submsk;
  425. subsrc >>= offset;
  426. subsrc &= 7;
  427. if (subsrc != 0) {
  428. desc = irq_desc + start;
  429. if (subsrc & 1)
  430. desc_handle_irq(start, desc);
  431. desc++;
  432. if (subsrc & 2)
  433. desc_handle_irq(start+1, desc);
  434. desc++;
  435. if (subsrc & 4)
  436. desc_handle_irq(start+2, desc);
  437. }
  438. }
  439. /* uart demux entry points */
  440. static void
  441. s3c_irq_demux_uart0(unsigned int irq,
  442. struct irqdesc *desc)
  443. {
  444. irq = irq;
  445. s3c_irq_demux_uart(IRQ_S3CUART_RX0);
  446. }
  447. static void
  448. s3c_irq_demux_uart1(unsigned int irq,
  449. struct irqdesc *desc)
  450. {
  451. irq = irq;
  452. s3c_irq_demux_uart(IRQ_S3CUART_RX1);
  453. }
  454. static void
  455. s3c_irq_demux_uart2(unsigned int irq,
  456. struct irqdesc *desc)
  457. {
  458. irq = irq;
  459. s3c_irq_demux_uart(IRQ_S3CUART_RX2);
  460. }
  461. static void
  462. s3c_irq_demux_extint8(unsigned int irq,
  463. struct irqdesc *desc)
  464. {
  465. unsigned long eintpnd = __raw_readl(S3C24XX_EINTPEND);
  466. unsigned long eintmsk = __raw_readl(S3C24XX_EINTMASK);
  467. eintpnd &= ~eintmsk;
  468. eintpnd &= ~0xff; /* ignore lower irqs */
  469. /* we may as well handle all the pending IRQs here */
  470. while (eintpnd) {
  471. irq = __ffs(eintpnd);
  472. eintpnd &= ~(1<<irq);
  473. irq += (IRQ_EINT4 - 4);
  474. desc_handle_irq(irq, irq_desc + irq);
  475. }
  476. }
  477. static void
  478. s3c_irq_demux_extint4t7(unsigned int irq,
  479. struct irqdesc *desc)
  480. {
  481. unsigned long eintpnd = __raw_readl(S3C24XX_EINTPEND);
  482. unsigned long eintmsk = __raw_readl(S3C24XX_EINTMASK);
  483. eintpnd &= ~eintmsk;
  484. eintpnd &= 0xff; /* only lower irqs */
  485. /* we may as well handle all the pending IRQs here */
  486. while (eintpnd) {
  487. irq = __ffs(eintpnd);
  488. eintpnd &= ~(1<<irq);
  489. irq += (IRQ_EINT4 - 4);
  490. desc_handle_irq(irq, irq_desc + irq);
  491. }
  492. }
  493. #ifdef CONFIG_PM
  494. static struct sleep_save irq_save[] = {
  495. SAVE_ITEM(S3C2410_INTMSK),
  496. SAVE_ITEM(S3C2410_INTSUBMSK),
  497. };
  498. /* the extint values move between the s3c2410/s3c2440 and the s3c2412
  499. * so we use an array to hold them, and to calculate the address of
  500. * the register at run-time
  501. */
  502. static unsigned long save_extint[3];
  503. static unsigned long save_eintflt[4];
  504. static unsigned long save_eintmask;
  505. int s3c24xx_irq_suspend(struct sys_device *dev, pm_message_t state)
  506. {
  507. unsigned int i;
  508. for (i = 0; i < ARRAY_SIZE(save_extint); i++)
  509. save_extint[i] = __raw_readl(S3C24XX_EXTINT0 + (i*4));
  510. for (i = 0; i < ARRAY_SIZE(save_eintflt); i++)
  511. save_eintflt[i] = __raw_readl(S3C24XX_EINFLT0 + (i*4));
  512. s3c2410_pm_do_save(irq_save, ARRAY_SIZE(irq_save));
  513. save_eintmask = __raw_readl(S3C24XX_EINTMASK);
  514. return 0;
  515. }
  516. int s3c24xx_irq_resume(struct sys_device *dev)
  517. {
  518. unsigned int i;
  519. for (i = 0; i < ARRAY_SIZE(save_extint); i++)
  520. __raw_writel(save_extint[i], S3C24XX_EXTINT0 + (i*4));
  521. for (i = 0; i < ARRAY_SIZE(save_eintflt); i++)
  522. __raw_writel(save_eintflt[i], S3C24XX_EINFLT0 + (i*4));
  523. s3c2410_pm_do_restore(irq_save, ARRAY_SIZE(irq_save));
  524. __raw_writel(save_eintmask, S3C24XX_EINTMASK);
  525. return 0;
  526. }
  527. #else
  528. #define s3c24xx_irq_suspend NULL
  529. #define s3c24xx_irq_resume NULL
  530. #endif
  531. /* s3c24xx_init_irq
  532. *
  533. * Initialise S3C2410 IRQ system
  534. */
  535. void __init s3c24xx_init_irq(void)
  536. {
  537. unsigned long pend;
  538. unsigned long last;
  539. int irqno;
  540. int i;
  541. irqdbf("s3c2410_init_irq: clearing interrupt status flags\n");
  542. /* first, clear all interrupts pending... */
  543. last = 0;
  544. for (i = 0; i < 4; i++) {
  545. pend = __raw_readl(S3C24XX_EINTPEND);
  546. if (pend == 0 || pend == last)
  547. break;
  548. __raw_writel(pend, S3C24XX_EINTPEND);
  549. printk("irq: clearing pending ext status %08x\n", (int)pend);
  550. last = pend;
  551. }
  552. last = 0;
  553. for (i = 0; i < 4; i++) {
  554. pend = __raw_readl(S3C2410_INTPND);
  555. if (pend == 0 || pend == last)
  556. break;
  557. __raw_writel(pend, S3C2410_SRCPND);
  558. __raw_writel(pend, S3C2410_INTPND);
  559. printk("irq: clearing pending status %08x\n", (int)pend);
  560. last = pend;
  561. }
  562. last = 0;
  563. for (i = 0; i < 4; i++) {
  564. pend = __raw_readl(S3C2410_SUBSRCPND);
  565. if (pend == 0 || pend == last)
  566. break;
  567. printk("irq: clearing subpending status %08x\n", (int)pend);
  568. __raw_writel(pend, S3C2410_SUBSRCPND);
  569. last = pend;
  570. }
  571. /* register the main interrupts */
  572. irqdbf("s3c2410_init_irq: registering s3c2410 interrupt handlers\n");
  573. for (irqno = IRQ_EINT4t7; irqno <= IRQ_ADCPARENT; irqno++) {
  574. /* set all the s3c2410 internal irqs */
  575. switch (irqno) {
  576. /* deal with the special IRQs (cascaded) */
  577. case IRQ_EINT4t7:
  578. case IRQ_EINT8t23:
  579. case IRQ_UART0:
  580. case IRQ_UART1:
  581. case IRQ_UART2:
  582. case IRQ_ADCPARENT:
  583. set_irq_chip(irqno, &s3c_irq_level_chip);
  584. set_irq_handler(irqno, do_level_IRQ);
  585. break;
  586. case IRQ_RESERVED6:
  587. case IRQ_RESERVED24:
  588. /* no IRQ here */
  589. break;
  590. default:
  591. //irqdbf("registering irq %d (s3c irq)\n", irqno);
  592. set_irq_chip(irqno, &s3c_irq_chip);
  593. set_irq_handler(irqno, do_edge_IRQ);
  594. set_irq_flags(irqno, IRQF_VALID);
  595. }
  596. }
  597. /* setup the cascade irq handlers */
  598. set_irq_chained_handler(IRQ_EINT4t7, s3c_irq_demux_extint4t7);
  599. set_irq_chained_handler(IRQ_EINT8t23, s3c_irq_demux_extint8);
  600. set_irq_chained_handler(IRQ_UART0, s3c_irq_demux_uart0);
  601. set_irq_chained_handler(IRQ_UART1, s3c_irq_demux_uart1);
  602. set_irq_chained_handler(IRQ_UART2, s3c_irq_demux_uart2);
  603. set_irq_chained_handler(IRQ_ADCPARENT, s3c_irq_demux_adc);
  604. /* external interrupts */
  605. for (irqno = IRQ_EINT0; irqno <= IRQ_EINT3; irqno++) {
  606. irqdbf("registering irq %d (ext int)\n", irqno);
  607. set_irq_chip(irqno, &s3c_irq_eint0t4);
  608. set_irq_handler(irqno, do_edge_IRQ);
  609. set_irq_flags(irqno, IRQF_VALID);
  610. }
  611. for (irqno = IRQ_EINT4; irqno <= IRQ_EINT23; irqno++) {
  612. irqdbf("registering irq %d (extended s3c irq)\n", irqno);
  613. set_irq_chip(irqno, &s3c_irqext_chip);
  614. set_irq_handler(irqno, do_edge_IRQ);
  615. set_irq_flags(irqno, IRQF_VALID);
  616. }
  617. /* register the uart interrupts */
  618. irqdbf("s3c2410: registering external interrupts\n");
  619. for (irqno = IRQ_S3CUART_RX0; irqno <= IRQ_S3CUART_ERR0; irqno++) {
  620. irqdbf("registering irq %d (s3c uart0 irq)\n", irqno);
  621. set_irq_chip(irqno, &s3c_irq_uart0);
  622. set_irq_handler(irqno, do_level_IRQ);
  623. set_irq_flags(irqno, IRQF_VALID);
  624. }
  625. for (irqno = IRQ_S3CUART_RX1; irqno <= IRQ_S3CUART_ERR1; irqno++) {
  626. irqdbf("registering irq %d (s3c uart1 irq)\n", irqno);
  627. set_irq_chip(irqno, &s3c_irq_uart1);
  628. set_irq_handler(irqno, do_level_IRQ);
  629. set_irq_flags(irqno, IRQF_VALID);
  630. }
  631. for (irqno = IRQ_S3CUART_RX2; irqno <= IRQ_S3CUART_ERR2; irqno++) {
  632. irqdbf("registering irq %d (s3c uart2 irq)\n", irqno);
  633. set_irq_chip(irqno, &s3c_irq_uart2);
  634. set_irq_handler(irqno, do_level_IRQ);
  635. set_irq_flags(irqno, IRQF_VALID);
  636. }
  637. for (irqno = IRQ_TC; irqno <= IRQ_ADC; irqno++) {
  638. irqdbf("registering irq %d (s3c adc irq)\n", irqno);
  639. set_irq_chip(irqno, &s3c_irq_adc);
  640. set_irq_handler(irqno, do_edge_IRQ);
  641. set_irq_flags(irqno, IRQF_VALID);
  642. }
  643. irqdbf("s3c2410: registered interrupt handlers\n");
  644. }