/arch/sh/cchips/hd6446x/hd64461.c

https://bitbucket.org/cresqo/cm7-p500-kernel · C · 123 lines · 92 code · 24 blank · 7 comment · 10 complexity · 089f94fae64a7a2b642b09f59db6b8b1 MD5 · raw file 

    

  1. /*
    2. 

  2.  *	Copyright (C) 2000 YAEGASHI Takeshi
    3. 

  3.  *	Hitachi HD64461 companion chip support
    4. 

  4.  */
    5. 

  5. 

  6. #include <linux/sched.h>
    7. 

  7. #include <linux/module.h>
    8. 

  8. #include <linux/kernel.h>
    9. 

  9. #include <linux/param.h>
    10. 

  10. #include <linux/interrupt.h>
    11. 

  11. #include <linux/init.h>
    12. 

  12. #include <linux/irq.h>
    13. 

  13. #include <linux/io.h>
    14. 

  14. #include <asm/irq.h>
    15. 

  15. #include <asm/hd64461.h>
    16. 

  16. 

  17. /* This belongs in cpu specific */
    18. 

  18. #define INTC_ICR1 0xA4140010UL
    19. 

  19. 

  20. static void hd64461_mask_irq(unsigned int irq)
    21. 

  21. {
    22. 

  22. 	unsigned short nimr;
    23. 

  23. 	unsigned short mask = 1 << (irq - HD64461_IRQBASE);
    24. 

  24. 

  25. 	nimr = __raw_readw(HD64461_NIMR);
    26. 

  26. 	nimr |= mask;
    27. 

  27. 	__raw_writew(nimr, HD64461_NIMR);
    28. 

  28. }
    29. 

  29. 

  30. static void hd64461_unmask_irq(unsigned int irq)
    31. 

  31. {
    32. 

  32. 	unsigned short nimr;
    33. 

  33. 	unsigned short mask = 1 << (irq - HD64461_IRQBASE);
    34. 

  34. 

  35. 	nimr = __raw_readw(HD64461_NIMR);
    36. 

  36. 	nimr &= ~mask;
    37. 

  37. 	__raw_writew(nimr, HD64461_NIMR);
    38. 

  38. }
    39. 

  39. 

  40. static void hd64461_mask_and_ack_irq(unsigned int irq)
    41. 

  41. {
    42. 

  42. 	hd64461_mask_irq(irq);
    43. 

  43. #ifdef CONFIG_HD64461_ENABLER
    44. 

  44. 	if (irq == HD64461_IRQBASE + 13)
    45. 

  45. 		__raw_writeb(0x00, HD64461_PCC1CSCR);
    46. 

  46. #endif
    47. 

  47. }
    48. 

  48. 

  49. static struct irq_chip hd64461_irq_chip = {
    50. 

  50. 	.name		= "HD64461-IRQ",
    51. 

  51. 	.mask		= hd64461_mask_irq,
    52. 

  52. 	.mask_ack	= hd64461_mask_and_ack_irq,
    53. 

  53. 	.unmask		= hd64461_unmask_irq,
    54. 

  54. };
    55. 

  55. 

  56. static void hd64461_irq_demux(unsigned int irq, struct irq_desc *desc)
    57. 

  57. {
    58. 

  58. 	unsigned short intv = __raw_readw(HD64461_NIRR);
    59. 

  59. 	unsigned int ext_irq = HD64461_IRQBASE;
    60. 

  60. 

  61. 	intv &= (1 << HD64461_IRQ_NUM) - 1;
    62. 

  62. 

  63. 	for (; intv; intv >>= 1, ext_irq++) {
    64. 

  64. 		if (!(intv & 1))
    65. 

  65. 			continue;
    66. 

  66. 

  67. 		generic_handle_irq(ext_irq);
    68. 

  68. 	}
    69. 

  69. }
    70. 

  70. 

  71. int __init setup_hd64461(void)
    72. 

  72. {
    73. 

  73. 	int i, nid = cpu_to_node(boot_cpu_data);
    74. 

  74. 

  75. 	if (!MACH_HD64461)
    76. 

  76. 		return 0;
    77. 

  77. 

  78. 	printk(KERN_INFO
    79. 

  79. 	       "HD64461 configured at 0x%x on irq %d(mapped into %d to %d)\n",
    80. 

  80. 	       HD64461_IOBASE, CONFIG_HD64461_IRQ, HD64461_IRQBASE,
    81. 

  81. 	       HD64461_IRQBASE + 15);
    82. 

  82. 

  83. /* Should be at processor specific part.. */
    84. 

  84. #if defined(CONFIG_CPU_SUBTYPE_SH7709)
    85. 

  85. 	__raw_writew(0x2240, INTC_ICR1);
    86. 

  86. #endif
    87. 

  87. 	__raw_writew(0xffff, HD64461_NIMR);
    88. 

  88. 

  89. 	/*  IRQ 80 -> 95 belongs to HD64461  */
    90. 

  90. 	for (i = HD64461_IRQBASE; i < HD64461_IRQBASE + 16; i++) {
    91. 

  91. 		unsigned int irq;
    92. 

  92. 

  93. 		irq = create_irq_nr(i, nid);
    94. 

  94. 		if (unlikely(irq == 0)) {
    95. 

  95. 			pr_err("%s: failed hooking irq %d for HD64461\n",
    96. 

  96. 			       __func__, i);
    97. 

  97. 			return -EBUSY;
    98. 

  98. 		}
    99. 

  99. 

  100. 		if (unlikely(irq != i)) {
    101. 

  101. 			pr_err("%s: got irq %d but wanted %d, bailing.\n",
    102. 

  102. 			       __func__, irq, i);
    103. 

  103. 			destroy_irq(irq);
    104. 

  104. 			return -EINVAL;
    105. 

  105. 		}
    106. 

  106. 

  107. 		set_irq_chip_and_handler(i, &hd64461_irq_chip,
    108. 

  108. 					 handle_level_irq);
    109. 

  109. 	}
    110. 

  110. 

  111. 	set_irq_chained_handler(CONFIG_HD64461_IRQ, hd64461_irq_demux);
    112. 

  112. 	set_irq_type(CONFIG_HD64461_IRQ, IRQ_TYPE_LEVEL_LOW);
    113. 

  113. 

  114. #ifdef CONFIG_HD64461_ENABLER
    115. 

  115. 	printk(KERN_INFO "HD64461: enabling PCMCIA devices\n");
    116. 

  116. 	__raw_writeb(0x4c, HD64461_PCC1CSCIER);
    117. 

  117. 	__raw_writeb(0x00, HD64461_PCC1CSCR);
    118. 

  118. #endif
    119. 

  119. 

  120. 	return 0;
    121. 

  121. }
    122. 

  122. 

  123. module_init(setup_hd64461);
    124.