1 /* 2 * i2sbus driver 3 * 4 * Copyright 2006-2008 Johannes Berg <johannes@sipsolutions.net> 5 * 6 * GPL v2, can be found in COPYING. 7 */ 8 9 #include <linux/module.h> 10 #include <linux/slab.h> 11 #include <linux/pci.h> 12 #include <linux/interrupt.h> 13 #include <linux/dma-mapping.h> 14 #include <linux/of_address.h> 15 #include <linux/of_irq.h> 16 17 #include <sound/core.h> 18 19 #include <asm/macio.h> 20 #include <asm/dbdma.h> 21 22 #include "../soundbus.h" 23 #include "i2sbus.h" 24 25 MODULE_LICENSE("GPL"); 26 MODULE_AUTHOR("Johannes Berg <johannes@sipsolutions.net>"); 27 MODULE_DESCRIPTION("Apple Soundbus: I2S support"); 28 29 static int force; 30 module_param(force, int, 0444); 31 MODULE_PARM_DESC(force, "Force loading i2sbus even when" 32 " no layout-id property is present"); 33 34 static const struct of_device_id i2sbus_match[] = { 35 { .name = "i2s" }, 36 { } 37 }; 38 39 MODULE_DEVICE_TABLE(of, i2sbus_match); 40 41 static int alloc_dbdma_descriptor_ring(struct i2sbus_dev *i2sdev, 42 struct dbdma_command_mem *r, 43 int numcmds) 44 { 45 /* one more for rounding, one for branch back, one for stop command */ 46 r->size = (numcmds + 3) * sizeof(struct dbdma_cmd); 47 /* We use the PCI APIs for now until the generic one gets fixed 48 * enough or until we get some macio-specific versions 49 */ 50 r->space = dma_alloc_coherent(&macio_get_pci_dev(i2sdev->macio)->dev, 51 r->size, &r->bus_addr, GFP_KERNEL); 52 if (!r->space) 53 return -ENOMEM; 54 55 r->cmds = (void*)DBDMA_ALIGN(r->space); 56 r->bus_cmd_start = r->bus_addr + 57 (dma_addr_t)((char*)r->cmds - (char*)r->space); 58 59 return 0; 60 } 61 62 static void free_dbdma_descriptor_ring(struct i2sbus_dev *i2sdev, 63 struct dbdma_command_mem *r) 64 { 65 if (!r->space) return; 66 67 dma_free_coherent(&macio_get_pci_dev(i2sdev->macio)->dev, 68 r->size, r->space, r->bus_addr); 69 } 70 71 static void i2sbus_release_dev(struct device *dev) 72 { 73 struct i2sbus_dev *i2sdev; 74 int i; 75 76 i2sdev = container_of(dev, struct i2sbus_dev, sound.ofdev.dev); 77 iounmap(i2sdev->intfregs); 78 iounmap(i2sdev->out.dbdma); 79 iounmap(i2sdev->in.dbdma); 80 for (i = aoa_resource_i2smmio; i <= aoa_resource_rxdbdma; i++) 81 release_and_free_resource(i2sdev->allocated_resource[i]); 82 free_dbdma_descriptor_ring(i2sdev, &i2sdev->out.dbdma_ring); 83 free_dbdma_descriptor_ring(i2sdev, &i2sdev->in.dbdma_ring); 84 for (i = aoa_resource_i2smmio; i <= aoa_resource_rxdbdma; i++) 85 free_irq(i2sdev->interrupts[i], i2sdev); 86 i2sbus_control_remove_dev(i2sdev->control, i2sdev); 87 mutex_destroy(&i2sdev->lock); 88 kfree(i2sdev); 89 } 90 91 static irqreturn_t i2sbus_bus_intr(int irq, void *devid) 92 { 93 struct i2sbus_dev *dev = devid; 94 u32 intreg; 95 96 spin_lock(&dev->low_lock); 97 intreg = in_le32(&dev->intfregs->intr_ctl); 98 99 /* acknowledge interrupt reasons */ 100 out_le32(&dev->intfregs->intr_ctl, intreg); 101 102 spin_unlock(&dev->low_lock); 103 104 return IRQ_HANDLED; 105 } 106 107 108 /* 109 * XXX FIXME: We test the layout_id's here to get the proper way of 110 * mapping in various registers, thanks to bugs in Apple device-trees. 111 * We could instead key off the machine model and the name of the i2s 112 * node (i2s-a). This we'll do when we move it all to macio_asic.c 113 * and have that export items for each sub-node too. 114 */ 115 static int i2sbus_get_and_fixup_rsrc(struct device_node *np, int index, 116 int layout, struct resource *res) 117 { 118 struct device_node *parent; 119 int pindex, rc = -ENXIO; 120 const u32 *reg; 121 122 /* Machines with layout 76 and 36 (K2 based) have a weird device 123 * tree what we need to special case. 124 * Normal machines just fetch the resource from the i2s-X node. 125 * Darwin further divides normal machines into old and new layouts 126 * with a subtely different code path but that doesn't seem necessary 127 * in practice, they just bloated it. In addition, even on our K2 128 * case the i2s-modem node, if we ever want to handle it, uses the 129 * normal layout 130 */ 131 if (layout != 76 && layout != 36) 132 return of_address_to_resource(np, index, res); 133 134 parent = of_get_parent(np); 135 pindex = (index == aoa_resource_i2smmio) ? 0 : 1; 136 rc = of_address_to_resource(parent, pindex, res); 137 if (rc) 138 goto bail; 139 reg = of_get_property(np, "reg", NULL); 140 if (reg == NULL) { 141 rc = -ENXIO; 142 goto bail; 143 } 144 res->start += reg[index * 2]; 145 res->end = res->start + reg[index * 2 + 1] - 1; 146 bail: 147 of_node_put(parent); 148 return rc; 149 } 150 151 /* FIXME: look at device node refcounting */ 152 static int i2sbus_add_dev(struct macio_dev *macio, 153 struct i2sbus_control *control, 154 struct device_node *np) 155 { 156 struct i2sbus_dev *dev; 157 struct device_node *child, *sound = NULL; 158 struct resource *r; 159 int i, layout = 0, rlen, ok = force; 160 char node_name[6]; 161 static const char *rnames[] = { "i2sbus: %pOFn (control)", 162 "i2sbus: %pOFn (tx)", 163 "i2sbus: %pOFn (rx)" }; 164 static irq_handler_t ints[] = { 165 i2sbus_bus_intr, 166 i2sbus_tx_intr, 167 i2sbus_rx_intr 168 }; 169 170 if (snprintf(node_name, sizeof(node_name), "%pOFn", np) != 5) 171 return 0; 172 if (strncmp(node_name, "i2s-", 4)) 173 return 0; 174 175 dev = kzalloc(sizeof(struct i2sbus_dev), GFP_KERNEL); 176 if (!dev) 177 return 0; 178 179 i = 0; 180 for_each_child_of_node(np, child) { 181 if (of_node_name_eq(child, "sound")) { 182 i++; 183 sound = child; 184 } 185 } 186 if (i == 1) { 187 const u32 *id = of_get_property(sound, "layout-id", NULL); 188 189 if (id) { 190 layout = *id; 191 snprintf(dev->sound.modalias, 32, 192 "sound-layout-%d", layout); 193 ok = 1; 194 } else { 195 id = of_get_property(sound, "device-id", NULL); 196 /* 197 * We probably cannot handle all device-id machines, 198 * so restrict to those we do handle for now. 199 */ 200 if (id && (*id == 22 || *id == 14 || *id == 35 || 201 *id == 31 || *id == 44)) { 202 snprintf(dev->sound.modalias, 32, 203 "aoa-device-id-%d", *id); 204 ok = 1; 205 layout = -1; 206 } 207 } 208 } 209 /* for the time being, until we can handle non-layout-id 210 * things in some fabric, refuse to attach if there is no 211 * layout-id property or we haven't been forced to attach. 212 * When there are two i2s busses and only one has a layout-id, 213 * then this depends on the order, but that isn't important 214 * either as the second one in that case is just a modem. */ 215 if (!ok) { 216 kfree(dev); 217 return -ENODEV; 218 } 219 220 mutex_init(&dev->lock); 221 spin_lock_init(&dev->low_lock); 222 dev->sound.ofdev.archdata.dma_mask = macio->ofdev.archdata.dma_mask; 223 dev->sound.ofdev.dev.of_node = np; 224 dev->sound.ofdev.dev.dma_mask = &dev->sound.ofdev.archdata.dma_mask; 225 dev->sound.ofdev.dev.parent = &macio->ofdev.dev; 226 dev->sound.ofdev.dev.release = i2sbus_release_dev; 227 dev->sound.attach_codec = i2sbus_attach_codec; 228 dev->sound.detach_codec = i2sbus_detach_codec; 229 dev->sound.pcmid = -1; 230 dev->macio = macio; 231 dev->control = control; 232 dev->bus_number = node_name[4] - 'a'; 233 INIT_LIST_HEAD(&dev->sound.codec_list); 234 235 for (i = aoa_resource_i2smmio; i <= aoa_resource_rxdbdma; i++) { 236 dev->interrupts[i] = -1; 237 snprintf(dev->rnames[i], sizeof(dev->rnames[i]), 238 rnames[i], np); 239 } 240 for (i = aoa_resource_i2smmio; i <= aoa_resource_rxdbdma; i++) { 241 int irq = irq_of_parse_and_map(np, i); 242 if (request_irq(irq, ints[i], 0, dev->rnames[i], dev)) 243 goto err; 244 dev->interrupts[i] = irq; 245 } 246 247 248 /* Resource handling is problematic as some device-trees contain 249 * useless crap (ugh ugh ugh). We work around that here by calling 250 * specific functions for calculating the appropriate resources. 251 * 252 * This will all be moved to macio_asic.c at one point 253 */ 254 for (i = aoa_resource_i2smmio; i <= aoa_resource_rxdbdma; i++) { 255 if (i2sbus_get_and_fixup_rsrc(np,i,layout,&dev->resources[i])) 256 goto err; 257 /* If only we could use our resource dev->resources[i]... 258 * but request_resource doesn't know about parents and 259 * contained resources... 260 */ 261 dev->allocated_resource[i] = 262 request_mem_region(dev->resources[i].start, 263 resource_size(&dev->resources[i]), 264 dev->rnames[i]); 265 if (!dev->allocated_resource[i]) { 266 printk(KERN_ERR "i2sbus: failed to claim resource %d!\n", i); 267 goto err; 268 } 269 } 270 271 r = &dev->resources[aoa_resource_i2smmio]; 272 rlen = resource_size(r); 273 if (rlen < sizeof(struct i2s_interface_regs)) 274 goto err; 275 dev->intfregs = ioremap(r->start, rlen); 276 277 r = &dev->resources[aoa_resource_txdbdma]; 278 rlen = resource_size(r); 279 if (rlen < sizeof(struct dbdma_regs)) 280 goto err; 281 dev->out.dbdma = ioremap(r->start, rlen); 282 283 r = &dev->resources[aoa_resource_rxdbdma]; 284 rlen = resource_size(r); 285 if (rlen < sizeof(struct dbdma_regs)) 286 goto err; 287 dev->in.dbdma = ioremap(r->start, rlen); 288 289 if (!dev->intfregs || !dev->out.dbdma || !dev->in.dbdma) 290 goto err; 291 292 if (alloc_dbdma_descriptor_ring(dev, &dev->out.dbdma_ring, 293 MAX_DBDMA_COMMANDS)) 294 goto err; 295 if (alloc_dbdma_descriptor_ring(dev, &dev->in.dbdma_ring, 296 MAX_DBDMA_COMMANDS)) 297 goto err; 298 299 if (i2sbus_control_add_dev(dev->control, dev)) { 300 printk(KERN_ERR "i2sbus: control layer didn't like bus\n"); 301 goto err; 302 } 303 304 if (soundbus_add_one(&dev->sound)) { 305 printk(KERN_DEBUG "i2sbus: device registration error!\n"); 306 goto err; 307 } 308 309 /* enable this cell */ 310 i2sbus_control_cell(dev->control, dev, 1); 311 i2sbus_control_enable(dev->control, dev); 312 i2sbus_control_clock(dev->control, dev, 1); 313 314 return 1; 315 err: 316 for (i=0;i<3;i++) 317 if (dev->interrupts[i] != -1) 318 free_irq(dev->interrupts[i], dev); 319 free_dbdma_descriptor_ring(dev, &dev->out.dbdma_ring); 320 free_dbdma_descriptor_ring(dev, &dev->in.dbdma_ring); 321 iounmap(dev->intfregs); 322 iounmap(dev->out.dbdma); 323 iounmap(dev->in.dbdma); 324 for (i=0;i<3;i++) 325 release_and_free_resource(dev->allocated_resource[i]); 326 mutex_destroy(&dev->lock); 327 kfree(dev); 328 return 0; 329 } 330 331 static int i2sbus_probe(struct macio_dev* dev, const struct of_device_id *match) 332 { 333 struct device_node *np = NULL; 334 int got = 0, err; 335 struct i2sbus_control *control = NULL; 336 337 err = i2sbus_control_init(dev, &control); 338 if (err) 339 return err; 340 if (!control) { 341 printk(KERN_ERR "i2sbus_control_init API breakage\n"); 342 return -ENODEV; 343 } 344 345 while ((np = of_get_next_child(dev->ofdev.dev.of_node, np))) { 346 if (of_device_is_compatible(np, "i2sbus") || 347 of_device_is_compatible(np, "i2s-modem")) { 348 got += i2sbus_add_dev(dev, control, np); 349 } 350 } 351 352 if (!got) { 353 /* found none, clean up */ 354 i2sbus_control_destroy(control); 355 return -ENODEV; 356 } 357 358 dev_set_drvdata(&dev->ofdev.dev, control); 359 360 return 0; 361 } 362 363 static int i2sbus_remove(struct macio_dev* dev) 364 { 365 struct i2sbus_control *control = dev_get_drvdata(&dev->ofdev.dev); 366 struct i2sbus_dev *i2sdev, *tmp; 367 368 list_for_each_entry_safe(i2sdev, tmp, &control->list, item) 369 soundbus_remove_one(&i2sdev->sound); 370 371 return 0; 372 } 373 374 #ifdef CONFIG_PM 375 static int i2sbus_suspend(struct macio_dev* dev, pm_message_t state) 376 { 377 struct i2sbus_control *control = dev_get_drvdata(&dev->ofdev.dev); 378 struct codec_info_item *cii; 379 struct i2sbus_dev* i2sdev; 380 int err, ret = 0; 381 382 list_for_each_entry(i2sdev, &control->list, item) { 383 /* Notify codecs */ 384 list_for_each_entry(cii, &i2sdev->sound.codec_list, list) { 385 err = 0; 386 if (cii->codec->suspend) 387 err = cii->codec->suspend(cii, state); 388 if (err) 389 ret = err; 390 } 391 392 /* wait until streams are stopped */ 393 i2sbus_wait_for_stop_both(i2sdev); 394 } 395 396 return ret; 397 } 398 399 static int i2sbus_resume(struct macio_dev* dev) 400 { 401 struct i2sbus_control *control = dev_get_drvdata(&dev->ofdev.dev); 402 struct codec_info_item *cii; 403 struct i2sbus_dev* i2sdev; 404 int err, ret = 0; 405 406 list_for_each_entry(i2sdev, &control->list, item) { 407 /* reset i2s bus format etc. */ 408 i2sbus_pcm_prepare_both(i2sdev); 409 410 /* Notify codecs so they can re-initialize */ 411 list_for_each_entry(cii, &i2sdev->sound.codec_list, list) { 412 err = 0; 413 if (cii->codec->resume) 414 err = cii->codec->resume(cii); 415 if (err) 416 ret = err; 417 } 418 } 419 420 return ret; 421 } 422 #endif /* CONFIG_PM */ 423 424 static int i2sbus_shutdown(struct macio_dev* dev) 425 { 426 return 0; 427 } 428 429 static struct macio_driver i2sbus_drv = { 430 .driver = { 431 .name = "soundbus-i2s", 432 .owner = THIS_MODULE, 433 .of_match_table = i2sbus_match, 434 }, 435 .probe = i2sbus_probe, 436 .remove = i2sbus_remove, 437 #ifdef CONFIG_PM 438 .suspend = i2sbus_suspend, 439 .resume = i2sbus_resume, 440 #endif 441 .shutdown = i2sbus_shutdown, 442 }; 443 444 static int __init soundbus_i2sbus_init(void) 445 { 446 return macio_register_driver(&i2sbus_drv); 447 } 448 449 static void __exit soundbus_i2sbus_exit(void) 450 { 451 macio_unregister_driver(&i2sbus_drv); 452 } 453 454 module_init(soundbus_i2sbus_init); 455 module_exit(soundbus_i2sbus_exit); 456