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