amiints.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:13k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * linux/arch/m68k/amiga/amiints.c -- Amiga Linux interrupt handling code
  3.  *
  4.  * This file is subject to the terms and conditions of the GNU General Public
  5.  * License.  See the file COPYING in the main directory of this archive
  6.  * for more details.
  7.  *
  8.  * 11/07/96: rewritten interrupt handling, irq lists are exists now only for
  9.  *           this sources where it makes sense (VERTB/PORTS/EXTER) and you must
  10.  *           be careful that dev_id for this sources is unique since this the
  11.  *           only possibility to distinguish between different handlers for
  12.  *           free_irq. irq lists also have different irq flags:
  13.  *           - IRQ_FLG_FAST: handler is inserted at top of list (after other
  14.  *                           fast handlers)
  15.  *           - IRQ_FLG_SLOW: handler is inserted at bottom of list and before
  16.  *                           they're executed irq level is set to the previous
  17.  *                           one, but handlers don't need to be reentrant, if
  18.  *                           reentrance occurred, slow handlers will be just
  19.  *                           called again.
  20.  *           The whole interrupt handling for CIAs is moved to cia.c
  21.  *           /Roman Zippel
  22.  *
  23.  * 07/08/99: rewamp of the interrupt handling - we now have two types of
  24.  *           interrupts, normal and fast handlers, fast handlers being
  25.  *           marked with SA_INTERRUPT and runs with all other interrupts
  26.  *           disabled. Normal interrupts disable their own source but
  27.  *           run with all other interrupt sources enabled.
  28.  *           PORTS and EXTER interrupts are always shared even if the
  29.  *           drivers do not explicitly mark this when calling
  30.  *           request_irq which they really should do.
  31.  *           This is similar to the way interrupts are handled on all
  32.  *           other architectures and makes a ton of sense besides
  33.  *           having the advantage of making it easier to share
  34.  *           drivers.
  35.  *           /Jes
  36.  */
  37. #include <linux/types.h>
  38. #include <linux/kernel.h>
  39. #include <linux/sched.h>
  40. #include <linux/kernel_stat.h>
  41. #include <linux/init.h>
  42. #include <asm/system.h>
  43. #include <asm/irq.h>
  44. #include <asm/traps.h>
  45. #include <asm/amigahw.h>
  46. #include <asm/amigaints.h>
  47. #include <asm/amipcmcia.h>
  48. extern int cia_request_irq(struct ciabase *base,int irq,
  49.                            void (*handler)(int, void *, struct pt_regs *),
  50.                            unsigned long flags, const char *devname, void *dev_id);
  51. extern void cia_free_irq(struct ciabase *base, unsigned int irq, void *dev_id);
  52. extern void cia_init_IRQ(struct ciabase *base);
  53. extern int cia_get_irq_list(struct ciabase *base, char *buf);
  54. /* irq node variables for amiga interrupt sources */
  55. static irq_node_t *ami_irq_list[AMI_STD_IRQS];
  56. static unsigned short amiga_intena_vals[AMI_STD_IRQS] = {
  57. IF_VERTB, IF_COPER, IF_AUD0, IF_AUD1, IF_AUD2, IF_AUD3, IF_BLIT,
  58. IF_DSKSYN, IF_DSKBLK, IF_RBF, IF_TBE, IF_SOFT, IF_PORTS, IF_EXTER
  59. };
  60. static const unsigned char ami_servers[AMI_STD_IRQS] = {
  61. 1, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 1, 1
  62. };
  63. static short ami_ablecount[AMI_IRQS];
  64. static void ami_badint(int irq, void *dev_id, struct pt_regs *fp)
  65. {
  66. num_spurious += 1;
  67. }
  68. /*
  69.  * void amiga_init_IRQ(void)
  70.  *
  71.  * Parameters: None
  72.  *
  73.  * Returns: Nothing
  74.  *
  75.  * This function should be called during kernel startup to initialize
  76.  * the amiga IRQ handling routines.
  77.  */
  78. void __init amiga_init_IRQ(void)
  79. {
  80. int i;
  81. /* initialize handlers */
  82. for (i = 0; i < AMI_STD_IRQS; i++) {
  83. if (ami_servers[i]) {
  84. ami_irq_list[i] = NULL;
  85. } else {
  86. ami_irq_list[i] = new_irq_node();
  87. ami_irq_list[i]->handler = ami_badint;
  88. ami_irq_list[i]->flags   = 0;
  89. ami_irq_list[i]->dev_id  = NULL;
  90. ami_irq_list[i]->devname = NULL;
  91. ami_irq_list[i]->next    = NULL;
  92. }
  93. }
  94. for (i = 0; i < AMI_IRQS; i++)
  95. ami_ablecount[i] = 0;
  96. /* turn off PCMCIA interrupts */
  97. if (AMIGAHW_PRESENT(PCMCIA))
  98. gayle.inten = GAYLE_IRQ_IDE;
  99. /* turn off all interrupts and enable the master interrupt bit */
  100. custom.intena = 0x7fff;
  101. custom.intreq = 0x7fff;
  102. custom.intena = IF_SETCLR | IF_INTEN;
  103. cia_init_IRQ(&ciaa_base);
  104. cia_init_IRQ(&ciab_base);
  105. }
  106. static inline int amiga_insert_irq(irq_node_t **list, irq_node_t *node)
  107. {
  108. unsigned long flags;
  109. irq_node_t *cur;
  110. if (!node->dev_id)
  111. printk("%s: Warning: dev_id of %s is zeron",
  112.        __FUNCTION__, node->devname);
  113. save_flags(flags);
  114. cli();
  115. cur = *list;
  116. if (node->flags & SA_INTERRUPT) {
  117. if (node->flags & SA_SHIRQ)
  118. return -EBUSY;
  119. /*
  120.  * There should never be more than one
  121.  */
  122. while (cur && cur->flags & SA_INTERRUPT) {
  123. list = &cur->next;
  124. cur = cur->next;
  125. }
  126. } else {
  127. while (cur) {
  128. list = &cur->next;
  129. cur = cur->next;
  130. }
  131. }
  132. node->next = cur;
  133. *list = node;
  134. restore_flags(flags);
  135. return 0;
  136. }
  137. static inline void amiga_delete_irq(irq_node_t **list, void *dev_id)
  138. {
  139. unsigned long flags;
  140. irq_node_t *node;
  141. save_flags(flags);
  142. cli();
  143. for (node = *list; node; list = &node->next, node = *list) {
  144. if (node->dev_id == dev_id) {
  145. *list = node->next;
  146. /* Mark it as free. */
  147. node->handler = NULL;
  148. restore_flags(flags);
  149. return;
  150. }
  151. }
  152. restore_flags(flags);
  153. printk ("%s: tried to remove invalid irqn", __FUNCTION__);
  154. }
  155. /*
  156.  * amiga_request_irq : add an interrupt service routine for a particular
  157.  *                     machine specific interrupt source.
  158.  *                     If the addition was successful, it returns 0.
  159.  */
  160. int amiga_request_irq(unsigned int irq,
  161.       void (*handler)(int, void *, struct pt_regs *),
  162.                       unsigned long flags, const char *devname, void *dev_id)
  163. {
  164. irq_node_t *node;
  165. int error = 0;
  166. if (irq >= AMI_IRQS) {
  167. printk ("%s: Unknown IRQ %d from %sn", __FUNCTION__,
  168. irq, devname);
  169. return -ENXIO;
  170. }
  171. if (irq >= IRQ_AMIGA_AUTO)
  172. return sys_request_irq(irq - IRQ_AMIGA_AUTO, handler,
  173.                        flags, devname, dev_id);
  174. if (irq >= IRQ_AMIGA_CIAB)
  175. return cia_request_irq(&ciab_base, irq - IRQ_AMIGA_CIAB,
  176.                        handler, flags, devname, dev_id);
  177. if (irq >= IRQ_AMIGA_CIAA)
  178. return cia_request_irq(&ciaa_base, irq - IRQ_AMIGA_CIAA,
  179.                        handler, flags, devname, dev_id);
  180. /*
  181.  * IRQ_AMIGA_PORTS & IRQ_AMIGA_EXTER defaults to shared,
  182.  * we could add a check here for the SA_SHIRQ flag but all drivers
  183.  * should be aware of sharing anyway.
  184.  */
  185. if (ami_servers[irq]) {
  186. if (!(node = new_irq_node()))
  187. return -ENOMEM;
  188. node->handler = handler;
  189. node->flags   = flags;
  190. node->dev_id  = dev_id;
  191. node->devname = devname;
  192. node->next    = NULL;
  193. error = amiga_insert_irq(&ami_irq_list[irq], node);
  194. } else {
  195. ami_irq_list[irq]->handler = handler;
  196. ami_irq_list[irq]->flags   = flags;
  197. ami_irq_list[irq]->dev_id  = dev_id;
  198. ami_irq_list[irq]->devname = devname;
  199. }
  200. /* enable the interrupt */
  201. if (irq < IRQ_AMIGA_PORTS && !ami_ablecount[irq])
  202. custom.intena = IF_SETCLR | amiga_intena_vals[irq];
  203. return error;
  204. }
  205. void amiga_free_irq(unsigned int irq, void *dev_id)
  206. {
  207. if (irq >= AMI_IRQS) {
  208. printk ("%s: Unknown IRQ %dn", __FUNCTION__, irq);
  209. return;
  210. }
  211. if (irq >= IRQ_AMIGA_AUTO)
  212. sys_free_irq(irq - IRQ_AMIGA_AUTO, dev_id);
  213. if (irq >= IRQ_AMIGA_CIAB) {
  214. cia_free_irq(&ciab_base, irq - IRQ_AMIGA_CIAB, dev_id);
  215. return;
  216. }
  217. if (irq >= IRQ_AMIGA_CIAA) {
  218. cia_free_irq(&ciaa_base, irq - IRQ_AMIGA_CIAA, dev_id);
  219. return;
  220. }
  221. if (ami_servers[irq]) {
  222. amiga_delete_irq(&ami_irq_list[irq], dev_id);
  223. /* if server list empty, disable the interrupt */
  224. if (!ami_irq_list[irq] && irq < IRQ_AMIGA_PORTS)
  225. custom.intena = amiga_intena_vals[irq];
  226. } else {
  227. if (ami_irq_list[irq]->dev_id != dev_id)
  228. printk("%s: removing probably wrong IRQ %d from %sn",
  229.        __FUNCTION__, irq, ami_irq_list[irq]->devname);
  230. ami_irq_list[irq]->handler = ami_badint;
  231. ami_irq_list[irq]->flags   = 0;
  232. ami_irq_list[irq]->dev_id  = NULL;
  233. ami_irq_list[irq]->devname = NULL;
  234. custom.intena = amiga_intena_vals[irq];
  235. }
  236. }
  237. /*
  238.  * Enable/disable a particular machine specific interrupt source.
  239.  * Note that this may affect other interrupts in case of a shared interrupt.
  240.  * This function should only be called for a _very_ short time to change some
  241.  * internal data, that may not be changed by the interrupt at the same time.
  242.  * ami_(enable|disable)_irq calls may also be nested.
  243.  */
  244. void amiga_enable_irq(unsigned int irq)
  245. {
  246. if (irq >= AMI_IRQS) {
  247. printk("%s: Unknown IRQ %dn", __FUNCTION__, irq);
  248. return;
  249. }
  250. if (--ami_ablecount[irq])
  251. return;
  252. /* No action for auto-vector interrupts */
  253. if (irq >= IRQ_AMIGA_AUTO){
  254. printk("%s: Trying to enable auto-vector IRQ %in",
  255.        __FUNCTION__, irq - IRQ_AMIGA_AUTO);
  256. return;
  257. }
  258. if (irq >= IRQ_AMIGA_CIAB) {
  259. cia_set_irq(&ciab_base, (1 << (irq - IRQ_AMIGA_CIAB)));
  260. cia_able_irq(&ciab_base, CIA_ICR_SETCLR |
  261.              (1 << (irq - IRQ_AMIGA_CIAB)));
  262. return;
  263. }
  264. if (irq >= IRQ_AMIGA_CIAA) {
  265. cia_set_irq(&ciaa_base, (1 << (irq - IRQ_AMIGA_CIAA)));
  266. cia_able_irq(&ciaa_base, CIA_ICR_SETCLR |
  267.              (1 << (irq - IRQ_AMIGA_CIAA)));
  268. return;
  269. }
  270. /* enable the interrupt */
  271. custom.intena = IF_SETCLR | amiga_intena_vals[irq];
  272. }
  273. void amiga_disable_irq(unsigned int irq)
  274. {
  275. if (irq >= AMI_IRQS) {
  276. printk("%s: Unknown IRQ %dn", __FUNCTION__, irq);
  277. return;
  278. }
  279. if (ami_ablecount[irq]++)
  280. return;
  281. /* No action for auto-vector interrupts */
  282. if (irq >= IRQ_AMIGA_AUTO) {
  283. printk("%s: Trying to disable auto-vector IRQ %in",
  284.        __FUNCTION__, irq - IRQ_AMIGA_AUTO);
  285. return;
  286. }
  287. if (irq >= IRQ_AMIGA_CIAB) {
  288. cia_able_irq(&ciab_base, 1 << (irq - IRQ_AMIGA_CIAB));
  289. return;
  290. }
  291. if (irq >= IRQ_AMIGA_CIAA) {
  292. cia_able_irq(&ciaa_base, 1 << (irq - IRQ_AMIGA_CIAA));
  293. return;
  294. }
  295. /* disable the interrupt */
  296. custom.intena = amiga_intena_vals[irq];
  297. }
  298. inline void amiga_do_irq(int irq, struct pt_regs *fp)
  299. {
  300. kstat.irqs[0][SYS_IRQS + irq]++;
  301. ami_irq_list[irq]->handler(irq, ami_irq_list[irq]->dev_id, fp);
  302. }
  303. void amiga_do_irq_list(int irq, struct pt_regs *fp)
  304. {
  305. irq_node_t *node;
  306. kstat.irqs[0][SYS_IRQS + irq]++;
  307. custom.intreq = amiga_intena_vals[irq];
  308. for (node = ami_irq_list[irq]; node; node = node->next)
  309. node->handler(irq, node->dev_id, fp);
  310. }
  311. /*
  312.  * The builtin Amiga hardware interrupt handlers.
  313.  */
  314. static void ami_int1(int irq, void *dev_id, struct pt_regs *fp)
  315. {
  316. unsigned short ints = custom.intreqr & custom.intenar;
  317. /* if serial transmit buffer empty, interrupt */
  318. if (ints & IF_TBE) {
  319. custom.intreq = IF_TBE;
  320. amiga_do_irq(IRQ_AMIGA_TBE, fp);
  321. }
  322. /* if floppy disk transfer complete, interrupt */
  323. if (ints & IF_DSKBLK) {
  324. custom.intreq = IF_DSKBLK;
  325. amiga_do_irq(IRQ_AMIGA_DSKBLK, fp);
  326. }
  327. /* if software interrupt set, interrupt */
  328. if (ints & IF_SOFT) {
  329. custom.intreq = IF_SOFT;
  330. amiga_do_irq(IRQ_AMIGA_SOFT, fp);
  331. }
  332. }
  333. static void ami_int3(int irq, void *dev_id, struct pt_regs *fp)
  334. {
  335. unsigned short ints = custom.intreqr & custom.intenar;
  336. /* if a blitter interrupt */
  337. if (ints & IF_BLIT) {
  338. custom.intreq = IF_BLIT;
  339. amiga_do_irq(IRQ_AMIGA_BLIT, fp);
  340. }
  341. /* if a copper interrupt */
  342. if (ints & IF_COPER) {
  343. custom.intreq = IF_COPER;
  344. amiga_do_irq(IRQ_AMIGA_COPPER, fp);
  345. }
  346. /* if a vertical blank interrupt */
  347. if (ints & IF_VERTB)
  348. amiga_do_irq_list(IRQ_AMIGA_VERTB, fp);
  349. }
  350. static void ami_int4(int irq, void *dev_id, struct pt_regs *fp)
  351. {
  352. unsigned short ints = custom.intreqr & custom.intenar;
  353. /* if audio 0 interrupt */
  354. if (ints & IF_AUD0) {
  355. custom.intreq = IF_AUD0;
  356. amiga_do_irq(IRQ_AMIGA_AUD0, fp);
  357. }
  358. /* if audio 1 interrupt */
  359. if (ints & IF_AUD1) {
  360. custom.intreq = IF_AUD1;
  361. amiga_do_irq(IRQ_AMIGA_AUD1, fp);
  362. }
  363. /* if audio 2 interrupt */
  364. if (ints & IF_AUD2) {
  365. custom.intreq = IF_AUD2;
  366. amiga_do_irq(IRQ_AMIGA_AUD2, fp);
  367. }
  368. /* if audio 3 interrupt */
  369. if (ints & IF_AUD3) {
  370. custom.intreq = IF_AUD3;
  371. amiga_do_irq(IRQ_AMIGA_AUD3, fp);
  372. }
  373. }
  374. static void ami_int5(int irq, void *dev_id, struct pt_regs *fp)
  375. {
  376. unsigned short ints = custom.intreqr & custom.intenar;
  377. /* if serial receive buffer full interrupt */
  378. if (ints & IF_RBF) {
  379. /* acknowledge of IF_RBF must be done by the serial interrupt */
  380. amiga_do_irq(IRQ_AMIGA_RBF, fp);
  381. }
  382. /* if a disk sync interrupt */
  383. if (ints & IF_DSKSYN) {
  384. custom.intreq = IF_DSKSYN;
  385. amiga_do_irq(IRQ_AMIGA_DSKSYN, fp);
  386. }
  387. }
  388. static void ami_int7(int irq, void *dev_id, struct pt_regs *fp)
  389. {
  390. panic ("level 7 interrupt receivedn");
  391. }
  392. void (*amiga_default_handler[SYS_IRQS])(int, void *, struct pt_regs *) = {
  393. ami_badint, ami_int1, ami_badint, ami_int3,
  394. ami_int4, ami_int5, ami_badint, ami_int7
  395. };
  396. int amiga_get_irq_list(char *buf)
  397. {
  398. int i, len = 0;
  399. irq_node_t *node;
  400. for (i = 0; i < AMI_STD_IRQS; i++) {
  401. if (!(node = ami_irq_list[i]))
  402. continue;
  403. len += sprintf(buf+len, "ami  %2d: %10u ", i,
  404.                kstat.irqs[0][SYS_IRQS + i]);
  405. do {
  406. if (node->flags & SA_INTERRUPT)
  407. len += sprintf(buf+len, "F ");
  408. else
  409. len += sprintf(buf+len, "  ");
  410. len += sprintf(buf+len, "%sn", node->devname);
  411. if ((node = node->next))
  412. len += sprintf(buf+len, "                    ");
  413. } while (node);
  414. }
  415. len += cia_get_irq_list(&ciaa_base, buf+len);
  416. len += cia_get_irq_list(&ciab_base, buf+len);
  417. return len;
  418. }