1 /* 2 * linux/arch/arm/mach-sa1100/neponset.c 3 */ 4 #include <linux/err.h> 5 #include <linux/init.h> 6 #include <linux/ioport.h> 7 #include <linux/irq.h> 8 #include <linux/kernel.h> 9 #include <linux/module.h> 10 #include <linux/platform_device.h> 11 #include <linux/serial_core.h> 12 #include <linux/slab.h> 13 14 #include <asm/mach-types.h> 15 #include <asm/mach/map.h> 16 #include <asm/mach/serial_sa1100.h> 17 #include <asm/hardware/sa1111.h> 18 #include <asm/sizes.h> 19 20 #include <mach/hardware.h> 21 #include <mach/assabet.h> 22 #include <mach/neponset.h> 23 24 #define NEP_IRQ_SMC91X 0 25 #define NEP_IRQ_USAR 1 26 #define NEP_IRQ_SA1111 2 27 #define NEP_IRQ_NR 3 28 29 struct neponset_drvdata { 30 struct platform_device *sa1111; 31 struct platform_device *smc91x; 32 unsigned irq_base; 33 #ifdef CONFIG_PM_SLEEP 34 u32 ncr0; 35 u32 mdm_ctl_0; 36 #endif 37 }; 38 39 void neponset_ncr_frob(unsigned int mask, unsigned int val) 40 { 41 unsigned long flags; 42 43 local_irq_save(flags); 44 NCR_0 = (NCR_0 & ~mask) | val; 45 local_irq_restore(flags); 46 } 47 48 static void neponset_set_mctrl(struct uart_port *port, u_int mctrl) 49 { 50 u_int mdm_ctl0 = MDM_CTL_0; 51 52 if (port->mapbase == _Ser1UTCR0) { 53 if (mctrl & TIOCM_RTS) 54 mdm_ctl0 &= ~MDM_CTL0_RTS2; 55 else 56 mdm_ctl0 |= MDM_CTL0_RTS2; 57 58 if (mctrl & TIOCM_DTR) 59 mdm_ctl0 &= ~MDM_CTL0_DTR2; 60 else 61 mdm_ctl0 |= MDM_CTL0_DTR2; 62 } else if (port->mapbase == _Ser3UTCR0) { 63 if (mctrl & TIOCM_RTS) 64 mdm_ctl0 &= ~MDM_CTL0_RTS1; 65 else 66 mdm_ctl0 |= MDM_CTL0_RTS1; 67 68 if (mctrl & TIOCM_DTR) 69 mdm_ctl0 &= ~MDM_CTL0_DTR1; 70 else 71 mdm_ctl0 |= MDM_CTL0_DTR1; 72 } 73 74 MDM_CTL_0 = mdm_ctl0; 75 } 76 77 static u_int neponset_get_mctrl(struct uart_port *port) 78 { 79 u_int ret = TIOCM_CD | TIOCM_CTS | TIOCM_DSR; 80 u_int mdm_ctl1 = MDM_CTL_1; 81 82 if (port->mapbase == _Ser1UTCR0) { 83 if (mdm_ctl1 & MDM_CTL1_DCD2) 84 ret &= ~TIOCM_CD; 85 if (mdm_ctl1 & MDM_CTL1_CTS2) 86 ret &= ~TIOCM_CTS; 87 if (mdm_ctl1 & MDM_CTL1_DSR2) 88 ret &= ~TIOCM_DSR; 89 } else if (port->mapbase == _Ser3UTCR0) { 90 if (mdm_ctl1 & MDM_CTL1_DCD1) 91 ret &= ~TIOCM_CD; 92 if (mdm_ctl1 & MDM_CTL1_CTS1) 93 ret &= ~TIOCM_CTS; 94 if (mdm_ctl1 & MDM_CTL1_DSR1) 95 ret &= ~TIOCM_DSR; 96 } 97 98 return ret; 99 } 100 101 static struct sa1100_port_fns neponset_port_fns __devinitdata = { 102 .set_mctrl = neponset_set_mctrl, 103 .get_mctrl = neponset_get_mctrl, 104 }; 105 106 /* 107 * Install handler for Neponset IRQ. Note that we have to loop here 108 * since the ETHERNET and USAR IRQs are level based, and we need to 109 * ensure that the IRQ signal is deasserted before returning. This 110 * is rather unfortunate. 111 */ 112 static void neponset_irq_handler(unsigned int irq, struct irq_desc *desc) 113 { 114 struct neponset_drvdata *d = irq_desc_get_handler_data(desc); 115 unsigned int irr; 116 117 while (1) { 118 /* 119 * Acknowledge the parent IRQ. 120 */ 121 desc->irq_data.chip->irq_ack(&desc->irq_data); 122 123 /* 124 * Read the interrupt reason register. Let's have all 125 * active IRQ bits high. Note: there is a typo in the 126 * Neponset user's guide for the SA1111 IRR level. 127 */ 128 irr = IRR ^ (IRR_ETHERNET | IRR_USAR); 129 130 if ((irr & (IRR_ETHERNET | IRR_USAR | IRR_SA1111)) == 0) 131 break; 132 133 /* 134 * Since there is no individual mask, we have to 135 * mask the parent IRQ. This is safe, since we'll 136 * recheck the register for any pending IRQs. 137 */ 138 if (irr & (IRR_ETHERNET | IRR_USAR)) { 139 desc->irq_data.chip->irq_mask(&desc->irq_data); 140 141 /* 142 * Ack the interrupt now to prevent re-entering 143 * this neponset handler. Again, this is safe 144 * since we'll check the IRR register prior to 145 * leaving. 146 */ 147 desc->irq_data.chip->irq_ack(&desc->irq_data); 148 149 if (irr & IRR_ETHERNET) 150 generic_handle_irq(d->irq_base + NEP_IRQ_SMC91X); 151 152 if (irr & IRR_USAR) 153 generic_handle_irq(d->irq_base + NEP_IRQ_USAR); 154 155 desc->irq_data.chip->irq_unmask(&desc->irq_data); 156 } 157 158 if (irr & IRR_SA1111) 159 generic_handle_irq(d->irq_base + NEP_IRQ_SA1111); 160 } 161 } 162 163 /* Yes, we really do not have any kind of masking or unmasking */ 164 static void nochip_noop(struct irq_data *irq) 165 { 166 } 167 168 static struct irq_chip nochip = { 169 .name = "neponset", 170 .irq_ack = nochip_noop, 171 .irq_mask = nochip_noop, 172 .irq_unmask = nochip_noop, 173 }; 174 175 static struct sa1111_platform_data sa1111_info = { 176 .irq_base = IRQ_BOARD_END, 177 }; 178 179 static int __devinit neponset_probe(struct platform_device *dev) 180 { 181 struct neponset_drvdata *d; 182 struct resource sa1111_resources[] = { 183 DEFINE_RES_MEM(0x40000000, SZ_8K), 184 { .flags = IORESOURCE_IRQ }, 185 }; 186 struct platform_device_info sa1111_devinfo = { 187 .parent = &dev->dev, 188 .name = "sa1111", 189 .id = 0, 190 .res = sa1111_resources, 191 .num_res = ARRAY_SIZE(sa1111_resources), 192 .data = &sa1111_info, 193 .size_data = sizeof(sa1111_info), 194 .dma_mask = 0xffffffffUL, 195 }; 196 struct resource smc91x_resources[] = { 197 DEFINE_RES_MEM_NAMED(SA1100_CS3_PHYS, 198 0x02000000, "smc91x-regs"), 199 DEFINE_RES_MEM_NAMED(SA1100_CS3_PHYS + 0x02000000, 200 0x02000000, "smc91x-attrib"), 201 { .flags = IORESOURCE_IRQ }, 202 }; 203 struct platform_device_info smc91x_devinfo = { 204 .parent = &dev->dev, 205 .name = "smc91x", 206 .id = 0, 207 .res = smc91x_resources, 208 .num_res = ARRAY_SIZE(smc91x_resources), 209 }; 210 int ret; 211 212 d = kzalloc(sizeof(*d), GFP_KERNEL); 213 if (!d) { 214 ret = -ENOMEM; 215 goto err_alloc; 216 } 217 218 ret = irq_alloc_descs(-1, IRQ_BOARD_START, NEP_IRQ_NR, -1); 219 if (ret <= 0) { 220 dev_err(&dev->dev, "unable to allocate %u irqs: %d\n", 221 NEP_IRQ_NR, ret); 222 if (ret == 0) 223 ret = -ENOMEM; 224 goto err_irq_alloc; 225 } 226 227 d->irq_base = ret; 228 229 irq_set_chip_and_handler(d->irq_base + NEP_IRQ_SMC91X, &nochip, 230 handle_simple_irq); 231 set_irq_flags(d->irq_base + NEP_IRQ_SMC91X, IRQF_VALID | IRQF_PROBE); 232 irq_set_chip_and_handler(d->irq_base + NEP_IRQ_USAR, &nochip, 233 handle_simple_irq); 234 set_irq_flags(d->irq_base + NEP_IRQ_USAR, IRQF_VALID | IRQF_PROBE); 235 irq_set_chip(d->irq_base + NEP_IRQ_SA1111, &nochip); 236 237 irq_set_irq_type(IRQ_GPIO25, IRQ_TYPE_EDGE_RISING); 238 irq_set_handler_data(IRQ_GPIO25, d); 239 irq_set_chained_handler(IRQ_GPIO25, neponset_irq_handler); 240 241 /* 242 * We would set IRQ_GPIO25 to be a wake-up IRQ, but unfortunately 243 * something on the Neponset activates this IRQ on sleep (eth?) 244 */ 245 #if 0 246 enable_irq_wake(IRQ_GPIO25); 247 #endif 248 249 dev_info(&dev->dev, "Neponset daughter board, providing IRQ%u-%u\n", 250 d->irq_base, d->irq_base + NEP_IRQ_NR - 1); 251 252 sa1100_register_uart_fns(&neponset_port_fns); 253 254 /* Disable GPIO 0/1 drivers so the buttons work on the Assabet */ 255 NCR_0 = NCR_GP01_OFF; 256 257 sa1111_resources[1].start = d->irq_base + NEP_IRQ_SA1111; 258 sa1111_resources[1].end = d->irq_base + NEP_IRQ_SA1111; 259 d->sa1111 = platform_device_register_full(&sa1111_devinfo); 260 261 smc91x_resources[2].start = d->irq_base + NEP_IRQ_SMC91X; 262 smc91x_resources[2].end = d->irq_base + NEP_IRQ_SMC91X; 263 d->smc91x = platform_device_register_full(&smc91x_devinfo); 264 265 platform_set_drvdata(dev, d); 266 267 return 0; 268 269 err_irq_alloc: 270 kfree(d); 271 err_alloc: 272 return ret; 273 } 274 275 static int __devexit neponset_remove(struct platform_device *dev) 276 { 277 struct neponset_drvdata *d = platform_get_drvdata(dev); 278 279 if (!IS_ERR(d->sa1111)) 280 platform_device_unregister(d->sa1111); 281 if (!IS_ERR(d->smc91x)) 282 platform_device_unregister(d->smc91x); 283 irq_set_chained_handler(IRQ_GPIO25, NULL); 284 irq_free_descs(d->irq_base, NEP_IRQ_NR); 285 kfree(d); 286 287 return 0; 288 } 289 290 #ifdef CONFIG_PM 291 static int neponset_suspend(struct platform_device *dev, pm_message_t state) 292 { 293 struct neponset_drvdata *d = platform_get_drvdata(dev); 294 295 d->ncr0 = NCR_0; 296 d->mdm_ctl_0 = MDM_CTL_0; 297 298 return 0; 299 } 300 301 static int neponset_resume(struct platform_device *dev) 302 { 303 struct neponset_drvdata *d = platform_get_drvdata(dev); 304 305 NCR_0 = d->ncr0; 306 MDM_CTL_0 = d->mdm_ctl_0; 307 308 return 0; 309 } 310 311 #else 312 #define neponset_suspend NULL 313 #define neponset_resume NULL 314 #endif 315 316 static struct platform_driver neponset_device_driver = { 317 .probe = neponset_probe, 318 .remove = __devexit_p(neponset_remove), 319 .suspend = neponset_suspend, 320 .resume = neponset_resume, 321 .driver = { 322 .name = "neponset", 323 .owner = THIS_MODULE, 324 }, 325 }; 326 327 static struct resource neponset_resources[] = { 328 [0] = DEFINE_RES_MEM(0x10000000, 0x08000000), 329 }; 330 331 static struct platform_device neponset_device = { 332 .name = "neponset", 333 .id = 0, 334 .num_resources = ARRAY_SIZE(neponset_resources), 335 .resource = neponset_resources, 336 }; 337 338 extern void sa1110_mb_disable(void); 339 340 static int __init neponset_init(void) 341 { 342 platform_driver_register(&neponset_device_driver); 343 344 /* 345 * The Neponset is only present on the Assabet machine type. 346 */ 347 if (!machine_is_assabet()) 348 return -ENODEV; 349 350 /* 351 * Ensure that the memory bus request/grant signals are setup, 352 * and the grant is held in its inactive state, whether or not 353 * we actually have a Neponset attached. 354 */ 355 sa1110_mb_disable(); 356 357 if (!machine_has_neponset()) { 358 printk(KERN_DEBUG "Neponset expansion board not present\n"); 359 return -ENODEV; 360 } 361 362 if (WHOAMI != 0x11) { 363 printk(KERN_WARNING "Neponset board detected, but " 364 "wrong ID: %02x\n", WHOAMI); 365 return -ENODEV; 366 } 367 368 return platform_device_register(&neponset_device); 369 } 370 371 subsys_initcall(neponset_init); 372 373 static struct map_desc neponset_io_desc[] __initdata = { 374 { /* System Registers */ 375 .virtual = 0xf3000000, 376 .pfn = __phys_to_pfn(0x10000000), 377 .length = SZ_1M, 378 .type = MT_DEVICE 379 }, { /* SA-1111 */ 380 .virtual = 0xf4000000, 381 .pfn = __phys_to_pfn(0x40000000), 382 .length = SZ_1M, 383 .type = MT_DEVICE 384 } 385 }; 386 387 void __init neponset_map_io(void) 388 { 389 iotable_init(neponset_io_desc, ARRAY_SIZE(neponset_io_desc)); 390 } 391