int avmb1_detectcard(int port, int irq, int cardtype)
{
int rc;
if (!B1_valid_irq(irq, cardtype)) {
printk(KERN_WARNING "b1capi: irq %d not valid for %s-card.\n",
irq, cardtype2str(cardtype));
return -EIO;
}
if ((rc = B1_detect(port, cardtype)) != 0) {
printk(KERN_NOTICE "b1capi: NO %s-card at 0x%x (%d)\n",
cardtype2str(cardtype), port, rc);
return -EIO;
}
B1_reset(port);
switch (cardtype) {
default:
case AVM_CARDTYPE_M1:
case AVM_CARDTYPE_M2:
case AVM_CARDTYPE_B1:
printk(KERN_NOTICE "b1capi: AVM-%s-Controller detected at 0x%x\n", cardtype2str(cardtype), port);
break;
case AVM_CARDTYPE_T1:
printk(KERN_NOTICE "b1capi: AVM-%s-Controller may be at 0x%x\n", cardtype2str(cardtype), port);
break;
}
return 0;
}
int avmb1_probecard(int port, int irq)
{
int rc;
if (check_region((unsigned short) port, AVMB1_PORTLEN)) {
printk(KERN_WARNING
"b1capi: ports 0x%03x-0x%03x in use.\n",
portbase, portbase + AVMB1_PORTLEN);
return -EIO;
}
if (!B1_valid_irq(irq)) {
printk(KERN_WARNING "b1capi: irq %d not valid.\n", irq);
return -EIO;
}
if ((rc = B1_detect(port)) != 0) {
printk(KERN_NOTICE "b1capi: NO card at 0x%x (%d)\n", port, rc);
return -EIO;
}
B1_reset(port);
printk(KERN_NOTICE "b1capi: AVM-B1-Controller detected at 0x%x\n", port);
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;
}
