ipic.c 16 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757
  1. /*
  2. * arch/powerpc/sysdev/ipic.c
  3. *
  4. * IPIC routines implementations.
  5. *
  6. * Copyright 2005 Freescale Semiconductor, Inc.
  7. *
  8. * This program is free software; you can redistribute it and/or modify it
  9. * under the terms of the GNU General Public License as published by the
  10. * Free Software Foundation; either version 2 of the License, or (at your
  11. * option) any later version.
  12. */
  13. #include <linux/kernel.h>
  14. #include <linux/init.h>
  15. #include <linux/errno.h>
  16. #include <linux/reboot.h>
  17. #include <linux/slab.h>
  18. #include <linux/stddef.h>
  19. #include <linux/sched.h>
  20. #include <linux/signal.h>
  21. #include <linux/sysdev.h>
  22. #include <linux/device.h>
  23. #include <linux/bootmem.h>
  24. #include <linux/spinlock.h>
  25. #include <asm/irq.h>
  26. #include <asm/io.h>
  27. #include <asm/prom.h>
  28. #include <asm/ipic.h>
  29. #include "ipic.h"
  30. static struct ipic * primary_ipic;
  31. static DEFINE_SPINLOCK(ipic_lock);
  32. static struct ipic_info ipic_info[] = {
  33. [9] = {
  34. .pend = IPIC_SIPNR_H,
  35. .mask = IPIC_SIMSR_H,
  36. .prio = IPIC_SIPRR_D,
  37. .force = IPIC_SIFCR_H,
  38. .bit = 24,
  39. .prio_mask = 0,
  40. },
  41. [10] = {
  42. .pend = IPIC_SIPNR_H,
  43. .mask = IPIC_SIMSR_H,
  44. .prio = IPIC_SIPRR_D,
  45. .force = IPIC_SIFCR_H,
  46. .bit = 25,
  47. .prio_mask = 1,
  48. },
  49. [11] = {
  50. .pend = IPIC_SIPNR_H,
  51. .mask = IPIC_SIMSR_H,
  52. .prio = IPIC_SIPRR_D,
  53. .force = IPIC_SIFCR_H,
  54. .bit = 26,
  55. .prio_mask = 2,
  56. },
  57. [14] = {
  58. .pend = IPIC_SIPNR_H,
  59. .mask = IPIC_SIMSR_H,
  60. .prio = IPIC_SIPRR_D,
  61. .force = IPIC_SIFCR_H,
  62. .bit = 29,
  63. .prio_mask = 5,
  64. },
  65. [15] = {
  66. .pend = IPIC_SIPNR_H,
  67. .mask = IPIC_SIMSR_H,
  68. .prio = IPIC_SIPRR_D,
  69. .force = IPIC_SIFCR_H,
  70. .bit = 30,
  71. .prio_mask = 6,
  72. },
  73. [16] = {
  74. .pend = IPIC_SIPNR_H,
  75. .mask = IPIC_SIMSR_H,
  76. .prio = IPIC_SIPRR_D,
  77. .force = IPIC_SIFCR_H,
  78. .bit = 31,
  79. .prio_mask = 7,
  80. },
  81. [17] = {
  82. .pend = IPIC_SEPNR,
  83. .mask = IPIC_SEMSR,
  84. .prio = IPIC_SMPRR_A,
  85. .force = IPIC_SEFCR,
  86. .bit = 1,
  87. .prio_mask = 5,
  88. },
  89. [18] = {
  90. .pend = IPIC_SEPNR,
  91. .mask = IPIC_SEMSR,
  92. .prio = IPIC_SMPRR_A,
  93. .force = IPIC_SEFCR,
  94. .bit = 2,
  95. .prio_mask = 6,
  96. },
  97. [19] = {
  98. .pend = IPIC_SEPNR,
  99. .mask = IPIC_SEMSR,
  100. .prio = IPIC_SMPRR_A,
  101. .force = IPIC_SEFCR,
  102. .bit = 3,
  103. .prio_mask = 7,
  104. },
  105. [20] = {
  106. .pend = IPIC_SEPNR,
  107. .mask = IPIC_SEMSR,
  108. .prio = IPIC_SMPRR_B,
  109. .force = IPIC_SEFCR,
  110. .bit = 4,
  111. .prio_mask = 4,
  112. },
  113. [21] = {
  114. .pend = IPIC_SEPNR,
  115. .mask = IPIC_SEMSR,
  116. .prio = IPIC_SMPRR_B,
  117. .force = IPIC_SEFCR,
  118. .bit = 5,
  119. .prio_mask = 5,
  120. },
  121. [22] = {
  122. .pend = IPIC_SEPNR,
  123. .mask = IPIC_SEMSR,
  124. .prio = IPIC_SMPRR_B,
  125. .force = IPIC_SEFCR,
  126. .bit = 6,
  127. .prio_mask = 6,
  128. },
  129. [23] = {
  130. .pend = IPIC_SEPNR,
  131. .mask = IPIC_SEMSR,
  132. .prio = IPIC_SMPRR_B,
  133. .force = IPIC_SEFCR,
  134. .bit = 7,
  135. .prio_mask = 7,
  136. },
  137. [32] = {
  138. .pend = IPIC_SIPNR_H,
  139. .mask = IPIC_SIMSR_H,
  140. .prio = IPIC_SIPRR_A,
  141. .force = IPIC_SIFCR_H,
  142. .bit = 0,
  143. .prio_mask = 0,
  144. },
  145. [33] = {
  146. .pend = IPIC_SIPNR_H,
  147. .mask = IPIC_SIMSR_H,
  148. .prio = IPIC_SIPRR_A,
  149. .force = IPIC_SIFCR_H,
  150. .bit = 1,
  151. .prio_mask = 1,
  152. },
  153. [34] = {
  154. .pend = IPIC_SIPNR_H,
  155. .mask = IPIC_SIMSR_H,
  156. .prio = IPIC_SIPRR_A,
  157. .force = IPIC_SIFCR_H,
  158. .bit = 2,
  159. .prio_mask = 2,
  160. },
  161. [35] = {
  162. .pend = IPIC_SIPNR_H,
  163. .mask = IPIC_SIMSR_H,
  164. .prio = IPIC_SIPRR_A,
  165. .force = IPIC_SIFCR_H,
  166. .bit = 3,
  167. .prio_mask = 3,
  168. },
  169. [36] = {
  170. .pend = IPIC_SIPNR_H,
  171. .mask = IPIC_SIMSR_H,
  172. .prio = IPIC_SIPRR_A,
  173. .force = IPIC_SIFCR_H,
  174. .bit = 4,
  175. .prio_mask = 4,
  176. },
  177. [37] = {
  178. .pend = IPIC_SIPNR_H,
  179. .mask = IPIC_SIMSR_H,
  180. .prio = IPIC_SIPRR_A,
  181. .force = IPIC_SIFCR_H,
  182. .bit = 5,
  183. .prio_mask = 5,
  184. },
  185. [38] = {
  186. .pend = IPIC_SIPNR_H,
  187. .mask = IPIC_SIMSR_H,
  188. .prio = IPIC_SIPRR_A,
  189. .force = IPIC_SIFCR_H,
  190. .bit = 6,
  191. .prio_mask = 6,
  192. },
  193. [39] = {
  194. .pend = IPIC_SIPNR_H,
  195. .mask = IPIC_SIMSR_H,
  196. .prio = IPIC_SIPRR_A,
  197. .force = IPIC_SIFCR_H,
  198. .bit = 7,
  199. .prio_mask = 7,
  200. },
  201. [48] = {
  202. .pend = IPIC_SEPNR,
  203. .mask = IPIC_SEMSR,
  204. .prio = IPIC_SMPRR_A,
  205. .force = IPIC_SEFCR,
  206. .bit = 0,
  207. .prio_mask = 4,
  208. },
  209. [64] = {
  210. .pend = IPIC_SIPNR_L,
  211. .mask = IPIC_SIMSR_L,
  212. .prio = IPIC_SMPRR_A,
  213. .force = IPIC_SIFCR_L,
  214. .bit = 0,
  215. .prio_mask = 0,
  216. },
  217. [65] = {
  218. .pend = IPIC_SIPNR_L,
  219. .mask = IPIC_SIMSR_L,
  220. .prio = IPIC_SMPRR_A,
  221. .force = IPIC_SIFCR_L,
  222. .bit = 1,
  223. .prio_mask = 1,
  224. },
  225. [66] = {
  226. .pend = IPIC_SIPNR_L,
  227. .mask = IPIC_SIMSR_L,
  228. .prio = IPIC_SMPRR_A,
  229. .force = IPIC_SIFCR_L,
  230. .bit = 2,
  231. .prio_mask = 2,
  232. },
  233. [67] = {
  234. .pend = IPIC_SIPNR_L,
  235. .mask = IPIC_SIMSR_L,
  236. .prio = IPIC_SMPRR_A,
  237. .force = IPIC_SIFCR_L,
  238. .bit = 3,
  239. .prio_mask = 3,
  240. },
  241. [68] = {
  242. .pend = IPIC_SIPNR_L,
  243. .mask = IPIC_SIMSR_L,
  244. .prio = IPIC_SMPRR_B,
  245. .force = IPIC_SIFCR_L,
  246. .bit = 4,
  247. .prio_mask = 0,
  248. },
  249. [69] = {
  250. .pend = IPIC_SIPNR_L,
  251. .mask = IPIC_SIMSR_L,
  252. .prio = IPIC_SMPRR_B,
  253. .force = IPIC_SIFCR_L,
  254. .bit = 5,
  255. .prio_mask = 1,
  256. },
  257. [70] = {
  258. .pend = IPIC_SIPNR_L,
  259. .mask = IPIC_SIMSR_L,
  260. .prio = IPIC_SMPRR_B,
  261. .force = IPIC_SIFCR_L,
  262. .bit = 6,
  263. .prio_mask = 2,
  264. },
  265. [71] = {
  266. .pend = IPIC_SIPNR_L,
  267. .mask = IPIC_SIMSR_L,
  268. .prio = IPIC_SMPRR_B,
  269. .force = IPIC_SIFCR_L,
  270. .bit = 7,
  271. .prio_mask = 3,
  272. },
  273. [72] = {
  274. .pend = IPIC_SIPNR_L,
  275. .mask = IPIC_SIMSR_L,
  276. .prio = 0,
  277. .force = IPIC_SIFCR_L,
  278. .bit = 8,
  279. },
  280. [73] = {
  281. .pend = IPIC_SIPNR_L,
  282. .mask = IPIC_SIMSR_L,
  283. .prio = 0,
  284. .force = IPIC_SIFCR_L,
  285. .bit = 9,
  286. },
  287. [74] = {
  288. .pend = IPIC_SIPNR_L,
  289. .mask = IPIC_SIMSR_L,
  290. .prio = 0,
  291. .force = IPIC_SIFCR_L,
  292. .bit = 10,
  293. },
  294. [75] = {
  295. .pend = IPIC_SIPNR_L,
  296. .mask = IPIC_SIMSR_L,
  297. .prio = 0,
  298. .force = IPIC_SIFCR_L,
  299. .bit = 11,
  300. },
  301. [76] = {
  302. .pend = IPIC_SIPNR_L,
  303. .mask = IPIC_SIMSR_L,
  304. .prio = 0,
  305. .force = IPIC_SIFCR_L,
  306. .bit = 12,
  307. },
  308. [77] = {
  309. .pend = IPIC_SIPNR_L,
  310. .mask = IPIC_SIMSR_L,
  311. .prio = 0,
  312. .force = IPIC_SIFCR_L,
  313. .bit = 13,
  314. },
  315. [78] = {
  316. .pend = IPIC_SIPNR_L,
  317. .mask = IPIC_SIMSR_L,
  318. .prio = 0,
  319. .force = IPIC_SIFCR_L,
  320. .bit = 14,
  321. },
  322. [79] = {
  323. .pend = IPIC_SIPNR_L,
  324. .mask = IPIC_SIMSR_L,
  325. .prio = 0,
  326. .force = IPIC_SIFCR_L,
  327. .bit = 15,
  328. },
  329. [80] = {
  330. .pend = IPIC_SIPNR_L,
  331. .mask = IPIC_SIMSR_L,
  332. .prio = 0,
  333. .force = IPIC_SIFCR_L,
  334. .bit = 16,
  335. },
  336. [84] = {
  337. .pend = IPIC_SIPNR_L,
  338. .mask = IPIC_SIMSR_L,
  339. .prio = 0,
  340. .force = IPIC_SIFCR_L,
  341. .bit = 20,
  342. },
  343. [85] = {
  344. .pend = IPIC_SIPNR_L,
  345. .mask = IPIC_SIMSR_L,
  346. .prio = 0,
  347. .force = IPIC_SIFCR_L,
  348. .bit = 21,
  349. },
  350. [90] = {
  351. .pend = IPIC_SIPNR_L,
  352. .mask = IPIC_SIMSR_L,
  353. .prio = 0,
  354. .force = IPIC_SIFCR_L,
  355. .bit = 26,
  356. },
  357. [91] = {
  358. .pend = IPIC_SIPNR_L,
  359. .mask = IPIC_SIMSR_L,
  360. .prio = 0,
  361. .force = IPIC_SIFCR_L,
  362. .bit = 27,
  363. },
  364. };
  365. static inline u32 ipic_read(volatile u32 __iomem *base, unsigned int reg)
  366. {
  367. return in_be32(base + (reg >> 2));
  368. }
  369. static inline void ipic_write(volatile u32 __iomem *base, unsigned int reg, u32 value)
  370. {
  371. out_be32(base + (reg >> 2), value);
  372. }
  373. static inline struct ipic * ipic_from_irq(unsigned int virq)
  374. {
  375. return primary_ipic;
  376. }
  377. #define ipic_irq_to_hw(virq) ((unsigned int)irq_map[virq].hwirq)
  378. static void ipic_unmask_irq(unsigned int virq)
  379. {
  380. struct ipic *ipic = ipic_from_irq(virq);
  381. unsigned int src = ipic_irq_to_hw(virq);
  382. unsigned long flags;
  383. u32 temp;
  384. spin_lock_irqsave(&ipic_lock, flags);
  385. temp = ipic_read(ipic->regs, ipic_info[src].mask);
  386. temp |= (1 << (31 - ipic_info[src].bit));
  387. ipic_write(ipic->regs, ipic_info[src].mask, temp);
  388. spin_unlock_irqrestore(&ipic_lock, flags);
  389. }
  390. static void ipic_mask_irq(unsigned int virq)
  391. {
  392. struct ipic *ipic = ipic_from_irq(virq);
  393. unsigned int src = ipic_irq_to_hw(virq);
  394. unsigned long flags;
  395. u32 temp;
  396. spin_lock_irqsave(&ipic_lock, flags);
  397. temp = ipic_read(ipic->regs, ipic_info[src].mask);
  398. temp &= ~(1 << (31 - ipic_info[src].bit));
  399. ipic_write(ipic->regs, ipic_info[src].mask, temp);
  400. spin_unlock_irqrestore(&ipic_lock, flags);
  401. }
  402. static void ipic_ack_irq(unsigned int virq)
  403. {
  404. struct ipic *ipic = ipic_from_irq(virq);
  405. unsigned int src = ipic_irq_to_hw(virq);
  406. unsigned long flags;
  407. u32 temp;
  408. spin_lock_irqsave(&ipic_lock, flags);
  409. temp = ipic_read(ipic->regs, ipic_info[src].pend);
  410. temp |= (1 << (31 - ipic_info[src].bit));
  411. ipic_write(ipic->regs, ipic_info[src].pend, temp);
  412. spin_unlock_irqrestore(&ipic_lock, flags);
  413. }
  414. static void ipic_mask_irq_and_ack(unsigned int virq)
  415. {
  416. struct ipic *ipic = ipic_from_irq(virq);
  417. unsigned int src = ipic_irq_to_hw(virq);
  418. unsigned long flags;
  419. u32 temp;
  420. spin_lock_irqsave(&ipic_lock, flags);
  421. temp = ipic_read(ipic->regs, ipic_info[src].mask);
  422. temp &= ~(1 << (31 - ipic_info[src].bit));
  423. ipic_write(ipic->regs, ipic_info[src].mask, temp);
  424. temp = ipic_read(ipic->regs, ipic_info[src].pend);
  425. temp |= (1 << (31 - ipic_info[src].bit));
  426. ipic_write(ipic->regs, ipic_info[src].pend, temp);
  427. spin_unlock_irqrestore(&ipic_lock, flags);
  428. }
  429. static int ipic_set_irq_type(unsigned int virq, unsigned int flow_type)
  430. {
  431. struct ipic *ipic = ipic_from_irq(virq);
  432. unsigned int src = ipic_irq_to_hw(virq);
  433. struct irq_desc *desc = get_irq_desc(virq);
  434. unsigned int vold, vnew, edibit;
  435. if (flow_type == IRQ_TYPE_NONE)
  436. flow_type = IRQ_TYPE_LEVEL_LOW;
  437. /* ipic supports only low assertion and high-to-low change senses
  438. */
  439. if (!(flow_type & (IRQ_TYPE_LEVEL_LOW | IRQ_TYPE_EDGE_FALLING))) {
  440. printk(KERN_ERR "ipic: sense type 0x%x not supported\n",
  441. flow_type);
  442. return -EINVAL;
  443. }
  444. desc->status &= ~(IRQ_TYPE_SENSE_MASK | IRQ_LEVEL);
  445. desc->status |= flow_type & IRQ_TYPE_SENSE_MASK;
  446. if (flow_type & IRQ_TYPE_LEVEL_LOW) {
  447. desc->status |= IRQ_LEVEL;
  448. desc->handle_irq = handle_level_irq;
  449. } else {
  450. desc->handle_irq = handle_edge_irq;
  451. }
  452. /* only EXT IRQ senses are programmable on ipic
  453. * internal IRQ senses are LEVEL_LOW
  454. */
  455. if (src == IPIC_IRQ_EXT0)
  456. edibit = 15;
  457. else
  458. if (src >= IPIC_IRQ_EXT1 && src <= IPIC_IRQ_EXT7)
  459. edibit = (14 - (src - IPIC_IRQ_EXT1));
  460. else
  461. return (flow_type & IRQ_TYPE_LEVEL_LOW) ? 0 : -EINVAL;
  462. vold = ipic_read(ipic->regs, IPIC_SECNR);
  463. if ((flow_type & IRQ_TYPE_SENSE_MASK) == IRQ_TYPE_EDGE_FALLING) {
  464. vnew = vold | (1 << edibit);
  465. } else {
  466. vnew = vold & ~(1 << edibit);
  467. }
  468. if (vold != vnew)
  469. ipic_write(ipic->regs, IPIC_SECNR, vnew);
  470. return 0;
  471. }
  472. static struct irq_chip ipic_irq_chip = {
  473. .typename = " IPIC ",
  474. .unmask = ipic_unmask_irq,
  475. .mask = ipic_mask_irq,
  476. .mask_ack = ipic_mask_irq_and_ack,
  477. .ack = ipic_ack_irq,
  478. .set_type = ipic_set_irq_type,
  479. };
  480. static int ipic_host_match(struct irq_host *h, struct device_node *node)
  481. {
  482. /* Exact match, unless ipic node is NULL */
  483. return h->of_node == NULL || h->of_node == node;
  484. }
  485. static int ipic_host_map(struct irq_host *h, unsigned int virq,
  486. irq_hw_number_t hw)
  487. {
  488. struct ipic *ipic = h->host_data;
  489. struct irq_chip *chip;
  490. /* Default chip */
  491. chip = &ipic->hc_irq;
  492. set_irq_chip_data(virq, ipic);
  493. set_irq_chip_and_handler(virq, chip, handle_level_irq);
  494. /* Set default irq type */
  495. set_irq_type(virq, IRQ_TYPE_NONE);
  496. return 0;
  497. }
  498. static int ipic_host_xlate(struct irq_host *h, struct device_node *ct,
  499. u32 *intspec, unsigned int intsize,
  500. irq_hw_number_t *out_hwirq, unsigned int *out_flags)
  501. {
  502. /* interrupt sense values coming from the device tree equal either
  503. * LEVEL_LOW (low assertion) or EDGE_FALLING (high-to-low change)
  504. */
  505. *out_hwirq = intspec[0];
  506. if (intsize > 1)
  507. *out_flags = intspec[1];
  508. else
  509. *out_flags = IRQ_TYPE_NONE;
  510. return 0;
  511. }
  512. static struct irq_host_ops ipic_host_ops = {
  513. .match = ipic_host_match,
  514. .map = ipic_host_map,
  515. .xlate = ipic_host_xlate,
  516. };
  517. struct ipic * __init ipic_init(struct device_node *node, unsigned int flags)
  518. {
  519. struct ipic *ipic;
  520. struct resource res;
  521. u32 temp = 0, ret;
  522. ipic = alloc_bootmem(sizeof(struct ipic));
  523. if (ipic == NULL)
  524. return NULL;
  525. memset(ipic, 0, sizeof(struct ipic));
  526. ipic->irqhost = irq_alloc_host(of_node_get(node), IRQ_HOST_MAP_LINEAR,
  527. NR_IPIC_INTS,
  528. &ipic_host_ops, 0);
  529. if (ipic->irqhost == NULL) {
  530. of_node_put(node);
  531. return NULL;
  532. }
  533. ret = of_address_to_resource(node, 0, &res);
  534. if (ret) {
  535. of_node_put(node);
  536. return NULL;
  537. }
  538. ipic->regs = ioremap(res.start, res.end - res.start + 1);
  539. ipic->irqhost->host_data = ipic;
  540. ipic->hc_irq = ipic_irq_chip;
  541. /* init hw */
  542. ipic_write(ipic->regs, IPIC_SICNR, 0x0);
  543. /* default priority scheme is grouped. If spread mode is required
  544. * configure SICFR accordingly */
  545. if (flags & IPIC_SPREADMODE_GRP_A)
  546. temp |= SICFR_IPSA;
  547. if (flags & IPIC_SPREADMODE_GRP_D)
  548. temp |= SICFR_IPSD;
  549. if (flags & IPIC_SPREADMODE_MIX_A)
  550. temp |= SICFR_MPSA;
  551. if (flags & IPIC_SPREADMODE_MIX_B)
  552. temp |= SICFR_MPSB;
  553. ipic_write(ipic->regs, IPIC_SICNR, temp);
  554. /* handle MCP route */
  555. temp = 0;
  556. if (flags & IPIC_DISABLE_MCP_OUT)
  557. temp = SERCR_MCPR;
  558. ipic_write(ipic->regs, IPIC_SERCR, temp);
  559. /* handle routing of IRQ0 to MCP */
  560. temp = ipic_read(ipic->regs, IPIC_SEMSR);
  561. if (flags & IPIC_IRQ0_MCP)
  562. temp |= SEMSR_SIRQ0;
  563. else
  564. temp &= ~SEMSR_SIRQ0;
  565. ipic_write(ipic->regs, IPIC_SEMSR, temp);
  566. primary_ipic = ipic;
  567. irq_set_default_host(primary_ipic->irqhost);
  568. printk ("IPIC (%d IRQ sources) at %p\n", NR_IPIC_INTS,
  569. primary_ipic->regs);
  570. return ipic;
  571. }
  572. int ipic_set_priority(unsigned int virq, unsigned int priority)
  573. {
  574. struct ipic *ipic = ipic_from_irq(virq);
  575. unsigned int src = ipic_irq_to_hw(virq);
  576. u32 temp;
  577. if (priority > 7)
  578. return -EINVAL;
  579. if (src > 127)
  580. return -EINVAL;
  581. if (ipic_info[src].prio == 0)
  582. return -EINVAL;
  583. temp = ipic_read(ipic->regs, ipic_info[src].prio);
  584. if (priority < 4) {
  585. temp &= ~(0x7 << (20 + (3 - priority) * 3));
  586. temp |= ipic_info[src].prio_mask << (20 + (3 - priority) * 3);
  587. } else {
  588. temp &= ~(0x7 << (4 + (7 - priority) * 3));
  589. temp |= ipic_info[src].prio_mask << (4 + (7 - priority) * 3);
  590. }
  591. ipic_write(ipic->regs, ipic_info[src].prio, temp);
  592. return 0;
  593. }
  594. void ipic_set_highest_priority(unsigned int virq)
  595. {
  596. struct ipic *ipic = ipic_from_irq(virq);
  597. unsigned int src = ipic_irq_to_hw(virq);
  598. u32 temp;
  599. temp = ipic_read(ipic->regs, IPIC_SICFR);
  600. /* clear and set HPI */
  601. temp &= 0x7f000000;
  602. temp |= (src & 0x7f) << 24;
  603. ipic_write(ipic->regs, IPIC_SICFR, temp);
  604. }
  605. void ipic_set_default_priority(void)
  606. {
  607. ipic_write(primary_ipic->regs, IPIC_SIPRR_A, IPIC_SIPRR_A_DEFAULT);
  608. ipic_write(primary_ipic->regs, IPIC_SIPRR_D, IPIC_SIPRR_D_DEFAULT);
  609. ipic_write(primary_ipic->regs, IPIC_SMPRR_A, IPIC_SMPRR_A_DEFAULT);
  610. ipic_write(primary_ipic->regs, IPIC_SMPRR_B, IPIC_SMPRR_B_DEFAULT);
  611. }
  612. void ipic_enable_mcp(enum ipic_mcp_irq mcp_irq)
  613. {
  614. struct ipic *ipic = primary_ipic;
  615. u32 temp;
  616. temp = ipic_read(ipic->regs, IPIC_SERMR);
  617. temp |= (1 << (31 - mcp_irq));
  618. ipic_write(ipic->regs, IPIC_SERMR, temp);
  619. }
  620. void ipic_disable_mcp(enum ipic_mcp_irq mcp_irq)
  621. {
  622. struct ipic *ipic = primary_ipic;
  623. u32 temp;
  624. temp = ipic_read(ipic->regs, IPIC_SERMR);
  625. temp &= (1 << (31 - mcp_irq));
  626. ipic_write(ipic->regs, IPIC_SERMR, temp);
  627. }
  628. u32 ipic_get_mcp_status(void)
  629. {
  630. return ipic_read(primary_ipic->regs, IPIC_SERMR);
  631. }
  632. void ipic_clear_mcp_status(u32 mask)
  633. {
  634. ipic_write(primary_ipic->regs, IPIC_SERMR, mask);
  635. }
  636. /* Return an interrupt vector or NO_IRQ if no interrupt is pending. */
  637. unsigned int ipic_get_irq(void)
  638. {
  639. int irq;
  640. BUG_ON(primary_ipic == NULL);
  641. #define IPIC_SIVCR_VECTOR_MASK 0x7f
  642. irq = ipic_read(primary_ipic->regs, IPIC_SIVCR) & IPIC_SIVCR_VECTOR_MASK;
  643. if (irq == 0) /* 0 --> no irq is pending */
  644. return NO_IRQ;
  645. return irq_linear_revmap(primary_ipic->irqhost, irq);
  646. }
  647. static struct sysdev_class ipic_sysclass = {
  648. set_kset_name("ipic"),
  649. };
  650. static struct sys_device device_ipic = {
  651. .id = 0,
  652. .cls = &ipic_sysclass,
  653. };
  654. static int __init init_ipic_sysfs(void)
  655. {
  656. int rc;
  657. if (!primary_ipic->regs)
  658. return -ENODEV;
  659. printk(KERN_DEBUG "Registering ipic with sysfs...\n");
  660. rc = sysdev_class_register(&ipic_sysclass);
  661. if (rc) {
  662. printk(KERN_ERR "Failed registering ipic sys class\n");
  663. return -ENODEV;
  664. }
  665. rc = sysdev_register(&device_ipic);
  666. if (rc) {
  667. printk(KERN_ERR "Failed registering ipic sys device\n");
  668. return -ENODEV;
  669. }
  670. return 0;
  671. }
  672. subsys_initcall(init_ipic_sysfs);