root/netbt/rfcomm_socket.c

DEFINITIONS

1. rfcomm_usrreq
2. rfcomm_ctloutput
3. rfcomm_connecting
4. rfcomm_connected
5. rfcomm_disconnected
6. rfcomm_newconn
7. rfcomm_complete
8. rfcomm_linkmode
9. rfcomm_input

    1 /*      $OpenBSD: rfcomm_socket.c,v 1.1 2007/06/01 02:46:12 uwe Exp $   */
    2 /*      $NetBSD: rfcomm_socket.c,v 1.7 2007/04/21 06:15:23 plunky Exp $ */
    4 /*-
    5  * Copyright (c) 2006 Itronix Inc.
    6  * All rights reserved.
    7  *
    8  * Written by Iain Hibbert for Itronix Inc.
    9  *
   10  * Redistribution and use in source and binary forms, with or without
   11  * modification, are permitted provided that the following conditions
   12  * are met:
   13  * 1. Redistributions of source code must retain the above copyright
   14  *    notice, this list of conditions and the following disclaimer.
   15  * 2. Redistributions in binary form must reproduce the above copyright
   16  *    notice, this list of conditions and the following disclaimer in the
   17  *    documentation and/or other materials provided with the distribution.
   18  * 3. The name of Itronix Inc. may not be used to endorse
   19  *    or promote products derived from this software without specific
   20  *    prior written permission.
   21  *
   22  * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND
   23  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
   24  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
   25  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY
   26  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
   27  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
   28  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
   29  * ON ANY THEORY OF LIABILITY, WHETHER IN
   30  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
   31  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
   32  * POSSIBILITY OF SUCH DAMAGE.
   33  */
   35 #include <sys/cdefs.h>
   37 /* load symbolic names */
   38 #ifdef BLUETOOTH_DEBUG
   39 #define PRUREQUESTS
   40 #define PRCOREQUESTS
   41 #endif
   43 #include <sys/param.h>
   44 #include <sys/domain.h>
   45 #include <sys/kernel.h>
   46 #include <sys/mbuf.h>
   47 #include <sys/proc.h>
   48 #include <sys/protosw.h>
   49 #include <sys/socket.h>
   50 #include <sys/socketvar.h>
   51 #include <sys/systm.h>
   53 #include <netbt/bluetooth.h>
   54 #include <netbt/hci.h>          /* XXX for EPASSTHROUGH */
   55 #include <netbt/rfcomm.h>
   57 /****************************************************************************
   58  *
   59  *      RFCOMM SOCK_STREAM Sockets - serial line emulation
   60  *
   61  */
   63 static void rfcomm_connecting(void *);
   64 static void rfcomm_connected(void *);
   65 static void rfcomm_disconnected(void *, int);
   66 static void *rfcomm_newconn(void *, struct sockaddr_bt *, struct sockaddr_bt *);
   67 static void rfcomm_complete(void *, int);
   68 static void rfcomm_linkmode(void *, int);
   69 static void rfcomm_input(void *, struct mbuf *);
   71 static const struct btproto rfcomm_proto = {
rfcomm_connecting,
rfcomm_connected,
rfcomm_disconnected,
rfcomm_newconn,
rfcomm_complete,
rfcomm_linkmode,
rfcomm_input,
   79 };
   81 /* sysctl variables */
   82 int rfcomm_sendspace = 4096;
   83 int rfcomm_recvspace = 4096;
   85 /*
   86  * User Request.
   87  * up is socket
   88  * m is either
   89  *      optional mbuf chain containing message
   90  *      ioctl command (PRU_CONTROL)
   91  * nam is either
   92  *      optional mbuf chain containing an address
   93  *      ioctl data (PRU_CONTROL)
   94  *      optionally protocol number (PRU_ATTACH)
   95  *      message flags (PRU_RCVD)
   96  * ctl is either
   97  *      optional mbuf chain containing socket options
   98  *      optional interface pointer (PRU_CONTROL, PRU_PURGEIF)
   99  * l is pointer to process requesting action (if any)
  100  *
  101  * we are responsible for disposing of m and ctl if
  102  * they are mbuf chains
  103  */
  104 int
rfcomm_usrreq(struct socket *up, int req, struct mbuf *m,
  106                 struct mbuf *nam, struct mbuf *ctl)
  107 {
  108         struct rfcomm_dlc *pcb = up->so_pcb;
  109         struct sockaddr_bt *sa;
  110         struct mbuf *m0;
  111         int err = 0;
  113 #ifdef notyet                   /* XXX */
DPRINTFN(2, "%s\n", prurequests[req]);
  115 #endif
  117         switch (req) {
  118         case PRU_CONTROL:
  119                 return EPASSTHROUGH;
  121 #ifdef notyet                   /* XXX */
  122         case PRU_PURGEIF:
  123                 return EOPNOTSUPP;
  124 #endif
  126         case PRU_ATTACH:
  127                 if (pcb != NULL)
  128                         return EINVAL;
  130                 /*
  131                  * Since we have nothing to add, we attach the DLC
  132                  * structure directly to our PCB pointer.
  133                  */
err = rfcomm_attach((struct rfcomm_dlc **)&up->so_pcb,
  135                                         &rfcomm_proto, up);
  136                 if (err)
  137                         return err;
err = soreserve(up, rfcomm_sendspace, rfcomm_recvspace);
  140                 if (err)
  141                         return err;
err = rfcomm_rcvd(up->so_pcb, sbspace(&up->so_rcv));
  144                 if (err)
  145                         return err;
  147                 return 0;
  148         }
  150         if (pcb == NULL) {
err = EINVAL;
  152                 goto release;
  153         }
  155         switch(req) {
  156         case PRU_DISCONNECT:
soisdisconnecting(up);
  158                 return rfcomm_disconnect(pcb, up->so_linger);
  160         case PRU_ABORT:
rfcomm_disconnect(pcb, 0);
soisdisconnected(up);
  163                 /* fall through to */
  164         case PRU_DETACH:
  165                 return rfcomm_detach((struct rfcomm_dlc **)&up->so_pcb);
  167         case PRU_BIND:
KASSERT(nam != NULL);
sa = mtod(nam, struct sockaddr_bt *);
  171                 if (sa->bt_len != sizeof(struct sockaddr_bt))
  172                         return EINVAL;
  174                 if (sa->bt_family != AF_BLUETOOTH)
  175                         return EAFNOSUPPORT;
  177                 return rfcomm_bind(pcb, sa);
  179         case PRU_CONNECT:
KASSERT(nam != NULL);
sa = mtod(nam, struct sockaddr_bt *);
  183                 if (sa->bt_len != sizeof(struct sockaddr_bt))
  184                         return EINVAL;
  186                 if (sa->bt_family != AF_BLUETOOTH)
  187                         return EAFNOSUPPORT;
soisconnecting(up);
  190                 return rfcomm_connect(pcb, sa);
  192         case PRU_PEERADDR:
KASSERT(nam != NULL);
sa = mtod(nam, struct sockaddr_bt *);
nam->m_len = sizeof(struct sockaddr_bt);
  196                 return rfcomm_peeraddr(pcb, sa);
  198         case PRU_SOCKADDR:
KASSERT(nam != NULL);
sa = mtod(nam, struct sockaddr_bt *);
nam->m_len = sizeof(struct sockaddr_bt);
  202                 return rfcomm_sockaddr(pcb, sa);
  204         case PRU_SHUTDOWN:
socantsendmore(up);
  206                 break;
  208         case PRU_SEND:
KASSERT(m != NULL);
  211                 if (ctl)        /* no use for that */
m_freem(ctl);
m0 = m_copym(m, 0, M_COPYALL, M_DONTWAIT);
  215                 if (m0 == NULL)
  216                         return ENOMEM;
sbappendstream(&up->so_snd, m);
  220                 return rfcomm_send(pcb, m0);
  222         case PRU_SENSE:
  223                 return 0;               /* (no release) */
  225         case PRU_RCVD:
  226                 return rfcomm_rcvd(pcb, sbspace(&up->so_rcv));
  228         case PRU_RCVOOB:
  229                 return EOPNOTSUPP;      /* (no release) */
  231         case PRU_LISTEN:
  232                 return rfcomm_listen(pcb);
  234         case PRU_ACCEPT:
KASSERT(nam != NULL);
sa = mtod(nam, struct sockaddr_bt *);
nam->m_len = sizeof(struct sockaddr_bt);
  238                 return rfcomm_peeraddr(pcb, sa);
  240         case PRU_CONNECT2:
  241         case PRU_SENDOOB:
  242         case PRU_FASTTIMO:
  243         case PRU_SLOWTIMO:
  244         case PRU_PROTORCV:
  245         case PRU_PROTOSEND:
err = EOPNOTSUPP;
  247                 break;
  249         default:
UNKNOWN(req);
err = EOPNOTSUPP;
  252                 break;
  253         }
release:
  256         if (m) m_freem(m);
  257         if (ctl) m_freem(ctl);
  258         return err;
  259 }
  261 /*
  262  * rfcomm_ctloutput(request, socket, level, optname, opt)
  263  *
  264  */
  265 int
rfcomm_ctloutput(int req, struct socket *so, int level,
  267                 int optname, struct mbuf **opt)
  268 {
  269         struct rfcomm_dlc *pcb = so->so_pcb;
  270         struct mbuf *m;
  271         int err = 0;
  273 #ifdef notyet                   /* XXX */
DPRINTFN(2, "%s\n", prcorequests[req]);
  275 #endif
  277         if (pcb == NULL)
  278                 return EINVAL;
  280         if (level != BTPROTO_RFCOMM)
  281                 return ENOPROTOOPT;
  283         switch(req) {
  284         case PRCO_GETOPT:
m = m_get(M_WAIT, MT_SOOPTS);
m->m_len = rfcomm_getopt(pcb, optname, mtod(m, void *));
  287                 if (m->m_len == 0) {
m_freem(m);
m = NULL;
err = ENOPROTOOPT;
  291                 }
  292                 *opt = m;
  293                 break;
  295         case PRCO_SETOPT:
m = *opt;
KASSERT(m != NULL);
err = rfcomm_setopt(pcb, optname, mtod(m, void *));
m_freem(m);
  300                 break;
  302         default:
err = ENOPROTOOPT;
  304                 break;
  305         }
  307         return err;
  308 }
  310 /**********************************************************************
  311  *
  312  * RFCOMM callbacks
  313  */
  315 static void
rfcomm_connecting(void *arg)
  317 {
  318         /* struct socket *so = arg; */
KASSERT(arg != NULL);
DPRINTF("Connecting\n");
  322 }
  324 static void
rfcomm_connected(void *arg)
  326 {
  327         struct socket *so = arg;
KASSERT(so != NULL);
DPRINTF("Connected\n");
soisconnected(so);
  332 }
  334 static void
rfcomm_disconnected(void *arg, int err)
  336 {
  337         struct socket *so = arg;
KASSERT(so != NULL);
DPRINTF("Disconnected\n");
so->so_error = err;
soisdisconnected(so);
  344 }
  346 static void *
rfcomm_newconn(void *arg, struct sockaddr_bt *laddr,
  348     struct sockaddr_bt *raddr)
  349 {
  350         struct socket *so = arg;
DPRINTF("New Connection\n");
so = sonewconn(so, 0);
  354         if (so == NULL)
  355                 return NULL;
soisconnecting(so);
  359         return so->so_pcb;
  360 }
  362 /*
  363  * rfcomm_complete(rfcomm_dlc, length)
  364  *
  365  * length bytes are sent and may be removed from socket buffer
  366  */
  367 static void
rfcomm_complete(void *arg, int length)
  369 {
  370         struct socket *so = arg;
sbdrop(&so->so_snd, length);
sowwakeup(so);
  374 }
  376 /*
  377  * rfcomm_linkmode(rfcomm_dlc, new)
  378  *
  379  * link mode change notification.
  380  */
  381 static void
rfcomm_linkmode(void *arg, int new)
  383 {
  384         struct socket *so = arg;
  385         int mode;
DPRINTF("auth %s, encrypt %s, secure %s\n",
  388                 (new & RFCOMM_LM_AUTH ? "on" : "off"),
  389                 (new & RFCOMM_LM_ENCRYPT ? "on" : "off"),
  390                 (new & RFCOMM_LM_SECURE ? "on" : "off"));
  392         (void)rfcomm_getopt(so->so_pcb, SO_RFCOMM_LM, &mode);
  393         if (((mode & RFCOMM_LM_AUTH) && !(new & RFCOMM_LM_AUTH))
  394             || ((mode & RFCOMM_LM_ENCRYPT) && !(new & RFCOMM_LM_ENCRYPT))
  395             || ((mode & RFCOMM_LM_SECURE) && !(new & RFCOMM_LM_SECURE)))
rfcomm_disconnect(so->so_pcb, 0);
  397 }
  399 /*
  400  * rfcomm_input(rfcomm_dlc, mbuf)
  401  */
  402 static void
rfcomm_input(void *arg, struct mbuf *m)
  404 {
  405         struct socket *so = arg;
KASSERT(so != NULL);
  409         if (m->m_pkthdr.len > sbspace(&so->so_rcv)) {
printf("%s: %d bytes dropped (socket buffer full)\n",
__func__, m->m_pkthdr.len);
m_freem(m);
  413                 return;
  414         }
DPRINTFN(10, "received %d bytes\n", m->m_pkthdr.len);
sbappendstream(&so->so_rcv, m);
sorwakeup(so);
  420 }