int avmb1_unregistercard(int cnr, int freeio)
{
avmb1_card * card;
if (!VALID_CARD(cnr))
return -ESRCH;
card = CARD(cnr);
if (card->cardstate == CARD_FREE)
return -ESRCH;
if (card->cardstate == CARD_RUNNING)
avmb1_card_down(card, freeio);
free_irq(card->irq, card);
if (freeio)
release_region(card->port, AVMB1_PORTLEN);
card->cardstate = CARD_FREE;
return 0;
}
int avmb1_resetcard(int cnr)
{
avmb1_card * card;
if (!VALID_CARD(cnr))
return -ESRCH;
card = CARD(cnr);
if (card->cardstate == CARD_FREE)
return -ESRCH;
if (card->cardstate == CARD_RUNNING)
avmb1_card_down(card, 0);
B1_reset(card->port);
B1_reset(card->port);
card->cardstate = CARD_DETECTED;
return 0;
}
static int capi_manufacturer(unsigned int cmd, void *data)
{
unsigned long flags;
avmb1_loaddef ldef;
avmb1_carddef cdef;
avmb1_resetdef rdef;
avmb1_card *card;
int rc;
switch (cmd) {
case AVMB1_ADDCARD:
if ((rc = copy_from_user((void *) &cdef, data,
sizeof(avmb1_carddef))))
return rc;
if (!B1_valid_irq(cdef.irq))
return -EINVAL;
if ((rc = avmb1_probecard(cdef.port, cdef.irq)) != 0)
return rc;
return avmb1_addcard(cdef.port, cdef.irq);
case AVMB1_LOAD:
if ((rc = copy_from_user((void *) &ldef, data,
sizeof(avmb1_loaddef))))
return rc;
if (!VALID_CARD(ldef.contr) || ldef.t4file.len <= 0) {
if (loaddebug)
printk(KERN_DEBUG "b1capi: load: invalid parameter contr=%d len=%d\n", ldef.contr, ldef.t4file.len);
return -EINVAL;
}
card = CARD(ldef.contr);
save_flags(flags);
cli();
if (card->cardstate != CARD_DETECTED) {
restore_flags(flags);
if (loaddebug)
printk(KERN_DEBUG "b1capi: load: contr=%d not in detect state\n", ldef.contr);
return -EBUSY;
}
card->cardstate = CARD_LOADING;
restore_flags(flags);
if (loaddebug) {
printk(KERN_DEBUG "b1capi: load: reseting contr %d\n",
ldef.contr);
}
B1_reset(card->port);
if ((rc = B1_load_t4file(card->port, &ldef.t4file))) {
B1_reset(card->port);
printk(KERN_ERR "b1capi: failed to load t4file!!\n");
card->cardstate = CARD_DETECTED;
return rc;
}
B1_disable_irq(card->port);
if (loaddebug) {
printk(KERN_DEBUG "b1capi: load: ready contr %d: checking\n",
ldef.contr);
}
if (!B1_loaded(card->port)) {
card->cardstate = CARD_DETECTED;
printk(KERN_ERR "b1capi: failed to load t4file.\n");
return -EIO;
}
/*
* enable interrupt
*/
card->cardstate = CARD_INITSTATE;
save_flags(flags);
cli();
B1_assign_irq(card->port, card->irq);
B1_enable_irq(card->port);
restore_flags(flags);
if (loaddebug) {
printk(KERN_DEBUG "b1capi: load: irq enabled contr %d\n",
ldef.contr);
}
/*
* init card
*/
B1_send_init(card->port, AVM_NAPPS, AVM_NNCCI, card->cnr - 1);
if (loaddebug) {
printk(KERN_DEBUG "b1capi: load: waiting for init reply contr %d\n",
ldef.contr);
}
while (card->cardstate != CARD_RUNNING) {
current->timeout = jiffies + HZ / 10; /* 0.1 sec */
current->state = TASK_INTERRUPTIBLE;
schedule();
if (current->signal & ~current->blocked)
return -EINTR;
}
return 0;
case AVMB1_RESETCARD:
if ((rc = copy_from_user((void *) &rdef, data,
sizeof(avmb1_resetdef))))
return rc;
if (!VALID_CARD(rdef.contr))
return -EINVAL;
card = CARD(rdef.contr);
if (card->cardstate == CARD_RUNNING)
avmb1_card_down(card);
card->cardstate = CARD_DETECTED;
B1_reset(card->port);
B1_reset(card->port);
return 0;
}
return -EINVAL;
}
