1 /* $Id: mntfunc.c,v 1.19 2004/01/09 21:22:03 armin Exp $
3 * Driver for Eicon DIVA Server ISDN cards.
6 * Copyright 2000-2003 by Armin Schindler (mac@melware.de)
7 * Copyright 2000-2003 Cytronics & Melware (info@melware.de)
9 * This software may be used and distributed according to the terms
10 * of the GNU General Public License, incorporated herein by reference.
19 extern char *DRIVERRELEASE_MNT;
21 #define DBG_MINIMUM (DL_LOG + DL_FTL + DL_ERR)
22 #define DBG_DEFAULT (DBG_MINIMUM + DL_XLOG + DL_REG)
24 extern void DIVA_DIDD_Read(void *, int);
26 #define MAX_DESCRIPTORS 32
28 static dword notify_handle;
29 static DESCRIPTOR DAdapter;
30 static DESCRIPTOR MAdapter;
31 static DESCRIPTOR MaintDescriptor =
32 { IDI_DIMAINT, 0, 0, (IDI_CALL) diva_maint_prtComp };
34 extern void *diva_os_malloc_tbuffer(unsigned long flags,
36 extern void diva_os_free_tbuffer(unsigned long flags, void *ptr);
37 extern int diva_os_copy_to_user(void *os_handle, void __user *dst,
38 const void *src, int length);
39 extern int diva_os_copy_from_user(void *os_handle, void *dst,
40 const void __user *src, int length);
42 static void no_printf(unsigned char *x, ...)
44 /* dummy debug function */
52 static void stop_dbg(void)
55 memset(&MAdapter, 0, sizeof(MAdapter));
60 * DIDD callback function
62 static void *didd_callback(void *context, DESCRIPTOR * adapter,
65 if (adapter->type == IDI_DADAPTER) {
66 DBG_ERR(("cb: Change in DAdapter ? Oops ?."));
67 } else if (adapter->type == IDI_DIMAINT) {
71 memcpy(&MAdapter, adapter, sizeof(MAdapter));
72 dprintf = (DIVA_DI_PRINTF) MAdapter.request;
73 DbgRegister("MAINT", DRIVERRELEASE_MNT, DBG_DEFAULT);
75 } else if ((adapter->type > 0) && (adapter->type < 16)) {
77 diva_mnt_remove_xdi_adapter(adapter);
79 diva_mnt_add_xdi_adapter(adapter);
88 static int DIVA_INIT_FUNCTION connect_didd(void)
93 DESCRIPTOR DIDD_Table[MAX_DESCRIPTORS];
95 DIVA_DIDD_Read(DIDD_Table, sizeof(DIDD_Table));
97 for (x = 0; x < MAX_DESCRIPTORS; x++) {
98 if (DIDD_Table[x].type == IDI_DADAPTER) { /* DADAPTER found */
100 memcpy(&DAdapter, &DIDD_Table[x], sizeof(DAdapter));
101 req.didd_notify.e.Req = 0;
102 req.didd_notify.e.Rc =
103 IDI_SYNC_REQ_DIDD_REGISTER_ADAPTER_NOTIFY;
104 req.didd_notify.info.callback = (void *)didd_callback;
105 req.didd_notify.info.context = NULL;
106 DAdapter.request((ENTITY *) & req);
107 if (req.didd_notify.e.Rc != 0xff)
109 notify_handle = req.didd_notify.info.handle;
110 /* Register MAINT (me) */
111 req.didd_add_adapter.e.Req = 0;
112 req.didd_add_adapter.e.Rc =
113 IDI_SYNC_REQ_DIDD_ADD_ADAPTER;
114 req.didd_add_adapter.info.descriptor =
115 (void *) &MaintDescriptor;
116 DAdapter.request((ENTITY *) & req);
117 if (req.didd_add_adapter.e.Rc != 0xff)
119 } else if ((DIDD_Table[x].type > 0)
120 && (DIDD_Table[x].type < 16)) {
121 diva_mnt_add_xdi_adapter(&DIDD_Table[x]);
128 * disconnect from didd
130 static void DIVA_EXIT_FUNCTION disconnect_didd(void)
136 req.didd_notify.e.Req = 0;
137 req.didd_notify.e.Rc = IDI_SYNC_REQ_DIDD_REMOVE_ADAPTER_NOTIFY;
138 req.didd_notify.info.handle = notify_handle;
139 DAdapter.request((ENTITY *) & req);
141 req.didd_remove_adapter.e.Req = 0;
142 req.didd_remove_adapter.e.Rc = IDI_SYNC_REQ_DIDD_REMOVE_ADAPTER;
143 req.didd_remove_adapter.info.p_request =
144 (IDI_CALL) MaintDescriptor.request;
145 DAdapter.request((ENTITY *) & req);
151 int maint_read_write(void __user *buf, int count)
157 if (count < (3 * sizeof(dword)))
160 if (diva_os_copy_from_user(NULL, (void *) &data[0],
161 buf, 3 * sizeof(dword))) {
165 cmd = *(dword *) & data[0]; /* command */
166 id = *(dword *) & data[4]; /* driver id */
167 mask = *(dword *) & data[8]; /* mask or size */
170 case DITRACE_CMD_GET_DRIVER_INFO:
171 if ((ret = diva_get_driver_info(id, data, sizeof(data))) > 0) {
172 if ((count < ret) || diva_os_copy_to_user
173 (NULL, buf, (void *) &data[0], ret))
180 case DITRACE_READ_DRIVER_DBG_MASK:
181 if ((ret = diva_get_driver_dbg_mask(id, (byte *) data)) > 0) {
182 if ((count < ret) || diva_os_copy_to_user
183 (NULL, buf, (void *) &data[0], ret))
190 case DITRACE_WRITE_DRIVER_DBG_MASK:
191 if ((ret = diva_set_driver_dbg_mask(id, mask)) <= 0) {
196 case DITRACE_READ_TRACE_ENTRY:{
197 diva_os_spin_lock_magic_t old_irql;
199 diva_dbg_entry_head_t *pmsg;
202 if ((pmsg = diva_maint_get_message(&size, &old_irql))) {
204 diva_maint_ack_message(0, &old_irql);
207 if (!(pbuf = diva_os_malloc_tbuffer(0, size)))
209 diva_maint_ack_message(0, &old_irql);
213 memcpy(pbuf, pmsg, size);
214 diva_maint_ack_message(1, &old_irql);
215 if ((count < size) || diva_os_copy_to_user (NULL, buf,
216 (void *) pbuf, size))
218 diva_os_free_tbuffer(0, pbuf);
227 case DITRACE_READ_TRACE_ENTRYS:{
228 diva_os_spin_lock_magic_t old_irql;
230 diva_dbg_entry_head_t *pmsg;
238 if (!(pbuf = diva_os_malloc_tbuffer(0, mask))) {
244 diva_maint_get_message(&size, &old_irql))) {
247 if ((size + 8) > mask) {
248 diva_maint_ack_message(0, &old_irql);
254 pbuf[written++] = (byte) size;
255 pbuf[written++] = (byte) (size >> 8);
261 memcpy(&pbuf[written], pmsg, size);
262 diva_maint_ack_message(1, &old_irql);
271 if ((count < written) || diva_os_copy_to_user(NULL, buf, (void *) pbuf, written)) {
276 diva_os_free_tbuffer(0, pbuf);
289 int DIVA_INIT_FUNCTION mntfunc_init(int *buffer_length, void **buffer,
290 unsigned long diva_dbg_mem)
292 if (*buffer_length < 64) {
295 if (*buffer_length > 512) {
296 *buffer_length = 512;
298 *buffer_length *= 1024;
301 *buffer = (void *) diva_dbg_mem;
303 while ((*buffer_length >= (64 * 1024))
305 (!(*buffer = diva_os_malloc_tbuffer(0, *buffer_length)))) {
306 *buffer_length -= 1024;
310 DBG_ERR(("init: Can not alloc trace buffer"));
315 if (diva_maint_init(*buffer, *buffer_length, (diva_dbg_mem == 0))) {
317 diva_os_free_tbuffer(0, *buffer);
319 DBG_ERR(("init: maint init failed"));
323 if (!connect_didd()) {
324 DBG_ERR(("init: failed to connect to DIDD."));
327 diva_os_free_tbuffer(0, *buffer);
337 void DIVA_EXIT_FUNCTION mntfunc_finit(void)
342 while (diva_mnt_shutdown_xdi_adapters() && i--) {
348 if ((buffer = diva_maint_finit())) {
349 diva_os_free_tbuffer(0, buffer);