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