1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * 4 * Author Karsten Keil <kkeil@novell.com> 5 * 6 * Copyright 2008 by Karsten Keil <kkeil@novell.com> 7 */ 8 9 #include <linux/mISDNif.h> 10 #include <linux/slab.h> 11 #include <linux/export.h> 12 #include "core.h" 13 14 static u_int *debug; 15 16 static struct proto mISDN_proto = { 17 .name = "misdn", 18 .owner = THIS_MODULE, 19 .obj_size = sizeof(struct mISDN_sock) 20 }; 21 22 #define _pms(sk) ((struct mISDN_sock *)sk) 23 24 static struct mISDN_sock_list data_sockets = { 25 .lock = __RW_LOCK_UNLOCKED(data_sockets.lock) 26 }; 27 28 static struct mISDN_sock_list base_sockets = { 29 .lock = __RW_LOCK_UNLOCKED(base_sockets.lock) 30 }; 31 32 #define L2_HEADER_LEN 4 33 34 static inline struct sk_buff * 35 _l2_alloc_skb(unsigned int len, gfp_t gfp_mask) 36 { 37 struct sk_buff *skb; 38 39 skb = alloc_skb(len + L2_HEADER_LEN, gfp_mask); 40 if (likely(skb)) 41 skb_reserve(skb, L2_HEADER_LEN); 42 return skb; 43 } 44 45 static void 46 mISDN_sock_link(struct mISDN_sock_list *l, struct sock *sk) 47 { 48 write_lock_bh(&l->lock); 49 sk_add_node(sk, &l->head); 50 write_unlock_bh(&l->lock); 51 } 52 53 static void mISDN_sock_unlink(struct mISDN_sock_list *l, struct sock *sk) 54 { 55 write_lock_bh(&l->lock); 56 sk_del_node_init(sk); 57 write_unlock_bh(&l->lock); 58 } 59 60 static int 61 mISDN_send(struct mISDNchannel *ch, struct sk_buff *skb) 62 { 63 struct mISDN_sock *msk; 64 int err; 65 66 msk = container_of(ch, struct mISDN_sock, ch); 67 if (*debug & DEBUG_SOCKET) 68 printk(KERN_DEBUG "%s len %d %p\n", __func__, skb->len, skb); 69 if (msk->sk.sk_state == MISDN_CLOSED) 70 return -EUNATCH; 71 __net_timestamp(skb); 72 err = sock_queue_rcv_skb(&msk->sk, skb); 73 if (err) 74 printk(KERN_WARNING "%s: error %d\n", __func__, err); 75 return err; 76 } 77 78 static int 79 mISDN_ctrl(struct mISDNchannel *ch, u_int cmd, void *arg) 80 { 81 struct mISDN_sock *msk; 82 83 msk = container_of(ch, struct mISDN_sock, ch); 84 if (*debug & DEBUG_SOCKET) 85 printk(KERN_DEBUG "%s(%p, %x, %p)\n", __func__, ch, cmd, arg); 86 switch (cmd) { 87 case CLOSE_CHANNEL: 88 msk->sk.sk_state = MISDN_CLOSED; 89 break; 90 } 91 return 0; 92 } 93 94 static inline void 95 mISDN_sock_cmsg(struct sock *sk, struct msghdr *msg, struct sk_buff *skb) 96 { 97 struct __kernel_old_timeval tv; 98 99 if (_pms(sk)->cmask & MISDN_TIME_STAMP) { 100 skb_get_timestamp(skb, &tv); 101 put_cmsg(msg, SOL_MISDN, MISDN_TIME_STAMP, sizeof(tv), &tv); 102 } 103 } 104 105 static int 106 mISDN_sock_recvmsg(struct socket *sock, struct msghdr *msg, size_t len, 107 int flags) 108 { 109 struct sk_buff *skb; 110 struct sock *sk = sock->sk; 111 112 int copied, err; 113 114 if (*debug & DEBUG_SOCKET) 115 printk(KERN_DEBUG "%s: len %d, flags %x ch.nr %d, proto %x\n", 116 __func__, (int)len, flags, _pms(sk)->ch.nr, 117 sk->sk_protocol); 118 if (flags & (MSG_OOB)) 119 return -EOPNOTSUPP; 120 121 if (sk->sk_state == MISDN_CLOSED) 122 return 0; 123 124 skb = skb_recv_datagram(sk, flags, flags & MSG_DONTWAIT, &err); 125 if (!skb) 126 return err; 127 128 if (msg->msg_name) { 129 DECLARE_SOCKADDR(struct sockaddr_mISDN *, maddr, msg->msg_name); 130 131 maddr->family = AF_ISDN; 132 maddr->dev = _pms(sk)->dev->id; 133 if ((sk->sk_protocol == ISDN_P_LAPD_TE) || 134 (sk->sk_protocol == ISDN_P_LAPD_NT)) { 135 maddr->channel = (mISDN_HEAD_ID(skb) >> 16) & 0xff; 136 maddr->tei = (mISDN_HEAD_ID(skb) >> 8) & 0xff; 137 maddr->sapi = mISDN_HEAD_ID(skb) & 0xff; 138 } else { 139 maddr->channel = _pms(sk)->ch.nr; 140 maddr->sapi = _pms(sk)->ch.addr & 0xFF; 141 maddr->tei = (_pms(sk)->ch.addr >> 8) & 0xFF; 142 } 143 msg->msg_namelen = sizeof(*maddr); 144 } 145 146 copied = skb->len + MISDN_HEADER_LEN; 147 if (len < copied) { 148 if (flags & MSG_PEEK) 149 refcount_dec(&skb->users); 150 else 151 skb_queue_head(&sk->sk_receive_queue, skb); 152 return -ENOSPC; 153 } 154 memcpy(skb_push(skb, MISDN_HEADER_LEN), mISDN_HEAD_P(skb), 155 MISDN_HEADER_LEN); 156 157 err = skb_copy_datagram_msg(skb, 0, msg, copied); 158 159 mISDN_sock_cmsg(sk, msg, skb); 160 161 skb_free_datagram(sk, skb); 162 163 return err ? : copied; 164 } 165 166 static int 167 mISDN_sock_sendmsg(struct socket *sock, struct msghdr *msg, size_t len) 168 { 169 struct sock *sk = sock->sk; 170 struct sk_buff *skb; 171 int err = -ENOMEM; 172 173 if (*debug & DEBUG_SOCKET) 174 printk(KERN_DEBUG "%s: len %d flags %x ch %d proto %x\n", 175 __func__, (int)len, msg->msg_flags, _pms(sk)->ch.nr, 176 sk->sk_protocol); 177 178 if (msg->msg_flags & MSG_OOB) 179 return -EOPNOTSUPP; 180 181 if (msg->msg_flags & ~(MSG_DONTWAIT | MSG_NOSIGNAL | MSG_ERRQUEUE)) 182 return -EINVAL; 183 184 if (len < MISDN_HEADER_LEN) 185 return -EINVAL; 186 187 if (sk->sk_state != MISDN_BOUND) 188 return -EBADFD; 189 190 lock_sock(sk); 191 192 skb = _l2_alloc_skb(len, GFP_KERNEL); 193 if (!skb) 194 goto done; 195 196 if (memcpy_from_msg(skb_put(skb, len), msg, len)) { 197 err = -EFAULT; 198 goto done; 199 } 200 201 memcpy(mISDN_HEAD_P(skb), skb->data, MISDN_HEADER_LEN); 202 skb_pull(skb, MISDN_HEADER_LEN); 203 204 if (msg->msg_namelen >= sizeof(struct sockaddr_mISDN)) { 205 /* if we have a address, we use it */ 206 DECLARE_SOCKADDR(struct sockaddr_mISDN *, maddr, msg->msg_name); 207 mISDN_HEAD_ID(skb) = maddr->channel; 208 } else { /* use default for L2 messages */ 209 if ((sk->sk_protocol == ISDN_P_LAPD_TE) || 210 (sk->sk_protocol == ISDN_P_LAPD_NT)) 211 mISDN_HEAD_ID(skb) = _pms(sk)->ch.nr; 212 } 213 214 if (*debug & DEBUG_SOCKET) 215 printk(KERN_DEBUG "%s: ID:%x\n", 216 __func__, mISDN_HEAD_ID(skb)); 217 218 err = -ENODEV; 219 if (!_pms(sk)->ch.peer) 220 goto done; 221 err = _pms(sk)->ch.recv(_pms(sk)->ch.peer, skb); 222 if (err) 223 goto done; 224 else { 225 skb = NULL; 226 err = len; 227 } 228 229 done: 230 kfree_skb(skb); 231 release_sock(sk); 232 return err; 233 } 234 235 static int 236 data_sock_release(struct socket *sock) 237 { 238 struct sock *sk = sock->sk; 239 240 if (*debug & DEBUG_SOCKET) 241 printk(KERN_DEBUG "%s(%p) sk=%p\n", __func__, sock, sk); 242 if (!sk) 243 return 0; 244 switch (sk->sk_protocol) { 245 case ISDN_P_TE_S0: 246 case ISDN_P_NT_S0: 247 case ISDN_P_TE_E1: 248 case ISDN_P_NT_E1: 249 if (sk->sk_state == MISDN_BOUND) 250 delete_channel(&_pms(sk)->ch); 251 else 252 mISDN_sock_unlink(&data_sockets, sk); 253 break; 254 case ISDN_P_LAPD_TE: 255 case ISDN_P_LAPD_NT: 256 case ISDN_P_B_RAW: 257 case ISDN_P_B_HDLC: 258 case ISDN_P_B_X75SLP: 259 case ISDN_P_B_L2DTMF: 260 case ISDN_P_B_L2DSP: 261 case ISDN_P_B_L2DSPHDLC: 262 delete_channel(&_pms(sk)->ch); 263 mISDN_sock_unlink(&data_sockets, sk); 264 break; 265 } 266 267 lock_sock(sk); 268 269 sock_orphan(sk); 270 skb_queue_purge(&sk->sk_receive_queue); 271 272 release_sock(sk); 273 sock_put(sk); 274 275 return 0; 276 } 277 278 static int 279 data_sock_ioctl_bound(struct sock *sk, unsigned int cmd, void __user *p) 280 { 281 struct mISDN_ctrl_req cq; 282 int err = -EINVAL, val[2]; 283 struct mISDNchannel *bchan, *next; 284 285 lock_sock(sk); 286 if (!_pms(sk)->dev) { 287 err = -ENODEV; 288 goto done; 289 } 290 switch (cmd) { 291 case IMCTRLREQ: 292 if (copy_from_user(&cq, p, sizeof(cq))) { 293 err = -EFAULT; 294 break; 295 } 296 if ((sk->sk_protocol & ~ISDN_P_B_MASK) == ISDN_P_B_START) { 297 list_for_each_entry_safe(bchan, next, 298 &_pms(sk)->dev->bchannels, list) { 299 if (bchan->nr == cq.channel) { 300 err = bchan->ctrl(bchan, 301 CONTROL_CHANNEL, &cq); 302 break; 303 } 304 } 305 } else 306 err = _pms(sk)->dev->D.ctrl(&_pms(sk)->dev->D, 307 CONTROL_CHANNEL, &cq); 308 if (err) 309 break; 310 if (copy_to_user(p, &cq, sizeof(cq))) 311 err = -EFAULT; 312 break; 313 case IMCLEAR_L2: 314 if (sk->sk_protocol != ISDN_P_LAPD_NT) { 315 err = -EINVAL; 316 break; 317 } 318 val[0] = cmd; 319 if (get_user(val[1], (int __user *)p)) { 320 err = -EFAULT; 321 break; 322 } 323 err = _pms(sk)->dev->teimgr->ctrl(_pms(sk)->dev->teimgr, 324 CONTROL_CHANNEL, val); 325 break; 326 case IMHOLD_L1: 327 if (sk->sk_protocol != ISDN_P_LAPD_NT 328 && sk->sk_protocol != ISDN_P_LAPD_TE) { 329 err = -EINVAL; 330 break; 331 } 332 val[0] = cmd; 333 if (get_user(val[1], (int __user *)p)) { 334 err = -EFAULT; 335 break; 336 } 337 err = _pms(sk)->dev->teimgr->ctrl(_pms(sk)->dev->teimgr, 338 CONTROL_CHANNEL, val); 339 break; 340 default: 341 err = -EINVAL; 342 break; 343 } 344 done: 345 release_sock(sk); 346 return err; 347 } 348 349 static int 350 data_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) 351 { 352 int err = 0, id; 353 struct sock *sk = sock->sk; 354 struct mISDNdevice *dev; 355 struct mISDNversion ver; 356 357 switch (cmd) { 358 case IMGETVERSION: 359 ver.major = MISDN_MAJOR_VERSION; 360 ver.minor = MISDN_MINOR_VERSION; 361 ver.release = MISDN_RELEASE; 362 if (copy_to_user((void __user *)arg, &ver, sizeof(ver))) 363 err = -EFAULT; 364 break; 365 case IMGETCOUNT: 366 id = get_mdevice_count(); 367 if (put_user(id, (int __user *)arg)) 368 err = -EFAULT; 369 break; 370 case IMGETDEVINFO: 371 if (get_user(id, (int __user *)arg)) { 372 err = -EFAULT; 373 break; 374 } 375 dev = get_mdevice(id); 376 if (dev) { 377 struct mISDN_devinfo di; 378 379 memset(&di, 0, sizeof(di)); 380 di.id = dev->id; 381 di.Dprotocols = dev->Dprotocols; 382 di.Bprotocols = dev->Bprotocols | get_all_Bprotocols(); 383 di.protocol = dev->D.protocol; 384 memcpy(di.channelmap, dev->channelmap, 385 sizeof(di.channelmap)); 386 di.nrbchan = dev->nrbchan; 387 strscpy(di.name, dev_name(&dev->dev), sizeof(di.name)); 388 if (copy_to_user((void __user *)arg, &di, sizeof(di))) 389 err = -EFAULT; 390 } else 391 err = -ENODEV; 392 break; 393 default: 394 if (sk->sk_state == MISDN_BOUND) 395 err = data_sock_ioctl_bound(sk, cmd, 396 (void __user *)arg); 397 else 398 err = -ENOTCONN; 399 } 400 return err; 401 } 402 403 static int data_sock_setsockopt(struct socket *sock, int level, int optname, 404 char __user *optval, unsigned int len) 405 { 406 struct sock *sk = sock->sk; 407 int err = 0, opt = 0; 408 409 if (*debug & DEBUG_SOCKET) 410 printk(KERN_DEBUG "%s(%p, %d, %x, %p, %d)\n", __func__, sock, 411 level, optname, optval, len); 412 413 lock_sock(sk); 414 415 switch (optname) { 416 case MISDN_TIME_STAMP: 417 if (get_user(opt, (int __user *)optval)) { 418 err = -EFAULT; 419 break; 420 } 421 422 if (opt) 423 _pms(sk)->cmask |= MISDN_TIME_STAMP; 424 else 425 _pms(sk)->cmask &= ~MISDN_TIME_STAMP; 426 break; 427 default: 428 err = -ENOPROTOOPT; 429 break; 430 } 431 release_sock(sk); 432 return err; 433 } 434 435 static int data_sock_getsockopt(struct socket *sock, int level, int optname, 436 char __user *optval, int __user *optlen) 437 { 438 struct sock *sk = sock->sk; 439 int len, opt; 440 441 if (get_user(len, optlen)) 442 return -EFAULT; 443 444 if (len != sizeof(char)) 445 return -EINVAL; 446 447 switch (optname) { 448 case MISDN_TIME_STAMP: 449 if (_pms(sk)->cmask & MISDN_TIME_STAMP) 450 opt = 1; 451 else 452 opt = 0; 453 454 if (put_user(opt, optval)) 455 return -EFAULT; 456 break; 457 default: 458 return -ENOPROTOOPT; 459 } 460 461 return 0; 462 } 463 464 static int 465 data_sock_bind(struct socket *sock, struct sockaddr *addr, int addr_len) 466 { 467 struct sockaddr_mISDN *maddr = (struct sockaddr_mISDN *) addr; 468 struct sock *sk = sock->sk; 469 struct sock *csk; 470 int err = 0; 471 472 if (*debug & DEBUG_SOCKET) 473 printk(KERN_DEBUG "%s(%p) sk=%p\n", __func__, sock, sk); 474 if (addr_len != sizeof(struct sockaddr_mISDN)) 475 return -EINVAL; 476 if (!maddr || maddr->family != AF_ISDN) 477 return -EINVAL; 478 479 lock_sock(sk); 480 481 if (_pms(sk)->dev) { 482 err = -EALREADY; 483 goto done; 484 } 485 _pms(sk)->dev = get_mdevice(maddr->dev); 486 if (!_pms(sk)->dev) { 487 err = -ENODEV; 488 goto done; 489 } 490 491 if (sk->sk_protocol < ISDN_P_B_START) { 492 read_lock_bh(&data_sockets.lock); 493 sk_for_each(csk, &data_sockets.head) { 494 if (sk == csk) 495 continue; 496 if (_pms(csk)->dev != _pms(sk)->dev) 497 continue; 498 if (csk->sk_protocol >= ISDN_P_B_START) 499 continue; 500 if (IS_ISDN_P_TE(csk->sk_protocol) 501 == IS_ISDN_P_TE(sk->sk_protocol)) 502 continue; 503 read_unlock_bh(&data_sockets.lock); 504 err = -EBUSY; 505 goto done; 506 } 507 read_unlock_bh(&data_sockets.lock); 508 } 509 510 _pms(sk)->ch.send = mISDN_send; 511 _pms(sk)->ch.ctrl = mISDN_ctrl; 512 513 switch (sk->sk_protocol) { 514 case ISDN_P_TE_S0: 515 case ISDN_P_NT_S0: 516 case ISDN_P_TE_E1: 517 case ISDN_P_NT_E1: 518 mISDN_sock_unlink(&data_sockets, sk); 519 err = connect_layer1(_pms(sk)->dev, &_pms(sk)->ch, 520 sk->sk_protocol, maddr); 521 if (err) 522 mISDN_sock_link(&data_sockets, sk); 523 break; 524 case ISDN_P_LAPD_TE: 525 case ISDN_P_LAPD_NT: 526 err = create_l2entity(_pms(sk)->dev, &_pms(sk)->ch, 527 sk->sk_protocol, maddr); 528 break; 529 case ISDN_P_B_RAW: 530 case ISDN_P_B_HDLC: 531 case ISDN_P_B_X75SLP: 532 case ISDN_P_B_L2DTMF: 533 case ISDN_P_B_L2DSP: 534 case ISDN_P_B_L2DSPHDLC: 535 err = connect_Bstack(_pms(sk)->dev, &_pms(sk)->ch, 536 sk->sk_protocol, maddr); 537 break; 538 default: 539 err = -EPROTONOSUPPORT; 540 } 541 if (err) 542 goto done; 543 sk->sk_state = MISDN_BOUND; 544 _pms(sk)->ch.protocol = sk->sk_protocol; 545 546 done: 547 release_sock(sk); 548 return err; 549 } 550 551 static int 552 data_sock_getname(struct socket *sock, struct sockaddr *addr, 553 int peer) 554 { 555 struct sockaddr_mISDN *maddr = (struct sockaddr_mISDN *) addr; 556 struct sock *sk = sock->sk; 557 558 if (!_pms(sk)->dev) 559 return -EBADFD; 560 561 lock_sock(sk); 562 563 maddr->family = AF_ISDN; 564 maddr->dev = _pms(sk)->dev->id; 565 maddr->channel = _pms(sk)->ch.nr; 566 maddr->sapi = _pms(sk)->ch.addr & 0xff; 567 maddr->tei = (_pms(sk)->ch.addr >> 8) & 0xff; 568 release_sock(sk); 569 return sizeof(*maddr); 570 } 571 572 static const struct proto_ops data_sock_ops = { 573 .family = PF_ISDN, 574 .owner = THIS_MODULE, 575 .release = data_sock_release, 576 .ioctl = data_sock_ioctl, 577 .bind = data_sock_bind, 578 .getname = data_sock_getname, 579 .sendmsg = mISDN_sock_sendmsg, 580 .recvmsg = mISDN_sock_recvmsg, 581 .poll = datagram_poll, 582 .listen = sock_no_listen, 583 .shutdown = sock_no_shutdown, 584 .setsockopt = data_sock_setsockopt, 585 .getsockopt = data_sock_getsockopt, 586 .connect = sock_no_connect, 587 .socketpair = sock_no_socketpair, 588 .accept = sock_no_accept, 589 .mmap = sock_no_mmap 590 }; 591 592 static int 593 data_sock_create(struct net *net, struct socket *sock, int protocol, int kern) 594 { 595 struct sock *sk; 596 597 if (sock->type != SOCK_DGRAM) 598 return -ESOCKTNOSUPPORT; 599 600 sk = sk_alloc(net, PF_ISDN, GFP_KERNEL, &mISDN_proto, kern); 601 if (!sk) 602 return -ENOMEM; 603 604 sock_init_data(sock, sk); 605 606 sock->ops = &data_sock_ops; 607 sock->state = SS_UNCONNECTED; 608 sock_reset_flag(sk, SOCK_ZAPPED); 609 610 sk->sk_protocol = protocol; 611 sk->sk_state = MISDN_OPEN; 612 mISDN_sock_link(&data_sockets, sk); 613 614 return 0; 615 } 616 617 static int 618 base_sock_release(struct socket *sock) 619 { 620 struct sock *sk = sock->sk; 621 622 printk(KERN_DEBUG "%s(%p) sk=%p\n", __func__, sock, sk); 623 if (!sk) 624 return 0; 625 626 mISDN_sock_unlink(&base_sockets, sk); 627 sock_orphan(sk); 628 sock_put(sk); 629 630 return 0; 631 } 632 633 static int 634 base_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) 635 { 636 int err = 0, id; 637 struct mISDNdevice *dev; 638 struct mISDNversion ver; 639 640 switch (cmd) { 641 case IMGETVERSION: 642 ver.major = MISDN_MAJOR_VERSION; 643 ver.minor = MISDN_MINOR_VERSION; 644 ver.release = MISDN_RELEASE; 645 if (copy_to_user((void __user *)arg, &ver, sizeof(ver))) 646 err = -EFAULT; 647 break; 648 case IMGETCOUNT: 649 id = get_mdevice_count(); 650 if (put_user(id, (int __user *)arg)) 651 err = -EFAULT; 652 break; 653 case IMGETDEVINFO: 654 if (get_user(id, (int __user *)arg)) { 655 err = -EFAULT; 656 break; 657 } 658 dev = get_mdevice(id); 659 if (dev) { 660 struct mISDN_devinfo di; 661 662 memset(&di, 0, sizeof(di)); 663 di.id = dev->id; 664 di.Dprotocols = dev->Dprotocols; 665 di.Bprotocols = dev->Bprotocols | get_all_Bprotocols(); 666 di.protocol = dev->D.protocol; 667 memcpy(di.channelmap, dev->channelmap, 668 sizeof(di.channelmap)); 669 di.nrbchan = dev->nrbchan; 670 strscpy(di.name, dev_name(&dev->dev), sizeof(di.name)); 671 if (copy_to_user((void __user *)arg, &di, sizeof(di))) 672 err = -EFAULT; 673 } else 674 err = -ENODEV; 675 break; 676 case IMSETDEVNAME: 677 { 678 struct mISDN_devrename dn; 679 if (copy_from_user(&dn, (void __user *)arg, 680 sizeof(dn))) { 681 err = -EFAULT; 682 break; 683 } 684 dn.name[sizeof(dn.name) - 1] = '\0'; 685 dev = get_mdevice(dn.id); 686 if (dev) 687 err = device_rename(&dev->dev, dn.name); 688 else 689 err = -ENODEV; 690 } 691 break; 692 default: 693 err = -EINVAL; 694 } 695 return err; 696 } 697 698 static int 699 base_sock_bind(struct socket *sock, struct sockaddr *addr, int addr_len) 700 { 701 struct sockaddr_mISDN *maddr = (struct sockaddr_mISDN *) addr; 702 struct sock *sk = sock->sk; 703 int err = 0; 704 705 if (addr_len < sizeof(struct sockaddr_mISDN)) 706 return -EINVAL; 707 708 if (!maddr || maddr->family != AF_ISDN) 709 return -EINVAL; 710 711 lock_sock(sk); 712 713 if (_pms(sk)->dev) { 714 err = -EALREADY; 715 goto done; 716 } 717 718 _pms(sk)->dev = get_mdevice(maddr->dev); 719 if (!_pms(sk)->dev) { 720 err = -ENODEV; 721 goto done; 722 } 723 sk->sk_state = MISDN_BOUND; 724 725 done: 726 release_sock(sk); 727 return err; 728 } 729 730 static const struct proto_ops base_sock_ops = { 731 .family = PF_ISDN, 732 .owner = THIS_MODULE, 733 .release = base_sock_release, 734 .ioctl = base_sock_ioctl, 735 .bind = base_sock_bind, 736 .getname = sock_no_getname, 737 .sendmsg = sock_no_sendmsg, 738 .recvmsg = sock_no_recvmsg, 739 .listen = sock_no_listen, 740 .shutdown = sock_no_shutdown, 741 .setsockopt = sock_no_setsockopt, 742 .getsockopt = sock_no_getsockopt, 743 .connect = sock_no_connect, 744 .socketpair = sock_no_socketpair, 745 .accept = sock_no_accept, 746 .mmap = sock_no_mmap 747 }; 748 749 750 static int 751 base_sock_create(struct net *net, struct socket *sock, int protocol, int kern) 752 { 753 struct sock *sk; 754 755 if (sock->type != SOCK_RAW) 756 return -ESOCKTNOSUPPORT; 757 if (!capable(CAP_NET_RAW)) 758 return -EPERM; 759 760 sk = sk_alloc(net, PF_ISDN, GFP_KERNEL, &mISDN_proto, kern); 761 if (!sk) 762 return -ENOMEM; 763 764 sock_init_data(sock, sk); 765 sock->ops = &base_sock_ops; 766 sock->state = SS_UNCONNECTED; 767 sock_reset_flag(sk, SOCK_ZAPPED); 768 sk->sk_protocol = protocol; 769 sk->sk_state = MISDN_OPEN; 770 mISDN_sock_link(&base_sockets, sk); 771 772 return 0; 773 } 774 775 static int 776 mISDN_sock_create(struct net *net, struct socket *sock, int proto, int kern) 777 { 778 int err = -EPROTONOSUPPORT; 779 780 switch (proto) { 781 case ISDN_P_BASE: 782 err = base_sock_create(net, sock, proto, kern); 783 break; 784 case ISDN_P_TE_S0: 785 case ISDN_P_NT_S0: 786 case ISDN_P_TE_E1: 787 case ISDN_P_NT_E1: 788 case ISDN_P_LAPD_TE: 789 case ISDN_P_LAPD_NT: 790 case ISDN_P_B_RAW: 791 case ISDN_P_B_HDLC: 792 case ISDN_P_B_X75SLP: 793 case ISDN_P_B_L2DTMF: 794 case ISDN_P_B_L2DSP: 795 case ISDN_P_B_L2DSPHDLC: 796 err = data_sock_create(net, sock, proto, kern); 797 break; 798 default: 799 return err; 800 } 801 802 return err; 803 } 804 805 static const struct net_proto_family mISDN_sock_family_ops = { 806 .owner = THIS_MODULE, 807 .family = PF_ISDN, 808 .create = mISDN_sock_create, 809 }; 810 811 int 812 misdn_sock_init(u_int *deb) 813 { 814 int err; 815 816 debug = deb; 817 err = sock_register(&mISDN_sock_family_ops); 818 if (err) 819 printk(KERN_ERR "%s: error(%d)\n", __func__, err); 820 return err; 821 } 822 823 void 824 misdn_sock_cleanup(void) 825 { 826 sock_unregister(PF_ISDN); 827 } 828