diff options
Diffstat (limited to 'arch/m32r/platforms/mappi2/setup.c')
| -rw-r--r-- | arch/m32r/platforms/mappi2/setup.c | 89 |
1 files changed, 30 insertions, 59 deletions
diff --git a/arch/m32r/platforms/mappi2/setup.c b/arch/m32r/platforms/mappi2/setup.c index c049376d0270..9117c30ea365 100644 --- a/arch/m32r/platforms/mappi2/setup.c +++ b/arch/m32r/platforms/mappi2/setup.c | |||
| @@ -46,126 +46,97 @@ static void enable_mappi2_irq(unsigned int irq) | |||
| 46 | outl(data, port); | 46 | outl(data, port); |
| 47 | } | 47 | } |
| 48 | 48 | ||
| 49 | static void mask_and_ack_mappi2(unsigned int irq) | 49 | static void mask_mappi2(struct irq_data *data) |
| 50 | { | 50 | { |
| 51 | disable_mappi2_irq(irq); | 51 | disable_mappi2_irq(data->irq); |
| 52 | } | 52 | } |
| 53 | 53 | ||
| 54 | static void end_mappi2_irq(unsigned int irq) | 54 | static void unmask_mappi2(struct irq_data *data) |
| 55 | { | 55 | { |
| 56 | enable_mappi2_irq(irq); | 56 | enable_mappi2_irq(data->irq); |
| 57 | } | 57 | } |
| 58 | 58 | ||
| 59 | static unsigned int startup_mappi2_irq(unsigned int irq) | 59 | static void shutdown_mappi2(struct irq_data *data) |
| 60 | { | ||
| 61 | enable_mappi2_irq(irq); | ||
| 62 | return (0); | ||
| 63 | } | ||
| 64 | |||
| 65 | static void shutdown_mappi2_irq(unsigned int irq) | ||
| 66 | { | 60 | { |
| 67 | unsigned long port; | 61 | unsigned long port; |
| 68 | 62 | ||
| 69 | port = irq2port(irq); | 63 | port = irq2port(data->irq); |
| 70 | outl(M32R_ICUCR_ILEVEL7, port); | 64 | outl(M32R_ICUCR_ILEVEL7, port); |
| 71 | } | 65 | } |
| 72 | 66 | ||
| 73 | static struct irq_chip mappi2_irq_type = | 67 | static struct irq_chip mappi2_irq_type = |
| 74 | { | 68 | { |
| 75 | .name = "MAPPI2-IRQ", | 69 | .name = "MAPPI2-IRQ", |
| 76 | .startup = startup_mappi2_irq, | 70 | .irq_shutdown = shutdown_mappi2, |
| 77 | .shutdown = shutdown_mappi2_irq, | 71 | .irq_mask = mask_mappi2, |
| 78 | .enable = enable_mappi2_irq, | 72 | .irq_unmask = unmask_mappi2, |
| 79 | .disable = disable_mappi2_irq, | ||
| 80 | .ack = mask_and_ack_mappi2, | ||
| 81 | .end = end_mappi2_irq | ||
| 82 | }; | 73 | }; |
| 83 | 74 | ||
| 84 | void __init init_IRQ(void) | 75 | void __init init_IRQ(void) |
| 85 | { | 76 | { |
| 86 | #if defined(CONFIG_SMC91X) | 77 | #if defined(CONFIG_SMC91X) |
| 87 | /* INT0 : LAN controller (SMC91111) */ | 78 | /* INT0 : LAN controller (SMC91111) */ |
| 88 | irq_desc[M32R_IRQ_INT0].status = IRQ_DISABLED; | 79 | set_irq_chip_and_handler(M32R_IRQ_INT0, &mappi2_irq_type, |
| 89 | irq_desc[M32R_IRQ_INT0].chip = &mappi2_irq_type; | 80 | handle_level_irq); |
| 90 | irq_desc[M32R_IRQ_INT0].action = 0; | ||
| 91 | irq_desc[M32R_IRQ_INT0].depth = 1; | ||
| 92 | icu_data[M32R_IRQ_INT0].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD10; | 81 | icu_data[M32R_IRQ_INT0].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD10; |
| 93 | disable_mappi2_irq(M32R_IRQ_INT0); | 82 | disable_mappi2_irq(M32R_IRQ_INT0); |
| 94 | #endif /* CONFIG_SMC91X */ | 83 | #endif /* CONFIG_SMC91X */ |
| 95 | 84 | ||
| 96 | /* MFT2 : system timer */ | 85 | /* MFT2 : system timer */ |
| 97 | irq_desc[M32R_IRQ_MFT2].status = IRQ_DISABLED; | 86 | set_irq_chip_and_handler(M32R_IRQ_MFT2, &mappi2_irq_type, |
| 98 | irq_desc[M32R_IRQ_MFT2].chip = &mappi2_irq_type; | 87 | handle_level_irq); |
| 99 | irq_desc[M32R_IRQ_MFT2].action = 0; | ||
| 100 | irq_desc[M32R_IRQ_MFT2].depth = 1; | ||
| 101 | icu_data[M32R_IRQ_MFT2].icucr = M32R_ICUCR_IEN; | 88 | icu_data[M32R_IRQ_MFT2].icucr = M32R_ICUCR_IEN; |
| 102 | disable_mappi2_irq(M32R_IRQ_MFT2); | 89 | disable_mappi2_irq(M32R_IRQ_MFT2); |
| 103 | 90 | ||
| 104 | #ifdef CONFIG_SERIAL_M32R_SIO | 91 | #ifdef CONFIG_SERIAL_M32R_SIO |
| 105 | /* SIO0_R : uart receive data */ | 92 | /* SIO0_R : uart receive data */ |
| 106 | irq_desc[M32R_IRQ_SIO0_R].status = IRQ_DISABLED; | 93 | set_irq_chip_and_handler(M32R_IRQ_SIO0_R, &mappi2_irq_type, |
| 107 | irq_desc[M32R_IRQ_SIO0_R].chip = &mappi2_irq_type; | 94 | handle_level_irq); |
| 108 | irq_desc[M32R_IRQ_SIO0_R].action = 0; | ||
| 109 | irq_desc[M32R_IRQ_SIO0_R].depth = 1; | ||
| 110 | icu_data[M32R_IRQ_SIO0_R].icucr = 0; | 95 | icu_data[M32R_IRQ_SIO0_R].icucr = 0; |
| 111 | disable_mappi2_irq(M32R_IRQ_SIO0_R); | 96 | disable_mappi2_irq(M32R_IRQ_SIO0_R); |
| 112 | 97 | ||
| 113 | /* SIO0_S : uart send data */ | 98 | /* SIO0_S : uart send data */ |
| 114 | irq_desc[M32R_IRQ_SIO0_S].status = IRQ_DISABLED; | 99 | set_irq_chip_and_handler(M32R_IRQ_SIO0_S, &mappi2_irq_type, |
| 115 | irq_desc[M32R_IRQ_SIO0_S].chip = &mappi2_irq_type; | 100 | handle_level_irq); |
| 116 | irq_desc[M32R_IRQ_SIO0_S].action = 0; | ||
| 117 | irq_desc[M32R_IRQ_SIO0_S].depth = 1; | ||
| 118 | icu_data[M32R_IRQ_SIO0_S].icucr = 0; | 101 | icu_data[M32R_IRQ_SIO0_S].icucr = 0; |
| 119 | disable_mappi2_irq(M32R_IRQ_SIO0_S); | 102 | disable_mappi2_irq(M32R_IRQ_SIO0_S); |
| 120 | /* SIO1_R : uart receive data */ | 103 | /* SIO1_R : uart receive data */ |
| 121 | irq_desc[M32R_IRQ_SIO1_R].status = IRQ_DISABLED; | 104 | set_irq_chip_and_handler(M32R_IRQ_SIO1_R, &mappi2_irq_type, |
| 122 | irq_desc[M32R_IRQ_SIO1_R].chip = &mappi2_irq_type; | 105 | handle_level_irq); |
| 123 | irq_desc[M32R_IRQ_SIO1_R].action = 0; | ||
| 124 | irq_desc[M32R_IRQ_SIO1_R].depth = 1; | ||
| 125 | icu_data[M32R_IRQ_SIO1_R].icucr = 0; | 106 | icu_data[M32R_IRQ_SIO1_R].icucr = 0; |
| 126 | disable_mappi2_irq(M32R_IRQ_SIO1_R); | 107 | disable_mappi2_irq(M32R_IRQ_SIO1_R); |
| 127 | 108 | ||
| 128 | /* SIO1_S : uart send data */ | 109 | /* SIO1_S : uart send data */ |
| 129 | irq_desc[M32R_IRQ_SIO1_S].status = IRQ_DISABLED; | 110 | set_irq_chip_and_handler(M32R_IRQ_SIO1_S, &mappi2_irq_type, |
| 130 | irq_desc[M32R_IRQ_SIO1_S].chip = &mappi2_irq_type; | 111 | handle_level_irq); |
| 131 | irq_desc[M32R_IRQ_SIO1_S].action = 0; | ||
| 132 | irq_desc[M32R_IRQ_SIO1_S].depth = 1; | ||
| 133 | icu_data[M32R_IRQ_SIO1_S].icucr = 0; | 112 | icu_data[M32R_IRQ_SIO1_S].icucr = 0; |
| 134 | disable_mappi2_irq(M32R_IRQ_SIO1_S); | 113 | disable_mappi2_irq(M32R_IRQ_SIO1_S); |
| 135 | #endif /* CONFIG_M32R_USE_DBG_CONSOLE */ | 114 | #endif /* CONFIG_M32R_USE_DBG_CONSOLE */ |
| 136 | 115 | ||
| 137 | #if defined(CONFIG_USB) | 116 | #if defined(CONFIG_USB) |
| 138 | /* INT1 : USB Host controller interrupt */ | 117 | /* INT1 : USB Host controller interrupt */ |
| 139 | irq_desc[M32R_IRQ_INT1].status = IRQ_DISABLED; | 118 | set_irq_chip_and_handler(M32R_IRQ_INT1, &mappi2_irq_type, |
| 140 | irq_desc[M32R_IRQ_INT1].chip = &mappi2_irq_type; | 119 | handle_level_irq); |
| 141 | irq_desc[M32R_IRQ_INT1].action = 0; | ||
| 142 | irq_desc[M32R_IRQ_INT1].depth = 1; | ||
| 143 | icu_data[M32R_IRQ_INT1].icucr = M32R_ICUCR_ISMOD01; | 120 | icu_data[M32R_IRQ_INT1].icucr = M32R_ICUCR_ISMOD01; |
| 144 | disable_mappi2_irq(M32R_IRQ_INT1); | 121 | disable_mappi2_irq(M32R_IRQ_INT1); |
| 145 | #endif /* CONFIG_USB */ | 122 | #endif /* CONFIG_USB */ |
| 146 | 123 | ||
| 147 | /* ICUCR40: CFC IREQ */ | 124 | /* ICUCR40: CFC IREQ */ |
| 148 | irq_desc[PLD_IRQ_CFIREQ].status = IRQ_DISABLED; | 125 | set_irq_chip_and_handler(PLD_IRQ_CFIREQ, &mappi2_irq_type, |
| 149 | irq_desc[PLD_IRQ_CFIREQ].chip = &mappi2_irq_type; | 126 | handle_level_irq); |
| 150 | irq_desc[PLD_IRQ_CFIREQ].action = 0; | ||
| 151 | irq_desc[PLD_IRQ_CFIREQ].depth = 1; /* disable nested irq */ | ||
| 152 | icu_data[PLD_IRQ_CFIREQ].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD01; | 127 | icu_data[PLD_IRQ_CFIREQ].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD01; |
| 153 | disable_mappi2_irq(PLD_IRQ_CFIREQ); | 128 | disable_mappi2_irq(PLD_IRQ_CFIREQ); |
| 154 | 129 | ||
| 155 | #if defined(CONFIG_M32R_CFC) | 130 | #if defined(CONFIG_M32R_CFC) |
| 156 | /* ICUCR41: CFC Insert */ | 131 | /* ICUCR41: CFC Insert */ |
| 157 | irq_desc[PLD_IRQ_CFC_INSERT].status = IRQ_DISABLED; | 132 | set_irq_chip_and_handler(PLD_IRQ_CFC_INSERT, &mappi2_irq_type, |
| 158 | irq_desc[PLD_IRQ_CFC_INSERT].chip = &mappi2_irq_type; | 133 | handle_level_irq); |
| 159 | irq_desc[PLD_IRQ_CFC_INSERT].action = 0; | ||
| 160 | irq_desc[PLD_IRQ_CFC_INSERT].depth = 1; /* disable nested irq */ | ||
| 161 | icu_data[PLD_IRQ_CFC_INSERT].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD00; | 134 | icu_data[PLD_IRQ_CFC_INSERT].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD00; |
| 162 | disable_mappi2_irq(PLD_IRQ_CFC_INSERT); | 135 | disable_mappi2_irq(PLD_IRQ_CFC_INSERT); |
| 163 | 136 | ||
| 164 | /* ICUCR42: CFC Eject */ | 137 | /* ICUCR42: CFC Eject */ |
| 165 | irq_desc[PLD_IRQ_CFC_EJECT].status = IRQ_DISABLED; | 138 | set_irq_chip_and_handler(PLD_IRQ_CFC_EJECT, &mappi2_irq_type, |
| 166 | irq_desc[PLD_IRQ_CFC_EJECT].chip = &mappi2_irq_type; | 139 | handle_level_irq); |
| 167 | irq_desc[PLD_IRQ_CFC_EJECT].action = 0; | ||
| 168 | irq_desc[PLD_IRQ_CFC_EJECT].depth = 1; /* disable nested irq */ | ||
| 169 | icu_data[PLD_IRQ_CFC_EJECT].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD10; | 140 | icu_data[PLD_IRQ_CFC_EJECT].icucr = M32R_ICUCR_IEN|M32R_ICUCR_ISMOD10; |
| 170 | disable_mappi2_irq(PLD_IRQ_CFC_EJECT); | 141 | disable_mappi2_irq(PLD_IRQ_CFC_EJECT); |
| 171 | #endif /* CONFIG_MAPPI2_CFC */ | 142 | #endif /* CONFIG_MAPPI2_CFC */ |
