2 * Stuff used by all variants of the driver
4 * Copyright (c) 2001 by Stefan Eilers,
5 * Hansjoerg Lipp <hjlipp@web.de>,
6 * Tilman Schmidt <tilman@imap.cc>.
8 * =====================================================================
9 * This program is free software; you can redistribute it and/or
10 * modify it under the terms of the GNU General Public License as
11 * published by the Free Software Foundation; either version 2 of
12 * the License, or (at your option) any later version.
13 * =====================================================================
18 /* == Handling of I4L IO =====================================================*/
21 * called by LL to transmit data on an open channel
22 * inserts the buffer data into the send queue and starts the transmission
23 * Note that this operation must not sleep!
24 * When the buffer is processed completely, gigaset_skb_sent() should be called.
26 * driverID driver ID as assigned by LL
27 * channel channel number
28 * ack if != 0 LL wants to be notified on completion via
29 * statcallb(ISDN_STAT_BSENT)
30 * skb skb containing data to send
32 * number of accepted bytes
33 * 0 if temporarily unable to accept data (out of buffer space)
34 * <0 on error (eg. -EINVAL)
36 static int writebuf_from_LL(int driverID
, int channel
, int ack
,
44 if (!(cs
= gigaset_get_cs_by_id(driverID
))) {
45 err("%s: invalid driver ID (%d)", __func__
, driverID
);
48 if (channel
< 0 || channel
>= cs
->channels
) {
49 err("%s: invalid channel ID (%d)", __func__
, channel
);
52 bcs
= &cs
->bcs
[channel
];
56 "Receiving data from LL (id: %d, ch: %d, ack: %d, sz: %d)",
57 driverID
, channel
, ack
, len
);
61 notice("%s: not ACKing empty packet", __func__
);
64 if (len
> MAX_BUF_SIZE
) {
65 err("%s: packet too large (%d bytes)", __func__
, len
);
69 skblen
= ack
? len
: 0;
70 skb
->head
[0] = skblen
& 0xff;
71 skb
->head
[1] = skblen
>> 8;
72 gig_dbg(DEBUG_MCMD
, "skb: len=%u, skblen=%u: %02x %02x",
73 len
, skblen
, (unsigned) skb
->head
[0], (unsigned) skb
->head
[1]);
75 /* pass to device-specific module */
76 return cs
->ops
->send_skb(bcs
, skb
);
79 void gigaset_skb_sent(struct bc_state
*bcs
, struct sk_buff
*skb
)
87 dev_warn(bcs
->cs
->dev
, "%s: skb->len==%d\n",
90 len
= (unsigned char) skb
->head
[0] |
91 (unsigned) (unsigned char) skb
->head
[1] << 8;
93 gig_dbg(DEBUG_MCMD
, "ACKing to LL (id: %d, ch: %d, sz: %u)",
94 bcs
->cs
->myid
, bcs
->channel
, len
);
96 response
.driver
= bcs
->cs
->myid
;
97 response
.command
= ISDN_STAT_BSENT
;
98 response
.arg
= bcs
->channel
;
99 response
.parm
.length
= len
;
100 bcs
->cs
->iif
.statcallb(&response
);
103 EXPORT_SYMBOL_GPL(gigaset_skb_sent
);
105 /* This function will be called by LL to send commands
106 * NOTE: LL ignores the returned value, for commands other than ISDN_CMD_IOCTL,
107 * so don't put too much effort into it.
109 static int command_from_LL(isdn_ctrl
*cntrl
)
111 struct cardstate
*cs
= gigaset_get_cs_by_id(cntrl
->driver
);
112 struct bc_state
*bcs
;
114 struct setup_parm
*sp
;
116 gigaset_debugdrivers();
119 warn("LL tried to access unknown device with nr. %d",
124 switch (cntrl
->command
) {
126 gig_dbg(DEBUG_ANY
, "ISDN_CMD_IOCTL (driver: %d, arg: %ld)",
127 cntrl
->driver
, cntrl
->arg
);
129 warn("ISDN_CMD_IOCTL is not supported.");
134 "ISDN_CMD_DIAL (driver: %d, ch: %ld, "
135 "phone: %s, ownmsn: %s, si1: %d, si2: %d)",
136 cntrl
->driver
, cntrl
->arg
,
137 cntrl
->parm
.setup
.phone
, cntrl
->parm
.setup
.eazmsn
,
138 cntrl
->parm
.setup
.si1
, cntrl
->parm
.setup
.si2
);
140 if (cntrl
->arg
>= cs
->channels
) {
141 err("ISDN_CMD_DIAL: invalid channel (%d)",
146 bcs
= cs
->bcs
+ cntrl
->arg
;
148 if (!gigaset_get_channel(bcs
)) {
149 err("ISDN_CMD_DIAL: channel not free");
153 sp
= kmalloc(sizeof *sp
, GFP_ATOMIC
);
155 gigaset_free_channel(bcs
);
156 err("ISDN_CMD_DIAL: out of memory");
159 *sp
= cntrl
->parm
.setup
;
161 if (!gigaset_add_event(cs
, &bcs
->at_state
, EV_DIAL
, sp
,
162 bcs
->at_state
.seq_index
, NULL
)) {
163 //FIXME what should we do?
165 gigaset_free_channel(bcs
);
169 gig_dbg(DEBUG_CMD
, "scheduling DIAL");
170 gigaset_schedule_event(cs
);
172 case ISDN_CMD_ACCEPTD
: //FIXME
173 gig_dbg(DEBUG_ANY
, "ISDN_CMD_ACCEPTD");
175 if (cntrl
->arg
>= cs
->channels
) {
176 err("ISDN_CMD_ACCEPTD: invalid channel (%d)",
181 if (!gigaset_add_event(cs
, &cs
->bcs
[cntrl
->arg
].at_state
,
182 EV_ACCEPT
, NULL
, 0, NULL
)) {
183 //FIXME what should we do?
187 gig_dbg(DEBUG_CMD
, "scheduling ACCEPT");
188 gigaset_schedule_event(cs
);
191 case ISDN_CMD_ACCEPTB
:
192 gig_dbg(DEBUG_ANY
, "ISDN_CMD_ACCEPTB");
194 case ISDN_CMD_HANGUP
:
195 gig_dbg(DEBUG_ANY
, "ISDN_CMD_HANGUP (ch: %d)",
198 if (cntrl
->arg
>= cs
->channels
) {
199 err("ISDN_CMD_HANGUP: invalid channel (%u)",
200 (unsigned) cntrl
->arg
);
204 if (!gigaset_add_event(cs
, &cs
->bcs
[cntrl
->arg
].at_state
,
205 EV_HUP
, NULL
, 0, NULL
)) {
206 //FIXME what should we do?
210 gig_dbg(DEBUG_CMD
, "scheduling HUP");
211 gigaset_schedule_event(cs
);
214 case ISDN_CMD_CLREAZ
: /* Do not signal incoming signals */ //FIXME
215 gig_dbg(DEBUG_ANY
, "ISDN_CMD_CLREAZ");
217 case ISDN_CMD_SETEAZ
: /* Signal incoming calls for given MSN */ //FIXME
219 "ISDN_CMD_SETEAZ (id: %d, ch: %ld, number: %s)",
220 cntrl
->driver
, cntrl
->arg
, cntrl
->parm
.num
);
222 case ISDN_CMD_SETL2
: /* Set L2 to given protocol */
223 gig_dbg(DEBUG_ANY
, "ISDN_CMD_SETL2 (ch: %ld, proto: %lx)",
224 cntrl
->arg
& 0xff, (cntrl
->arg
>> 8));
226 if ((cntrl
->arg
& 0xff) >= cs
->channels
) {
227 err("ISDN_CMD_SETL2: invalid channel (%u)",
228 (unsigned) cntrl
->arg
& 0xff);
232 if (!gigaset_add_event(cs
, &cs
->bcs
[cntrl
->arg
& 0xff].at_state
,
233 EV_PROTO_L2
, NULL
, cntrl
->arg
>> 8,
235 //FIXME what should we do?
239 gig_dbg(DEBUG_CMD
, "scheduling PROTO_L2");
240 gigaset_schedule_event(cs
);
242 case ISDN_CMD_SETL3
: /* Set L3 to given protocol */
243 gig_dbg(DEBUG_ANY
, "ISDN_CMD_SETL3 (ch: %ld, proto: %lx)",
244 cntrl
->arg
& 0xff, (cntrl
->arg
>> 8));
246 if ((cntrl
->arg
& 0xff) >= cs
->channels
) {
247 err("ISDN_CMD_SETL3: invalid channel (%u)",
248 (unsigned) cntrl
->arg
& 0xff);
252 if (cntrl
->arg
>> 8 != ISDN_PROTO_L3_TRANS
) {
253 err("ISDN_CMD_SETL3: invalid protocol %lu",
259 case ISDN_CMD_PROCEED
:
260 gig_dbg(DEBUG_ANY
, "ISDN_CMD_PROCEED"); //FIXME
263 gig_dbg(DEBUG_ANY
, "ISDN_CMD_ALERT"); //FIXME
264 if (cntrl
->arg
>= cs
->channels
) {
265 err("ISDN_CMD_ALERT: invalid channel (%d)",
269 //bcs = cs->bcs + cntrl->arg;
274 gig_dbg(DEBUG_ANY
, "ISDN_CMD_REDIR"); //FIXME
276 case ISDN_CMD_PROT_IO
:
277 gig_dbg(DEBUG_ANY
, "ISDN_CMD_PROT_IO");
279 case ISDN_CMD_FAXCMD
:
280 gig_dbg(DEBUG_ANY
, "ISDN_CMD_FAXCMD");
283 gig_dbg(DEBUG_ANY
, "ISDN_CMD_GETL2");
286 gig_dbg(DEBUG_ANY
, "ISDN_CMD_GETL3");
288 case ISDN_CMD_GETEAZ
:
289 gig_dbg(DEBUG_ANY
, "ISDN_CMD_GETEAZ");
291 case ISDN_CMD_SETSIL
:
292 gig_dbg(DEBUG_ANY
, "ISDN_CMD_SETSIL");
294 case ISDN_CMD_GETSIL
:
295 gig_dbg(DEBUG_ANY
, "ISDN_CMD_GETSIL");
298 err("unknown command %d from LL", cntrl
->command
);
305 void gigaset_i4l_cmd(struct cardstate
*cs
, int cmd
)
309 command
.driver
= cs
->myid
;
310 command
.command
= cmd
;
312 cs
->iif
.statcallb(&command
);
315 void gigaset_i4l_channel_cmd(struct bc_state
*bcs
, int cmd
)
319 command
.driver
= bcs
->cs
->myid
;
320 command
.command
= cmd
;
321 command
.arg
= bcs
->channel
;
322 bcs
->cs
->iif
.statcallb(&command
);
325 int gigaset_isdn_setup_dial(struct at_state_t
*at_state
, void *data
)
327 struct bc_state
*bcs
= at_state
->bcs
;
330 size_t length
[AT_NUM
];
333 struct setup_parm
*sp
= data
;
335 switch (bcs
->proto2
) {
336 case ISDN_PROTO_L2_HDLC
:
337 proto
= 1; /* 0: Bitsynchron, 1: HDLC, 2: voice */
339 case ISDN_PROTO_L2_TRANS
:
340 proto
= 2; /* 0: Bitsynchron, 1: HDLC, 2: voice */
343 dev_err(bcs
->cs
->dev
, "%s: invalid L2 protocol: %u\n",
344 __func__
, bcs
->proto2
);
350 bc
= "9090A3"; /* 3.1 kHz audio, A-law */
353 default: /* hope the app knows what it is doing */
354 bc
= "8890"; /* unrestricted digital information */
356 //FIXME add missing si1 values from 1TR6, inspect si2, set HLC/LLC
358 length
[AT_DIAL
] = 1 + strlen(sp
->phone
) + 1 + 1;
359 l
= strlen(sp
->eazmsn
);
360 length
[AT_MSN
] = l
? 6 + l
+ 1 + 1 : 0;
361 length
[AT_BC
] = 5 + strlen(bc
) + 1 + 1;
362 length
[AT_PROTO
] = 6 + 1 + 1 + 1; /* proto: 1 character */
363 length
[AT_ISO
] = 6 + 1 + 1 + 1; /* channel: 1 character */
364 length
[AT_TYPE
] = 6 + 1 + 1 + 1; /* call type: 1 character */
367 for (i
= 0; i
< AT_NUM
; ++i
) {
368 kfree(bcs
->commands
[i
]);
369 bcs
->commands
[i
] = NULL
;
371 !(bcs
->commands
[i
] = kmalloc(length
[i
], GFP_ATOMIC
))) {
372 dev_err(bcs
->cs
->dev
, "out of memory\n");
377 /* type = 1: extern, 0: intern, 2: recall, 3: door, 4: centrex */
378 if (sp
->phone
[0] == '*' && sp
->phone
[1] == '*') {
379 /* internal call: translate ** prefix to CTP value */
380 snprintf(bcs
->commands
[AT_DIAL
], length
[AT_DIAL
],
381 "D%s\r", sp
->phone
+2);
382 strncpy(bcs
->commands
[AT_TYPE
], "^SCTP=0\r", length
[AT_TYPE
]);
384 snprintf(bcs
->commands
[AT_DIAL
], length
[AT_DIAL
],
386 strncpy(bcs
->commands
[AT_TYPE
], "^SCTP=1\r", length
[AT_TYPE
]);
389 if (bcs
->commands
[AT_MSN
])
390 snprintf(bcs
->commands
[AT_MSN
], length
[AT_MSN
],
391 "^SMSN=%s\r", sp
->eazmsn
);
392 snprintf(bcs
->commands
[AT_BC
], length
[AT_BC
],
394 snprintf(bcs
->commands
[AT_PROTO
], length
[AT_PROTO
],
395 "^SBPR=%u\r", proto
);
396 snprintf(bcs
->commands
[AT_ISO
], length
[AT_ISO
],
397 "^SISO=%u\r", (unsigned)bcs
->channel
+ 1);
402 int gigaset_isdn_setup_accept(struct at_state_t
*at_state
)
405 size_t length
[AT_NUM
];
407 struct bc_state
*bcs
= at_state
->bcs
;
409 switch (bcs
->proto2
) {
410 case ISDN_PROTO_L2_HDLC
:
411 proto
= 1; /* 0: Bitsynchron, 1: HDLC, 2: voice */
413 case ISDN_PROTO_L2_TRANS
:
414 proto
= 2; /* 0: Bitsynchron, 1: HDLC, 2: voice */
417 dev_err(at_state
->cs
->dev
, "%s: invalid protocol: %u\n",
418 __func__
, bcs
->proto2
);
422 length
[AT_DIAL
] = 0;
425 length
[AT_PROTO
] = 6 + 1 + 1 + 1; /* proto: 1 character */
426 length
[AT_ISO
] = 6 + 1 + 1 + 1; /* channel: 1 character */
427 length
[AT_TYPE
] = 0;
430 for (i
= 0; i
< AT_NUM
; ++i
) {
431 kfree(bcs
->commands
[i
]);
432 bcs
->commands
[i
] = NULL
;
434 !(bcs
->commands
[i
] = kmalloc(length
[i
], GFP_ATOMIC
))) {
435 dev_err(at_state
->cs
->dev
, "out of memory\n");
440 snprintf(bcs
->commands
[AT_PROTO
], length
[AT_PROTO
],
441 "^SBPR=%u\r", proto
);
442 snprintf(bcs
->commands
[AT_ISO
], length
[AT_ISO
],
443 "^SISO=%u\r", (unsigned) bcs
->channel
+ 1);
448 int gigaset_isdn_icall(struct at_state_t
*at_state
)
450 struct cardstate
*cs
= at_state
->cs
;
451 struct bc_state
*bcs
= at_state
->bcs
;
455 /* fill ICALL structure */
456 response
.parm
.setup
.si1
= 0; /* default: unknown */
457 response
.parm
.setup
.si2
= 0;
458 response
.parm
.setup
.screen
= 0; //FIXME how to set these?
459 response
.parm
.setup
.plan
= 0;
460 if (!at_state
->str_var
[STR_ZBC
]) {
461 /* no BC (internal call): assume speech, A-law */
462 response
.parm
.setup
.si1
= 1;
463 } else if (!strcmp(at_state
->str_var
[STR_ZBC
], "8890")) {
464 /* unrestricted digital information */
465 response
.parm
.setup
.si1
= 7;
466 } else if (!strcmp(at_state
->str_var
[STR_ZBC
], "8090A3")) {
468 response
.parm
.setup
.si1
= 1;
469 } else if (!strcmp(at_state
->str_var
[STR_ZBC
], "9090A3")) {
470 /* 3,1 kHz audio, A-law */
471 response
.parm
.setup
.si1
= 1;
472 response
.parm
.setup
.si2
= 2;
474 dev_warn(cs
->dev
, "RING ignored - unsupported BC %s\n",
475 at_state
->str_var
[STR_ZBC
]);
478 if (at_state
->str_var
[STR_NMBR
]) {
479 strncpy(response
.parm
.setup
.phone
, at_state
->str_var
[STR_NMBR
],
480 sizeof response
.parm
.setup
.phone
- 1);
481 response
.parm
.setup
.phone
[sizeof response
.parm
.setup
.phone
- 1] = 0;
483 response
.parm
.setup
.phone
[0] = 0;
484 if (at_state
->str_var
[STR_ZCPN
]) {
485 strncpy(response
.parm
.setup
.eazmsn
, at_state
->str_var
[STR_ZCPN
],
486 sizeof response
.parm
.setup
.eazmsn
- 1);
487 response
.parm
.setup
.eazmsn
[sizeof response
.parm
.setup
.eazmsn
- 1] = 0;
489 response
.parm
.setup
.eazmsn
[0] = 0;
492 dev_notice(cs
->dev
, "no channel for incoming call\n");
493 response
.command
= ISDN_STAT_ICALLW
;
494 response
.arg
= 0; //FIXME
496 gig_dbg(DEBUG_CMD
, "Sending ICALL");
497 response
.command
= ISDN_STAT_ICALL
;
498 response
.arg
= bcs
->channel
; //FIXME
500 response
.driver
= cs
->myid
;
501 retval
= cs
->iif
.statcallb(&response
);
502 gig_dbg(DEBUG_CMD
, "Response: %d", retval
);
504 case 0: /* no takers */
506 case 1: /* alerting */
507 bcs
->chstate
|= CHS_NOTIFY_LL
;
511 case 3: /* incomplete */
513 "LL requested unsupported feature: Incomplete Number\n");
515 case 4: /* proceeding */
516 /* Gigaset will send ALERTING anyway.
517 * There doesn't seem to be a way to avoid this.
520 case 5: /* deflect */
522 "LL requested unsupported feature: Call Deflection\n");
525 dev_err(cs
->dev
, "LL error %d on ICALL\n", retval
);
530 /* Set Callback function pointer */
531 int gigaset_register_to_LL(struct cardstate
*cs
, const char *isdnid
)
533 isdn_if
*iif
= &cs
->iif
;
535 gig_dbg(DEBUG_ANY
, "Register driver capabilities to LL");
537 //iif->id[sizeof(iif->id) - 1]=0;
538 //strncpy(iif->id, isdnid, sizeof(iif->id) - 1);
539 if (snprintf(iif
->id
, sizeof iif
->id
, "%s_%u", isdnid
, cs
->minor_index
)
541 return -ENOMEM
; //FIXME EINVAL/...??
543 iif
->owner
= THIS_MODULE
;
544 iif
->channels
= cs
->channels
;
545 iif
->maxbufsize
= MAX_BUF_SIZE
;
546 iif
->features
= ISDN_FEATURE_L2_TRANS
|
547 ISDN_FEATURE_L2_HDLC
|
549 ISDN_FEATURE_L2_X75I
|
551 ISDN_FEATURE_L3_TRANS
|
553 iif
->hl_hdrlen
= HW_HDR_LEN
; /* Area for storing ack */
554 iif
->command
= command_from_LL
;
555 iif
->writebuf_skb
= writebuf_from_LL
;
556 iif
->writecmd
= NULL
; /* Don't support isdnctrl */
557 iif
->readstat
= NULL
; /* Don't support isdnctrl */
558 iif
->rcvcallb_skb
= NULL
; /* Will be set by LL */
559 iif
->statcallb
= NULL
; /* Will be set by LL */
561 if (!register_isdn(iif
))
564 cs
->myid
= iif
->channels
; /* Set my device id */