forked from luck/tmp_suning_uos_patched
268 lines
6.3 KiB
C
268 lines
6.3 KiB
C
|
/* $Id: idifunc.c,v 1.14.4.4 2004/08/28 20:03:53 armin Exp $
|
||
|
*
|
||
|
* Driver for Eicon DIVA Server ISDN cards.
|
||
|
* User Mode IDI Interface
|
||
|
*
|
||
|
* Copyright 2000-2003 by Armin Schindler (mac@melware.de)
|
||
|
* Copyright 2000-2003 Cytronics & Melware (info@melware.de)
|
||
|
*
|
||
|
* This software may be used and distributed according to the terms
|
||
|
* of the GNU General Public License, incorporated herein by reference.
|
||
|
*/
|
||
|
|
||
|
#include "platform.h"
|
||
|
#include "di_defs.h"
|
||
|
#include "divasync.h"
|
||
|
#include "um_xdi.h"
|
||
|
#include "um_idi.h"
|
||
|
|
||
|
#define DBG_MINIMUM (DL_LOG + DL_FTL + DL_ERR)
|
||
|
#define DBG_DEFAULT (DBG_MINIMUM + DL_XLOG + DL_REG)
|
||
|
|
||
|
extern char *DRIVERRELEASE_IDI;
|
||
|
|
||
|
extern void DIVA_DIDD_Read(void *, int);
|
||
|
extern int diva_user_mode_idi_create_adapter(const DESCRIPTOR *, int);
|
||
|
extern void diva_user_mode_idi_remove_adapter(int);
|
||
|
|
||
|
static dword notify_handle;
|
||
|
static DESCRIPTOR DAdapter;
|
||
|
static DESCRIPTOR MAdapter;
|
||
|
|
||
|
static void no_printf(unsigned char *x, ...)
|
||
|
{
|
||
|
/* dummy debug function */
|
||
|
}
|
||
|
|
||
|
#include "debuglib.c"
|
||
|
|
||
|
/*
|
||
|
* stop debug
|
||
|
*/
|
||
|
static void stop_dbg(void)
|
||
|
{
|
||
|
DbgDeregister();
|
||
|
memset(&MAdapter, 0, sizeof(MAdapter));
|
||
|
dprintf = no_printf;
|
||
|
}
|
||
|
|
||
|
typedef struct _udiva_card {
|
||
|
struct list_head list;
|
||
|
int Id;
|
||
|
DESCRIPTOR d;
|
||
|
} udiva_card;
|
||
|
|
||
|
static LIST_HEAD(cards);
|
||
|
static diva_os_spin_lock_t ll_lock;
|
||
|
|
||
|
/*
|
||
|
* find card in list
|
||
|
*/
|
||
|
static udiva_card *find_card_in_list(DESCRIPTOR * d)
|
||
|
{
|
||
|
udiva_card *card;
|
||
|
struct list_head *tmp;
|
||
|
diva_os_spin_lock_magic_t old_irql;
|
||
|
|
||
|
diva_os_enter_spin_lock(&ll_lock, &old_irql, "find card");
|
||
|
list_for_each(tmp, &cards) {
|
||
|
card = list_entry(tmp, udiva_card, list);
|
||
|
if (card->d.request == d->request) {
|
||
|
diva_os_leave_spin_lock(&ll_lock, &old_irql,
|
||
|
"find card");
|
||
|
return (card);
|
||
|
}
|
||
|
}
|
||
|
diva_os_leave_spin_lock(&ll_lock, &old_irql, "find card");
|
||
|
return ((udiva_card *) NULL);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* new card
|
||
|
*/
|
||
|
static void um_new_card(DESCRIPTOR * d)
|
||
|
{
|
||
|
int adapter_nr = 0;
|
||
|
udiva_card *card = NULL;
|
||
|
IDI_SYNC_REQ sync_req;
|
||
|
diva_os_spin_lock_magic_t old_irql;
|
||
|
|
||
|
if (!(card = diva_os_malloc(0, sizeof(udiva_card)))) {
|
||
|
DBG_ERR(("cannot get buffer for card"));
|
||
|
return;
|
||
|
}
|
||
|
memcpy(&card->d, d, sizeof(DESCRIPTOR));
|
||
|
sync_req.xdi_logical_adapter_number.Req = 0;
|
||
|
sync_req.xdi_logical_adapter_number.Rc =
|
||
|
IDI_SYNC_REQ_XDI_GET_LOGICAL_ADAPTER_NUMBER;
|
||
|
card->d.request((ENTITY *) & sync_req);
|
||
|
adapter_nr =
|
||
|
sync_req.xdi_logical_adapter_number.info.logical_adapter_number;
|
||
|
card->Id = adapter_nr;
|
||
|
if (!(diva_user_mode_idi_create_adapter(d, adapter_nr))) {
|
||
|
diva_os_enter_spin_lock(&ll_lock, &old_irql, "add card");
|
||
|
list_add_tail(&card->list, &cards);
|
||
|
diva_os_leave_spin_lock(&ll_lock, &old_irql, "add card");
|
||
|
} else {
|
||
|
DBG_ERR(("could not create user mode idi card %d",
|
||
|
adapter_nr));
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* remove card
|
||
|
*/
|
||
|
static void um_remove_card(DESCRIPTOR * d)
|
||
|
{
|
||
|
diva_os_spin_lock_magic_t old_irql;
|
||
|
udiva_card *card = NULL;
|
||
|
|
||
|
if (!(card = find_card_in_list(d))) {
|
||
|
DBG_ERR(("cannot find card to remove"));
|
||
|
return;
|
||
|
}
|
||
|
diva_user_mode_idi_remove_adapter(card->Id);
|
||
|
diva_os_enter_spin_lock(&ll_lock, &old_irql, "remove card");
|
||
|
list_del(&card->list);
|
||
|
diva_os_leave_spin_lock(&ll_lock, &old_irql, "remove card");
|
||
|
DBG_LOG(("idi proc entry removed for card %d", card->Id));
|
||
|
diva_os_free(0, card);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* remove all adapter
|
||
|
*/
|
||
|
static void DIVA_EXIT_FUNCTION remove_all_idi_proc(void)
|
||
|
{
|
||
|
udiva_card *card;
|
||
|
diva_os_spin_lock_magic_t old_irql;
|
||
|
|
||
|
rescan:
|
||
|
diva_os_enter_spin_lock(&ll_lock, &old_irql, "remove all");
|
||
|
if (!list_empty(&cards)) {
|
||
|
card = list_entry(cards.next, udiva_card, list);
|
||
|
list_del(&card->list);
|
||
|
diva_os_leave_spin_lock(&ll_lock, &old_irql, "remove all");
|
||
|
diva_user_mode_idi_remove_adapter(card->Id);
|
||
|
diva_os_free(0, card);
|
||
|
goto rescan;
|
||
|
}
|
||
|
diva_os_leave_spin_lock(&ll_lock, &old_irql, "remove all");
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* DIDD notify callback
|
||
|
*/
|
||
|
static void *didd_callback(void *context, DESCRIPTOR * adapter,
|
||
|
int removal)
|
||
|
{
|
||
|
if (adapter->type == IDI_DADAPTER) {
|
||
|
DBG_ERR(("Notification about IDI_DADAPTER change ! Oops."));
|
||
|
return (NULL);
|
||
|
} else if (adapter->type == IDI_DIMAINT) {
|
||
|
if (removal) {
|
||
|
stop_dbg();
|
||
|
} else {
|
||
|
memcpy(&MAdapter, adapter, sizeof(MAdapter));
|
||
|
dprintf = (DIVA_DI_PRINTF) MAdapter.request;
|
||
|
DbgRegister("User IDI", DRIVERRELEASE_IDI, DBG_DEFAULT);
|
||
|
}
|
||
|
} else if ((adapter->type > 0) && (adapter->type < 16)) { /* IDI Adapter */
|
||
|
if (removal) {
|
||
|
um_remove_card(adapter);
|
||
|
} else {
|
||
|
um_new_card(adapter);
|
||
|
}
|
||
|
}
|
||
|
return (NULL);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* connect DIDD
|
||
|
*/
|
||
|
static int DIVA_INIT_FUNCTION connect_didd(void)
|
||
|
{
|
||
|
int x = 0;
|
||
|
int dadapter = 0;
|
||
|
IDI_SYNC_REQ req;
|
||
|
DESCRIPTOR DIDD_Table[MAX_DESCRIPTORS];
|
||
|
|
||
|
DIVA_DIDD_Read(DIDD_Table, sizeof(DIDD_Table));
|
||
|
|
||
|
for (x = 0; x < MAX_DESCRIPTORS; x++) {
|
||
|
if (DIDD_Table[x].type == IDI_DADAPTER) { /* DADAPTER found */
|
||
|
dadapter = 1;
|
||
|
memcpy(&DAdapter, &DIDD_Table[x], sizeof(DAdapter));
|
||
|
req.didd_notify.e.Req = 0;
|
||
|
req.didd_notify.e.Rc =
|
||
|
IDI_SYNC_REQ_DIDD_REGISTER_ADAPTER_NOTIFY;
|
||
|
req.didd_notify.info.callback = (void *)didd_callback;
|
||
|
req.didd_notify.info.context = NULL;
|
||
|
DAdapter.request((ENTITY *) & req);
|
||
|
if (req.didd_notify.e.Rc != 0xff) {
|
||
|
stop_dbg();
|
||
|
return (0);
|
||
|
}
|
||
|
notify_handle = req.didd_notify.info.handle;
|
||
|
} else if (DIDD_Table[x].type == IDI_DIMAINT) { /* MAINT found */
|
||
|
memcpy(&MAdapter, &DIDD_Table[x], sizeof(DAdapter));
|
||
|
dprintf = (DIVA_DI_PRINTF) MAdapter.request;
|
||
|
DbgRegister("User IDI", DRIVERRELEASE_IDI, DBG_DEFAULT);
|
||
|
} else if ((DIDD_Table[x].type > 0)
|
||
|
&& (DIDD_Table[x].type < 16)) { /* IDI Adapter found */
|
||
|
um_new_card(&DIDD_Table[x]);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (!dadapter) {
|
||
|
stop_dbg();
|
||
|
}
|
||
|
|
||
|
return (dadapter);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* Disconnect from DIDD
|
||
|
*/
|
||
|
static void DIVA_EXIT_FUNCTION disconnect_didd(void)
|
||
|
{
|
||
|
IDI_SYNC_REQ req;
|
||
|
|
||
|
stop_dbg();
|
||
|
|
||
|
req.didd_notify.e.Req = 0;
|
||
|
req.didd_notify.e.Rc = IDI_SYNC_REQ_DIDD_REMOVE_ADAPTER_NOTIFY;
|
||
|
req.didd_notify.info.handle = notify_handle;
|
||
|
DAdapter.request((ENTITY *) & req);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* init
|
||
|
*/
|
||
|
int DIVA_INIT_FUNCTION idifunc_init(void)
|
||
|
{
|
||
|
diva_os_initialize_spin_lock(&ll_lock, "idifunc");
|
||
|
|
||
|
if (diva_user_mode_idi_init()) {
|
||
|
DBG_ERR(("init: init failed."));
|
||
|
return (0);
|
||
|
}
|
||
|
|
||
|
if (!connect_didd()) {
|
||
|
diva_user_mode_idi_finit();
|
||
|
DBG_ERR(("init: failed to connect to DIDD."));
|
||
|
return (0);
|
||
|
}
|
||
|
return (1);
|
||
|
}
|
||
|
|
||
|
/*
|
||
|
* finit
|
||
|
*/
|
||
|
void DIVA_EXIT_FUNCTION idifunc_finit(void)
|
||
|
{
|
||
|
diva_user_mode_idi_finit();
|
||
|
disconnect_didd();
|
||
|
remove_all_idi_proc();
|
||
|
}
|