rfcomm_socket.c revision 1.1.2.3
1 1.1.2.3 yamt /* $NetBSD: rfcomm_socket.c,v 1.1.2.3 2006/12/30 20:50:32 yamt Exp $ */ 2 1.1.2.2 yamt 3 1.1.2.2 yamt /*- 4 1.1.2.2 yamt * Copyright (c) 2006 Itronix Inc. 5 1.1.2.2 yamt * All rights reserved. 6 1.1.2.2 yamt * 7 1.1.2.2 yamt * Written by Iain Hibbert for Itronix Inc. 8 1.1.2.2 yamt * 9 1.1.2.2 yamt * Redistribution and use in source and binary forms, with or without 10 1.1.2.2 yamt * modification, are permitted provided that the following conditions 11 1.1.2.2 yamt * are met: 12 1.1.2.2 yamt * 1. Redistributions of source code must retain the above copyright 13 1.1.2.2 yamt * notice, this list of conditions and the following disclaimer. 14 1.1.2.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 15 1.1.2.2 yamt * notice, this list of conditions and the following disclaimer in the 16 1.1.2.2 yamt * documentation and/or other materials provided with the distribution. 17 1.1.2.2 yamt * 3. The name of Itronix Inc. may not be used to endorse 18 1.1.2.2 yamt * or promote products derived from this software without specific 19 1.1.2.2 yamt * prior written permission. 20 1.1.2.2 yamt * 21 1.1.2.2 yamt * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND 22 1.1.2.2 yamt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 23 1.1.2.2 yamt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 24 1.1.2.2 yamt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY 25 1.1.2.2 yamt * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 26 1.1.2.2 yamt * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 27 1.1.2.2 yamt * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 28 1.1.2.2 yamt * ON ANY THEORY OF LIABILITY, WHETHER IN 29 1.1.2.2 yamt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 30 1.1.2.2 yamt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 31 1.1.2.2 yamt * POSSIBILITY OF SUCH DAMAGE. 32 1.1.2.2 yamt */ 33 1.1.2.2 yamt 34 1.1.2.2 yamt #include <sys/cdefs.h> 35 1.1.2.3 yamt __KERNEL_RCSID(0, "$NetBSD: rfcomm_socket.c,v 1.1.2.3 2006/12/30 20:50:32 yamt Exp $"); 36 1.1.2.2 yamt 37 1.1.2.2 yamt #include <sys/param.h> 38 1.1.2.2 yamt #include <sys/domain.h> 39 1.1.2.2 yamt #include <sys/kernel.h> 40 1.1.2.2 yamt #include <sys/mbuf.h> 41 1.1.2.2 yamt #include <sys/proc.h> 42 1.1.2.2 yamt #include <sys/protosw.h> 43 1.1.2.2 yamt #include <sys/socket.h> 44 1.1.2.2 yamt #include <sys/socketvar.h> 45 1.1.2.2 yamt #include <sys/systm.h> 46 1.1.2.2 yamt 47 1.1.2.2 yamt #include <netbt/bluetooth.h> 48 1.1.2.2 yamt #include <netbt/rfcomm.h> 49 1.1.2.2 yamt 50 1.1.2.2 yamt /**************************************************************************** 51 1.1.2.2 yamt * 52 1.1.2.2 yamt * RFCOMM SOCK_STREAM Sockets - serial line emulation 53 1.1.2.2 yamt * 54 1.1.2.2 yamt */ 55 1.1.2.2 yamt 56 1.1.2.2 yamt static void rfcomm_connecting(void *); 57 1.1.2.2 yamt static void rfcomm_connected(void *); 58 1.1.2.2 yamt static void rfcomm_disconnected(void *, int); 59 1.1.2.2 yamt static void *rfcomm_newconn(void *, struct sockaddr_bt *, struct sockaddr_bt *); 60 1.1.2.2 yamt static void rfcomm_complete(void *, int); 61 1.1.2.2 yamt static void rfcomm_input(void *, struct mbuf *); 62 1.1.2.2 yamt 63 1.1.2.2 yamt static const struct btproto rfcomm_proto = { 64 1.1.2.2 yamt rfcomm_connecting, 65 1.1.2.2 yamt rfcomm_connected, 66 1.1.2.2 yamt rfcomm_disconnected, 67 1.1.2.2 yamt rfcomm_newconn, 68 1.1.2.2 yamt rfcomm_complete, 69 1.1.2.2 yamt rfcomm_input, 70 1.1.2.2 yamt }; 71 1.1.2.2 yamt 72 1.1.2.2 yamt /* sysctl variables */ 73 1.1.2.2 yamt int rfcomm_sendspace = 4096; 74 1.1.2.2 yamt int rfcomm_recvspace = 4096; 75 1.1.2.2 yamt 76 1.1.2.2 yamt /* 77 1.1.2.2 yamt * User Request. 78 1.1.2.2 yamt * up is socket 79 1.1.2.2 yamt * m is either 80 1.1.2.2 yamt * optional mbuf chain containing message 81 1.1.2.2 yamt * ioctl command (PRU_CONTROL) 82 1.1.2.2 yamt * nam is either 83 1.1.2.2 yamt * optional mbuf chain containing an address 84 1.1.2.2 yamt * ioctl data (PRU_CONTROL) 85 1.1.2.2 yamt * optionally protocol number (PRU_ATTACH) 86 1.1.2.2 yamt * message flags (PRU_RCVD) 87 1.1.2.2 yamt * ctl is either 88 1.1.2.2 yamt * optional mbuf chain containing socket options 89 1.1.2.2 yamt * optional interface pointer (PRU_CONTROL, PRU_PURGEIF) 90 1.1.2.2 yamt * l is pointer to process requesting action (if any) 91 1.1.2.2 yamt * 92 1.1.2.2 yamt * we are responsible for disposing of m and ctl if 93 1.1.2.2 yamt * they are mbuf chains 94 1.1.2.2 yamt */ 95 1.1.2.2 yamt int 96 1.1.2.2 yamt rfcomm_usrreq(struct socket *up, int req, struct mbuf *m, 97 1.1.2.2 yamt struct mbuf *nam, struct mbuf *ctl, struct lwp *l) 98 1.1.2.2 yamt { 99 1.1.2.2 yamt struct rfcomm_dlc *pcb = up->so_pcb; 100 1.1.2.2 yamt struct sockaddr_bt *sa; 101 1.1.2.2 yamt struct mbuf *m0; 102 1.1.2.2 yamt int err = 0; 103 1.1.2.2 yamt 104 1.1.2.2 yamt DPRINTFN(2, "%s\n", prurequests[req]); 105 1.1.2.2 yamt 106 1.1.2.2 yamt switch (req) { 107 1.1.2.2 yamt case PRU_CONTROL: 108 1.1.2.2 yamt return EPASSTHROUGH; 109 1.1.2.2 yamt 110 1.1.2.2 yamt case PRU_PURGEIF: 111 1.1.2.2 yamt return EOPNOTSUPP; 112 1.1.2.2 yamt 113 1.1.2.2 yamt case PRU_ATTACH: 114 1.1.2.2 yamt if (pcb != NULL) 115 1.1.2.2 yamt return EINVAL; 116 1.1.2.2 yamt 117 1.1.2.2 yamt /* 118 1.1.2.2 yamt * Since we have nothing to add, we attach the DLC 119 1.1.2.2 yamt * structure directly to our PCB pointer. 120 1.1.2.2 yamt */ 121 1.1.2.2 yamt err = rfcomm_attach((struct rfcomm_dlc **)&up->so_pcb, 122 1.1.2.2 yamt &rfcomm_proto, up); 123 1.1.2.2 yamt if (err) 124 1.1.2.2 yamt return err; 125 1.1.2.2 yamt 126 1.1.2.2 yamt err = soreserve(up, rfcomm_sendspace, rfcomm_recvspace); 127 1.1.2.2 yamt if (err) 128 1.1.2.2 yamt return err; 129 1.1.2.2 yamt 130 1.1.2.2 yamt err = rfcomm_rcvd(up->so_pcb, sbspace(&up->so_rcv)); 131 1.1.2.2 yamt if (err) 132 1.1.2.2 yamt return err; 133 1.1.2.2 yamt 134 1.1.2.2 yamt return 0; 135 1.1.2.2 yamt } 136 1.1.2.2 yamt 137 1.1.2.2 yamt if (pcb == NULL) { 138 1.1.2.2 yamt err = EINVAL; 139 1.1.2.2 yamt goto release; 140 1.1.2.2 yamt } 141 1.1.2.2 yamt 142 1.1.2.2 yamt switch(req) { 143 1.1.2.2 yamt case PRU_DISCONNECT: 144 1.1.2.2 yamt soisdisconnecting(up); 145 1.1.2.2 yamt return rfcomm_disconnect(pcb, up->so_linger); 146 1.1.2.2 yamt 147 1.1.2.2 yamt case PRU_ABORT: 148 1.1.2.2 yamt rfcomm_disconnect(pcb, 0); 149 1.1.2.2 yamt soisdisconnected(up); 150 1.1.2.2 yamt /* fall through to */ 151 1.1.2.2 yamt case PRU_DETACH: 152 1.1.2.2 yamt return rfcomm_detach((struct rfcomm_dlc **)&up->so_pcb); 153 1.1.2.2 yamt 154 1.1.2.2 yamt case PRU_BIND: 155 1.1.2.2 yamt KASSERT(nam); 156 1.1.2.2 yamt sa = mtod(nam, struct sockaddr_bt *); 157 1.1.2.2 yamt 158 1.1.2.2 yamt if (sa->bt_len != sizeof(struct sockaddr_bt)) 159 1.1.2.2 yamt return EINVAL; 160 1.1.2.2 yamt 161 1.1.2.2 yamt if (sa->bt_family != AF_BLUETOOTH) 162 1.1.2.2 yamt return EAFNOSUPPORT; 163 1.1.2.2 yamt 164 1.1.2.2 yamt return rfcomm_bind(pcb, sa); 165 1.1.2.2 yamt 166 1.1.2.2 yamt case PRU_CONNECT: 167 1.1.2.2 yamt KASSERT(nam); 168 1.1.2.2 yamt sa = mtod(nam, struct sockaddr_bt *); 169 1.1.2.2 yamt 170 1.1.2.2 yamt if (sa->bt_len != sizeof(struct sockaddr_bt)) 171 1.1.2.2 yamt return EINVAL; 172 1.1.2.2 yamt 173 1.1.2.2 yamt if (sa->bt_family != AF_BLUETOOTH) 174 1.1.2.2 yamt return EAFNOSUPPORT; 175 1.1.2.2 yamt 176 1.1.2.2 yamt soisconnecting(up); 177 1.1.2.2 yamt return rfcomm_connect(pcb, sa); 178 1.1.2.2 yamt 179 1.1.2.2 yamt case PRU_PEERADDR: 180 1.1.2.2 yamt KASSERT(nam); 181 1.1.2.2 yamt sa = mtod(nam, struct sockaddr_bt *); 182 1.1.2.2 yamt nam->m_len = sizeof(struct sockaddr_bt); 183 1.1.2.2 yamt return rfcomm_peeraddr(pcb, sa); 184 1.1.2.2 yamt 185 1.1.2.2 yamt case PRU_SOCKADDR: 186 1.1.2.2 yamt KASSERT(nam); 187 1.1.2.2 yamt sa = mtod(nam, struct sockaddr_bt *); 188 1.1.2.2 yamt nam->m_len = sizeof(struct sockaddr_bt); 189 1.1.2.2 yamt return rfcomm_sockaddr(pcb, sa); 190 1.1.2.2 yamt 191 1.1.2.2 yamt case PRU_SHUTDOWN: 192 1.1.2.2 yamt socantsendmore(up); 193 1.1.2.2 yamt break; 194 1.1.2.2 yamt 195 1.1.2.2 yamt case PRU_SEND: 196 1.1.2.2 yamt KASSERT(m); 197 1.1.2.2 yamt 198 1.1.2.2 yamt if (ctl) /* no use for that */ 199 1.1.2.2 yamt m_freem(ctl); 200 1.1.2.2 yamt 201 1.1.2.2 yamt m0 = m_copypacket(m, M_DONTWAIT); 202 1.1.2.2 yamt if (m0 == NULL) 203 1.1.2.2 yamt return ENOMEM; 204 1.1.2.2 yamt 205 1.1.2.2 yamt sbappendstream(&up->so_snd, m); 206 1.1.2.2 yamt 207 1.1.2.2 yamt return rfcomm_send(pcb, m0); 208 1.1.2.2 yamt 209 1.1.2.2 yamt case PRU_SENSE: 210 1.1.2.2 yamt return 0; /* (no release) */ 211 1.1.2.2 yamt 212 1.1.2.2 yamt case PRU_RCVD: 213 1.1.2.2 yamt return rfcomm_rcvd(pcb, sbspace(&up->so_rcv)); 214 1.1.2.2 yamt 215 1.1.2.2 yamt case PRU_RCVOOB: 216 1.1.2.2 yamt return EOPNOTSUPP; /* (no release) */ 217 1.1.2.2 yamt 218 1.1.2.2 yamt case PRU_LISTEN: 219 1.1.2.2 yamt return rfcomm_listen(pcb); 220 1.1.2.2 yamt 221 1.1.2.2 yamt case PRU_ACCEPT: 222 1.1.2.2 yamt KASSERT(nam); 223 1.1.2.2 yamt sa = mtod(nam, struct sockaddr_bt *); 224 1.1.2.2 yamt nam->m_len = sizeof(struct sockaddr_bt); 225 1.1.2.2 yamt return rfcomm_peeraddr(pcb, sa); 226 1.1.2.2 yamt 227 1.1.2.2 yamt case PRU_CONNECT2: 228 1.1.2.2 yamt case PRU_SENDOOB: 229 1.1.2.2 yamt case PRU_FASTTIMO: 230 1.1.2.2 yamt case PRU_SLOWTIMO: 231 1.1.2.2 yamt case PRU_PROTORCV: 232 1.1.2.2 yamt case PRU_PROTOSEND: 233 1.1.2.2 yamt err = EOPNOTSUPP; 234 1.1.2.2 yamt break; 235 1.1.2.2 yamt 236 1.1.2.2 yamt default: 237 1.1.2.2 yamt UNKNOWN(req); 238 1.1.2.2 yamt err = EOPNOTSUPP; 239 1.1.2.2 yamt break; 240 1.1.2.2 yamt } 241 1.1.2.2 yamt 242 1.1.2.2 yamt release: 243 1.1.2.2 yamt if (m) m_freem(m); 244 1.1.2.2 yamt if (ctl) m_freem(ctl); 245 1.1.2.2 yamt return err; 246 1.1.2.2 yamt } 247 1.1.2.2 yamt 248 1.1.2.2 yamt /* 249 1.1.2.2 yamt * rfcomm_ctloutput(request, socket, level, optname, opt) 250 1.1.2.2 yamt * 251 1.1.2.2 yamt */ 252 1.1.2.2 yamt int 253 1.1.2.2 yamt rfcomm_ctloutput(int req, struct socket *so, int level, 254 1.1.2.2 yamt int optname, struct mbuf **opt) 255 1.1.2.2 yamt { 256 1.1.2.2 yamt struct rfcomm_dlc *pcb = so->so_pcb; 257 1.1.2.2 yamt struct mbuf *m; 258 1.1.2.2 yamt int err = 0; 259 1.1.2.2 yamt 260 1.1.2.2 yamt DPRINTFN(2, "%s\n", prcorequests[req]); 261 1.1.2.2 yamt 262 1.1.2.2 yamt if (level != BTPROTO_RFCOMM) 263 1.1.2.2 yamt return 0; // err? 264 1.1.2.2 yamt 265 1.1.2.2 yamt switch(req) { 266 1.1.2.2 yamt case PRCO_GETOPT: 267 1.1.2.2 yamt m = m_get(M_WAIT, MT_SOOPTS); 268 1.1.2.2 yamt m->m_len = rfcomm_getopt(pcb, optname, mtod(m, void *)); 269 1.1.2.2 yamt if (m->m_len == 0) { 270 1.1.2.2 yamt m_freem(m); 271 1.1.2.2 yamt m = NULL; 272 1.1.2.2 yamt err = EINVAL; 273 1.1.2.2 yamt } 274 1.1.2.2 yamt *opt = m; 275 1.1.2.2 yamt break; 276 1.1.2.2 yamt 277 1.1.2.2 yamt case PRCO_SETOPT: 278 1.1.2.2 yamt m = *opt; 279 1.1.2.2 yamt KASSERT(m != NULL); 280 1.1.2.2 yamt err = rfcomm_setopt(pcb, optname, mtod(m, void *)); 281 1.1.2.2 yamt m_freem(m); 282 1.1.2.2 yamt break; 283 1.1.2.2 yamt 284 1.1.2.2 yamt default: 285 1.1.2.2 yamt err = EINVAL; 286 1.1.2.2 yamt break; 287 1.1.2.2 yamt } 288 1.1.2.2 yamt 289 1.1.2.2 yamt return err; 290 1.1.2.2 yamt } 291 1.1.2.2 yamt 292 1.1.2.2 yamt /********************************************************************** 293 1.1.2.2 yamt * 294 1.1.2.2 yamt * RFCOMM callbacks 295 1.1.2.2 yamt */ 296 1.1.2.2 yamt 297 1.1.2.2 yamt static void 298 1.1.2.2 yamt rfcomm_connecting(void *arg) 299 1.1.2.2 yamt { 300 1.1.2.2 yamt /* struct socket *so = arg; */ 301 1.1.2.2 yamt 302 1.1.2.2 yamt KASSERT(arg); 303 1.1.2.2 yamt DPRINTF("Connecting\n"); 304 1.1.2.2 yamt } 305 1.1.2.2 yamt 306 1.1.2.2 yamt static void 307 1.1.2.2 yamt rfcomm_connected(void *arg) 308 1.1.2.2 yamt { 309 1.1.2.2 yamt struct socket *so = arg; 310 1.1.2.2 yamt 311 1.1.2.2 yamt KASSERT(so); 312 1.1.2.2 yamt DPRINTF("Connected\n"); 313 1.1.2.2 yamt soisconnected(so); 314 1.1.2.2 yamt } 315 1.1.2.2 yamt 316 1.1.2.2 yamt static void 317 1.1.2.2 yamt rfcomm_disconnected(void *arg, int err) 318 1.1.2.2 yamt { 319 1.1.2.2 yamt struct socket *so = arg; 320 1.1.2.2 yamt 321 1.1.2.2 yamt KASSERT(so); 322 1.1.2.2 yamt DPRINTF("Disconnected\n"); 323 1.1.2.2 yamt 324 1.1.2.2 yamt so->so_error = err; 325 1.1.2.2 yamt soisdisconnected(so); 326 1.1.2.2 yamt } 327 1.1.2.2 yamt 328 1.1.2.2 yamt static void * 329 1.1.2.3 yamt rfcomm_newconn(void *arg, struct sockaddr_bt *laddr, 330 1.1.2.3 yamt struct sockaddr_bt *raddr) 331 1.1.2.2 yamt { 332 1.1.2.2 yamt struct socket *so = arg; 333 1.1.2.2 yamt 334 1.1.2.2 yamt DPRINTF("New Connection\n"); 335 1.1.2.2 yamt so = sonewconn(so, 0); 336 1.1.2.2 yamt if (so == NULL) 337 1.1.2.2 yamt return NULL; 338 1.1.2.2 yamt 339 1.1.2.2 yamt soisconnecting(so); 340 1.1.2.2 yamt 341 1.1.2.2 yamt return so->so_pcb; 342 1.1.2.2 yamt } 343 1.1.2.2 yamt 344 1.1.2.2 yamt /* 345 1.1.2.2 yamt * rfcomm_complete(rfcomm_dlc, length) 346 1.1.2.2 yamt * 347 1.1.2.2 yamt * length bytes are sent and may be removed from socket buffer 348 1.1.2.2 yamt */ 349 1.1.2.2 yamt static void 350 1.1.2.2 yamt rfcomm_complete(void *arg, int length) 351 1.1.2.2 yamt { 352 1.1.2.2 yamt struct socket *so = arg; 353 1.1.2.2 yamt 354 1.1.2.2 yamt sbdrop(&so->so_snd, length); 355 1.1.2.2 yamt sowwakeup(so); 356 1.1.2.2 yamt } 357 1.1.2.2 yamt 358 1.1.2.2 yamt /* 359 1.1.2.2 yamt * rfcomm_input(rfcomm_dlc, mbuf) 360 1.1.2.2 yamt */ 361 1.1.2.2 yamt static void 362 1.1.2.2 yamt rfcomm_input(void *arg, struct mbuf *m) 363 1.1.2.2 yamt { 364 1.1.2.2 yamt struct socket *so = arg; 365 1.1.2.2 yamt 366 1.1.2.2 yamt KASSERT(so); 367 1.1.2.2 yamt 368 1.1.2.2 yamt if (m->m_pkthdr.len > sbspace(&so->so_rcv)) { 369 1.1.2.2 yamt printf("%s: %d bytes dropped (socket buffer full)\n", 370 1.1.2.2 yamt __func__, m->m_pkthdr.len); 371 1.1.2.2 yamt m_freem(m); 372 1.1.2.2 yamt return; 373 1.1.2.2 yamt } 374 1.1.2.2 yamt 375 1.1.2.2 yamt DPRINTFN(10, "received %d bytes\n", m->m_pkthdr.len); 376 1.1.2.2 yamt 377 1.1.2.2 yamt sbappendstream(&so->so_rcv, m); 378 1.1.2.2 yamt sorwakeup(so); 379 1.1.2.2 yamt } 380
Indexes created Thu Oct 02 14:10:14 GMT 2025