Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* $Id: callc.c,v 2.59.2.4 2004/02/11 13:21:32 keil Exp $ |
| 2 | * |
| 3 | * Author Karsten Keil |
| 4 | * Copyright by Karsten Keil <keil@isdn4linux.de> |
| 5 | * |
| 6 | * This software may be used and distributed according to the terms |
| 7 | * of the GNU General Public License, incorporated herein by reference. |
| 8 | * |
| 9 | * For changes and modifications please read |
| 10 | * Documentation/isdn/HiSax.cert |
| 11 | * |
| 12 | * based on the teles driver from Jan den Ouden |
| 13 | * |
| 14 | * Thanks to Jan den Ouden |
| 15 | * Fritz Elfert |
| 16 | * |
| 17 | */ |
| 18 | |
| 19 | #include <linux/module.h> |
Tejun Heo | 5a0e3ad | 2010-03-24 17:04:11 +0900 | [diff] [blame] | 20 | #include <linux/slab.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | #include <linux/init.h> |
| 22 | #include "hisax.h" |
| 23 | #include <linux/isdn/capicmd.h> |
| 24 | |
| 25 | const char *lli_revision = "$Revision: 2.59.2.4 $"; |
| 26 | |
| 27 | extern struct IsdnCard cards[]; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 28 | |
| 29 | static int init_b_st(struct Channel *chanp, int incoming); |
| 30 | static void release_b_st(struct Channel *chanp); |
| 31 | |
| 32 | static struct Fsm callcfsm; |
| 33 | static int chancount; |
| 34 | |
| 35 | /* experimental REJECT after ALERTING for CALLBACK to beat the 4s delay */ |
| 36 | #define ALERT_REJECT 0 |
| 37 | |
| 38 | /* Value to delay the sending of the first B-channel paket after CONNECT |
| 39 | * here is no value given by ITU, but experience shows that 300 ms will |
| 40 | * work on many networks, if you or your other side is behind local exchanges |
| 41 | * a greater value may be recommented. If the delay is to short the first paket |
| 42 | * will be lost and autodetect on many comercial routers goes wrong ! |
| 43 | * You can adjust this value on runtime with |
| 44 | * hisaxctrl <id> 2 <value> |
| 45 | * value is in milliseconds |
| 46 | */ |
| 47 | #define DEFAULT_B_DELAY 300 |
| 48 | |
| 49 | /* Flags for remembering action done in lli */ |
| 50 | |
| 51 | #define FLG_START_B 0 |
| 52 | |
| 53 | /* |
| 54 | * Find card with given driverId |
| 55 | */ |
| 56 | static inline struct IsdnCardState * |
| 57 | hisax_findcard(int driverid) |
| 58 | { |
| 59 | int i; |
| 60 | |
| 61 | for (i = 0; i < nrcards; i++) |
| 62 | if (cards[i].cs) |
| 63 | if (cards[i].cs->myid == driverid) |
| 64 | return (cards[i].cs); |
| 65 | return (struct IsdnCardState *) 0; |
| 66 | } |
| 67 | |
Joe Perches | 9920239 | 2010-11-10 18:54:58 +0000 | [diff] [blame] | 68 | static __attribute__((format(printf, 3, 4))) void |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 69 | link_debug(struct Channel *chanp, int direction, char *fmt, ...) |
| 70 | { |
| 71 | va_list args; |
| 72 | char tmp[16]; |
| 73 | |
| 74 | va_start(args, fmt); |
| 75 | sprintf(tmp, "Ch%d %s ", chanp->chan, |
| 76 | direction ? "LL->HL" : "HL->LL"); |
| 77 | VHiSax_putstatus(chanp->cs, tmp, fmt, args); |
| 78 | va_end(args); |
| 79 | } |
| 80 | |
| 81 | enum { |
| 82 | ST_NULL, /* 0 inactive */ |
| 83 | ST_OUT_DIAL, /* 1 outgoing, SETUP send; awaiting confirm */ |
| 84 | ST_IN_WAIT_LL, /* 2 incoming call received; wait for LL confirm */ |
| 85 | ST_IN_ALERT_SENT, /* 3 incoming call received; ALERT send */ |
| 86 | ST_IN_WAIT_CONN_ACK, /* 4 incoming CONNECT send; awaiting CONN_ACK */ |
| 87 | ST_WAIT_BCONN, /* 5 CONNECT/CONN_ACK received, awaiting b-channel prot. estbl. */ |
| 88 | ST_ACTIVE, /* 6 active, b channel prot. established */ |
| 89 | ST_WAIT_BRELEASE, /* 7 call clear. (initiator), awaiting b channel prot. rel. */ |
| 90 | ST_WAIT_BREL_DISC, /* 8 call clear. (receiver), DISCONNECT req. received */ |
| 91 | ST_WAIT_DCOMMAND, /* 9 call clear. (receiver), awaiting DCHANNEL message */ |
| 92 | ST_WAIT_DRELEASE, /* 10 DISCONNECT sent, awaiting RELEASE */ |
| 93 | ST_WAIT_D_REL_CNF, /* 11 RELEASE sent, awaiting RELEASE confirm */ |
| 94 | ST_IN_PROCEED_SEND, /* 12 incoming call, proceeding send */ |
| 95 | }; |
| 96 | |
| 97 | |
| 98 | #define STATE_COUNT (ST_IN_PROCEED_SEND + 1) |
| 99 | |
| 100 | static char *strState[] = |
| 101 | { |
| 102 | "ST_NULL", |
| 103 | "ST_OUT_DIAL", |
| 104 | "ST_IN_WAIT_LL", |
| 105 | "ST_IN_ALERT_SENT", |
| 106 | "ST_IN_WAIT_CONN_ACK", |
| 107 | "ST_WAIT_BCONN", |
| 108 | "ST_ACTIVE", |
| 109 | "ST_WAIT_BRELEASE", |
| 110 | "ST_WAIT_BREL_DISC", |
| 111 | "ST_WAIT_DCOMMAND", |
| 112 | "ST_WAIT_DRELEASE", |
| 113 | "ST_WAIT_D_REL_CNF", |
| 114 | "ST_IN_PROCEED_SEND", |
| 115 | }; |
| 116 | |
| 117 | enum { |
| 118 | EV_DIAL, /* 0 */ |
| 119 | EV_SETUP_CNF, /* 1 */ |
| 120 | EV_ACCEPTB, /* 2 */ |
| 121 | EV_DISCONNECT_IND, /* 3 */ |
| 122 | EV_RELEASE, /* 4 */ |
| 123 | EV_LEASED, /* 5 */ |
| 124 | EV_LEASED_REL, /* 6 */ |
| 125 | EV_SETUP_IND, /* 7 */ |
| 126 | EV_ACCEPTD, /* 8 */ |
| 127 | EV_SETUP_CMPL_IND, /* 9 */ |
| 128 | EV_BC_EST, /* 10 */ |
| 129 | EV_WRITEBUF, /* 11 */ |
| 130 | EV_HANGUP, /* 12 */ |
| 131 | EV_BC_REL, /* 13 */ |
| 132 | EV_CINF, /* 14 */ |
| 133 | EV_SUSPEND, /* 15 */ |
| 134 | EV_RESUME, /* 16 */ |
| 135 | EV_NOSETUP_RSP, /* 17 */ |
| 136 | EV_SETUP_ERR, /* 18 */ |
| 137 | EV_CONNECT_ERR, /* 19 */ |
| 138 | EV_PROCEED, /* 20 */ |
| 139 | EV_ALERT, /* 21 */ |
| 140 | EV_REDIR, /* 22 */ |
| 141 | }; |
| 142 | |
| 143 | #define EVENT_COUNT (EV_REDIR + 1) |
| 144 | |
| 145 | static char *strEvent[] = |
| 146 | { |
| 147 | "EV_DIAL", |
| 148 | "EV_SETUP_CNF", |
| 149 | "EV_ACCEPTB", |
| 150 | "EV_DISCONNECT_IND", |
| 151 | "EV_RELEASE", |
| 152 | "EV_LEASED", |
| 153 | "EV_LEASED_REL", |
| 154 | "EV_SETUP_IND", |
| 155 | "EV_ACCEPTD", |
| 156 | "EV_SETUP_CMPL_IND", |
| 157 | "EV_BC_EST", |
| 158 | "EV_WRITEBUF", |
| 159 | "EV_HANGUP", |
| 160 | "EV_BC_REL", |
| 161 | "EV_CINF", |
| 162 | "EV_SUSPEND", |
| 163 | "EV_RESUME", |
| 164 | "EV_NOSETUP_RSP", |
| 165 | "EV_SETUP_ERR", |
| 166 | "EV_CONNECT_ERR", |
| 167 | "EV_PROCEED", |
| 168 | "EV_ALERT", |
| 169 | "EV_REDIR", |
| 170 | }; |
| 171 | |
| 172 | |
| 173 | static inline void |
| 174 | HL_LL(struct Channel *chanp, int command) |
| 175 | { |
| 176 | isdn_ctrl ic; |
| 177 | |
| 178 | ic.driver = chanp->cs->myid; |
| 179 | ic.command = command; |
| 180 | ic.arg = chanp->chan; |
| 181 | chanp->cs->iif.statcallb(&ic); |
| 182 | } |
| 183 | |
| 184 | static inline void |
| 185 | lli_deliver_cause(struct Channel *chanp) |
| 186 | { |
| 187 | isdn_ctrl ic; |
| 188 | |
| 189 | if (!chanp->proc) |
| 190 | return; |
| 191 | if (chanp->proc->para.cause == NO_CAUSE) |
| 192 | return; |
| 193 | ic.driver = chanp->cs->myid; |
| 194 | ic.command = ISDN_STAT_CAUSE; |
| 195 | ic.arg = chanp->chan; |
| 196 | if (chanp->cs->protocol == ISDN_PTYPE_EURO) |
| 197 | sprintf(ic.parm.num, "E%02X%02X", chanp->proc->para.loc & 0x7f, |
| 198 | chanp->proc->para.cause & 0x7f); |
| 199 | else |
| 200 | sprintf(ic.parm.num, "%02X%02X", chanp->proc->para.loc & 0x7f, |
| 201 | chanp->proc->para.cause & 0x7f); |
| 202 | chanp->cs->iif.statcallb(&ic); |
| 203 | } |
| 204 | |
| 205 | static inline void |
| 206 | lli_close(struct FsmInst *fi) |
| 207 | { |
| 208 | struct Channel *chanp = fi->userdata; |
| 209 | |
| 210 | FsmChangeState(fi, ST_NULL); |
| 211 | chanp->Flags = 0; |
| 212 | chanp->cs->cardmsg(chanp->cs, MDL_INFO_REL, (void *) (long)chanp->chan); |
| 213 | } |
| 214 | |
| 215 | static void |
| 216 | lli_leased_in(struct FsmInst *fi, int event, void *arg) |
| 217 | { |
| 218 | struct Channel *chanp = fi->userdata; |
| 219 | isdn_ctrl ic; |
| 220 | int ret; |
| 221 | |
| 222 | if (!chanp->leased) |
| 223 | return; |
| 224 | chanp->cs->cardmsg(chanp->cs, MDL_INFO_SETUP, (void *) (long)chanp->chan); |
| 225 | FsmChangeState(fi, ST_IN_WAIT_LL); |
| 226 | if (chanp->debug & 1) |
| 227 | link_debug(chanp, 0, "STAT_ICALL_LEASED"); |
| 228 | ic.driver = chanp->cs->myid; |
| 229 | ic.command = ((chanp->chan < 2) ? ISDN_STAT_ICALL : ISDN_STAT_ICALLW); |
| 230 | ic.arg = chanp->chan; |
| 231 | ic.parm.setup.si1 = 7; |
| 232 | ic.parm.setup.si2 = 0; |
| 233 | ic.parm.setup.plan = 0; |
| 234 | ic.parm.setup.screen = 0; |
| 235 | sprintf(ic.parm.setup.eazmsn,"%d", chanp->chan + 1); |
| 236 | sprintf(ic.parm.setup.phone,"LEASED%d", chanp->cs->myid); |
| 237 | ret = chanp->cs->iif.statcallb(&ic); |
| 238 | if (chanp->debug & 1) |
| 239 | link_debug(chanp, 1, "statcallb ret=%d", ret); |
| 240 | if (!ret) { |
| 241 | chanp->cs->cardmsg(chanp->cs, MDL_INFO_REL, (void *) (long)chanp->chan); |
| 242 | FsmChangeState(fi, ST_NULL); |
| 243 | } |
| 244 | } |
| 245 | |
| 246 | |
| 247 | /* |
| 248 | * Dial out |
| 249 | */ |
| 250 | static void |
| 251 | lli_init_bchan_out(struct FsmInst *fi, int event, void *arg) |
| 252 | { |
| 253 | struct Channel *chanp = fi->userdata; |
| 254 | |
| 255 | FsmChangeState(fi, ST_WAIT_BCONN); |
| 256 | if (chanp->debug & 1) |
| 257 | link_debug(chanp, 0, "STAT_DCONN"); |
| 258 | HL_LL(chanp, ISDN_STAT_DCONN); |
| 259 | init_b_st(chanp, 0); |
| 260 | chanp->b_st->lli.l4l3(chanp->b_st, DL_ESTABLISH | REQUEST, NULL); |
| 261 | } |
| 262 | |
| 263 | static void |
| 264 | lli_prep_dialout(struct FsmInst *fi, int event, void *arg) |
| 265 | { |
| 266 | struct Channel *chanp = fi->userdata; |
| 267 | |
| 268 | FsmDelTimer(&chanp->drel_timer, 60); |
| 269 | FsmDelTimer(&chanp->dial_timer, 73); |
| 270 | chanp->l2_active_protocol = chanp->l2_protocol; |
| 271 | chanp->incoming = 0; |
| 272 | chanp->cs->cardmsg(chanp->cs, MDL_INFO_SETUP, (void *) (long)chanp->chan); |
| 273 | if (chanp->leased) { |
| 274 | lli_init_bchan_out(fi, event, arg); |
| 275 | } else { |
| 276 | FsmChangeState(fi, ST_OUT_DIAL); |
| 277 | chanp->d_st->lli.l4l3(chanp->d_st, CC_SETUP | REQUEST, chanp); |
| 278 | } |
| 279 | } |
| 280 | |
| 281 | static void |
| 282 | lli_resume(struct FsmInst *fi, int event, void *arg) |
| 283 | { |
| 284 | struct Channel *chanp = fi->userdata; |
| 285 | |
| 286 | FsmDelTimer(&chanp->drel_timer, 60); |
| 287 | FsmDelTimer(&chanp->dial_timer, 73); |
| 288 | chanp->l2_active_protocol = chanp->l2_protocol; |
| 289 | chanp->incoming = 0; |
| 290 | chanp->cs->cardmsg(chanp->cs, MDL_INFO_SETUP, (void *) (long)chanp->chan); |
| 291 | if (chanp->leased) { |
| 292 | lli_init_bchan_out(fi, event, arg); |
| 293 | } else { |
| 294 | FsmChangeState(fi, ST_OUT_DIAL); |
| 295 | chanp->d_st->lli.l4l3(chanp->d_st, CC_RESUME | REQUEST, chanp); |
| 296 | } |
| 297 | } |
| 298 | |
| 299 | static void |
| 300 | lli_go_active(struct FsmInst *fi, int event, void *arg) |
| 301 | { |
| 302 | struct Channel *chanp = fi->userdata; |
| 303 | isdn_ctrl ic; |
| 304 | |
| 305 | |
| 306 | FsmChangeState(fi, ST_ACTIVE); |
| 307 | chanp->data_open = !0; |
| 308 | if (chanp->bcs->conmsg) |
| 309 | strcpy(ic.parm.num, chanp->bcs->conmsg); |
| 310 | else |
| 311 | ic.parm.num[0] = 0; |
| 312 | if (chanp->debug & 1) |
| 313 | link_debug(chanp, 0, "STAT_BCONN %s", ic.parm.num); |
| 314 | ic.driver = chanp->cs->myid; |
| 315 | ic.command = ISDN_STAT_BCONN; |
| 316 | ic.arg = chanp->chan; |
| 317 | chanp->cs->iif.statcallb(&ic); |
| 318 | chanp->cs->cardmsg(chanp->cs, MDL_INFO_CONN, (void *) (long)chanp->chan); |
| 319 | } |
| 320 | |
| 321 | |
| 322 | /* |
| 323 | * RESUME |
| 324 | */ |
| 325 | |
| 326 | /* incoming call */ |
| 327 | |
| 328 | static void |
| 329 | lli_deliver_call(struct FsmInst *fi, int event, void *arg) |
| 330 | { |
| 331 | struct Channel *chanp = fi->userdata; |
| 332 | isdn_ctrl ic; |
| 333 | int ret; |
| 334 | |
| 335 | chanp->cs->cardmsg(chanp->cs, MDL_INFO_SETUP, (void *) (long)chanp->chan); |
| 336 | /* |
| 337 | * Report incoming calls only once to linklevel, use CallFlags |
| 338 | * which is set to 3 with each broadcast message in isdnl1.c |
| 339 | * and resetted if a interface answered the STAT_ICALL. |
| 340 | */ |
| 341 | if (1) { /* for only one TEI */ |
| 342 | FsmChangeState(fi, ST_IN_WAIT_LL); |
| 343 | if (chanp->debug & 1) |
| 344 | link_debug(chanp, 0, (chanp->chan < 2) ? "STAT_ICALL" : "STAT_ICALLW"); |
| 345 | ic.driver = chanp->cs->myid; |
| 346 | ic.command = ((chanp->chan < 2) ? ISDN_STAT_ICALL : ISDN_STAT_ICALLW); |
| 347 | |
| 348 | ic.arg = chanp->chan; |
| 349 | /* |
| 350 | * No need to return "unknown" for calls without OAD, |
| 351 | * cause that's handled in linklevel now (replaced by '0') |
| 352 | */ |
| 353 | memcpy(&ic.parm.setup, &chanp->proc->para.setup, sizeof(setup_parm)); |
| 354 | ret = chanp->cs->iif.statcallb(&ic); |
| 355 | if (chanp->debug & 1) |
| 356 | link_debug(chanp, 1, "statcallb ret=%d", ret); |
| 357 | |
| 358 | switch (ret) { |
| 359 | case 1: /* OK, someone likes this call */ |
| 360 | FsmDelTimer(&chanp->drel_timer, 61); |
| 361 | FsmChangeState(fi, ST_IN_ALERT_SENT); |
| 362 | chanp->d_st->lli.l4l3(chanp->d_st, CC_ALERTING | REQUEST, chanp->proc); |
| 363 | break; |
| 364 | case 5: /* direct redirect */ |
| 365 | case 4: /* Proceeding desired */ |
| 366 | FsmDelTimer(&chanp->drel_timer, 61); |
| 367 | FsmChangeState(fi, ST_IN_PROCEED_SEND); |
| 368 | chanp->d_st->lli.l4l3(chanp->d_st, CC_PROCEED_SEND | REQUEST, chanp->proc); |
| 369 | if (ret == 5) { |
| 370 | memcpy(&chanp->setup, &ic.parm.setup, sizeof(setup_parm)); |
| 371 | chanp->d_st->lli.l4l3(chanp->d_st, CC_REDIR | REQUEST, chanp->proc); |
| 372 | } |
| 373 | break; |
| 374 | case 2: /* Rejecting Call */ |
| 375 | break; |
| 376 | case 3: /* incomplete number */ |
| 377 | FsmDelTimer(&chanp->drel_timer, 61); |
| 378 | chanp->d_st->lli.l4l3(chanp->d_st, CC_MORE_INFO | REQUEST, chanp->proc); |
| 379 | break; |
| 380 | case 0: /* OK, nobody likes this call */ |
| 381 | default: /* statcallb problems */ |
| 382 | chanp->d_st->lli.l4l3(chanp->d_st, CC_IGNORE | REQUEST, chanp->proc); |
| 383 | chanp->cs->cardmsg(chanp->cs, MDL_INFO_REL, (void *) (long)chanp->chan); |
| 384 | FsmChangeState(fi, ST_NULL); |
| 385 | break; |
| 386 | } |
| 387 | } else { |
| 388 | chanp->d_st->lli.l4l3(chanp->d_st, CC_IGNORE | REQUEST, chanp->proc); |
| 389 | chanp->cs->cardmsg(chanp->cs, MDL_INFO_REL, (void *) (long)chanp->chan); |
| 390 | } |
| 391 | } |
| 392 | |
| 393 | static void |
| 394 | lli_send_dconnect(struct FsmInst *fi, int event, void *arg) |
| 395 | { |
| 396 | struct Channel *chanp = fi->userdata; |
| 397 | |
| 398 | FsmChangeState(fi, ST_IN_WAIT_CONN_ACK); |
| 399 | chanp->d_st->lli.l4l3(chanp->d_st, CC_SETUP | RESPONSE, chanp->proc); |
| 400 | } |
| 401 | |
| 402 | static void |
| 403 | lli_send_alert(struct FsmInst *fi, int event, void *arg) |
| 404 | { |
| 405 | struct Channel *chanp = fi->userdata; |
| 406 | |
| 407 | FsmChangeState(fi, ST_IN_ALERT_SENT); |
| 408 | chanp->d_st->lli.l4l3(chanp->d_st, CC_ALERTING | REQUEST, chanp->proc); |
| 409 | } |
| 410 | |
| 411 | static void |
| 412 | lli_send_redir(struct FsmInst *fi, int event, void *arg) |
| 413 | { |
| 414 | struct Channel *chanp = fi->userdata; |
| 415 | |
| 416 | chanp->d_st->lli.l4l3(chanp->d_st, CC_REDIR | REQUEST, chanp->proc); |
| 417 | } |
| 418 | |
| 419 | static void |
| 420 | lli_init_bchan_in(struct FsmInst *fi, int event, void *arg) |
| 421 | { |
| 422 | struct Channel *chanp = fi->userdata; |
| 423 | |
| 424 | FsmChangeState(fi, ST_WAIT_BCONN); |
| 425 | if (chanp->debug & 1) |
| 426 | link_debug(chanp, 0, "STAT_DCONN"); |
| 427 | HL_LL(chanp, ISDN_STAT_DCONN); |
| 428 | chanp->l2_active_protocol = chanp->l2_protocol; |
| 429 | chanp->incoming = !0; |
| 430 | init_b_st(chanp, !0); |
| 431 | chanp->b_st->lli.l4l3(chanp->b_st, DL_ESTABLISH | REQUEST, NULL); |
| 432 | } |
| 433 | |
| 434 | static void |
| 435 | lli_setup_rsp(struct FsmInst *fi, int event, void *arg) |
| 436 | { |
| 437 | struct Channel *chanp = fi->userdata; |
| 438 | |
| 439 | if (chanp->leased) { |
| 440 | lli_init_bchan_in(fi, event, arg); |
| 441 | } else { |
| 442 | FsmChangeState(fi, ST_IN_WAIT_CONN_ACK); |
| 443 | #ifdef WANT_ALERT |
| 444 | chanp->d_st->lli.l4l3(chanp->d_st, CC_ALERTING | REQUEST, chanp->proc); |
| 445 | #endif |
| 446 | chanp->d_st->lli.l4l3(chanp->d_st, CC_SETUP | RESPONSE, chanp->proc); |
| 447 | } |
| 448 | } |
| 449 | |
| 450 | /* Call suspend */ |
| 451 | |
| 452 | static void |
| 453 | lli_suspend(struct FsmInst *fi, int event, void *arg) |
| 454 | { |
| 455 | struct Channel *chanp = fi->userdata; |
| 456 | |
| 457 | chanp->d_st->lli.l4l3(chanp->d_st, CC_SUSPEND | REQUEST, chanp->proc); |
| 458 | } |
| 459 | |
| 460 | /* Call clearing */ |
| 461 | |
| 462 | static void |
| 463 | lli_leased_hup(struct FsmInst *fi, struct Channel *chanp) |
| 464 | { |
| 465 | isdn_ctrl ic; |
| 466 | |
| 467 | ic.driver = chanp->cs->myid; |
| 468 | ic.command = ISDN_STAT_CAUSE; |
| 469 | ic.arg = chanp->chan; |
| 470 | sprintf(ic.parm.num, "L0010"); |
| 471 | chanp->cs->iif.statcallb(&ic); |
| 472 | if (chanp->debug & 1) |
| 473 | link_debug(chanp, 0, "STAT_DHUP"); |
| 474 | HL_LL(chanp, ISDN_STAT_DHUP); |
| 475 | lli_close(fi); |
| 476 | } |
| 477 | |
| 478 | static void |
| 479 | lli_disconnect_req(struct FsmInst *fi, int event, void *arg) |
| 480 | { |
| 481 | struct Channel *chanp = fi->userdata; |
| 482 | |
| 483 | if (chanp->leased) { |
| 484 | lli_leased_hup(fi, chanp); |
| 485 | } else { |
| 486 | FsmChangeState(fi, ST_WAIT_DRELEASE); |
| 487 | if (chanp->proc) |
| 488 | chanp->proc->para.cause = 0x10; /* Normal Call Clearing */ |
| 489 | chanp->d_st->lli.l4l3(chanp->d_st, CC_DISCONNECT | REQUEST, |
| 490 | chanp->proc); |
| 491 | } |
| 492 | } |
| 493 | |
| 494 | static void |
| 495 | lli_disconnect_reject(struct FsmInst *fi, int event, void *arg) |
| 496 | { |
| 497 | struct Channel *chanp = fi->userdata; |
| 498 | |
| 499 | if (chanp->leased) { |
| 500 | lli_leased_hup(fi, chanp); |
| 501 | } else { |
| 502 | FsmChangeState(fi, ST_WAIT_DRELEASE); |
| 503 | if (chanp->proc) |
| 504 | chanp->proc->para.cause = 0x15; /* Call Rejected */ |
| 505 | chanp->d_st->lli.l4l3(chanp->d_st, CC_DISCONNECT | REQUEST, |
| 506 | chanp->proc); |
| 507 | } |
| 508 | } |
| 509 | |
| 510 | static void |
| 511 | lli_dhup_close(struct FsmInst *fi, int event, void *arg) |
| 512 | { |
| 513 | struct Channel *chanp = fi->userdata; |
| 514 | |
| 515 | if (chanp->leased) { |
| 516 | lli_leased_hup(fi, chanp); |
| 517 | } else { |
| 518 | if (chanp->debug & 1) |
| 519 | link_debug(chanp, 0, "STAT_DHUP"); |
| 520 | lli_deliver_cause(chanp); |
| 521 | HL_LL(chanp, ISDN_STAT_DHUP); |
| 522 | lli_close(fi); |
| 523 | } |
| 524 | } |
| 525 | |
| 526 | static void |
| 527 | lli_reject_req(struct FsmInst *fi, int event, void *arg) |
| 528 | { |
| 529 | struct Channel *chanp = fi->userdata; |
| 530 | |
| 531 | if (chanp->leased) { |
| 532 | lli_leased_hup(fi, chanp); |
| 533 | return; |
| 534 | } |
| 535 | #ifndef ALERT_REJECT |
| 536 | if (chanp->proc) |
| 537 | chanp->proc->para.cause = 0x15; /* Call Rejected */ |
| 538 | chanp->d_st->lli.l4l3(chanp->d_st, CC_REJECT | REQUEST, chanp->proc); |
| 539 | lli_dhup_close(fi, event, arg); |
| 540 | #else |
| 541 | FsmRestartTimer(&chanp->drel_timer, 40, EV_HANGUP, NULL, 63); |
| 542 | FsmChangeState(fi, ST_IN_ALERT_SENT); |
| 543 | chanp->d_st->lli.l4l3(chanp->d_st, CC_ALERTING | REQUEST, chanp->proc); |
| 544 | #endif |
| 545 | } |
| 546 | |
| 547 | static void |
| 548 | lli_disconn_bchan(struct FsmInst *fi, int event, void *arg) |
| 549 | { |
| 550 | struct Channel *chanp = fi->userdata; |
| 551 | |
| 552 | chanp->data_open = 0; |
| 553 | FsmChangeState(fi, ST_WAIT_BRELEASE); |
| 554 | chanp->b_st->lli.l4l3(chanp->b_st, DL_RELEASE | REQUEST, NULL); |
| 555 | } |
| 556 | |
| 557 | static void |
| 558 | lli_start_disc(struct FsmInst *fi, int event, void *arg) |
| 559 | { |
| 560 | struct Channel *chanp = fi->userdata; |
| 561 | |
| 562 | if (chanp->leased) { |
| 563 | lli_leased_hup(fi, chanp); |
| 564 | } else { |
| 565 | lli_disconnect_req(fi, event, arg); |
| 566 | } |
| 567 | } |
| 568 | |
| 569 | static void |
| 570 | lli_rel_b_disc(struct FsmInst *fi, int event, void *arg) |
| 571 | { |
| 572 | struct Channel *chanp = fi->userdata; |
| 573 | |
| 574 | release_b_st(chanp); |
| 575 | lli_start_disc(fi, event, arg); |
| 576 | } |
| 577 | |
| 578 | static void |
| 579 | lli_bhup_disc(struct FsmInst *fi, int event, void *arg) |
| 580 | { |
| 581 | struct Channel *chanp = fi->userdata; |
| 582 | |
| 583 | if (chanp->debug & 1) |
| 584 | link_debug(chanp, 0, "STAT_BHUP"); |
| 585 | HL_LL(chanp, ISDN_STAT_BHUP); |
| 586 | lli_rel_b_disc(fi, event, arg); |
| 587 | } |
| 588 | |
| 589 | static void |
| 590 | lli_bhup_rel_b(struct FsmInst *fi, int event, void *arg) |
| 591 | { |
| 592 | struct Channel *chanp = fi->userdata; |
| 593 | |
| 594 | FsmChangeState(fi, ST_WAIT_DCOMMAND); |
| 595 | chanp->data_open = 0; |
| 596 | if (chanp->debug & 1) |
| 597 | link_debug(chanp, 0, "STAT_BHUP"); |
| 598 | HL_LL(chanp, ISDN_STAT_BHUP); |
| 599 | release_b_st(chanp); |
| 600 | } |
| 601 | |
| 602 | static void |
| 603 | lli_release_bchan(struct FsmInst *fi, int event, void *arg) |
| 604 | { |
| 605 | struct Channel *chanp = fi->userdata; |
| 606 | |
| 607 | chanp->data_open = 0; |
| 608 | FsmChangeState(fi, ST_WAIT_BREL_DISC); |
| 609 | chanp->b_st->lli.l4l3(chanp->b_st, DL_RELEASE | REQUEST, NULL); |
| 610 | } |
| 611 | |
| 612 | |
| 613 | static void |
| 614 | lli_rel_b_dhup(struct FsmInst *fi, int event, void *arg) |
| 615 | { |
| 616 | struct Channel *chanp = fi->userdata; |
| 617 | |
| 618 | release_b_st(chanp); |
| 619 | lli_dhup_close(fi, event, arg); |
| 620 | } |
| 621 | |
| 622 | static void |
| 623 | lli_bhup_dhup(struct FsmInst *fi, int event, void *arg) |
| 624 | { |
| 625 | struct Channel *chanp = fi->userdata; |
| 626 | |
| 627 | if (chanp->debug & 1) |
| 628 | link_debug(chanp, 0, "STAT_BHUP"); |
| 629 | HL_LL(chanp, ISDN_STAT_BHUP); |
| 630 | lli_rel_b_dhup(fi, event, arg); |
| 631 | } |
| 632 | |
| 633 | static void |
| 634 | lli_abort(struct FsmInst *fi, int event, void *arg) |
| 635 | { |
| 636 | struct Channel *chanp = fi->userdata; |
| 637 | |
| 638 | chanp->data_open = 0; |
| 639 | chanp->b_st->lli.l4l3(chanp->b_st, DL_RELEASE | REQUEST, NULL); |
| 640 | lli_bhup_dhup(fi, event, arg); |
| 641 | } |
| 642 | |
| 643 | static void |
| 644 | lli_release_req(struct FsmInst *fi, int event, void *arg) |
| 645 | { |
| 646 | struct Channel *chanp = fi->userdata; |
| 647 | |
| 648 | if (chanp->leased) { |
| 649 | lli_leased_hup(fi, chanp); |
| 650 | } else { |
| 651 | FsmChangeState(fi, ST_WAIT_D_REL_CNF); |
| 652 | chanp->d_st->lli.l4l3(chanp->d_st, CC_RELEASE | REQUEST, |
| 653 | chanp->proc); |
| 654 | } |
| 655 | } |
| 656 | |
| 657 | static void |
| 658 | lli_rel_b_release_req(struct FsmInst *fi, int event, void *arg) |
| 659 | { |
| 660 | struct Channel *chanp = fi->userdata; |
| 661 | |
| 662 | release_b_st(chanp); |
| 663 | lli_release_req(fi, event, arg); |
| 664 | } |
| 665 | |
| 666 | static void |
| 667 | lli_bhup_release_req(struct FsmInst *fi, int event, void *arg) |
| 668 | { |
| 669 | struct Channel *chanp = fi->userdata; |
| 670 | |
| 671 | if (chanp->debug & 1) |
| 672 | link_debug(chanp, 0, "STAT_BHUP"); |
| 673 | HL_LL(chanp, ISDN_STAT_BHUP); |
| 674 | lli_rel_b_release_req(fi, event, arg); |
| 675 | } |
| 676 | |
| 677 | |
| 678 | /* processing charge info */ |
| 679 | static void |
| 680 | lli_charge_info(struct FsmInst *fi, int event, void *arg) |
| 681 | { |
| 682 | struct Channel *chanp = fi->userdata; |
| 683 | isdn_ctrl ic; |
| 684 | |
| 685 | ic.driver = chanp->cs->myid; |
| 686 | ic.command = ISDN_STAT_CINF; |
| 687 | ic.arg = chanp->chan; |
| 688 | sprintf(ic.parm.num, "%d", chanp->proc->para.chargeinfo); |
| 689 | chanp->cs->iif.statcallb(&ic); |
| 690 | } |
| 691 | |
| 692 | /* error procedures */ |
| 693 | |
| 694 | static void |
| 695 | lli_dchan_not_ready(struct FsmInst *fi, int event, void *arg) |
| 696 | { |
| 697 | struct Channel *chanp = fi->userdata; |
| 698 | |
| 699 | if (chanp->debug & 1) |
| 700 | link_debug(chanp, 0, "STAT_DHUP"); |
| 701 | HL_LL(chanp, ISDN_STAT_DHUP); |
| 702 | } |
| 703 | |
| 704 | static void |
| 705 | lli_no_setup_rsp(struct FsmInst *fi, int event, void *arg) |
| 706 | { |
| 707 | struct Channel *chanp = fi->userdata; |
| 708 | |
| 709 | if (chanp->debug & 1) |
| 710 | link_debug(chanp, 0, "STAT_DHUP"); |
| 711 | HL_LL(chanp, ISDN_STAT_DHUP); |
| 712 | lli_close(fi); |
| 713 | } |
| 714 | |
| 715 | static void |
| 716 | lli_error(struct FsmInst *fi, int event, void *arg) |
| 717 | { |
| 718 | FsmChangeState(fi, ST_WAIT_DRELEASE); |
| 719 | } |
| 720 | |
| 721 | static void |
| 722 | lli_failure_l(struct FsmInst *fi, int event, void *arg) |
| 723 | { |
| 724 | struct Channel *chanp = fi->userdata; |
| 725 | isdn_ctrl ic; |
| 726 | |
| 727 | FsmChangeState(fi, ST_NULL); |
| 728 | ic.driver = chanp->cs->myid; |
| 729 | ic.command = ISDN_STAT_CAUSE; |
| 730 | ic.arg = chanp->chan; |
| 731 | sprintf(ic.parm.num, "L%02X%02X", 0, 0x2f); |
| 732 | chanp->cs->iif.statcallb(&ic); |
| 733 | HL_LL(chanp, ISDN_STAT_DHUP); |
| 734 | chanp->Flags = 0; |
| 735 | chanp->cs->cardmsg(chanp->cs, MDL_INFO_REL, (void *) (long)chanp->chan); |
| 736 | } |
| 737 | |
| 738 | static void |
| 739 | lli_rel_b_fail(struct FsmInst *fi, int event, void *arg) |
| 740 | { |
| 741 | struct Channel *chanp = fi->userdata; |
| 742 | |
| 743 | release_b_st(chanp); |
| 744 | lli_failure_l(fi, event, arg); |
| 745 | } |
| 746 | |
| 747 | static void |
| 748 | lli_bhup_fail(struct FsmInst *fi, int event, void *arg) |
| 749 | { |
| 750 | struct Channel *chanp = fi->userdata; |
| 751 | |
| 752 | if (chanp->debug & 1) |
| 753 | link_debug(chanp, 0, "STAT_BHUP"); |
| 754 | HL_LL(chanp, ISDN_STAT_BHUP); |
| 755 | lli_rel_b_fail(fi, event, arg); |
| 756 | } |
| 757 | |
| 758 | static void |
| 759 | lli_failure_a(struct FsmInst *fi, int event, void *arg) |
| 760 | { |
| 761 | struct Channel *chanp = fi->userdata; |
| 762 | |
| 763 | chanp->data_open = 0; |
| 764 | chanp->b_st->lli.l4l3(chanp->b_st, DL_RELEASE | REQUEST, NULL); |
| 765 | lli_bhup_fail(fi, event, arg); |
| 766 | } |
| 767 | |
| 768 | /* *INDENT-OFF* */ |
| 769 | static struct FsmNode fnlist[] __initdata = |
| 770 | { |
| 771 | {ST_NULL, EV_DIAL, lli_prep_dialout}, |
| 772 | {ST_NULL, EV_RESUME, lli_resume}, |
| 773 | {ST_NULL, EV_SETUP_IND, lli_deliver_call}, |
| 774 | {ST_NULL, EV_LEASED, lli_leased_in}, |
| 775 | {ST_OUT_DIAL, EV_SETUP_CNF, lli_init_bchan_out}, |
| 776 | {ST_OUT_DIAL, EV_HANGUP, lli_disconnect_req}, |
| 777 | {ST_OUT_DIAL, EV_DISCONNECT_IND, lli_release_req}, |
| 778 | {ST_OUT_DIAL, EV_RELEASE, lli_dhup_close}, |
| 779 | {ST_OUT_DIAL, EV_NOSETUP_RSP, lli_no_setup_rsp}, |
| 780 | {ST_OUT_DIAL, EV_SETUP_ERR, lli_error}, |
| 781 | {ST_IN_WAIT_LL, EV_LEASED_REL, lli_failure_l}, |
| 782 | {ST_IN_WAIT_LL, EV_ACCEPTD, lli_setup_rsp}, |
| 783 | {ST_IN_WAIT_LL, EV_HANGUP, lli_reject_req}, |
| 784 | {ST_IN_WAIT_LL, EV_DISCONNECT_IND, lli_release_req}, |
| 785 | {ST_IN_WAIT_LL, EV_RELEASE, lli_dhup_close}, |
| 786 | {ST_IN_WAIT_LL, EV_SETUP_IND, lli_deliver_call}, |
| 787 | {ST_IN_WAIT_LL, EV_SETUP_ERR, lli_error}, |
| 788 | {ST_IN_ALERT_SENT, EV_SETUP_CMPL_IND, lli_init_bchan_in}, |
| 789 | {ST_IN_ALERT_SENT, EV_ACCEPTD, lli_send_dconnect}, |
| 790 | {ST_IN_ALERT_SENT, EV_HANGUP, lli_disconnect_reject}, |
| 791 | {ST_IN_ALERT_SENT, EV_DISCONNECT_IND, lli_release_req}, |
| 792 | {ST_IN_ALERT_SENT, EV_RELEASE, lli_dhup_close}, |
| 793 | {ST_IN_ALERT_SENT, EV_REDIR, lli_send_redir}, |
| 794 | {ST_IN_PROCEED_SEND, EV_REDIR, lli_send_redir}, |
| 795 | {ST_IN_PROCEED_SEND, EV_ALERT, lli_send_alert}, |
| 796 | {ST_IN_PROCEED_SEND, EV_ACCEPTD, lli_send_dconnect}, |
| 797 | {ST_IN_PROCEED_SEND, EV_HANGUP, lli_disconnect_reject}, |
| 798 | {ST_IN_PROCEED_SEND, EV_DISCONNECT_IND, lli_dhup_close}, |
| 799 | {ST_IN_ALERT_SENT, EV_RELEASE, lli_dhup_close}, |
| 800 | {ST_IN_WAIT_CONN_ACK, EV_SETUP_CMPL_IND, lli_init_bchan_in}, |
| 801 | {ST_IN_WAIT_CONN_ACK, EV_HANGUP, lli_disconnect_req}, |
| 802 | {ST_IN_WAIT_CONN_ACK, EV_DISCONNECT_IND, lli_release_req}, |
| 803 | {ST_IN_WAIT_CONN_ACK, EV_RELEASE, lli_dhup_close}, |
| 804 | {ST_IN_WAIT_CONN_ACK, EV_CONNECT_ERR, lli_error}, |
| 805 | {ST_WAIT_BCONN, EV_BC_EST, lli_go_active}, |
| 806 | {ST_WAIT_BCONN, EV_BC_REL, lli_rel_b_disc}, |
| 807 | {ST_WAIT_BCONN, EV_HANGUP, lli_rel_b_disc}, |
| 808 | {ST_WAIT_BCONN, EV_DISCONNECT_IND, lli_rel_b_release_req}, |
| 809 | {ST_WAIT_BCONN, EV_RELEASE, lli_rel_b_dhup}, |
| 810 | {ST_WAIT_BCONN, EV_LEASED_REL, lli_rel_b_fail}, |
| 811 | {ST_WAIT_BCONN, EV_CINF, lli_charge_info}, |
| 812 | {ST_ACTIVE, EV_CINF, lli_charge_info}, |
| 813 | {ST_ACTIVE, EV_BC_REL, lli_bhup_rel_b}, |
| 814 | {ST_ACTIVE, EV_SUSPEND, lli_suspend}, |
| 815 | {ST_ACTIVE, EV_HANGUP, lli_disconn_bchan}, |
| 816 | {ST_ACTIVE, EV_DISCONNECT_IND, lli_release_bchan}, |
| 817 | {ST_ACTIVE, EV_RELEASE, lli_abort}, |
| 818 | {ST_ACTIVE, EV_LEASED_REL, lli_failure_a}, |
| 819 | {ST_WAIT_BRELEASE, EV_BC_REL, lli_bhup_disc}, |
| 820 | {ST_WAIT_BRELEASE, EV_DISCONNECT_IND, lli_bhup_release_req}, |
| 821 | {ST_WAIT_BRELEASE, EV_RELEASE, lli_bhup_dhup}, |
| 822 | {ST_WAIT_BRELEASE, EV_LEASED_REL, lli_bhup_fail}, |
| 823 | {ST_WAIT_BREL_DISC, EV_BC_REL, lli_bhup_release_req}, |
| 824 | {ST_WAIT_BREL_DISC, EV_RELEASE, lli_bhup_dhup}, |
| 825 | {ST_WAIT_DCOMMAND, EV_HANGUP, lli_start_disc}, |
| 826 | {ST_WAIT_DCOMMAND, EV_DISCONNECT_IND, lli_release_req}, |
| 827 | {ST_WAIT_DCOMMAND, EV_RELEASE, lli_dhup_close}, |
| 828 | {ST_WAIT_DCOMMAND, EV_LEASED_REL, lli_failure_l}, |
| 829 | {ST_WAIT_DRELEASE, EV_RELEASE, lli_dhup_close}, |
| 830 | {ST_WAIT_DRELEASE, EV_DIAL, lli_dchan_not_ready}, |
| 831 | /* ETS 300-104 16.1 */ |
| 832 | {ST_WAIT_D_REL_CNF, EV_RELEASE, lli_dhup_close}, |
| 833 | {ST_WAIT_D_REL_CNF, EV_DIAL, lli_dchan_not_ready}, |
| 834 | }; |
| 835 | /* *INDENT-ON* */ |
| 836 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 837 | int __init |
| 838 | CallcNew(void) |
| 839 | { |
| 840 | callcfsm.state_count = STATE_COUNT; |
| 841 | callcfsm.event_count = EVENT_COUNT; |
| 842 | callcfsm.strEvent = strEvent; |
| 843 | callcfsm.strState = strState; |
Karsten Keil | ba2d6cc | 2009-07-24 18:26:08 +0200 | [diff] [blame] | 844 | return FsmNew(&callcfsm, fnlist, ARRAY_SIZE(fnlist)); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 845 | } |
| 846 | |
| 847 | void |
| 848 | CallcFree(void) |
| 849 | { |
| 850 | FsmFree(&callcfsm); |
| 851 | } |
| 852 | |
| 853 | static void |
| 854 | release_b_st(struct Channel *chanp) |
| 855 | { |
| 856 | struct PStack *st = chanp->b_st; |
| 857 | |
| 858 | if(test_and_clear_bit(FLG_START_B, &chanp->Flags)) { |
| 859 | chanp->bcs->BC_Close(chanp->bcs); |
| 860 | switch (chanp->l2_active_protocol) { |
| 861 | case (ISDN_PROTO_L2_X75I): |
| 862 | releasestack_isdnl2(st); |
| 863 | break; |
| 864 | case (ISDN_PROTO_L2_HDLC): |
| 865 | case (ISDN_PROTO_L2_HDLC_56K): |
| 866 | case (ISDN_PROTO_L2_TRANS): |
| 867 | case (ISDN_PROTO_L2_MODEM): |
| 868 | case (ISDN_PROTO_L2_FAX): |
| 869 | releasestack_transl2(st); |
| 870 | break; |
| 871 | } |
| 872 | } |
| 873 | } |
| 874 | |
Adrian Bunk | 672c3fd | 2005-06-25 14:59:18 -0700 | [diff] [blame] | 875 | static struct Channel |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 876 | *selectfreechannel(struct PStack *st, int bch) |
| 877 | { |
| 878 | struct IsdnCardState *cs = st->l1.hardware; |
| 879 | struct Channel *chanp = st->lli.userdata; |
| 880 | int i; |
| 881 | |
| 882 | if (test_bit(FLG_TWO_DCHAN, &cs->HW_Flags)) |
| 883 | i=1; |
| 884 | else |
| 885 | i=0; |
| 886 | |
| 887 | if (!bch) { |
| 888 | i = 2; /* virtual channel */ |
| 889 | chanp += 2; |
| 890 | } |
| 891 | |
| 892 | while (i < ((bch) ? cs->chanlimit : (2 + MAX_WAITING_CALLS))) { |
| 893 | if (chanp->fi.state == ST_NULL) |
| 894 | return (chanp); |
| 895 | chanp++; |
| 896 | i++; |
| 897 | } |
| 898 | |
| 899 | if (bch) /* number of channels is limited */ { |
| 900 | i = 2; /* virtual channel */ |
| 901 | chanp = st->lli.userdata; |
| 902 | chanp += i; |
| 903 | while (i < (2 + MAX_WAITING_CALLS)) { |
| 904 | if (chanp->fi.state == ST_NULL) |
| 905 | return (chanp); |
| 906 | chanp++; |
| 907 | i++; |
| 908 | } |
| 909 | } |
| 910 | return (NULL); |
| 911 | } |
| 912 | |
| 913 | static void stat_redir_result(struct IsdnCardState *cs, int chan, ulong result) |
| 914 | { isdn_ctrl ic; |
| 915 | |
| 916 | ic.driver = cs->myid; |
| 917 | ic.command = ISDN_STAT_REDIR; |
| 918 | ic.arg = chan; |
| 919 | ic.parm.num[0] = result; |
| 920 | cs->iif.statcallb(&ic); |
| 921 | } /* stat_redir_result */ |
| 922 | |
| 923 | static void |
| 924 | dchan_l3l4(struct PStack *st, int pr, void *arg) |
| 925 | { |
| 926 | struct l3_process *pc = arg; |
| 927 | struct IsdnCardState *cs = st->l1.hardware; |
| 928 | struct Channel *chanp; |
| 929 | |
| 930 | if(!pc) |
| 931 | return; |
| 932 | |
| 933 | if (pr == (CC_SETUP | INDICATION)) { |
| 934 | if (!(chanp = selectfreechannel(pc->st, pc->para.bchannel))) { |
| 935 | pc->para.cause = 0x11; /* User busy */ |
| 936 | pc->st->lli.l4l3(pc->st, CC_REJECT | REQUEST, pc); |
| 937 | } else { |
| 938 | chanp->proc = pc; |
| 939 | pc->chan = chanp; |
| 940 | FsmEvent(&chanp->fi, EV_SETUP_IND, NULL); |
| 941 | } |
| 942 | return; |
| 943 | } |
| 944 | if (!(chanp = pc->chan)) |
| 945 | return; |
| 946 | |
| 947 | switch (pr) { |
| 948 | case (CC_MORE_INFO | INDICATION): |
| 949 | FsmEvent(&chanp->fi, EV_SETUP_IND, NULL); |
| 950 | break; |
| 951 | case (CC_DISCONNECT | INDICATION): |
| 952 | FsmEvent(&chanp->fi, EV_DISCONNECT_IND, NULL); |
| 953 | break; |
| 954 | case (CC_RELEASE | CONFIRM): |
| 955 | FsmEvent(&chanp->fi, EV_RELEASE, NULL); |
| 956 | break; |
| 957 | case (CC_SUSPEND | CONFIRM): |
| 958 | FsmEvent(&chanp->fi, EV_RELEASE, NULL); |
| 959 | break; |
| 960 | case (CC_RESUME | CONFIRM): |
| 961 | FsmEvent(&chanp->fi, EV_SETUP_CNF, NULL); |
| 962 | break; |
| 963 | case (CC_RESUME_ERR): |
| 964 | FsmEvent(&chanp->fi, EV_RELEASE, NULL); |
| 965 | break; |
| 966 | case (CC_RELEASE | INDICATION): |
| 967 | FsmEvent(&chanp->fi, EV_RELEASE, NULL); |
| 968 | break; |
| 969 | case (CC_SETUP_COMPL | INDICATION): |
| 970 | FsmEvent(&chanp->fi, EV_SETUP_CMPL_IND, NULL); |
| 971 | break; |
| 972 | case (CC_SETUP | CONFIRM): |
| 973 | FsmEvent(&chanp->fi, EV_SETUP_CNF, NULL); |
| 974 | break; |
| 975 | case (CC_CHARGE | INDICATION): |
| 976 | FsmEvent(&chanp->fi, EV_CINF, NULL); |
| 977 | break; |
| 978 | case (CC_NOSETUP_RSP): |
| 979 | FsmEvent(&chanp->fi, EV_NOSETUP_RSP, NULL); |
| 980 | break; |
| 981 | case (CC_SETUP_ERR): |
| 982 | FsmEvent(&chanp->fi, EV_SETUP_ERR, NULL); |
| 983 | break; |
| 984 | case (CC_CONNECT_ERR): |
| 985 | FsmEvent(&chanp->fi, EV_CONNECT_ERR, NULL); |
| 986 | break; |
| 987 | case (CC_RELEASE_ERR): |
| 988 | FsmEvent(&chanp->fi, EV_RELEASE, NULL); |
| 989 | break; |
| 990 | case (CC_PROCEED_SEND | INDICATION): |
| 991 | case (CC_PROCEEDING | INDICATION): |
| 992 | case (CC_ALERTING | INDICATION): |
| 993 | case (CC_PROGRESS | INDICATION): |
| 994 | case (CC_NOTIFY | INDICATION): |
| 995 | break; |
| 996 | case (CC_REDIR | INDICATION): |
| 997 | stat_redir_result(cs, chanp->chan, pc->redir_result); |
| 998 | break; |
| 999 | default: |
| 1000 | if (chanp->debug & 0x800) { |
| 1001 | HiSax_putstatus(chanp->cs, "Ch", |
| 1002 | "%d L3->L4 unknown primitiv %#x", |
| 1003 | chanp->chan, pr); |
| 1004 | } |
| 1005 | } |
| 1006 | } |
| 1007 | |
| 1008 | static void |
| 1009 | dummy_pstack(struct PStack *st, int pr, void *arg) { |
| 1010 | printk(KERN_WARNING"call to dummy_pstack pr=%04x arg %lx\n", pr, (long)arg); |
| 1011 | } |
| 1012 | |
| 1013 | static int |
| 1014 | init_PStack(struct PStack **stp) { |
| 1015 | *stp = kmalloc(sizeof(struct PStack), GFP_ATOMIC); |
| 1016 | if (!*stp) |
| 1017 | return -ENOMEM; |
| 1018 | (*stp)->next = NULL; |
| 1019 | (*stp)->l1.l1l2 = dummy_pstack; |
| 1020 | (*stp)->l1.l1hw = dummy_pstack; |
| 1021 | (*stp)->l1.l1tei = dummy_pstack; |
| 1022 | (*stp)->l2.l2tei = dummy_pstack; |
| 1023 | (*stp)->l2.l2l1 = dummy_pstack; |
| 1024 | (*stp)->l2.l2l3 = dummy_pstack; |
| 1025 | (*stp)->l3.l3l2 = dummy_pstack; |
| 1026 | (*stp)->l3.l3ml3 = dummy_pstack; |
| 1027 | (*stp)->l3.l3l4 = dummy_pstack; |
| 1028 | (*stp)->lli.l4l3 = dummy_pstack; |
| 1029 | (*stp)->ma.layer = dummy_pstack; |
| 1030 | return 0; |
| 1031 | } |
| 1032 | |
| 1033 | static int |
| 1034 | init_d_st(struct Channel *chanp) |
| 1035 | { |
| 1036 | struct PStack *st; |
| 1037 | struct IsdnCardState *cs = chanp->cs; |
| 1038 | char tmp[16]; |
| 1039 | int err; |
| 1040 | |
| 1041 | err = init_PStack(&chanp->d_st); |
| 1042 | if (err) |
| 1043 | return err; |
| 1044 | st = chanp->d_st; |
| 1045 | st->next = NULL; |
| 1046 | HiSax_addlist(cs, st); |
| 1047 | setstack_HiSax(st, cs); |
| 1048 | st->l2.sap = 0; |
| 1049 | st->l2.tei = -1; |
| 1050 | st->l2.flag = 0; |
| 1051 | test_and_set_bit(FLG_MOD128, &st->l2.flag); |
| 1052 | test_and_set_bit(FLG_LAPD, &st->l2.flag); |
| 1053 | test_and_set_bit(FLG_ORIG, &st->l2.flag); |
| 1054 | st->l2.maxlen = MAX_DFRAME_LEN; |
| 1055 | st->l2.window = 1; |
| 1056 | st->l2.T200 = 1000; /* 1000 milliseconds */ |
| 1057 | st->l2.N200 = 3; /* try 3 times */ |
| 1058 | st->l2.T203 = 10000; /* 10000 milliseconds */ |
| 1059 | if (test_bit(FLG_TWO_DCHAN, &cs->HW_Flags)) |
| 1060 | sprintf(tmp, "DCh%d Q.921 ", chanp->chan); |
| 1061 | else |
| 1062 | sprintf(tmp, "DCh Q.921 "); |
| 1063 | setstack_isdnl2(st, tmp); |
| 1064 | setstack_l3dc(st, chanp); |
| 1065 | st->lli.userdata = chanp; |
| 1066 | st->l3.l3l4 = dchan_l3l4; |
| 1067 | |
| 1068 | return 0; |
| 1069 | } |
| 1070 | |
Joe Perches | 9920239 | 2010-11-10 18:54:58 +0000 | [diff] [blame] | 1071 | static __attribute__((format(printf, 2, 3))) void |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1072 | callc_debug(struct FsmInst *fi, char *fmt, ...) |
| 1073 | { |
| 1074 | va_list args; |
| 1075 | struct Channel *chanp = fi->userdata; |
| 1076 | char tmp[16]; |
| 1077 | |
| 1078 | va_start(args, fmt); |
| 1079 | sprintf(tmp, "Ch%d callc ", chanp->chan); |
| 1080 | VHiSax_putstatus(chanp->cs, tmp, fmt, args); |
| 1081 | va_end(args); |
| 1082 | } |
| 1083 | |
| 1084 | static int |
| 1085 | init_chan(int chan, struct IsdnCardState *csta) |
| 1086 | { |
| 1087 | struct Channel *chanp = csta->channel + chan; |
| 1088 | int err; |
| 1089 | |
| 1090 | chanp->cs = csta; |
| 1091 | chanp->bcs = csta->bcs + chan; |
| 1092 | chanp->chan = chan; |
| 1093 | chanp->incoming = 0; |
| 1094 | chanp->debug = 0; |
| 1095 | chanp->Flags = 0; |
| 1096 | chanp->leased = 0; |
| 1097 | err = init_PStack(&chanp->b_st); |
| 1098 | if (err) |
| 1099 | return err; |
| 1100 | chanp->b_st->l1.delay = DEFAULT_B_DELAY; |
| 1101 | chanp->fi.fsm = &callcfsm; |
| 1102 | chanp->fi.state = ST_NULL; |
| 1103 | chanp->fi.debug = 0; |
| 1104 | chanp->fi.userdata = chanp; |
| 1105 | chanp->fi.printdebug = callc_debug; |
| 1106 | FsmInitTimer(&chanp->fi, &chanp->dial_timer); |
| 1107 | FsmInitTimer(&chanp->fi, &chanp->drel_timer); |
| 1108 | if (!chan || (test_bit(FLG_TWO_DCHAN, &csta->HW_Flags) && chan < 2)) { |
| 1109 | err = init_d_st(chanp); |
| 1110 | if (err) |
| 1111 | return err; |
| 1112 | } else { |
| 1113 | chanp->d_st = csta->channel->d_st; |
| 1114 | } |
| 1115 | chanp->data_open = 0; |
| 1116 | return 0; |
| 1117 | } |
| 1118 | |
| 1119 | int |
| 1120 | CallcNewChan(struct IsdnCardState *csta) { |
| 1121 | int i, err; |
| 1122 | |
| 1123 | chancount += 2; |
| 1124 | err = init_chan(0, csta); |
| 1125 | if (err) |
| 1126 | return err; |
| 1127 | err = init_chan(1, csta); |
| 1128 | if (err) |
| 1129 | return err; |
| 1130 | printk(KERN_INFO "HiSax: 2 channels added\n"); |
| 1131 | |
| 1132 | for (i = 0; i < MAX_WAITING_CALLS; i++) { |
| 1133 | err = init_chan(i+2,csta); |
| 1134 | if (err) |
| 1135 | return err; |
| 1136 | } |
| 1137 | printk(KERN_INFO "HiSax: MAX_WAITING_CALLS added\n"); |
| 1138 | if (test_bit(FLG_PTP, &csta->channel->d_st->l2.flag)) { |
| 1139 | printk(KERN_INFO "LAYER2 WATCHING ESTABLISH\n"); |
| 1140 | csta->channel->d_st->lli.l4l3(csta->channel->d_st, |
| 1141 | DL_ESTABLISH | REQUEST, NULL); |
| 1142 | } |
| 1143 | return (0); |
| 1144 | } |
| 1145 | |
| 1146 | static void |
| 1147 | release_d_st(struct Channel *chanp) |
| 1148 | { |
| 1149 | struct PStack *st = chanp->d_st; |
| 1150 | |
| 1151 | if (!st) |
| 1152 | return; |
| 1153 | releasestack_isdnl2(st); |
| 1154 | releasestack_isdnl3(st); |
| 1155 | HiSax_rmlist(st->l1.hardware, st); |
| 1156 | kfree(st); |
| 1157 | chanp->d_st = NULL; |
| 1158 | } |
| 1159 | |
| 1160 | void |
| 1161 | CallcFreeChan(struct IsdnCardState *csta) |
| 1162 | { |
| 1163 | int i; |
| 1164 | |
| 1165 | for (i = 0; i < 2; i++) { |
| 1166 | FsmDelTimer(&csta->channel[i].drel_timer, 74); |
| 1167 | FsmDelTimer(&csta->channel[i].dial_timer, 75); |
| 1168 | if (i || test_bit(FLG_TWO_DCHAN, &csta->HW_Flags)) |
| 1169 | release_d_st(csta->channel + i); |
| 1170 | if (csta->channel[i].b_st) { |
| 1171 | release_b_st(csta->channel + i); |
| 1172 | kfree(csta->channel[i].b_st); |
| 1173 | csta->channel[i].b_st = NULL; |
| 1174 | } else |
Uwe Kleine-König | 698f931 | 2010-07-02 20:41:51 +0200 | [diff] [blame] | 1175 | printk(KERN_WARNING "CallcFreeChan b_st ch%d already freed\n", i); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1176 | if (i || test_bit(FLG_TWO_DCHAN, &csta->HW_Flags)) { |
| 1177 | release_d_st(csta->channel + i); |
| 1178 | } else |
| 1179 | csta->channel[i].d_st = NULL; |
| 1180 | } |
| 1181 | } |
| 1182 | |
| 1183 | static void |
| 1184 | lldata_handler(struct PStack *st, int pr, void *arg) |
| 1185 | { |
| 1186 | struct Channel *chanp = (struct Channel *) st->lli.userdata; |
| 1187 | struct sk_buff *skb = arg; |
| 1188 | |
| 1189 | switch (pr) { |
| 1190 | case (DL_DATA | INDICATION): |
| 1191 | if (chanp->data_open) { |
| 1192 | if (chanp->debug & 0x800) |
| 1193 | link_debug(chanp, 0, "lldata: %d", skb->len); |
| 1194 | chanp->cs->iif.rcvcallb_skb(chanp->cs->myid, chanp->chan, skb); |
| 1195 | } else { |
| 1196 | link_debug(chanp, 0, "lldata: channel not open"); |
| 1197 | dev_kfree_skb(skb); |
| 1198 | } |
| 1199 | break; |
| 1200 | case (DL_ESTABLISH | INDICATION): |
| 1201 | case (DL_ESTABLISH | CONFIRM): |
| 1202 | FsmEvent(&chanp->fi, EV_BC_EST, NULL); |
| 1203 | break; |
| 1204 | case (DL_RELEASE | INDICATION): |
| 1205 | case (DL_RELEASE | CONFIRM): |
| 1206 | FsmEvent(&chanp->fi, EV_BC_REL, NULL); |
| 1207 | break; |
| 1208 | default: |
| 1209 | printk(KERN_WARNING "lldata_handler unknown primitive %#x\n", |
| 1210 | pr); |
| 1211 | break; |
| 1212 | } |
| 1213 | } |
| 1214 | |
| 1215 | static void |
| 1216 | lltrans_handler(struct PStack *st, int pr, void *arg) |
| 1217 | { |
| 1218 | struct Channel *chanp = (struct Channel *) st->lli.userdata; |
| 1219 | struct sk_buff *skb = arg; |
| 1220 | |
| 1221 | switch (pr) { |
| 1222 | case (PH_DATA | INDICATION): |
| 1223 | if (chanp->data_open) { |
| 1224 | if (chanp->debug & 0x800) |
| 1225 | link_debug(chanp, 0, "lltrans: %d", skb->len); |
| 1226 | chanp->cs->iif.rcvcallb_skb(chanp->cs->myid, chanp->chan, skb); |
| 1227 | } else { |
| 1228 | link_debug(chanp, 0, "lltrans: channel not open"); |
| 1229 | dev_kfree_skb(skb); |
| 1230 | } |
| 1231 | break; |
| 1232 | case (PH_ACTIVATE | INDICATION): |
| 1233 | case (PH_ACTIVATE | CONFIRM): |
| 1234 | FsmEvent(&chanp->fi, EV_BC_EST, NULL); |
| 1235 | break; |
| 1236 | case (PH_DEACTIVATE | INDICATION): |
| 1237 | case (PH_DEACTIVATE | CONFIRM): |
| 1238 | FsmEvent(&chanp->fi, EV_BC_REL, NULL); |
| 1239 | break; |
| 1240 | default: |
| 1241 | printk(KERN_WARNING "lltrans_handler unknown primitive %#x\n", |
| 1242 | pr); |
| 1243 | break; |
| 1244 | } |
| 1245 | } |
| 1246 | |
| 1247 | void |
| 1248 | lli_writewakeup(struct PStack *st, int len) |
| 1249 | { |
| 1250 | struct Channel *chanp = st->lli.userdata; |
| 1251 | isdn_ctrl ic; |
| 1252 | |
| 1253 | if (chanp->debug & 0x800) |
| 1254 | link_debug(chanp, 0, "llwakeup: %d", len); |
| 1255 | ic.driver = chanp->cs->myid; |
| 1256 | ic.command = ISDN_STAT_BSENT; |
| 1257 | ic.arg = chanp->chan; |
| 1258 | ic.parm.length = len; |
| 1259 | chanp->cs->iif.statcallb(&ic); |
| 1260 | } |
| 1261 | |
| 1262 | static int |
| 1263 | init_b_st(struct Channel *chanp, int incoming) |
| 1264 | { |
| 1265 | struct PStack *st = chanp->b_st; |
| 1266 | struct IsdnCardState *cs = chanp->cs; |
| 1267 | char tmp[16]; |
| 1268 | |
| 1269 | st->l1.hardware = cs; |
| 1270 | if (chanp->leased) |
| 1271 | st->l1.bc = chanp->chan & 1; |
| 1272 | else |
| 1273 | st->l1.bc = chanp->proc->para.bchannel - 1; |
| 1274 | switch (chanp->l2_active_protocol) { |
| 1275 | case (ISDN_PROTO_L2_X75I): |
| 1276 | case (ISDN_PROTO_L2_HDLC): |
| 1277 | st->l1.mode = L1_MODE_HDLC; |
| 1278 | break; |
| 1279 | case (ISDN_PROTO_L2_HDLC_56K): |
| 1280 | st->l1.mode = L1_MODE_HDLC_56K; |
| 1281 | break; |
| 1282 | case (ISDN_PROTO_L2_TRANS): |
| 1283 | st->l1.mode = L1_MODE_TRANS; |
| 1284 | break; |
| 1285 | case (ISDN_PROTO_L2_MODEM): |
| 1286 | st->l1.mode = L1_MODE_V32; |
| 1287 | break; |
| 1288 | case (ISDN_PROTO_L2_FAX): |
| 1289 | st->l1.mode = L1_MODE_FAX; |
| 1290 | break; |
| 1291 | } |
| 1292 | chanp->bcs->conmsg = NULL; |
| 1293 | if (chanp->bcs->BC_SetStack(st, chanp->bcs)) |
| 1294 | return (-1); |
| 1295 | st->l2.flag = 0; |
| 1296 | test_and_set_bit(FLG_LAPB, &st->l2.flag); |
| 1297 | st->l2.maxlen = MAX_DATA_SIZE; |
| 1298 | if (!incoming) |
| 1299 | test_and_set_bit(FLG_ORIG, &st->l2.flag); |
| 1300 | st->l2.T200 = 1000; /* 1000 milliseconds */ |
| 1301 | st->l2.window = 7; |
| 1302 | st->l2.N200 = 4; /* try 4 times */ |
| 1303 | st->l2.T203 = 5000; /* 5000 milliseconds */ |
| 1304 | st->l3.debug = 0; |
| 1305 | switch (chanp->l2_active_protocol) { |
| 1306 | case (ISDN_PROTO_L2_X75I): |
| 1307 | sprintf(tmp, "Ch%d X.75", chanp->chan); |
| 1308 | setstack_isdnl2(st, tmp); |
| 1309 | setstack_l3bc(st, chanp); |
| 1310 | st->l2.l2l3 = lldata_handler; |
| 1311 | st->lli.userdata = chanp; |
| 1312 | test_and_clear_bit(FLG_LLI_L1WAKEUP, &st->lli.flag); |
| 1313 | test_and_set_bit(FLG_LLI_L2WAKEUP, &st->lli.flag); |
| 1314 | st->l2.l2m.debug = chanp->debug & 16; |
| 1315 | st->l2.debug = chanp->debug & 64; |
| 1316 | break; |
| 1317 | case (ISDN_PROTO_L2_HDLC): |
| 1318 | case (ISDN_PROTO_L2_HDLC_56K): |
| 1319 | case (ISDN_PROTO_L2_TRANS): |
| 1320 | case (ISDN_PROTO_L2_MODEM): |
| 1321 | case (ISDN_PROTO_L2_FAX): |
| 1322 | st->l1.l1l2 = lltrans_handler; |
| 1323 | st->lli.userdata = chanp; |
| 1324 | test_and_set_bit(FLG_LLI_L1WAKEUP, &st->lli.flag); |
| 1325 | test_and_clear_bit(FLG_LLI_L2WAKEUP, &st->lli.flag); |
| 1326 | setstack_transl2(st); |
| 1327 | setstack_l3bc(st, chanp); |
| 1328 | break; |
| 1329 | } |
| 1330 | test_and_set_bit(FLG_START_B, &chanp->Flags); |
| 1331 | return (0); |
| 1332 | } |
| 1333 | |
| 1334 | static void |
| 1335 | leased_l4l3(struct PStack *st, int pr, void *arg) |
| 1336 | { |
| 1337 | struct Channel *chanp = (struct Channel *) st->lli.userdata; |
| 1338 | struct sk_buff *skb = arg; |
| 1339 | |
| 1340 | switch (pr) { |
| 1341 | case (DL_DATA | REQUEST): |
| 1342 | link_debug(chanp, 0, "leased line d-channel DATA"); |
| 1343 | dev_kfree_skb(skb); |
| 1344 | break; |
| 1345 | case (DL_ESTABLISH | REQUEST): |
| 1346 | st->l2.l2l1(st, PH_ACTIVATE | REQUEST, NULL); |
| 1347 | break; |
| 1348 | case (DL_RELEASE | REQUEST): |
| 1349 | break; |
| 1350 | default: |
| 1351 | printk(KERN_WARNING "transd_l4l3 unknown primitive %#x\n", |
| 1352 | pr); |
| 1353 | break; |
| 1354 | } |
| 1355 | } |
| 1356 | |
| 1357 | static void |
| 1358 | leased_l1l2(struct PStack *st, int pr, void *arg) |
| 1359 | { |
| 1360 | struct Channel *chanp = (struct Channel *) st->lli.userdata; |
| 1361 | struct sk_buff *skb = arg; |
| 1362 | int i,event = EV_LEASED_REL; |
| 1363 | |
| 1364 | switch (pr) { |
| 1365 | case (PH_DATA | INDICATION): |
| 1366 | link_debug(chanp, 0, "leased line d-channel DATA"); |
| 1367 | dev_kfree_skb(skb); |
| 1368 | break; |
| 1369 | case (PH_ACTIVATE | INDICATION): |
| 1370 | case (PH_ACTIVATE | CONFIRM): |
| 1371 | event = EV_LEASED; |
| 1372 | case (PH_DEACTIVATE | INDICATION): |
| 1373 | case (PH_DEACTIVATE | CONFIRM): |
| 1374 | if (test_bit(FLG_TWO_DCHAN, &chanp->cs->HW_Flags)) |
| 1375 | i = 1; |
| 1376 | else |
| 1377 | i = 0; |
| 1378 | while (i < 2) { |
| 1379 | FsmEvent(&chanp->fi, event, NULL); |
| 1380 | chanp++; |
| 1381 | i++; |
| 1382 | } |
| 1383 | break; |
| 1384 | default: |
| 1385 | printk(KERN_WARNING |
| 1386 | "transd_l1l2 unknown primitive %#x\n", pr); |
| 1387 | break; |
| 1388 | } |
| 1389 | } |
| 1390 | |
| 1391 | static void |
| 1392 | distr_debug(struct IsdnCardState *csta, int debugflags) |
| 1393 | { |
| 1394 | int i; |
| 1395 | struct Channel *chanp = csta->channel; |
| 1396 | |
| 1397 | for (i = 0; i < (2 + MAX_WAITING_CALLS) ; i++) { |
| 1398 | chanp[i].debug = debugflags; |
| 1399 | chanp[i].fi.debug = debugflags & 2; |
| 1400 | chanp[i].d_st->l2.l2m.debug = debugflags & 8; |
| 1401 | chanp[i].b_st->l2.l2m.debug = debugflags & 0x10; |
| 1402 | chanp[i].d_st->l2.debug = debugflags & 0x20; |
| 1403 | chanp[i].b_st->l2.debug = debugflags & 0x40; |
| 1404 | chanp[i].d_st->l3.l3m.debug = debugflags & 0x80; |
| 1405 | chanp[i].b_st->l3.l3m.debug = debugflags & 0x100; |
| 1406 | chanp[i].b_st->ma.tei_m.debug = debugflags & 0x200; |
| 1407 | chanp[i].b_st->ma.debug = debugflags & 0x200; |
| 1408 | chanp[i].d_st->l1.l1m.debug = debugflags & 0x1000; |
| 1409 | chanp[i].b_st->l1.l1m.debug = debugflags & 0x2000; |
| 1410 | } |
| 1411 | if (debugflags & 4) |
| 1412 | csta->debug |= DEB_DLOG_HEX; |
| 1413 | else |
| 1414 | csta->debug &= ~DEB_DLOG_HEX; |
| 1415 | } |
| 1416 | |
| 1417 | static char tmpbuf[256]; |
| 1418 | |
| 1419 | static void |
| 1420 | capi_debug(struct Channel *chanp, capi_msg *cm) |
| 1421 | { |
| 1422 | char *t = tmpbuf; |
| 1423 | |
| 1424 | t += QuickHex(t, (u_char *)cm, (cm->Length>50)? 50: cm->Length); |
| 1425 | t--; |
| 1426 | *t= 0; |
| 1427 | HiSax_putstatus(chanp->cs, "Ch", "%d CAPIMSG %s", chanp->chan, tmpbuf); |
| 1428 | } |
| 1429 | |
Adrian Bunk | 672c3fd | 2005-06-25 14:59:18 -0700 | [diff] [blame] | 1430 | static void |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1431 | lli_got_fac_req(struct Channel *chanp, capi_msg *cm) { |
| 1432 | if ((cm->para[0] != 3) || (cm->para[1] != 0)) |
| 1433 | return; |
| 1434 | if (cm->para[2]<3) |
| 1435 | return; |
| 1436 | if (cm->para[4] != 0) |
| 1437 | return; |
| 1438 | switch(cm->para[3]) { |
| 1439 | case 4: /* Suspend */ |
| 1440 | strncpy(chanp->setup.phone, &cm->para[5], cm->para[5] +1); |
| 1441 | FsmEvent(&chanp->fi, EV_SUSPEND, cm); |
| 1442 | break; |
| 1443 | case 5: /* Resume */ |
| 1444 | strncpy(chanp->setup.phone, &cm->para[5], cm->para[5] +1); |
| 1445 | if (chanp->fi.state == ST_NULL) { |
| 1446 | FsmEvent(&chanp->fi, EV_RESUME, cm); |
| 1447 | } else { |
| 1448 | FsmDelTimer(&chanp->dial_timer, 72); |
| 1449 | FsmAddTimer(&chanp->dial_timer, 80, EV_RESUME, cm, 73); |
| 1450 | } |
| 1451 | break; |
| 1452 | } |
| 1453 | } |
| 1454 | |
Adrian Bunk | 672c3fd | 2005-06-25 14:59:18 -0700 | [diff] [blame] | 1455 | static void |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1456 | lli_got_manufacturer(struct Channel *chanp, struct IsdnCardState *cs, capi_msg *cm) { |
| 1457 | if ((cs->typ == ISDN_CTYPE_ELSA) || (cs->typ == ISDN_CTYPE_ELSA_PNP) || |
| 1458 | (cs->typ == ISDN_CTYPE_ELSA_PCI)) { |
| 1459 | if (cs->hw.elsa.MFlag) { |
| 1460 | cs->cardmsg(cs, CARD_AUX_IND, cm->para); |
| 1461 | } |
| 1462 | } |
| 1463 | } |
| 1464 | |
| 1465 | |
| 1466 | /***************************************************************/ |
| 1467 | /* Limit the available number of channels for the current card */ |
| 1468 | /***************************************************************/ |
| 1469 | static int |
| 1470 | set_channel_limit(struct IsdnCardState *cs, int chanmax) |
| 1471 | { |
| 1472 | isdn_ctrl ic; |
| 1473 | int i, ii; |
| 1474 | |
| 1475 | if ((chanmax < 0) || (chanmax > 2)) |
| 1476 | return(-EINVAL); |
| 1477 | cs->chanlimit = 0; |
| 1478 | for (ii = 0; ii < 2; ii++) { |
| 1479 | ic.driver = cs->myid; |
| 1480 | ic.command = ISDN_STAT_DISCH; |
| 1481 | ic.arg = ii; |
| 1482 | if (ii >= chanmax) |
| 1483 | ic.parm.num[0] = 0; /* disabled */ |
| 1484 | else |
| 1485 | ic.parm.num[0] = 1; /* enabled */ |
| 1486 | i = cs->iif.statcallb(&ic); |
| 1487 | if (i) return(-EINVAL); |
| 1488 | if (ii < chanmax) |
| 1489 | cs->chanlimit++; |
| 1490 | } |
| 1491 | return(0); |
| 1492 | } /* set_channel_limit */ |
| 1493 | |
| 1494 | int |
| 1495 | HiSax_command(isdn_ctrl * ic) |
| 1496 | { |
| 1497 | struct IsdnCardState *csta = hisax_findcard(ic->driver); |
| 1498 | struct PStack *st; |
| 1499 | struct Channel *chanp; |
| 1500 | int i; |
| 1501 | u_int num; |
| 1502 | |
| 1503 | if (!csta) { |
| 1504 | printk(KERN_ERR |
| 1505 | "HiSax: if_command %d called with invalid driverId %d!\n", |
| 1506 | ic->command, ic->driver); |
| 1507 | return -ENODEV; |
| 1508 | } |
| 1509 | switch (ic->command) { |
| 1510 | case (ISDN_CMD_SETEAZ): |
| 1511 | chanp = csta->channel + ic->arg; |
| 1512 | break; |
| 1513 | case (ISDN_CMD_SETL2): |
| 1514 | chanp = csta->channel + (ic->arg & 0xff); |
| 1515 | if (chanp->debug & 1) |
| 1516 | link_debug(chanp, 1, "SETL2 card %d %ld", |
| 1517 | csta->cardnr + 1, ic->arg >> 8); |
| 1518 | chanp->l2_protocol = ic->arg >> 8; |
| 1519 | break; |
| 1520 | case (ISDN_CMD_SETL3): |
| 1521 | chanp = csta->channel + (ic->arg & 0xff); |
| 1522 | if (chanp->debug & 1) |
| 1523 | link_debug(chanp, 1, "SETL3 card %d %ld", |
| 1524 | csta->cardnr + 1, ic->arg >> 8); |
| 1525 | chanp->l3_protocol = ic->arg >> 8; |
| 1526 | break; |
| 1527 | case (ISDN_CMD_DIAL): |
| 1528 | chanp = csta->channel + (ic->arg & 0xff); |
| 1529 | if (chanp->debug & 1) |
| 1530 | link_debug(chanp, 1, "DIAL %s -> %s (%d,%d)", |
| 1531 | ic->parm.setup.eazmsn, ic->parm.setup.phone, |
| 1532 | ic->parm.setup.si1, ic->parm.setup.si2); |
| 1533 | memcpy(&chanp->setup, &ic->parm.setup, sizeof(setup_parm)); |
| 1534 | if (!strcmp(chanp->setup.eazmsn, "0")) |
| 1535 | chanp->setup.eazmsn[0] = '\0'; |
| 1536 | /* this solution is dirty and may be change, if |
| 1537 | * we make a callreference based callmanager */ |
| 1538 | if (chanp->fi.state == ST_NULL) { |
| 1539 | FsmEvent(&chanp->fi, EV_DIAL, NULL); |
| 1540 | } else { |
| 1541 | FsmDelTimer(&chanp->dial_timer, 70); |
| 1542 | FsmAddTimer(&chanp->dial_timer, 50, EV_DIAL, NULL, 71); |
| 1543 | } |
| 1544 | break; |
| 1545 | case (ISDN_CMD_ACCEPTB): |
| 1546 | chanp = csta->channel + ic->arg; |
| 1547 | if (chanp->debug & 1) |
| 1548 | link_debug(chanp, 1, "ACCEPTB"); |
| 1549 | FsmEvent(&chanp->fi, EV_ACCEPTB, NULL); |
| 1550 | break; |
| 1551 | case (ISDN_CMD_ACCEPTD): |
| 1552 | chanp = csta->channel + ic->arg; |
| 1553 | memcpy(&chanp->setup, &ic->parm.setup, sizeof(setup_parm)); |
| 1554 | if (chanp->debug & 1) |
| 1555 | link_debug(chanp, 1, "ACCEPTD"); |
| 1556 | FsmEvent(&chanp->fi, EV_ACCEPTD, NULL); |
| 1557 | break; |
| 1558 | case (ISDN_CMD_HANGUP): |
| 1559 | chanp = csta->channel + ic->arg; |
| 1560 | if (chanp->debug & 1) |
| 1561 | link_debug(chanp, 1, "HANGUP"); |
| 1562 | FsmEvent(&chanp->fi, EV_HANGUP, NULL); |
| 1563 | break; |
| 1564 | case (CAPI_PUT_MESSAGE): |
| 1565 | chanp = csta->channel + ic->arg; |
| 1566 | if (chanp->debug & 1) |
| 1567 | capi_debug(chanp, &ic->parm.cmsg); |
| 1568 | if (ic->parm.cmsg.Length < 8) |
| 1569 | break; |
| 1570 | switch(ic->parm.cmsg.Command) { |
| 1571 | case CAPI_FACILITY: |
| 1572 | if (ic->parm.cmsg.Subcommand == CAPI_REQ) |
| 1573 | lli_got_fac_req(chanp, &ic->parm.cmsg); |
| 1574 | break; |
| 1575 | case CAPI_MANUFACTURER: |
| 1576 | if (ic->parm.cmsg.Subcommand == CAPI_REQ) |
| 1577 | lli_got_manufacturer(chanp, csta, &ic->parm.cmsg); |
| 1578 | break; |
| 1579 | default: |
| 1580 | break; |
| 1581 | } |
| 1582 | break; |
| 1583 | case (ISDN_CMD_IOCTL): |
| 1584 | switch (ic->arg) { |
| 1585 | case (0): |
| 1586 | num = *(unsigned int *) ic->parm.num; |
| 1587 | HiSax_reportcard(csta->cardnr, num); |
| 1588 | break; |
| 1589 | case (1): |
| 1590 | num = *(unsigned int *) ic->parm.num; |
| 1591 | distr_debug(csta, num); |
| 1592 | printk(KERN_DEBUG "HiSax: debugging flags card %d set to %x\n", |
| 1593 | csta->cardnr + 1, num); |
| 1594 | HiSax_putstatus(csta, "debugging flags ", |
| 1595 | "card %d set to %x", csta->cardnr + 1, num); |
| 1596 | break; |
| 1597 | case (2): |
| 1598 | num = *(unsigned int *) ic->parm.num; |
| 1599 | csta->channel[0].b_st->l1.delay = num; |
| 1600 | csta->channel[1].b_st->l1.delay = num; |
| 1601 | HiSax_putstatus(csta, "delay ", "card %d set to %d ms", |
| 1602 | csta->cardnr + 1, num); |
| 1603 | printk(KERN_DEBUG "HiSax: delay card %d set to %d ms\n", |
| 1604 | csta->cardnr + 1, num); |
| 1605 | break; |
| 1606 | case (5): /* set card in leased mode */ |
| 1607 | num = *(unsigned int *) ic->parm.num; |
| 1608 | if ((num <1) || (num > 2)) { |
| 1609 | HiSax_putstatus(csta, "Set LEASED ", |
| 1610 | "wrong channel %d", num); |
| 1611 | printk(KERN_WARNING "HiSax: Set LEASED wrong channel %d\n", |
| 1612 | num); |
| 1613 | } else { |
| 1614 | num--; |
| 1615 | chanp = csta->channel +num; |
| 1616 | chanp->leased = 1; |
| 1617 | HiSax_putstatus(csta, "Card", |
| 1618 | "%d channel %d set leased mode\n", |
| 1619 | csta->cardnr + 1, num + 1); |
| 1620 | chanp->d_st->l1.l1l2 = leased_l1l2; |
| 1621 | chanp->d_st->lli.l4l3 = leased_l4l3; |
| 1622 | chanp->d_st->lli.l4l3(chanp->d_st, |
| 1623 | DL_ESTABLISH | REQUEST, NULL); |
| 1624 | } |
| 1625 | break; |
| 1626 | case (6): /* set B-channel test loop */ |
| 1627 | num = *(unsigned int *) ic->parm.num; |
| 1628 | if (csta->stlist) |
| 1629 | csta->stlist->l2.l2l1(csta->stlist, |
| 1630 | PH_TESTLOOP | REQUEST, (void *) (long)num); |
| 1631 | break; |
| 1632 | case (7): /* set card in PTP mode */ |
| 1633 | num = *(unsigned int *) ic->parm.num; |
| 1634 | if (test_bit(FLG_TWO_DCHAN, &csta->HW_Flags)) { |
| 1635 | printk(KERN_ERR "HiSax PTP mode only with one TEI possible\n"); |
| 1636 | } else if (num) { |
| 1637 | test_and_set_bit(FLG_PTP, &csta->channel[0].d_st->l2.flag); |
| 1638 | test_and_set_bit(FLG_FIXED_TEI, &csta->channel[0].d_st->l2.flag); |
| 1639 | csta->channel[0].d_st->l2.tei = 0; |
| 1640 | HiSax_putstatus(csta, "set card ", "in PTP mode"); |
| 1641 | printk(KERN_DEBUG "HiSax: set card in PTP mode\n"); |
| 1642 | printk(KERN_INFO "LAYER2 WATCHING ESTABLISH\n"); |
| 1643 | csta->channel[0].d_st->lli.l4l3(csta->channel[0].d_st, |
| 1644 | DL_ESTABLISH | REQUEST, NULL); |
| 1645 | } else { |
| 1646 | test_and_clear_bit(FLG_PTP, &csta->channel[0].d_st->l2.flag); |
| 1647 | test_and_clear_bit(FLG_FIXED_TEI, &csta->channel[0].d_st->l2.flag); |
| 1648 | HiSax_putstatus(csta, "set card ", "in PTMP mode"); |
| 1649 | printk(KERN_DEBUG "HiSax: set card in PTMP mode\n"); |
| 1650 | } |
| 1651 | break; |
| 1652 | case (8): /* set card in FIXED TEI mode */ |
| 1653 | num = *(unsigned int *) ic->parm.num; |
| 1654 | chanp = csta->channel + (num & 1); |
| 1655 | num = num >>1; |
| 1656 | if (num == 127) { |
| 1657 | test_and_clear_bit(FLG_FIXED_TEI, &chanp->d_st->l2.flag); |
| 1658 | chanp->d_st->l2.tei = -1; |
| 1659 | HiSax_putstatus(csta, "set card ", "in VAR TEI mode"); |
| 1660 | printk(KERN_DEBUG "HiSax: set card in VAR TEI mode\n"); |
| 1661 | } else { |
| 1662 | test_and_set_bit(FLG_FIXED_TEI, &chanp->d_st->l2.flag); |
| 1663 | chanp->d_st->l2.tei = num; |
| 1664 | HiSax_putstatus(csta, "set card ", "in FIXED TEI (%d) mode", num); |
| 1665 | printk(KERN_DEBUG "HiSax: set card in FIXED TEI (%d) mode\n", |
| 1666 | num); |
| 1667 | } |
| 1668 | chanp->d_st->lli.l4l3(chanp->d_st, |
| 1669 | DL_ESTABLISH | REQUEST, NULL); |
| 1670 | break; |
| 1671 | case (11): |
| 1672 | num = csta->debug & DEB_DLOG_HEX; |
| 1673 | csta->debug = *(unsigned int *) ic->parm.num; |
| 1674 | csta->debug |= num; |
| 1675 | HiSax_putstatus(cards[0].cs, "l1 debugging ", |
| 1676 | "flags card %d set to %x", |
| 1677 | csta->cardnr + 1, csta->debug); |
| 1678 | printk(KERN_DEBUG "HiSax: l1 debugging flags card %d set to %x\n", |
| 1679 | csta->cardnr + 1, csta->debug); |
| 1680 | break; |
| 1681 | case (13): |
| 1682 | csta->channel[0].d_st->l3.debug = *(unsigned int *) ic->parm.num; |
| 1683 | csta->channel[1].d_st->l3.debug = *(unsigned int *) ic->parm.num; |
| 1684 | HiSax_putstatus(cards[0].cs, "l3 debugging ", |
| 1685 | "flags card %d set to %x\n", csta->cardnr + 1, |
| 1686 | *(unsigned int *) ic->parm.num); |
| 1687 | printk(KERN_DEBUG "HiSax: l3 debugging flags card %d set to %x\n", |
| 1688 | csta->cardnr + 1, *(unsigned int *) ic->parm.num); |
| 1689 | break; |
| 1690 | case (10): |
| 1691 | i = *(unsigned int *) ic->parm.num; |
| 1692 | return(set_channel_limit(csta, i)); |
| 1693 | default: |
| 1694 | if (csta->auxcmd) |
| 1695 | return(csta->auxcmd(csta, ic)); |
| 1696 | printk(KERN_DEBUG "HiSax: invalid ioclt %d\n", |
| 1697 | (int) ic->arg); |
| 1698 | return (-EINVAL); |
| 1699 | } |
| 1700 | break; |
| 1701 | |
| 1702 | case (ISDN_CMD_PROCEED): |
| 1703 | chanp = csta->channel + ic->arg; |
| 1704 | if (chanp->debug & 1) |
| 1705 | link_debug(chanp, 1, "PROCEED"); |
| 1706 | FsmEvent(&chanp->fi, EV_PROCEED, NULL); |
| 1707 | break; |
| 1708 | |
| 1709 | case (ISDN_CMD_ALERT): |
| 1710 | chanp = csta->channel + ic->arg; |
| 1711 | if (chanp->debug & 1) |
| 1712 | link_debug(chanp, 1, "ALERT"); |
| 1713 | FsmEvent(&chanp->fi, EV_ALERT, NULL); |
| 1714 | break; |
| 1715 | |
| 1716 | case (ISDN_CMD_REDIR): |
| 1717 | chanp = csta->channel + ic->arg; |
| 1718 | if (chanp->debug & 1) |
| 1719 | link_debug(chanp, 1, "REDIR"); |
| 1720 | memcpy(&chanp->setup, &ic->parm.setup, sizeof(setup_parm)); |
| 1721 | FsmEvent(&chanp->fi, EV_REDIR, NULL); |
| 1722 | break; |
| 1723 | |
| 1724 | /* protocol specific io commands */ |
| 1725 | case (ISDN_CMD_PROT_IO): |
| 1726 | for (st = csta->stlist; st; st = st->next) |
| 1727 | if (st->protocol == (ic->arg & 0xFF)) |
| 1728 | return(st->lli.l4l3_proto(st, ic)); |
| 1729 | return(-EINVAL); |
| 1730 | break; |
| 1731 | default: |
| 1732 | if (csta->auxcmd) |
| 1733 | return(csta->auxcmd(csta, ic)); |
| 1734 | return(-EINVAL); |
| 1735 | } |
| 1736 | return (0); |
| 1737 | } |
| 1738 | |
| 1739 | int |
| 1740 | HiSax_writebuf_skb(int id, int chan, int ack, struct sk_buff *skb) |
| 1741 | { |
| 1742 | struct IsdnCardState *csta = hisax_findcard(id); |
| 1743 | struct Channel *chanp; |
| 1744 | struct PStack *st; |
| 1745 | int len = skb->len; |
| 1746 | struct sk_buff *nskb; |
| 1747 | |
| 1748 | if (!csta) { |
| 1749 | printk(KERN_ERR |
| 1750 | "HiSax: if_sendbuf called with invalid driverId!\n"); |
| 1751 | return -ENODEV; |
| 1752 | } |
| 1753 | chanp = csta->channel + chan; |
| 1754 | st = chanp->b_st; |
| 1755 | if (!chanp->data_open) { |
| 1756 | link_debug(chanp, 1, "writebuf: channel not open"); |
| 1757 | return -EIO; |
| 1758 | } |
| 1759 | if (len > MAX_DATA_SIZE) { |
| 1760 | link_debug(chanp, 1, "writebuf: packet too large (%d bytes)", len); |
| 1761 | printk(KERN_WARNING "HiSax_writebuf: packet too large (%d bytes) !\n", |
| 1762 | len); |
| 1763 | return -EINVAL; |
| 1764 | } |
| 1765 | if (len) { |
| 1766 | if ((len + chanp->bcs->tx_cnt) > MAX_DATA_MEM) { |
| 1767 | /* Must return 0 here, since this is not an error |
| 1768 | * but a temporary lack of resources. |
| 1769 | */ |
| 1770 | if (chanp->debug & 0x800) |
| 1771 | link_debug(chanp, 1, "writebuf: no buffers for %d bytes", len); |
| 1772 | return 0; |
| 1773 | } else if (chanp->debug & 0x800) |
| 1774 | link_debug(chanp, 1, "writebuf %d/%d/%d", len, chanp->bcs->tx_cnt,MAX_DATA_MEM); |
| 1775 | nskb = skb_clone(skb, GFP_ATOMIC); |
| 1776 | if (nskb) { |
| 1777 | nskb->truesize = nskb->len; |
| 1778 | if (!ack) |
| 1779 | nskb->pkt_type = PACKET_NOACK; |
| 1780 | if (chanp->l2_active_protocol == ISDN_PROTO_L2_X75I) |
| 1781 | st->l3.l3l2(st, DL_DATA | REQUEST, nskb); |
| 1782 | else { |
| 1783 | chanp->bcs->tx_cnt += len; |
| 1784 | st->l2.l2l1(st, PH_DATA | REQUEST, nskb); |
| 1785 | } |
| 1786 | dev_kfree_skb(skb); |
| 1787 | } else |
| 1788 | len = 0; |
| 1789 | } |
| 1790 | return (len); |
| 1791 | } |