18e87d14255acffeee36873de226dc25c11b5f46dYOSHIFUJI Hideaki/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds CMTP implementation for Linux Bluetooth stack (BlueZ). 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds Copyright (C) 2002-2003 Marcel Holtmann <marcel@holtmann.org> 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds This program is free software; you can redistribute it and/or modify 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds it under the terms of the GNU General Public License version 2 as 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds published by the Free Software Foundation; 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS. 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY 138e87d14255acffeee36873de226dc25c11b5f46dYOSHIFUJI Hideaki CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES 148e87d14255acffeee36873de226dc25c11b5f46dYOSHIFUJI Hideaki WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 158e87d14255acffeee36873de226dc25c11b5f46dYOSHIFUJI Hideaki ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 188e87d14255acffeee36873de226dc25c11b5f46dYOSHIFUJI Hideaki ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, 198e87d14255acffeee36873de226dc25c11b5f46dYOSHIFUJI Hideaki COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SOFTWARE IS DISCLAIMED. 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds*/ 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 232ad8f54bc86809c2a8de3830e3ed275fcc6401edSyam Sidhardhan#include <linux/export.h> 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/types.h> 264fc268d24ceb9f4150777c1b5b2b8e6214e56b2bRandy Dunlap#include <linux/capability.h> 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/errno.h> 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/poll.h> 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/fcntl.h> 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/skbuff.h> 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/socket.h> 331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/ioctl.h> 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/file.h> 35e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann#include <linux/compat.h> 365a0e3ad6af8660be21ca98a971cd00f331318c05Tejun Heo#include <linux/gfp.h> 37ffd13320aa96e07f3048ebdcc603aaf38bed0c47Szymon Janc#include <linux/uaccess.h> 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <net/sock.h> 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/isdn/capilli.h> 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "cmtp.h" 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 458c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATOstatic struct bt_sock_list cmtp_sk_list = { 468c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO .lock = __RW_LOCK_UNLOCKED(cmtp_sk_list.lock) 478c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO}; 488c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int cmtp_sock_release(struct socket *sock) 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct sock *sk = sock->sk; 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BT_DBG("sock %p sk %p", sock, sk); 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sk) 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 588c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO bt_sock_unlink(&cmtp_sk_list, sk); 598c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO 601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock_orphan(sk); 611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock_put(sk); 621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int cmtp_sock_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct cmtp_connadd_req ca; 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct cmtp_conndel_req cd; 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct cmtp_connlist_req cl; 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct cmtp_conninfo ci; 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct socket *nsock; 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds void __user *argp = (void __user *)arg; 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BT_DBG("cmd %x arg %lx", cmd, arg); 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds switch (cmd) { 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CMTPCONNADD: 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_NET_ADMIN)) 81bf5b30b8a4416de04f1ac1196281ddb318669464Zhao Hongjiang return -EPERM; 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&ca, argp, sizeof(ca))) 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds nsock = sockfd_lookup(ca.sock, &err); 871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!nsock) 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (nsock->sk->sk_state != BT_CONNECTED) { 9167b23219ce2f78352b0c566a472ff16c1b0fea9aJulia Lawall sockfd_put(nsock); 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EBADFD; 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = cmtp_add_connection(&ca, nsock); 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!err) { 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_to_user(argp, &ca, sizeof(ca))) 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = -EFAULT; 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } else 10067b23219ce2f78352b0c566a472ff16c1b0fea9aJulia Lawall sockfd_put(nsock); 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CMTPCONNDEL: 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!capable(CAP_NET_ADMIN)) 106bf5b30b8a4416de04f1ac1196281ddb318669464Zhao Hongjiang return -EPERM; 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&cd, argp, sizeof(cd))) 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return cmtp_del_connection(&cd); 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CMTPGETCONNLIST: 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&cl, argp, sizeof(cl))) 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (cl.cnum <= 0) 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = cmtp_get_connlist(&cl); 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!err && copy_to_user(argp, &cl, sizeof(cl))) 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds case CMTPGETCONNINFO: 1271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (copy_from_user(&ci, argp, sizeof(ci))) 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = cmtp_get_conninfo(&ci); 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!err && copy_to_user(argp, &ci, sizeof(ci))) 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EFAULT; 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 1381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 140e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann#ifdef CONFIG_COMPAT 141e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmannstatic int cmtp_sock_compat_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg) 142e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann{ 143e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann if (cmd == CMTPGETCONNLIST) { 144e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann struct cmtp_connlist_req cl; 145816a11d5ced501d368fabe09172f3d62744e8b53Johan Hedberg u32 uci; 146e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann int err; 147e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann 148816a11d5ced501d368fabe09172f3d62744e8b53Johan Hedberg if (get_user(cl.cnum, (u32 __user *) arg) || 149e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann get_user(uci, (u32 __user *) (arg + 4))) 150e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann return -EFAULT; 151e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann 152e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann cl.ci = compat_ptr(uci); 153e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann 154e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann if (cl.cnum <= 0) 155e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann return -EINVAL; 1568e87d14255acffeee36873de226dc25c11b5f46dYOSHIFUJI Hideaki 157e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann err = cmtp_get_connlist(&cl); 158e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann 159816a11d5ced501d368fabe09172f3d62744e8b53Johan Hedberg if (!err && put_user(cl.cnum, (u32 __user *) arg)) 160e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann err = -EFAULT; 161e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann 162e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann return err; 163e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann } 164e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann 165e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann return cmtp_sock_ioctl(sock, cmd, arg); 166e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann} 167e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann#endif 168e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann 16990ddc4f0470427df306f308ad03db6b6b21644b8Eric Dumazetstatic const struct proto_ops cmtp_sock_ops = { 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .family = PF_BLUETOOTH, 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .release = cmtp_sock_release, 1731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .ioctl = cmtp_sock_ioctl, 174e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann#ifdef CONFIG_COMPAT 175e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann .compat_ioctl = cmtp_sock_compat_ioctl, 176e9c5702e3c5558dade169949abd730173e87ef9cMarcel Holtmann#endif 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .bind = sock_no_bind, 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .getname = sock_no_getname, 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .sendmsg = sock_no_sendmsg, 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .recvmsg = sock_no_recvmsg, 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .poll = sock_no_poll, 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .listen = sock_no_listen, 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .shutdown = sock_no_shutdown, 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .setsockopt = sock_no_setsockopt, 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .getsockopt = sock_no_getsockopt, 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .connect = sock_no_connect, 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .socketpair = sock_no_socketpair, 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .accept = sock_no_accept, 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .mmap = sock_no_mmap 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic struct proto cmtp_proto = { 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .name = "CMTP", 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 1951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .obj_size = sizeof(struct bt_sock) 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1983f378b684453f2a028eda463ce383370545d9cc9Eric Parisstatic int cmtp_sock_create(struct net *net, struct socket *sock, int protocol, 1993f378b684453f2a028eda463ce383370545d9cc9Eric Paris int kern) 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct sock *sk; 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds BT_DBG("sock %p", sock); 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (sock->type != SOCK_RAW) 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ESOCKTNOSUPPORT; 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2086257ff2177ff02d7f260a7a501876aa41cb9a9f6Pavel Emelyanov sk = sk_alloc(net, PF_BLUETOOTH, GFP_ATOMIC, &cmtp_proto); 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!sk) 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -ENOMEM; 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock_init_data(sock, sk); 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock->ops = &cmtp_sock_ops; 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock->state = SS_UNCONNECTED; 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sock_reset_flag(sk, SOCK_ZAPPED); 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sk->sk_protocol = protocol; 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds sk->sk_state = BT_OPEN; 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2238c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO bt_sock_link(&cmtp_sk_list, sk); 2248c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 228ec1b4cf74c81bfd0fbe5bf62bafc86c45917e72fStephen Hemmingerstatic const struct net_proto_family cmtp_sock_family_ops = { 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .family = PF_BLUETOOTH, 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .owner = THIS_MODULE, 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .create = cmtp_sock_create 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint cmtp_init_sockets(void) 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = proto_register(&cmtp_proto, 0); 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err < 0) 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = bt_sock_register(BTPROTO_CMTP, &cmtp_sock_family_ops); 2438c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO if (err < 0) { 2448c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO BT_ERR("Can't register CMTP socket"); 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto error; 2468c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO } 2478c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO 248b03166152f6da91cec8b66837b309dd3923ea536Al Viro err = bt_procfs_init(&init_net, "cmtp", &cmtp_sk_list, NULL); 2498c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO if (err < 0) { 2508c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO BT_ERR("Failed to create CMTP proc file"); 2518c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO bt_sock_unregister(BTPROTO_HIDP); 2528c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO goto error; 2538c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO } 2548c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO 2558c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO BT_INFO("CMTP socket layer initialized"); 2561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldserror: 2601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds proto_unregister(&cmtp_proto); 2611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 2621da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid cmtp_cleanup_sockets(void) 2651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2668c8de589cedd375934d96e073d2b9077a00f10c2Masatake YAMATO bt_procfs_cleanup(&init_net, "cmtp"); 2675e9d7f868f04106139a58212b860dcdc268ad3afDavid Herrmann bt_sock_unregister(BTPROTO_CMTP); 2681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds proto_unregister(&cmtp_proto); 2691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 270