sock.c revision 1da177e4c3f41524e886b7f1b8a0c1fc7321cac
11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BNEP implementation for Linux Bluetooth stack (BlueZ). 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Copyright (C) 2001-2002 Inventel Systemes 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Written 2001-2002 by 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds David Libault <david.libault@inventel.fr> 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Copyright (C) 2002 Maxim Krasnyansky <maxk@qualcomm.com> 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds This program is free software; you can redistribute it and/or modify 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds it under the terms of the GNU General Public License version 2 as 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds published by the Free Software Foundation; 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS. 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SOFTWARE IS DISCLAIMED. 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * $Id: sock.c,v 1.4 2002/08/04 21:23:58 maxk Exp $ 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/config.h> 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h> 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/major.h> 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/sched.h> 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/slab.h> 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/poll.h> 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/fcntl.h> 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/skbuff.h> 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/socket.h> 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/ioctl.h> 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/file.h> 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <net/sock.h> 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/system.h> 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <asm/uaccess.h> 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "bnep.h" 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#ifndef CONFIG_BT_BNEP_DEBUG 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#undef BT_DBG 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define BT_DBG( A... ) 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#endif 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int bnep_sock_release(struct socket *sock) 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct sock *sk = sock->sk; 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BT_DBG("sock %p sk %p", sock, sk); 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sk) 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock_orphan(sk); 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock_put(sk); 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int bnep_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bnep_connlist_req cl; 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bnep_connadd_req ca; 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bnep_conndel_req cd; 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct bnep_conninfo ci; 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct socket *nsock; 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void __user *argp = (void __user *)arg; 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BT_DBG("cmd %x arg %lx", cmd, arg); 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case BNEPCONNADD: 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_NET_ADMIN)) 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EACCES; 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&ca, argp, sizeof(ca))) 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds nsock = sockfd_lookup(ca.sock, &err); 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!nsock) 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (nsock->sk->sk_state != BT_CONNECTED) { 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fput(nsock->file); 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBADFD; 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = bnep_add_connection(&ca, nsock); 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!err) { 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_to_user(argp, &ca, sizeof(ca))) 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EFAULT; 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds fput(nsock->file); 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case BNEPCONNDEL: 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_NET_ADMIN)) 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EACCES; 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&cd, argp, sizeof(cd))) 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return bnep_del_connection(&cd); 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case BNEPGETCONNLIST: 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&cl, argp, sizeof(cl))) 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cl.cnum <= 0) 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = bnep_get_connlist(&cl); 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!err && copy_to_user(argp, &cl, sizeof(cl))) 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case BNEPGETCONNINFO: 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&ci, argp, sizeof(ci))) 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = bnep_get_conninfo(&ci); 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!err && copy_to_user(argp, &ci, sizeof(ci))) 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 1401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds default: 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct proto_ops bnep_sock_ops = { 1511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .family = PF_BLUETOOTH, 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = bnep_sock_release, 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ioctl = bnep_sock_ioctl, 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .bind = sock_no_bind, 1561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .getname = sock_no_getname, 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .sendmsg = sock_no_sendmsg, 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .recvmsg = sock_no_recvmsg, 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .poll = sock_no_poll, 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .listen = sock_no_listen, 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .shutdown = sock_no_shutdown, 1621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .setsockopt = sock_no_setsockopt, 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .getsockopt = sock_no_getsockopt, 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .connect = sock_no_connect, 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .socketpair = sock_no_socketpair, 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .accept = sock_no_accept, 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mmap = sock_no_mmap 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct proto bnep_proto = { 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = "BNEP", 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .obj_size = sizeof(struct bt_sock) 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int bnep_sock_create(struct socket *sock, int protocol) 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct sock *sk; 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BT_DBG("sock %p", sock); 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sock->type != SOCK_RAW) 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ESOCKTNOSUPPORT; 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sk = sk_alloc(PF_BLUETOOTH, GFP_KERNEL, &bnep_proto, 1); 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sk) 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock_init_data(sock, sk); 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock->ops = &bnep_sock_ops; 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock->state = SS_UNCONNECTED; 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock_reset_flag(sk, SOCK_ZAPPED); 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sk->sk_protocol = protocol; 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sk->sk_state = BT_OPEN; 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct net_proto_family bnep_sock_family_ops = { 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .family = PF_BLUETOOTH, 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .create = bnep_sock_create 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint __init bnep_sock_init(void) 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = proto_register(&bnep_proto, 0); 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err < 0) 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = bt_sock_register(BTPROTO_BNEP, &bnep_sock_family_ops); 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err < 0) 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto error; 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldserror: 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BT_ERR("Can't register BNEP socket"); 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds proto_unregister(&bnep_proto); 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint __exit bnep_sock_cleanup(void) 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (bt_sock_unregister(BTPROTO_BNEP) < 0) 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BT_ERR("Can't unregister BNEP socket"); 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds proto_unregister(&bnep_proto); 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 238