Home | History | Annotate | Line # | Download | only in netbt
rfcomm_socket.c revision 1.10.38.2
      1  1.10.38.1       tls /*	$NetBSD: rfcomm_socket.c,v 1.10.38.2 2017/12/03 11:39:03 jdolecek Exp $	*/
      2        1.1   gdamore 
      3        1.1   gdamore /*-
      4        1.1   gdamore  * Copyright (c) 2006 Itronix Inc.
      5        1.1   gdamore  * All rights reserved.
      6        1.1   gdamore  *
      7        1.1   gdamore  * Written by Iain Hibbert for Itronix Inc.
      8        1.1   gdamore  *
      9        1.1   gdamore  * Redistribution and use in source and binary forms, with or without
     10        1.1   gdamore  * modification, are permitted provided that the following conditions
     11        1.1   gdamore  * are met:
     12        1.1   gdamore  * 1. Redistributions of source code must retain the above copyright
     13        1.1   gdamore  *    notice, this list of conditions and the following disclaimer.
     14        1.1   gdamore  * 2. Redistributions in binary form must reproduce the above copyright
     15        1.1   gdamore  *    notice, this list of conditions and the following disclaimer in the
     16        1.1   gdamore  *    documentation and/or other materials provided with the distribution.
     17        1.1   gdamore  * 3. The name of Itronix Inc. may not be used to endorse
     18        1.1   gdamore  *    or promote products derived from this software without specific
     19        1.1   gdamore  *    prior written permission.
     20        1.1   gdamore  *
     21        1.1   gdamore  * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
     22        1.1   gdamore  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     23        1.1   gdamore  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     24        1.1   gdamore  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
     25        1.1   gdamore  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     26        1.1   gdamore  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
     27        1.1   gdamore  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
     28        1.1   gdamore  * ON ANY THEORY OF LIABILITY, WHETHER IN
     29        1.1   gdamore  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     30        1.1   gdamore  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     31        1.1   gdamore  * POSSIBILITY OF SUCH DAMAGE.
     32        1.1   gdamore  */
     33        1.1   gdamore 
     34        1.1   gdamore #include <sys/cdefs.h>
     35  1.10.38.1       tls __KERNEL_RCSID(0, "$NetBSD: rfcomm_socket.c,v 1.10.38.2 2017/12/03 11:39:03 jdolecek Exp $");
     36        1.6    plunky 
     37        1.6    plunky /* load symbolic names */
     38        1.6    plunky #ifdef BLUETOOTH_DEBUG
     39        1.6    plunky #define PRUREQUESTS
     40        1.6    plunky #define PRCOREQUESTS
     41        1.6    plunky #endif
     42        1.1   gdamore 
     43        1.1   gdamore #include <sys/param.h>
     44        1.1   gdamore #include <sys/domain.h>
     45        1.1   gdamore #include <sys/kernel.h>
     46        1.1   gdamore #include <sys/mbuf.h>
     47        1.1   gdamore #include <sys/proc.h>
     48        1.1   gdamore #include <sys/protosw.h>
     49        1.1   gdamore #include <sys/socket.h>
     50        1.1   gdamore #include <sys/socketvar.h>
     51        1.1   gdamore #include <sys/systm.h>
     52        1.1   gdamore 
     53        1.1   gdamore #include <netbt/bluetooth.h>
     54        1.1   gdamore #include <netbt/rfcomm.h>
     55        1.1   gdamore 
     56        1.1   gdamore /****************************************************************************
     57        1.1   gdamore  *
     58        1.1   gdamore  *	RFCOMM SOCK_STREAM Sockets - serial line emulation
     59        1.1   gdamore  *
     60        1.1   gdamore  */
     61        1.1   gdamore 
     62        1.1   gdamore static void rfcomm_connecting(void *);
     63        1.1   gdamore static void rfcomm_connected(void *);
     64        1.1   gdamore static void rfcomm_disconnected(void *, int);
     65        1.1   gdamore static void *rfcomm_newconn(void *, struct sockaddr_bt *, struct sockaddr_bt *);
     66        1.1   gdamore static void rfcomm_complete(void *, int);
     67        1.7    plunky static void rfcomm_linkmode(void *, int);
     68        1.1   gdamore static void rfcomm_input(void *, struct mbuf *);
     69        1.1   gdamore 
     70        1.1   gdamore static const struct btproto rfcomm_proto = {
     71        1.1   gdamore 	rfcomm_connecting,
     72        1.1   gdamore 	rfcomm_connected,
     73        1.1   gdamore 	rfcomm_disconnected,
     74        1.1   gdamore 	rfcomm_newconn,
     75        1.1   gdamore 	rfcomm_complete,
     76        1.7    plunky 	rfcomm_linkmode,
     77        1.1   gdamore 	rfcomm_input,
     78        1.1   gdamore };
     79        1.1   gdamore 
     80        1.1   gdamore /* sysctl variables */
     81        1.1   gdamore int rfcomm_sendspace = 4096;
     82        1.1   gdamore int rfcomm_recvspace = 4096;
     83        1.1   gdamore 
     84  1.10.38.1       tls static int
     85  1.10.38.1       tls rfcomm_attach(struct socket *so, int proto)
     86  1.10.38.1       tls {
     87  1.10.38.1       tls 	int error;
     88  1.10.38.1       tls 
     89  1.10.38.1       tls 	KASSERT(so->so_pcb == NULL);
     90  1.10.38.1       tls 
     91  1.10.38.1       tls 	if (so->so_lock == NULL) {
     92  1.10.38.1       tls 		mutex_obj_hold(bt_lock);
     93  1.10.38.1       tls 		so->so_lock = bt_lock;
     94  1.10.38.1       tls 		solock(so);
     95  1.10.38.1       tls 	}
     96  1.10.38.1       tls 	KASSERT(solocked(so));
     97  1.10.38.1       tls 
     98  1.10.38.1       tls 	/*
     99  1.10.38.1       tls 	 * Since we have nothing to add, we attach the DLC
    100  1.10.38.1       tls 	 * structure directly to our PCB pointer.
    101  1.10.38.1       tls 	 */
    102  1.10.38.1       tls 	error = soreserve(so, rfcomm_sendspace, rfcomm_recvspace);
    103  1.10.38.1       tls 	if (error)
    104  1.10.38.1       tls 		return error;
    105  1.10.38.1       tls 
    106  1.10.38.1       tls 	error = rfcomm_attach_pcb((struct rfcomm_dlc **)&so->so_pcb,
    107  1.10.38.1       tls 				&rfcomm_proto, so);
    108  1.10.38.1       tls 	if (error)
    109  1.10.38.1       tls 		return error;
    110  1.10.38.1       tls 
    111  1.10.38.1       tls 	error = rfcomm_rcvd_pcb(so->so_pcb, sbspace(&so->so_rcv));
    112  1.10.38.1       tls 	if (error) {
    113  1.10.38.1       tls 		rfcomm_detach_pcb((struct rfcomm_dlc **)&so->so_pcb);
    114  1.10.38.1       tls 		return error;
    115  1.10.38.1       tls 	}
    116  1.10.38.1       tls 	return 0;
    117  1.10.38.1       tls }
    118  1.10.38.1       tls 
    119  1.10.38.1       tls static void
    120  1.10.38.1       tls rfcomm_detach(struct socket *so)
    121  1.10.38.1       tls {
    122  1.10.38.1       tls 	KASSERT(so->so_pcb != NULL);
    123  1.10.38.1       tls 	rfcomm_detach_pcb((struct rfcomm_dlc **)&so->so_pcb);
    124  1.10.38.1       tls 	KASSERT(so->so_pcb == NULL);
    125  1.10.38.1       tls }
    126  1.10.38.1       tls 
    127  1.10.38.1       tls static int
    128  1.10.38.2  jdolecek rfcomm_accept(struct socket *so, struct sockaddr *nam)
    129  1.10.38.1       tls {
    130  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    131  1.10.38.1       tls 
    132  1.10.38.1       tls 	KASSERT(solocked(so));
    133  1.10.38.1       tls 	KASSERT(nam != NULL);
    134  1.10.38.1       tls 
    135  1.10.38.1       tls 	if (pcb == NULL)
    136  1.10.38.1       tls 		return EINVAL;
    137  1.10.38.1       tls 
    138  1.10.38.2  jdolecek 	return rfcomm_peeraddr_pcb(pcb, (struct sockaddr_bt *)nam);
    139  1.10.38.1       tls }
    140  1.10.38.1       tls 
    141  1.10.38.1       tls static int
    142  1.10.38.2  jdolecek rfcomm_bind(struct socket *so, struct sockaddr *nam, struct lwp *l)
    143  1.10.38.1       tls {
    144  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    145  1.10.38.2  jdolecek 	struct sockaddr_bt *sa = (struct sockaddr_bt *)nam;
    146  1.10.38.1       tls 
    147  1.10.38.1       tls 	KASSERT(solocked(so));
    148  1.10.38.1       tls 	KASSERT(nam != NULL);
    149  1.10.38.1       tls 
    150  1.10.38.1       tls 	if (pcb == NULL)
    151  1.10.38.1       tls 		return EINVAL;
    152  1.10.38.1       tls 
    153  1.10.38.1       tls 	if (sa->bt_len != sizeof(struct sockaddr_bt))
    154  1.10.38.1       tls 		return EINVAL;
    155  1.10.38.1       tls 
    156  1.10.38.1       tls 	if (sa->bt_family != AF_BLUETOOTH)
    157  1.10.38.1       tls 		return EAFNOSUPPORT;
    158  1.10.38.1       tls 
    159  1.10.38.1       tls 	return rfcomm_bind_pcb(pcb, sa);
    160  1.10.38.1       tls }
    161  1.10.38.1       tls 
    162  1.10.38.1       tls static int
    163  1.10.38.1       tls rfcomm_listen(struct socket *so, struct lwp *l)
    164  1.10.38.1       tls {
    165  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    166  1.10.38.1       tls 
    167  1.10.38.1       tls 	KASSERT(solocked(so));
    168  1.10.38.1       tls 
    169  1.10.38.1       tls 	if (pcb == NULL)
    170  1.10.38.1       tls 		return EINVAL;
    171  1.10.38.1       tls 
    172  1.10.38.1       tls 	return rfcomm_listen_pcb(pcb);
    173  1.10.38.1       tls }
    174  1.10.38.1       tls 
    175  1.10.38.1       tls static int
    176  1.10.38.2  jdolecek rfcomm_connect(struct socket *so, struct sockaddr *nam, struct lwp *l)
    177  1.10.38.1       tls {
    178  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    179  1.10.38.2  jdolecek 	struct sockaddr_bt *sa = (struct sockaddr_bt *)nam;
    180  1.10.38.1       tls 
    181  1.10.38.1       tls 	KASSERT(solocked(so));
    182  1.10.38.1       tls 	KASSERT(nam != NULL);
    183  1.10.38.1       tls 
    184  1.10.38.1       tls 	if (pcb == NULL)
    185  1.10.38.1       tls 		return EINVAL;
    186  1.10.38.1       tls 
    187  1.10.38.1       tls 	if (sa->bt_len != sizeof(struct sockaddr_bt))
    188  1.10.38.1       tls 		return EINVAL;
    189  1.10.38.1       tls 
    190  1.10.38.1       tls 	if (sa->bt_family != AF_BLUETOOTH)
    191  1.10.38.1       tls 		return EAFNOSUPPORT;
    192  1.10.38.1       tls 
    193  1.10.38.1       tls 	soisconnecting(so);
    194  1.10.38.1       tls 	return rfcomm_connect_pcb(pcb, sa);
    195  1.10.38.1       tls }
    196  1.10.38.1       tls 
    197  1.10.38.1       tls static int
    198  1.10.38.1       tls rfcomm_connect2(struct socket *so, struct socket *so2)
    199  1.10.38.1       tls {
    200  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    201  1.10.38.1       tls 
    202  1.10.38.1       tls 	KASSERT(solocked(so));
    203  1.10.38.1       tls 
    204  1.10.38.1       tls 	if (pcb == NULL)
    205  1.10.38.1       tls 		return EINVAL;
    206  1.10.38.1       tls 
    207  1.10.38.1       tls 	return EOPNOTSUPP;
    208  1.10.38.1       tls }
    209  1.10.38.1       tls 
    210  1.10.38.1       tls static int
    211  1.10.38.1       tls rfcomm_disconnect(struct socket *so)
    212  1.10.38.1       tls {
    213  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    214  1.10.38.1       tls 
    215  1.10.38.1       tls 	KASSERT(solocked(so));
    216  1.10.38.1       tls 
    217  1.10.38.1       tls 	if (pcb == NULL)
    218  1.10.38.1       tls 		return EINVAL;
    219  1.10.38.1       tls 
    220  1.10.38.1       tls 	soisdisconnecting(so);
    221  1.10.38.1       tls 	return rfcomm_disconnect_pcb(pcb, so->so_linger);
    222  1.10.38.1       tls }
    223  1.10.38.1       tls 
    224  1.10.38.1       tls static int
    225  1.10.38.1       tls rfcomm_shutdown(struct socket *so)
    226  1.10.38.1       tls {
    227  1.10.38.1       tls 	KASSERT(solocked(so));
    228  1.10.38.1       tls 
    229  1.10.38.1       tls 	socantsendmore(so);
    230  1.10.38.1       tls 	return 0;
    231  1.10.38.1       tls }
    232  1.10.38.1       tls 
    233  1.10.38.1       tls static int
    234  1.10.38.1       tls rfcomm_abort(struct socket *so)
    235  1.10.38.1       tls {
    236  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    237  1.10.38.1       tls 
    238  1.10.38.1       tls 	KASSERT(solocked(so));
    239  1.10.38.1       tls 
    240  1.10.38.1       tls 	if (pcb == NULL)
    241  1.10.38.1       tls 		return EINVAL;
    242  1.10.38.1       tls 
    243  1.10.38.1       tls 	rfcomm_disconnect_pcb(pcb, 0);
    244  1.10.38.1       tls 	soisdisconnected(so);
    245  1.10.38.1       tls 	rfcomm_detach(so);
    246  1.10.38.1       tls 	return 0;
    247  1.10.38.1       tls }
    248  1.10.38.1       tls 
    249  1.10.38.1       tls static int
    250  1.10.38.1       tls rfcomm_ioctl(struct socket *so, u_long cmd, void *nam, struct ifnet *ifp)
    251  1.10.38.1       tls {
    252  1.10.38.1       tls 	return EPASSTHROUGH;
    253  1.10.38.1       tls }
    254  1.10.38.1       tls 
    255  1.10.38.1       tls static int
    256  1.10.38.1       tls rfcomm_stat(struct socket *so, struct stat *ub)
    257  1.10.38.1       tls {
    258  1.10.38.1       tls 	KASSERT(solocked(so));
    259  1.10.38.1       tls 
    260  1.10.38.1       tls 	return 0;
    261  1.10.38.1       tls }
    262  1.10.38.1       tls 
    263  1.10.38.1       tls static int
    264  1.10.38.2  jdolecek rfcomm_peeraddr(struct socket *so, struct sockaddr *nam)
    265  1.10.38.1       tls {
    266  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    267  1.10.38.1       tls 
    268  1.10.38.1       tls 	KASSERT(solocked(so));
    269  1.10.38.1       tls 	KASSERT(pcb != NULL);
    270  1.10.38.1       tls 	KASSERT(nam != NULL);
    271  1.10.38.1       tls 
    272  1.10.38.2  jdolecek 	return rfcomm_peeraddr_pcb(pcb, (struct sockaddr_bt *)nam);
    273  1.10.38.1       tls }
    274  1.10.38.1       tls 
    275  1.10.38.1       tls static int
    276  1.10.38.2  jdolecek rfcomm_sockaddr(struct socket *so, struct sockaddr *nam)
    277  1.10.38.1       tls {
    278  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    279  1.10.38.1       tls 
    280  1.10.38.1       tls 	KASSERT(solocked(so));
    281  1.10.38.1       tls 	KASSERT(pcb != NULL);
    282  1.10.38.1       tls 	KASSERT(nam != NULL);
    283  1.10.38.1       tls 
    284  1.10.38.2  jdolecek 	return rfcomm_sockaddr_pcb(pcb, (struct sockaddr_bt *)nam);
    285  1.10.38.1       tls }
    286  1.10.38.1       tls 
    287  1.10.38.1       tls static int
    288  1.10.38.1       tls rfcomm_rcvd(struct socket *so, int flags, struct lwp *l)
    289  1.10.38.1       tls {
    290  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    291  1.10.38.1       tls 
    292  1.10.38.1       tls 	KASSERT(solocked(so));
    293  1.10.38.1       tls 
    294  1.10.38.1       tls 	if (pcb == NULL)
    295  1.10.38.1       tls 		return EINVAL;
    296  1.10.38.1       tls 
    297  1.10.38.1       tls 	return rfcomm_rcvd_pcb(pcb, sbspace(&so->so_rcv));
    298  1.10.38.1       tls }
    299  1.10.38.1       tls 
    300  1.10.38.1       tls static int
    301  1.10.38.1       tls rfcomm_recvoob(struct socket *so, struct mbuf *m, int flags)
    302  1.10.38.1       tls {
    303  1.10.38.1       tls 	KASSERT(solocked(so));
    304  1.10.38.1       tls 
    305  1.10.38.1       tls 	return EOPNOTSUPP;
    306  1.10.38.1       tls }
    307  1.10.38.1       tls 
    308  1.10.38.1       tls static int
    309  1.10.38.2  jdolecek rfcomm_send(struct socket *so, struct mbuf *m, struct sockaddr *nam,
    310  1.10.38.1       tls     struct mbuf *control, struct lwp *l)
    311  1.10.38.1       tls {
    312  1.10.38.1       tls 	struct rfcomm_dlc *pcb = so->so_pcb;
    313  1.10.38.1       tls 	int err = 0;
    314  1.10.38.1       tls 	struct mbuf *m0;
    315  1.10.38.1       tls 
    316  1.10.38.1       tls 	KASSERT(solocked(so));
    317  1.10.38.1       tls 	KASSERT(m != NULL);
    318  1.10.38.1       tls 
    319  1.10.38.1       tls 	if (control)	/* no use for that */
    320  1.10.38.1       tls 		m_freem(control);
    321  1.10.38.1       tls 
    322  1.10.38.1       tls 	if (pcb == NULL) {
    323  1.10.38.1       tls 		err = EINVAL;
    324  1.10.38.1       tls 		goto release;
    325  1.10.38.1       tls 	}
    326  1.10.38.1       tls 
    327  1.10.38.1       tls 	m0 = m_copypacket(m, M_DONTWAIT);
    328  1.10.38.1       tls 	if (m0 == NULL) {
    329  1.10.38.1       tls 		err = ENOMEM;
    330  1.10.38.1       tls 		goto release;
    331  1.10.38.1       tls 	}
    332  1.10.38.1       tls 
    333  1.10.38.1       tls 	sbappendstream(&so->so_snd, m);
    334  1.10.38.1       tls 	return rfcomm_send_pcb(pcb, m0);
    335  1.10.38.1       tls 
    336  1.10.38.1       tls release:
    337  1.10.38.1       tls 	m_freem(m);
    338  1.10.38.1       tls 	return err;
    339  1.10.38.1       tls }
    340  1.10.38.1       tls 
    341  1.10.38.1       tls static int
    342  1.10.38.1       tls rfcomm_sendoob(struct socket *so, struct mbuf *m, struct mbuf *control)
    343  1.10.38.1       tls {
    344  1.10.38.1       tls 	KASSERT(solocked(so));
    345  1.10.38.1       tls 
    346  1.10.38.1       tls 	if (m)
    347  1.10.38.1       tls 		m_freem(m);
    348  1.10.38.1       tls 	if (control)
    349  1.10.38.1       tls 		m_freem(control);
    350  1.10.38.1       tls 
    351  1.10.38.1       tls 	return EOPNOTSUPP;
    352  1.10.38.1       tls }
    353  1.10.38.1       tls 
    354  1.10.38.1       tls static int
    355  1.10.38.1       tls rfcomm_purgeif(struct socket *so, struct ifnet *ifp)
    356  1.10.38.1       tls {
    357  1.10.38.1       tls 
    358  1.10.38.1       tls 	return EOPNOTSUPP;
    359  1.10.38.1       tls }
    360  1.10.38.1       tls 
    361        1.1   gdamore /*
    362       1.10    plunky  * rfcomm_ctloutput(req, socket, sockopt)
    363        1.1   gdamore  *
    364        1.1   gdamore  */
    365        1.1   gdamore int
    366       1.10    plunky rfcomm_ctloutput(int req, struct socket *so, struct sockopt *sopt)
    367        1.1   gdamore {
    368        1.1   gdamore 	struct rfcomm_dlc *pcb = so->so_pcb;
    369        1.1   gdamore 	int err = 0;
    370        1.1   gdamore 
    371        1.1   gdamore 	DPRINTFN(2, "%s\n", prcorequests[req]);
    372        1.1   gdamore 
    373        1.4    plunky 	if (pcb == NULL)
    374        1.4    plunky 		return EINVAL;
    375        1.4    plunky 
    376       1.10    plunky 	if (sopt->sopt_level != BTPROTO_RFCOMM)
    377        1.4    plunky 		return ENOPROTOOPT;
    378        1.1   gdamore 
    379        1.1   gdamore 	switch(req) {
    380        1.1   gdamore 	case PRCO_GETOPT:
    381       1.10    plunky 		err = rfcomm_getopt(pcb, sopt);
    382        1.1   gdamore 		break;
    383        1.1   gdamore 
    384        1.1   gdamore 	case PRCO_SETOPT:
    385       1.10    plunky 		err = rfcomm_setopt(pcb, sopt);
    386        1.1   gdamore 		break;
    387        1.1   gdamore 
    388        1.1   gdamore 	default:
    389        1.4    plunky 		err = ENOPROTOOPT;
    390        1.1   gdamore 		break;
    391        1.1   gdamore 	}
    392        1.1   gdamore 
    393        1.1   gdamore 	return err;
    394        1.1   gdamore }
    395        1.1   gdamore 
    396        1.1   gdamore /**********************************************************************
    397        1.1   gdamore  *
    398        1.1   gdamore  * RFCOMM callbacks
    399        1.1   gdamore  */
    400        1.1   gdamore 
    401        1.1   gdamore static void
    402        1.3  christos rfcomm_connecting(void *arg)
    403        1.1   gdamore {
    404        1.1   gdamore 	/* struct socket *so = arg; */
    405        1.1   gdamore 
    406        1.5    plunky 	KASSERT(arg != NULL);
    407        1.1   gdamore 	DPRINTF("Connecting\n");
    408        1.1   gdamore }
    409        1.1   gdamore 
    410        1.1   gdamore static void
    411        1.1   gdamore rfcomm_connected(void *arg)
    412        1.1   gdamore {
    413        1.1   gdamore 	struct socket *so = arg;
    414        1.1   gdamore 
    415        1.5    plunky 	KASSERT(so != NULL);
    416        1.1   gdamore 	DPRINTF("Connected\n");
    417        1.1   gdamore 	soisconnected(so);
    418        1.1   gdamore }
    419        1.1   gdamore 
    420        1.1   gdamore static void
    421        1.1   gdamore rfcomm_disconnected(void *arg, int err)
    422        1.1   gdamore {
    423        1.1   gdamore 	struct socket *so = arg;
    424        1.1   gdamore 
    425        1.5    plunky 	KASSERT(so != NULL);
    426        1.1   gdamore 	DPRINTF("Disconnected\n");
    427        1.1   gdamore 
    428        1.1   gdamore 	so->so_error = err;
    429        1.1   gdamore 	soisdisconnected(so);
    430        1.1   gdamore }
    431        1.1   gdamore 
    432        1.1   gdamore static void *
    433        1.3  christos rfcomm_newconn(void *arg, struct sockaddr_bt *laddr,
    434        1.3  christos     struct sockaddr_bt *raddr)
    435        1.1   gdamore {
    436        1.1   gdamore 	struct socket *so = arg;
    437        1.1   gdamore 
    438        1.1   gdamore 	DPRINTF("New Connection\n");
    439  1.10.38.1       tls 	so = sonewconn(so, false);
    440        1.1   gdamore 	if (so == NULL)
    441        1.1   gdamore 		return NULL;
    442        1.1   gdamore 
    443        1.1   gdamore 	soisconnecting(so);
    444        1.1   gdamore 
    445        1.1   gdamore 	return so->so_pcb;
    446        1.1   gdamore }
    447        1.1   gdamore 
    448        1.1   gdamore /*
    449        1.1   gdamore  * rfcomm_complete(rfcomm_dlc, length)
    450        1.1   gdamore  *
    451        1.1   gdamore  * length bytes are sent and may be removed from socket buffer
    452        1.1   gdamore  */
    453        1.1   gdamore static void
    454        1.1   gdamore rfcomm_complete(void *arg, int length)
    455        1.1   gdamore {
    456        1.1   gdamore 	struct socket *so = arg;
    457        1.1   gdamore 
    458        1.1   gdamore 	sbdrop(&so->so_snd, length);
    459        1.1   gdamore 	sowwakeup(so);
    460        1.1   gdamore }
    461        1.1   gdamore 
    462        1.1   gdamore /*
    463        1.7    plunky  * rfcomm_linkmode(rfcomm_dlc, new)
    464        1.7    plunky  *
    465        1.7    plunky  * link mode change notification.
    466        1.7    plunky  */
    467        1.7    plunky static void
    468        1.7    plunky rfcomm_linkmode(void *arg, int new)
    469        1.7    plunky {
    470        1.7    plunky 	struct socket *so = arg;
    471       1.10    plunky 	struct sockopt sopt;
    472        1.7    plunky 	int mode;
    473        1.7    plunky 
    474        1.7    plunky 	DPRINTF("auth %s, encrypt %s, secure %s\n",
    475        1.7    plunky 		(new & RFCOMM_LM_AUTH ? "on" : "off"),
    476        1.7    plunky 		(new & RFCOMM_LM_ENCRYPT ? "on" : "off"),
    477        1.7    plunky 		(new & RFCOMM_LM_SECURE ? "on" : "off"));
    478        1.7    plunky 
    479       1.10    plunky 	sockopt_init(&sopt, BTPROTO_RFCOMM, SO_RFCOMM_LM, 0);
    480       1.10    plunky 	(void)rfcomm_getopt(so->so_pcb, &sopt);
    481       1.10    plunky 	(void)sockopt_getint(&sopt, &mode);
    482       1.10    plunky 	sockopt_destroy(&sopt);
    483       1.10    plunky 
    484        1.7    plunky 	if (((mode & RFCOMM_LM_AUTH) && !(new & RFCOMM_LM_AUTH))
    485        1.7    plunky 	    || ((mode & RFCOMM_LM_ENCRYPT) && !(new & RFCOMM_LM_ENCRYPT))
    486        1.7    plunky 	    || ((mode & RFCOMM_LM_SECURE) && !(new & RFCOMM_LM_SECURE)))
    487  1.10.38.1       tls 		rfcomm_disconnect_pcb(so->so_pcb, 0);
    488        1.7    plunky }
    489        1.7    plunky 
    490        1.7    plunky /*
    491        1.1   gdamore  * rfcomm_input(rfcomm_dlc, mbuf)
    492        1.1   gdamore  */
    493        1.1   gdamore static void
    494        1.1   gdamore rfcomm_input(void *arg, struct mbuf *m)
    495        1.1   gdamore {
    496        1.1   gdamore 	struct socket *so = arg;
    497        1.1   gdamore 
    498        1.5    plunky 	KASSERT(so != NULL);
    499        1.1   gdamore 
    500        1.1   gdamore 	if (m->m_pkthdr.len > sbspace(&so->so_rcv)) {
    501        1.1   gdamore 		printf("%s: %d bytes dropped (socket buffer full)\n",
    502        1.1   gdamore 			__func__, m->m_pkthdr.len);
    503        1.1   gdamore 		m_freem(m);
    504        1.1   gdamore 		return;
    505        1.1   gdamore 	}
    506        1.1   gdamore 
    507        1.1   gdamore 	DPRINTFN(10, "received %d bytes\n", m->m_pkthdr.len);
    508        1.1   gdamore 
    509        1.1   gdamore 	sbappendstream(&so->so_rcv, m);
    510        1.1   gdamore 	sorwakeup(so);
    511        1.1   gdamore }
    512  1.10.38.1       tls 
    513  1.10.38.1       tls PR_WRAP_USRREQS(rfcomm)
    514  1.10.38.1       tls 
    515  1.10.38.1       tls #define	rfcomm_attach		rfcomm_attach_wrapper
    516  1.10.38.1       tls #define	rfcomm_detach		rfcomm_detach_wrapper
    517  1.10.38.1       tls #define	rfcomm_accept		rfcomm_accept_wrapper
    518  1.10.38.1       tls #define	rfcomm_bind		rfcomm_bind_wrapper
    519  1.10.38.1       tls #define	rfcomm_listen		rfcomm_listen_wrapper
    520  1.10.38.1       tls #define	rfcomm_connect		rfcomm_connect_wrapper
    521  1.10.38.1       tls #define	rfcomm_connect2		rfcomm_connect2_wrapper
    522  1.10.38.1       tls #define	rfcomm_disconnect	rfcomm_disconnect_wrapper
    523  1.10.38.1       tls #define	rfcomm_shutdown		rfcomm_shutdown_wrapper
    524  1.10.38.1       tls #define	rfcomm_abort		rfcomm_abort_wrapper
    525  1.10.38.1       tls #define	rfcomm_ioctl		rfcomm_ioctl_wrapper
    526  1.10.38.1       tls #define	rfcomm_stat		rfcomm_stat_wrapper
    527  1.10.38.1       tls #define	rfcomm_peeraddr		rfcomm_peeraddr_wrapper
    528  1.10.38.1       tls #define	rfcomm_sockaddr		rfcomm_sockaddr_wrapper
    529  1.10.38.1       tls #define	rfcomm_rcvd		rfcomm_rcvd_wrapper
    530  1.10.38.1       tls #define	rfcomm_recvoob		rfcomm_recvoob_wrapper
    531  1.10.38.1       tls #define	rfcomm_send		rfcomm_send_wrapper
    532  1.10.38.1       tls #define	rfcomm_sendoob		rfcomm_sendoob_wrapper
    533  1.10.38.1       tls #define	rfcomm_purgeif		rfcomm_purgeif_wrapper
    534  1.10.38.1       tls 
    535  1.10.38.1       tls const struct pr_usrreqs rfcomm_usrreqs = {
    536  1.10.38.1       tls 	.pr_attach	= rfcomm_attach,
    537  1.10.38.1       tls 	.pr_detach	= rfcomm_detach,
    538  1.10.38.1       tls 	.pr_accept	= rfcomm_accept,
    539  1.10.38.1       tls 	.pr_bind	= rfcomm_bind,
    540  1.10.38.1       tls 	.pr_listen	= rfcomm_listen,
    541  1.10.38.1       tls 	.pr_connect	= rfcomm_connect,
    542  1.10.38.1       tls 	.pr_connect2	= rfcomm_connect2,
    543  1.10.38.1       tls 	.pr_disconnect	= rfcomm_disconnect,
    544  1.10.38.1       tls 	.pr_shutdown	= rfcomm_shutdown,
    545  1.10.38.1       tls 	.pr_abort	= rfcomm_abort,
    546  1.10.38.1       tls 	.pr_ioctl	= rfcomm_ioctl,
    547  1.10.38.1       tls 	.pr_stat	= rfcomm_stat,
    548  1.10.38.1       tls 	.pr_peeraddr	= rfcomm_peeraddr,
    549  1.10.38.1       tls 	.pr_sockaddr	= rfcomm_sockaddr,
    550  1.10.38.1       tls 	.pr_rcvd	= rfcomm_rcvd,
    551  1.10.38.1       tls 	.pr_recvoob	= rfcomm_recvoob,
    552  1.10.38.1       tls 	.pr_send	= rfcomm_send,
    553  1.10.38.1       tls 	.pr_sendoob	= rfcomm_sendoob,
    554  1.10.38.1       tls 	.pr_purgeif	= rfcomm_purgeif,
    555  1.10.38.1       tls };
    556