static void release_card(struct w6692_hw *card) { u_long flags; spin_lock_irqsave(&card->lock, flags); disable_hwirq(card); w6692_mode(&card->bc[0], ISDN_P_NONE); w6692_mode(&card->bc[1], ISDN_P_NONE); if ((card->fmask & led) || card->subtype == W6692_USR) { card->xdata |= 0x04; WriteW6692(card, W_XDATA, card->xdata); } spin_unlock_irqrestore(&card->lock, flags); free_irq(card->irq, card); l1_event(card->dch.l1, CLOSE_CHANNEL); mISDN_unregister_device(&card->dch.dev); release_region(card->addr, 256); mISDN_freebchannel(&card->bc[1].bch); mISDN_freebchannel(&card->bc[0].bch); mISDN_freedchannel(&card->dch); write_lock_irqsave(&card_lock, flags); list_del(&card->list); write_unlock_irqrestore(&card_lock, flags); pci_disable_device(card->pdev); pci_set_drvdata(card->pdev, NULL); kfree(card); }
static int isar_bctrl(struct mISDNchannel *ch, u32 cmd, void *arg) { struct bchannel *bch = container_of(ch, struct bchannel, ch); struct isar_ch *ich = container_of(bch, struct isar_ch, bch); int ret = -EINVAL; u_long flags; pr_debug("%s: %s cmd:%x %p\n", ich->is->name, __func__, cmd, arg); switch (cmd) { case CLOSE_CHANNEL: test_and_clear_bit(FLG_OPEN, &bch->Flags); if (test_bit(FLG_ACTIVE, &bch->Flags)) { spin_lock_irqsave(ich->is->hwlock, flags); mISDN_freebchannel(bch); modeisar(ich, ISDN_P_NONE); spin_unlock_irqrestore(ich->is->hwlock, flags); } else { skb_queue_purge(&bch->rqueue); bch->rcount = 0; } ch->protocol = ISDN_P_NONE; ch->peer = NULL; module_put(ich->is->owner); ret = 0; break; case CONTROL_CHANNEL: ret = channel_bctrl(bch, arg); break; default: pr_info("%s: %s unknown prim(%x)\n", ich->is->name, __func__, cmd); } return ret; }
static int setup_instance(struct w6692_hw *card) { int i, err; u_long flags; snprintf(card->name, MISDN_MAX_IDLEN - 1, "w6692.%d", w6692_cnt + 1); write_lock_irqsave(&card_lock, flags); list_add_tail(&card->list, &Cards); write_unlock_irqrestore(&card_lock, flags); card->fmask = (1 << w6692_cnt); _set_debug(card); spin_lock_init(&card->lock); mISDN_initdchannel(&card->dch, MAX_DFRAME_LEN_L1, W6692_ph_bh); card->dch.dev.Dprotocols = (1 << ISDN_P_TE_S0); card->dch.dev.D.send = w6692_l2l1D; card->dch.dev.D.ctrl = w6692_dctrl; card->dch.dev.Bprotocols = (1 << (ISDN_P_B_RAW & ISDN_P_B_MASK)) | (1 << (ISDN_P_B_HDLC & ISDN_P_B_MASK)); card->dch.hw = card; card->dch.dev.nrbchan = 2; for (i = 0; i < 2; i++) { mISDN_initbchannel(&card->bc[i].bch, MAX_DATA_MEM); card->bc[i].bch.hw = card; card->bc[i].bch.nr = i + 1; card->bc[i].bch.ch.nr = i + 1; card->bc[i].bch.ch.send = w6692_l2l1B; card->bc[i].bch.ch.ctrl = w6692_bctrl; set_channelmap(i + 1, card->dch.dev.channelmap); list_add(&card->bc[i].bch.ch.list, &card->dch.dev.bchannels); } err = setup_w6692(card); if (err) goto error_setup; err = mISDN_register_device(&card->dch.dev, &card->pdev->dev, card->name); if (err) goto error_reg; err = init_card(card); if (err) goto error_init; err = create_l1(&card->dch, w6692_l1callback); if (!err) { w6692_cnt++; pr_notice("W6692 %d cards installed\n", w6692_cnt); return 0; } free_irq(card->irq, card); error_init: mISDN_unregister_device(&card->dch.dev); error_reg: release_region(card->addr, 256); error_setup: mISDN_freebchannel(&card->bc[1].bch); mISDN_freebchannel(&card->bc[0].bch); mISDN_freedchannel(&card->dch); write_lock_irqsave(&card_lock, flags); list_del(&card->list); write_unlock_irqrestore(&card_lock, flags); kfree(card); return err; }