l2cap_socket.c revision 1.10.2.1
1 1.10.2.1 tls /* $NetBSD: l2cap_socket.c,v 1.10.2.1 2014/08/10 06:56:23 tls Exp $ */ 2 1.1 gdamore 3 1.1 gdamore /*- 4 1.1 gdamore * Copyright (c) 2005 Iain Hibbert. 5 1.1 gdamore * Copyright (c) 2006 Itronix Inc. 6 1.1 gdamore * All rights reserved. 7 1.1 gdamore * 8 1.1 gdamore * Redistribution and use in source and binary forms, with or without 9 1.1 gdamore * modification, are permitted provided that the following conditions 10 1.1 gdamore * are met: 11 1.1 gdamore * 1. Redistributions of source code must retain the above copyright 12 1.1 gdamore * notice, this list of conditions and the following disclaimer. 13 1.1 gdamore * 2. Redistributions in binary form must reproduce the above copyright 14 1.1 gdamore * notice, this list of conditions and the following disclaimer in the 15 1.1 gdamore * documentation and/or other materials provided with the distribution. 16 1.1 gdamore * 3. The name of Itronix Inc. may not be used to endorse 17 1.1 gdamore * or promote products derived from this software without specific 18 1.1 gdamore * prior written permission. 19 1.1 gdamore * 20 1.1 gdamore * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND 21 1.1 gdamore * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 22 1.1 gdamore * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 23 1.1 gdamore * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY 24 1.1 gdamore * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 25 1.1 gdamore * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 26 1.1 gdamore * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 27 1.1 gdamore * ON ANY THEORY OF LIABILITY, WHETHER IN 28 1.1 gdamore * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 29 1.1 gdamore * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 30 1.1 gdamore * POSSIBILITY OF SUCH DAMAGE. 31 1.1 gdamore */ 32 1.1 gdamore 33 1.1 gdamore #include <sys/cdefs.h> 34 1.10.2.1 tls __KERNEL_RCSID(0, "$NetBSD: l2cap_socket.c,v 1.10.2.1 2014/08/10 06:56:23 tls Exp $"); 35 1.6 plunky 36 1.6 plunky /* load symbolic names */ 37 1.6 plunky #ifdef BLUETOOTH_DEBUG 38 1.6 plunky #define PRUREQUESTS 39 1.6 plunky #define PRCOREQUESTS 40 1.6 plunky #endif 41 1.1 gdamore 42 1.1 gdamore #include <sys/param.h> 43 1.1 gdamore #include <sys/domain.h> 44 1.1 gdamore #include <sys/kernel.h> 45 1.1 gdamore #include <sys/mbuf.h> 46 1.1 gdamore #include <sys/proc.h> 47 1.1 gdamore #include <sys/protosw.h> 48 1.1 gdamore #include <sys/socket.h> 49 1.1 gdamore #include <sys/socketvar.h> 50 1.1 gdamore #include <sys/systm.h> 51 1.1 gdamore 52 1.1 gdamore #include <netbt/bluetooth.h> 53 1.1 gdamore #include <netbt/l2cap.h> 54 1.1 gdamore 55 1.1 gdamore /* 56 1.1 gdamore * L2CAP Sockets 57 1.1 gdamore * 58 1.1 gdamore * SOCK_SEQPACKET - normal L2CAP connection 59 1.1 gdamore * 60 1.1 gdamore * SOCK_DGRAM - connectionless L2CAP - XXX not yet 61 1.1 gdamore */ 62 1.1 gdamore 63 1.1 gdamore static void l2cap_connecting(void *); 64 1.1 gdamore static void l2cap_connected(void *); 65 1.1 gdamore static void l2cap_disconnected(void *, int); 66 1.1 gdamore static void *l2cap_newconn(void *, struct sockaddr_bt *, struct sockaddr_bt *); 67 1.1 gdamore static void l2cap_complete(void *, int); 68 1.7 plunky static void l2cap_linkmode(void *, int); 69 1.1 gdamore static void l2cap_input(void *, struct mbuf *); 70 1.1 gdamore 71 1.1 gdamore static const struct btproto l2cap_proto = { 72 1.1 gdamore l2cap_connecting, 73 1.1 gdamore l2cap_connected, 74 1.1 gdamore l2cap_disconnected, 75 1.1 gdamore l2cap_newconn, 76 1.1 gdamore l2cap_complete, 77 1.7 plunky l2cap_linkmode, 78 1.7 plunky l2cap_input, 79 1.1 gdamore }; 80 1.1 gdamore 81 1.1 gdamore /* sysctl variables */ 82 1.1 gdamore int l2cap_sendspace = 4096; 83 1.1 gdamore int l2cap_recvspace = 4096; 84 1.1 gdamore 85 1.10.2.1 tls static int 86 1.10.2.1 tls l2cap_attach(struct socket *so, int proto) 87 1.10.2.1 tls { 88 1.10.2.1 tls int error; 89 1.10.2.1 tls 90 1.10.2.1 tls KASSERT(so->so_pcb == NULL); 91 1.10.2.1 tls 92 1.10.2.1 tls if (so->so_lock == NULL) { 93 1.10.2.1 tls mutex_obj_hold(bt_lock); 94 1.10.2.1 tls so->so_lock = bt_lock; 95 1.10.2.1 tls solock(so); 96 1.10.2.1 tls } 97 1.10.2.1 tls KASSERT(solocked(so)); 98 1.10.2.1 tls 99 1.10.2.1 tls /* 100 1.10.2.1 tls * For L2CAP socket PCB we just use an l2cap_channel structure 101 1.10.2.1 tls * since we have nothing to add.. 102 1.10.2.1 tls */ 103 1.10.2.1 tls error = soreserve(so, l2cap_sendspace, l2cap_recvspace); 104 1.10.2.1 tls if (error) 105 1.10.2.1 tls return error; 106 1.10.2.1 tls 107 1.10.2.1 tls return l2cap_attach_pcb((struct l2cap_channel **)&so->so_pcb, 108 1.10.2.1 tls &l2cap_proto, so); 109 1.10.2.1 tls } 110 1.10.2.1 tls 111 1.10.2.1 tls static void 112 1.10.2.1 tls l2cap_detach(struct socket *so) 113 1.10.2.1 tls { 114 1.10.2.1 tls KASSERT(so->so_pcb != NULL); 115 1.10.2.1 tls l2cap_detach_pcb((struct l2cap_channel **)&so->so_pcb); 116 1.10.2.1 tls KASSERT(so->so_pcb == NULL); 117 1.10.2.1 tls } 118 1.10.2.1 tls 119 1.10.2.1 tls static int 120 1.10.2.1 tls l2cap_accept(struct socket *so, struct mbuf *nam) 121 1.10.2.1 tls { 122 1.10.2.1 tls struct l2cap_channel *pcb = so->so_pcb; 123 1.10.2.1 tls struct sockaddr_bt *sa; 124 1.10.2.1 tls 125 1.10.2.1 tls KASSERT(solocked(so)); 126 1.10.2.1 tls KASSERT(nam != NULL); 127 1.10.2.1 tls 128 1.10.2.1 tls if (pcb == NULL) 129 1.10.2.1 tls return EINVAL; 130 1.10.2.1 tls 131 1.10.2.1 tls sa = mtod(nam, struct sockaddr_bt *); 132 1.10.2.1 tls nam->m_len = sizeof(struct sockaddr_bt); 133 1.10.2.1 tls return l2cap_peeraddr_pcb(pcb, sa); 134 1.10.2.1 tls } 135 1.10.2.1 tls 136 1.10.2.1 tls static int 137 1.10.2.1 tls l2cap_bind(struct socket *so, struct mbuf *nam, struct lwp *l) 138 1.10.2.1 tls { 139 1.10.2.1 tls struct l2cap_channel *pcb = so->so_pcb; 140 1.10.2.1 tls struct sockaddr_bt *sa; 141 1.10.2.1 tls 142 1.10.2.1 tls KASSERT(solocked(so)); 143 1.10.2.1 tls KASSERT(nam != NULL); 144 1.10.2.1 tls 145 1.10.2.1 tls if (pcb == NULL) 146 1.10.2.1 tls return EINVAL; 147 1.10.2.1 tls 148 1.10.2.1 tls sa = mtod(nam, struct sockaddr_bt *); 149 1.10.2.1 tls if (sa->bt_len != sizeof(struct sockaddr_bt)) 150 1.10.2.1 tls return EINVAL; 151 1.10.2.1 tls 152 1.10.2.1 tls if (sa->bt_family != AF_BLUETOOTH) 153 1.10.2.1 tls return EAFNOSUPPORT; 154 1.10.2.1 tls 155 1.10.2.1 tls return l2cap_bind_pcb(pcb, sa); 156 1.10.2.1 tls } 157 1.10.2.1 tls 158 1.10.2.1 tls static int 159 1.10.2.1 tls l2cap_listen(struct socket *so, struct lwp *l) 160 1.10.2.1 tls { 161 1.10.2.1 tls struct l2cap_channel *pcb = so->so_pcb; 162 1.10.2.1 tls 163 1.10.2.1 tls KASSERT(solocked(so)); 164 1.10.2.1 tls 165 1.10.2.1 tls if (pcb == NULL) 166 1.10.2.1 tls return EINVAL; 167 1.10.2.1 tls 168 1.10.2.1 tls return l2cap_listen_pcb(pcb); 169 1.10.2.1 tls } 170 1.10.2.1 tls 171 1.10.2.1 tls static int 172 1.10.2.1 tls l2cap_connect(struct socket *so, struct mbuf *nam, struct lwp *l) 173 1.10.2.1 tls { 174 1.10.2.1 tls struct l2cap_channel *pcb = so->so_pcb; 175 1.10.2.1 tls struct sockaddr_bt *sa; 176 1.10.2.1 tls 177 1.10.2.1 tls KASSERT(solocked(so)); 178 1.10.2.1 tls KASSERT(nam != NULL); 179 1.10.2.1 tls 180 1.10.2.1 tls if (pcb == NULL) 181 1.10.2.1 tls return EINVAL; 182 1.10.2.1 tls 183 1.10.2.1 tls sa = mtod(nam, struct sockaddr_bt *); 184 1.10.2.1 tls if (sa->bt_len != sizeof(struct sockaddr_bt)) 185 1.10.2.1 tls return EINVAL; 186 1.10.2.1 tls 187 1.10.2.1 tls if (sa->bt_family != AF_BLUETOOTH) 188 1.10.2.1 tls return EAFNOSUPPORT; 189 1.10.2.1 tls 190 1.10.2.1 tls soisconnecting(so); 191 1.10.2.1 tls return l2cap_connect_pcb(pcb, sa); 192 1.10.2.1 tls } 193 1.10.2.1 tls 194 1.10.2.1 tls static int 195 1.10.2.1 tls l2cap_connect2(struct socket *so, struct socket *so2) 196 1.10.2.1 tls { 197 1.10.2.1 tls KASSERT(solocked(so)); 198 1.10.2.1 tls 199 1.10.2.1 tls if (so->so_pcb == NULL) 200 1.10.2.1 tls return EINVAL; 201 1.10.2.1 tls 202 1.10.2.1 tls return EOPNOTSUPP; 203 1.10.2.1 tls } 204 1.10.2.1 tls 205 1.10.2.1 tls static int 206 1.10.2.1 tls l2cap_disconnect(struct socket *so) 207 1.10.2.1 tls { 208 1.10.2.1 tls struct l2cap_channel *pcb = so->so_pcb; 209 1.10.2.1 tls 210 1.10.2.1 tls KASSERT(solocked(so)); 211 1.10.2.1 tls 212 1.10.2.1 tls if (pcb == NULL) 213 1.10.2.1 tls return EINVAL; 214 1.10.2.1 tls 215 1.10.2.1 tls soisdisconnecting(so); 216 1.10.2.1 tls return l2cap_disconnect_pcb(pcb, so->so_linger); 217 1.10.2.1 tls } 218 1.10.2.1 tls 219 1.10.2.1 tls static int 220 1.10.2.1 tls l2cap_shutdown(struct socket *so) 221 1.10.2.1 tls { 222 1.10.2.1 tls KASSERT(solocked(so)); 223 1.10.2.1 tls 224 1.10.2.1 tls socantsendmore(so); 225 1.10.2.1 tls return 0; 226 1.10.2.1 tls } 227 1.10.2.1 tls 228 1.10.2.1 tls static int 229 1.10.2.1 tls l2cap_abort(struct socket *so) 230 1.10.2.1 tls { 231 1.10.2.1 tls struct l2cap_channel *pcb = so->so_pcb; 232 1.10.2.1 tls 233 1.10.2.1 tls KASSERT(solocked(so)); 234 1.10.2.1 tls 235 1.10.2.1 tls if (pcb == NULL) 236 1.10.2.1 tls return EINVAL; 237 1.10.2.1 tls 238 1.10.2.1 tls l2cap_disconnect_pcb(pcb, 0); 239 1.10.2.1 tls soisdisconnected(so); 240 1.10.2.1 tls l2cap_detach(so); 241 1.10.2.1 tls return 0; 242 1.10.2.1 tls } 243 1.10.2.1 tls 244 1.10.2.1 tls static int 245 1.10.2.1 tls l2cap_ioctl(struct socket *so, u_long cmd, void *nam, struct ifnet *ifp) 246 1.10.2.1 tls { 247 1.10.2.1 tls return EPASSTHROUGH; 248 1.10.2.1 tls } 249 1.10.2.1 tls 250 1.10.2.1 tls static int 251 1.10.2.1 tls l2cap_stat(struct socket *so, struct stat *ub) 252 1.10.2.1 tls { 253 1.10.2.1 tls KASSERT(solocked(so)); 254 1.10.2.1 tls 255 1.10.2.1 tls return 0; 256 1.10.2.1 tls } 257 1.10.2.1 tls 258 1.10.2.1 tls static int 259 1.10.2.1 tls l2cap_peeraddr(struct socket *so, struct mbuf *nam) 260 1.10.2.1 tls { 261 1.10.2.1 tls struct l2cap_channel *pcb = so->so_pcb; 262 1.10.2.1 tls struct sockaddr_bt *sa; 263 1.10.2.1 tls 264 1.10.2.1 tls KASSERT(solocked(so)); 265 1.10.2.1 tls KASSERT(pcb != NULL); 266 1.10.2.1 tls KASSERT(nam != NULL); 267 1.10.2.1 tls 268 1.10.2.1 tls sa = mtod(nam, struct sockaddr_bt *); 269 1.10.2.1 tls nam->m_len = sizeof(struct sockaddr_bt); 270 1.10.2.1 tls return l2cap_peeraddr_pcb(pcb, sa); 271 1.10.2.1 tls } 272 1.10.2.1 tls 273 1.10.2.1 tls static int 274 1.10.2.1 tls l2cap_sockaddr(struct socket *so, struct mbuf *nam) 275 1.10.2.1 tls { 276 1.10.2.1 tls struct l2cap_channel *pcb = so->so_pcb; 277 1.10.2.1 tls struct sockaddr_bt *sa; 278 1.10.2.1 tls 279 1.10.2.1 tls KASSERT(solocked(so)); 280 1.10.2.1 tls KASSERT(pcb != NULL); 281 1.10.2.1 tls KASSERT(nam != NULL); 282 1.10.2.1 tls 283 1.10.2.1 tls sa = mtod(nam, struct sockaddr_bt *); 284 1.10.2.1 tls nam->m_len = sizeof(struct sockaddr_bt); 285 1.10.2.1 tls return l2cap_sockaddr_pcb(pcb, sa); 286 1.10.2.1 tls } 287 1.10.2.1 tls 288 1.10.2.1 tls static int 289 1.10.2.1 tls l2cap_rcvd(struct socket *so, int flags, struct lwp *l) 290 1.10.2.1 tls { 291 1.10.2.1 tls KASSERT(solocked(so)); 292 1.10.2.1 tls 293 1.10.2.1 tls return EOPNOTSUPP; 294 1.10.2.1 tls } 295 1.10.2.1 tls 296 1.10.2.1 tls static int 297 1.10.2.1 tls l2cap_recvoob(struct socket *so, struct mbuf *m, int flags) 298 1.10.2.1 tls { 299 1.10.2.1 tls KASSERT(solocked(so)); 300 1.10.2.1 tls 301 1.10.2.1 tls return EOPNOTSUPP; 302 1.10.2.1 tls } 303 1.10.2.1 tls 304 1.10.2.1 tls static int 305 1.10.2.1 tls l2cap_send(struct socket *so, struct mbuf *m, struct mbuf *nam, 306 1.10.2.1 tls struct mbuf *control, struct lwp *l) 307 1.10.2.1 tls { 308 1.10.2.1 tls struct l2cap_channel *pcb = so->so_pcb; 309 1.10.2.1 tls struct mbuf *m0; 310 1.10.2.1 tls int error = 0; 311 1.10.2.1 tls 312 1.10.2.1 tls KASSERT(solocked(so)); 313 1.10.2.1 tls KASSERT(m != NULL); 314 1.10.2.1 tls 315 1.10.2.1 tls if (control) 316 1.10.2.1 tls m_freem(control); 317 1.10.2.1 tls 318 1.10.2.1 tls if (pcb == NULL) { 319 1.10.2.1 tls error = EINVAL; 320 1.10.2.1 tls goto release; 321 1.10.2.1 tls } 322 1.10.2.1 tls 323 1.10.2.1 tls if (m->m_pkthdr.len == 0) 324 1.10.2.1 tls goto release; 325 1.10.2.1 tls 326 1.10.2.1 tls if (m->m_pkthdr.len > pcb->lc_omtu) { 327 1.10.2.1 tls error = EMSGSIZE; 328 1.10.2.1 tls goto release; 329 1.10.2.1 tls } 330 1.10.2.1 tls 331 1.10.2.1 tls m0 = m_copypacket(m, M_DONTWAIT); 332 1.10.2.1 tls if (m0 == NULL) { 333 1.10.2.1 tls error = ENOMEM; 334 1.10.2.1 tls goto release; 335 1.10.2.1 tls } 336 1.10.2.1 tls 337 1.10.2.1 tls sbappendrecord(&so->so_snd, m); 338 1.10.2.1 tls return l2cap_send_pcb(pcb, m0); 339 1.10.2.1 tls 340 1.10.2.1 tls release: 341 1.10.2.1 tls if (m) 342 1.10.2.1 tls m_freem(m); 343 1.10.2.1 tls 344 1.10.2.1 tls return error; 345 1.10.2.1 tls } 346 1.10.2.1 tls 347 1.10.2.1 tls static int 348 1.10.2.1 tls l2cap_sendoob(struct socket *so, struct mbuf *m, struct mbuf *control) 349 1.10.2.1 tls { 350 1.10.2.1 tls KASSERT(solocked(so)); 351 1.10.2.1 tls 352 1.10.2.1 tls if (m) 353 1.10.2.1 tls m_freem(m); 354 1.10.2.1 tls if (control) 355 1.10.2.1 tls m_freem(control); 356 1.10.2.1 tls 357 1.10.2.1 tls return EOPNOTSUPP; 358 1.10.2.1 tls } 359 1.10.2.1 tls 360 1.10.2.1 tls static int 361 1.10.2.1 tls l2cap_purgeif(struct socket *so, struct ifnet *ifp) 362 1.10.2.1 tls { 363 1.10.2.1 tls 364 1.10.2.1 tls return EOPNOTSUPP; 365 1.10.2.1 tls } 366 1.10.2.1 tls 367 1.1 gdamore /* 368 1.1 gdamore * User Request. 369 1.1 gdamore * up is socket 370 1.10.2.1 tls * m is optional mbuf chain containing message 371 1.1 gdamore * ctl is either 372 1.1 gdamore * optional mbuf chain containing socket options 373 1.1 gdamore * l is pointer to process requesting action (if any) 374 1.1 gdamore * 375 1.1 gdamore * we are responsible for disposing of m and ctl if 376 1.1 gdamore * they are mbuf chains 377 1.1 gdamore */ 378 1.10.2.1 tls static int 379 1.1 gdamore l2cap_usrreq(struct socket *up, int req, struct mbuf *m, 380 1.3 christos struct mbuf *nam, struct mbuf *ctl, struct lwp *l) 381 1.1 gdamore { 382 1.1 gdamore struct l2cap_channel *pcb = up->so_pcb; 383 1.1 gdamore int err = 0; 384 1.1 gdamore 385 1.1 gdamore DPRINTFN(2, "%s\n", prurequests[req]); 386 1.10.2.1 tls KASSERT(req != PRU_ATTACH); 387 1.10.2.1 tls KASSERT(req != PRU_DETACH); 388 1.10.2.1 tls KASSERT(req != PRU_ACCEPT); 389 1.10.2.1 tls KASSERT(req != PRU_BIND); 390 1.10.2.1 tls KASSERT(req != PRU_LISTEN); 391 1.10.2.1 tls KASSERT(req != PRU_CONNECT); 392 1.10.2.1 tls KASSERT(req != PRU_CONNECT2); 393 1.10.2.1 tls KASSERT(req != PRU_DISCONNECT); 394 1.10.2.1 tls KASSERT(req != PRU_SHUTDOWN); 395 1.10.2.1 tls KASSERT(req != PRU_ABORT); 396 1.10.2.1 tls KASSERT(req != PRU_CONTROL); 397 1.10.2.1 tls KASSERT(req != PRU_SENSE); 398 1.10.2.1 tls KASSERT(req != PRU_PEERADDR); 399 1.10.2.1 tls KASSERT(req != PRU_SOCKADDR); 400 1.10.2.1 tls KASSERT(req != PRU_RCVD); 401 1.10.2.1 tls KASSERT(req != PRU_RCVOOB); 402 1.10.2.1 tls KASSERT(req != PRU_SEND); 403 1.10.2.1 tls KASSERT(req != PRU_SENDOOB); 404 1.10.2.1 tls KASSERT(req != PRU_PURGEIF); 405 1.1 gdamore 406 1.1 gdamore if (pcb == NULL) { 407 1.1 gdamore err = EINVAL; 408 1.1 gdamore goto release; 409 1.1 gdamore } 410 1.1 gdamore 411 1.1 gdamore switch(req) { 412 1.1 gdamore case PRU_FASTTIMO: 413 1.1 gdamore case PRU_SLOWTIMO: 414 1.1 gdamore case PRU_PROTORCV: 415 1.1 gdamore case PRU_PROTOSEND: 416 1.1 gdamore err = EOPNOTSUPP; 417 1.1 gdamore break; 418 1.1 gdamore 419 1.1 gdamore default: 420 1.1 gdamore UNKNOWN(req); 421 1.1 gdamore err = EOPNOTSUPP; 422 1.1 gdamore break; 423 1.1 gdamore } 424 1.1 gdamore 425 1.1 gdamore release: 426 1.1 gdamore if (m) m_freem(m); 427 1.1 gdamore if (ctl) m_freem(ctl); 428 1.1 gdamore return err; 429 1.1 gdamore } 430 1.1 gdamore 431 1.1 gdamore /* 432 1.9 plunky * l2cap_ctloutput(req, socket, sockopt) 433 1.1 gdamore * 434 1.1 gdamore * Apply configuration commands to channel. This corresponds to 435 1.1 gdamore * "Reconfigure Channel Request" in the L2CAP specification. 436 1.1 gdamore */ 437 1.1 gdamore int 438 1.9 plunky l2cap_ctloutput(int req, struct socket *so, struct sockopt *sopt) 439 1.1 gdamore { 440 1.1 gdamore struct l2cap_channel *pcb = so->so_pcb; 441 1.1 gdamore int err = 0; 442 1.1 gdamore 443 1.1 gdamore DPRINTFN(2, "%s\n", prcorequests[req]); 444 1.1 gdamore 445 1.4 plunky if (pcb == NULL) 446 1.4 plunky return EINVAL; 447 1.4 plunky 448 1.9 plunky if (sopt->sopt_level != BTPROTO_L2CAP) 449 1.4 plunky return ENOPROTOOPT; 450 1.1 gdamore 451 1.1 gdamore switch(req) { 452 1.1 gdamore case PRCO_GETOPT: 453 1.9 plunky err = l2cap_getopt(pcb, sopt); 454 1.1 gdamore break; 455 1.1 gdamore 456 1.1 gdamore case PRCO_SETOPT: 457 1.9 plunky err = l2cap_setopt(pcb, sopt); 458 1.1 gdamore break; 459 1.1 gdamore 460 1.1 gdamore default: 461 1.4 plunky err = ENOPROTOOPT; 462 1.1 gdamore break; 463 1.1 gdamore } 464 1.1 gdamore 465 1.1 gdamore return err; 466 1.1 gdamore } 467 1.1 gdamore 468 1.1 gdamore /********************************************************************** 469 1.1 gdamore * 470 1.1 gdamore * L2CAP Protocol socket callbacks 471 1.1 gdamore * 472 1.1 gdamore */ 473 1.1 gdamore 474 1.1 gdamore static void 475 1.1 gdamore l2cap_connecting(void *arg) 476 1.1 gdamore { 477 1.1 gdamore struct socket *so = arg; 478 1.1 gdamore 479 1.1 gdamore DPRINTF("Connecting\n"); 480 1.1 gdamore soisconnecting(so); 481 1.1 gdamore } 482 1.1 gdamore 483 1.1 gdamore static void 484 1.1 gdamore l2cap_connected(void *arg) 485 1.1 gdamore { 486 1.1 gdamore struct socket *so = arg; 487 1.1 gdamore 488 1.1 gdamore DPRINTF("Connected\n"); 489 1.1 gdamore soisconnected(so); 490 1.1 gdamore } 491 1.1 gdamore 492 1.1 gdamore static void 493 1.1 gdamore l2cap_disconnected(void *arg, int err) 494 1.1 gdamore { 495 1.1 gdamore struct socket *so = arg; 496 1.1 gdamore 497 1.1 gdamore DPRINTF("Disconnected (%d)\n", err); 498 1.1 gdamore 499 1.1 gdamore so->so_error = err; 500 1.1 gdamore soisdisconnected(so); 501 1.1 gdamore } 502 1.1 gdamore 503 1.1 gdamore static void * 504 1.3 christos l2cap_newconn(void *arg, struct sockaddr_bt *laddr, 505 1.3 christos struct sockaddr_bt *raddr) 506 1.1 gdamore { 507 1.1 gdamore struct socket *so = arg; 508 1.1 gdamore 509 1.1 gdamore DPRINTF("New Connection\n"); 510 1.10 rmind so = sonewconn(so, false); 511 1.1 gdamore if (so == NULL) 512 1.1 gdamore return NULL; 513 1.1 gdamore 514 1.1 gdamore soisconnecting(so); 515 1.1 gdamore 516 1.1 gdamore return so->so_pcb; 517 1.1 gdamore } 518 1.1 gdamore 519 1.1 gdamore static void 520 1.1 gdamore l2cap_complete(void *arg, int count) 521 1.1 gdamore { 522 1.1 gdamore struct socket *so = arg; 523 1.1 gdamore 524 1.1 gdamore while (count-- > 0) 525 1.1 gdamore sbdroprecord(&so->so_snd); 526 1.1 gdamore 527 1.1 gdamore sowwakeup(so); 528 1.1 gdamore } 529 1.1 gdamore 530 1.1 gdamore static void 531 1.7 plunky l2cap_linkmode(void *arg, int new) 532 1.7 plunky { 533 1.7 plunky struct socket *so = arg; 534 1.9 plunky struct sockopt sopt; 535 1.7 plunky int mode; 536 1.7 plunky 537 1.7 plunky DPRINTF("auth %s, encrypt %s, secure %s\n", 538 1.7 plunky (new & L2CAP_LM_AUTH ? "on" : "off"), 539 1.7 plunky (new & L2CAP_LM_ENCRYPT ? "on" : "off"), 540 1.7 plunky (new & L2CAP_LM_SECURE ? "on" : "off")); 541 1.7 plunky 542 1.9 plunky sockopt_init(&sopt, BTPROTO_L2CAP, SO_L2CAP_LM, 0); 543 1.9 plunky (void)l2cap_getopt(so->so_pcb, &sopt); 544 1.9 plunky (void)sockopt_getint(&sopt, &mode); 545 1.9 plunky sockopt_destroy(&sopt); 546 1.9 plunky 547 1.7 plunky if (((mode & L2CAP_LM_AUTH) && !(new & L2CAP_LM_AUTH)) 548 1.7 plunky || ((mode & L2CAP_LM_ENCRYPT) && !(new & L2CAP_LM_ENCRYPT)) 549 1.7 plunky || ((mode & L2CAP_LM_SECURE) && !(new & L2CAP_LM_SECURE))) 550 1.10.2.1 tls l2cap_disconnect_pcb(so->so_pcb, 0); 551 1.7 plunky } 552 1.7 plunky 553 1.7 plunky static void 554 1.1 gdamore l2cap_input(void *arg, struct mbuf *m) 555 1.1 gdamore { 556 1.1 gdamore struct socket *so = arg; 557 1.1 gdamore 558 1.1 gdamore if (m->m_pkthdr.len > sbspace(&so->so_rcv)) { 559 1.1 gdamore printf("%s: packet (%d bytes) dropped (socket buffer full)\n", 560 1.1 gdamore __func__, m->m_pkthdr.len); 561 1.1 gdamore m_freem(m); 562 1.1 gdamore return; 563 1.1 gdamore } 564 1.1 gdamore 565 1.1 gdamore DPRINTFN(10, "received %d bytes\n", m->m_pkthdr.len); 566 1.1 gdamore 567 1.1 gdamore sbappendrecord(&so->so_rcv, m); 568 1.1 gdamore sorwakeup(so); 569 1.1 gdamore } 570 1.10.2.1 tls 571 1.10.2.1 tls PR_WRAP_USRREQS(l2cap) 572 1.10.2.1 tls 573 1.10.2.1 tls #define l2cap_attach l2cap_attach_wrapper 574 1.10.2.1 tls #define l2cap_detach l2cap_detach_wrapper 575 1.10.2.1 tls #define l2cap_accept l2cap_accept_wrapper 576 1.10.2.1 tls #define l2cap_bind l2cap_bind_wrapper 577 1.10.2.1 tls #define l2cap_listen l2cap_listen_wrapper 578 1.10.2.1 tls #define l2cap_connect l2cap_connect_wrapper 579 1.10.2.1 tls #define l2cap_connect2 l2cap_connect2_wrapper 580 1.10.2.1 tls #define l2cap_disconnect l2cap_disconnect_wrapper 581 1.10.2.1 tls #define l2cap_shutdown l2cap_shutdown_wrapper 582 1.10.2.1 tls #define l2cap_abort l2cap_abort_wrapper 583 1.10.2.1 tls #define l2cap_ioctl l2cap_ioctl_wrapper 584 1.10.2.1 tls #define l2cap_stat l2cap_stat_wrapper 585 1.10.2.1 tls #define l2cap_peeraddr l2cap_peeraddr_wrapper 586 1.10.2.1 tls #define l2cap_sockaddr l2cap_sockaddr_wrapper 587 1.10.2.1 tls #define l2cap_rcvd l2cap_rcvd_wrapper 588 1.10.2.1 tls #define l2cap_recvoob l2cap_recvoob_wrapper 589 1.10.2.1 tls #define l2cap_send l2cap_send_wrapper 590 1.10.2.1 tls #define l2cap_sendoob l2cap_sendoob_wrapper 591 1.10.2.1 tls #define l2cap_purgeif l2cap_purgeif_wrapper 592 1.10.2.1 tls #define l2cap_usrreq l2cap_usrreq_wrapper 593 1.10.2.1 tls 594 1.10.2.1 tls const struct pr_usrreqs l2cap_usrreqs = { 595 1.10.2.1 tls .pr_attach = l2cap_attach, 596 1.10.2.1 tls .pr_detach = l2cap_detach, 597 1.10.2.1 tls .pr_accept = l2cap_accept, 598 1.10.2.1 tls .pr_bind = l2cap_bind, 599 1.10.2.1 tls .pr_listen = l2cap_listen, 600 1.10.2.1 tls .pr_connect = l2cap_connect, 601 1.10.2.1 tls .pr_connect2 = l2cap_connect2, 602 1.10.2.1 tls .pr_disconnect = l2cap_disconnect, 603 1.10.2.1 tls .pr_shutdown = l2cap_shutdown, 604 1.10.2.1 tls .pr_abort = l2cap_abort, 605 1.10.2.1 tls .pr_ioctl = l2cap_ioctl, 606 1.10.2.1 tls .pr_stat = l2cap_stat, 607 1.10.2.1 tls .pr_peeraddr = l2cap_peeraddr, 608 1.10.2.1 tls .pr_sockaddr = l2cap_sockaddr, 609 1.10.2.1 tls .pr_rcvd = l2cap_rcvd, 610 1.10.2.1 tls .pr_recvoob = l2cap_recvoob, 611 1.10.2.1 tls .pr_send = l2cap_send, 612 1.10.2.1 tls .pr_sendoob = l2cap_sendoob, 613 1.10.2.1 tls .pr_purgeif = l2cap_purgeif, 614 1.10.2.1 tls .pr_generic = l2cap_usrreq, 615 1.10.2.1 tls }; 616
Indexes created Tue Sep 30 07:10:03 GMT 2025