1 /* $OpenBSD: src/sys/netbt/rfcomm_dlc.c,v 1.2 2008/02/24 21:34:48 uwe Exp $ */ 2 /* $NetBSD: rfcomm_dlc.c,v 1.4 2007/11/03 17:20:17 plunky Exp $ */ 3 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 */ 34 35 #include <sys/param.h> 36 #include <sys/kernel.h> 37 #include <sys/mbuf.h> 38 #include <sys/proc.h> 39 #include <sys/systm.h> 40 #include <sys/endian.h> 41 42 #include <netbt/bluetooth.h> 43 #include <netbt/hci.h> 44 #include <netbt/l2cap.h> 45 #include <netbt/rfcomm.h> 46 47 /* 48 * rfcomm_dlc_lookup(rfcomm_session, dlci) 49 * 50 * Find DLC on session with matching dlci 51 */ 52 struct rfcomm_dlc * 53 rfcomm_dlc_lookup(struct rfcomm_session *rs, int dlci) 54 { 55 struct rfcomm_dlc *dlc; 56 57 LIST_FOREACH(dlc, &rs->rs_dlcs, rd_next) { 58 if (dlc->rd_dlci == dlci) 59 break; 60 } 61 62 return dlc; 63 } 64 65 /* 66 * rfcomm_dlc_newconn(rfcomm_session, dlci) 67 * 68 * handle a new dlc request (since its called from a couple of places) 69 */ 70 struct rfcomm_dlc * 71 rfcomm_dlc_newconn(struct rfcomm_session *rs, int dlci) 72 { 73 struct rfcomm_session *ls; 74 struct rfcomm_dlc *new, *dlc, *any, *best; 75 struct sockaddr_bt laddr, raddr, addr; 76 int chan; 77 78 /* 79 * Search amongst the listening DLC community for the best match for 80 * address & channel. We keep listening DLC's hanging on listening 81 * sessions in a last first order, so scan the entire bunch and keep 82 * a note of the best address and BDADDR_ANY matches in order to find 83 * the oldest and most specific match. 84 */ 85 l2cap_sockaddr(rs->rs_l2cap, &laddr); 86 l2cap_peeraddr(rs->rs_l2cap, &raddr); 87 chan = RFCOMM_CHANNEL(dlci); 88 new = NULL; 89 90 any = best = NULL; 91 LIST_FOREACH(ls, &rfcomm_session_listen, rs_next) { 92 l2cap_sockaddr(ls->rs_l2cap, &addr); 93 94 if (addr.bt_psm != laddr.bt_psm) 95 continue; 96 97 if (bdaddr_same(&laddr.bt_bdaddr, &addr.bt_bdaddr)) { 98 LIST_FOREACH(dlc, &ls->rs_dlcs, rd_next) { 99 if (dlc->rd_laddr.bt_channel == chan) 100 best = dlc; 101 } 102 } 103 104 if (bdaddr_any(&addr.bt_bdaddr)) { 105 LIST_FOREACH(dlc, &ls->rs_dlcs, rd_next) { 106 if (dlc->rd_laddr.bt_channel == chan) 107 any = dlc; 108 } 109 } 110 } 111 112 dlc = best ? best : any; 113 114 /* XXX 115 * Note that if this fails, we could have missed a chance to open 116 * a connection - really need to rewrite the strategy for storing 117 * listening DLC's so all can be checked in turn.. 118 */ 119 if (dlc != NULL) 120 new = (*dlc->rd_proto->newconn)(dlc->rd_upper, &laddr, &raddr); 121 122 if (new == NULL) { 123 rfcomm_session_send_frame(rs, RFCOMM_FRAME_DM, dlci); 124 return NULL; 125 } 126 127 new->rd_dlci = dlci; 128 new->rd_mtu = rfcomm_mtu_default; 129 new->rd_mode = dlc->rd_mode; 130 131 memcpy(&new->rd_laddr, &laddr, sizeof(struct sockaddr_bt)); 132 new->rd_laddr.bt_channel = chan; 133 134 memcpy(&new->rd_raddr, &raddr, sizeof(struct sockaddr_bt)); 135 new->rd_raddr.bt_channel = chan; 136 137 new->rd_session = rs; 138 new->rd_state = RFCOMM_DLC_WAIT_CONNECT; 139 LIST_INSERT_HEAD(&rs->rs_dlcs, new, rd_next); 140 141 return new; 142 } 143 144 /* 145 * rfcomm_dlc_close(dlc, error) 146 * 147 * detach DLC from session and clean up 148 */ 149 void 150 rfcomm_dlc_close(struct rfcomm_dlc *dlc, int err) 151 { 152 struct rfcomm_session *rs; 153 struct rfcomm_credit *credit; 154 155 KKASSERT(dlc->rd_state != RFCOMM_DLC_CLOSED); 156 157 /* Clear credit history */ 158 rs = dlc->rd_session; 159 STAILQ_FOREACH(credit, &rs->rs_credits, rc_next) 160 if (credit->rc_dlc == dlc) 161 credit->rc_dlc = NULL; 162 163 callout_stop(&dlc->rd_timeout); 164 165 LIST_REMOVE(dlc, rd_next); 166 dlc->rd_session = NULL; 167 dlc->rd_state = RFCOMM_DLC_CLOSED; 168 169 (*dlc->rd_proto->disconnected)(dlc->rd_upper, err); 170 171 /* 172 * It is the responsibility of the party who sends the last 173 * DISC(dlci) to disconnect the session, but we will schedule 174 * an expiry just in case that doesnt happen.. 175 */ 176 if (LIST_EMPTY(&rs->rs_dlcs)) { 177 if (rs->rs_state == RFCOMM_SESSION_LISTEN) 178 rfcomm_session_free(rs); 179 else 180 callout_reset(&rs->rs_timeout, rfcomm_ack_timeout * hz, 181 rfcomm_session_timeout, rs); 182 } 183 } 184 185 /* 186 * rfcomm_dlc_timeout(dlc) 187 * 188 * DLC timeout function is schedUled when we sent any of SABM, 189 * DISC, MCC_MSC, or MCC_PN and should be cancelled when we get 190 * the relevant response. There is nothing to do but shut this 191 * DLC down. 192 */ 193 void 194 rfcomm_dlc_timeout(void *arg) 195 { 196 struct rfcomm_dlc *dlc = arg; 197 198 crit_enter(); 199 200 if (dlc->rd_state != RFCOMM_DLC_CLOSED) 201 rfcomm_dlc_close(dlc, ETIMEDOUT); 202 else if (dlc->rd_flags & RFCOMM_DLC_DETACH) 203 kfree(dlc, M_BLUETOOTH); 204 205 crit_exit(); 206 } 207 208 /* 209 * rfcomm_dlc_setmode(rfcomm_dlc) 210 * 211 * Set link mode for DLC. This is only called when the session is 212 * already open, so we don't need to worry about any previous mode 213 * settings. 214 */ 215 int 216 rfcomm_dlc_setmode(struct rfcomm_dlc *dlc) 217 { 218 int mode = 0; 219 220 KKASSERT(dlc->rd_session != NULL); 221 KKASSERT(dlc->rd_session->rs_state == RFCOMM_SESSION_OPEN); 222 223 DPRINTF("dlci %d, auth %s, encrypt %s, secure %s\n", dlc->rd_dlci, 224 (dlc->rd_mode & RFCOMM_LM_AUTH ? "yes" : "no"), 225 (dlc->rd_mode & RFCOMM_LM_ENCRYPT ? "yes" : "no"), 226 (dlc->rd_mode & RFCOMM_LM_SECURE ? "yes" : "no")); 227 228 if (dlc->rd_mode & RFCOMM_LM_AUTH) 229 mode |= L2CAP_LM_AUTH; 230 231 if (dlc->rd_mode & RFCOMM_LM_ENCRYPT) 232 mode |= L2CAP_LM_ENCRYPT; 233 234 if (dlc->rd_mode & RFCOMM_LM_SECURE) 235 mode |= L2CAP_LM_SECURE; 236 237 return l2cap_setopt(dlc->rd_session->rs_l2cap, SO_L2CAP_LM, &mode); 238 } 239 240 /* 241 * rfcomm_dlc_connect(rfcomm_dlc) 242 * 243 * initiate DLC connection (session is already connected) 244 */ 245 int 246 rfcomm_dlc_connect(struct rfcomm_dlc *dlc) 247 { 248 struct rfcomm_mcc_pn pn; 249 int err = 0; 250 251 KKASSERT(dlc->rd_session != NULL); 252 KKASSERT(dlc->rd_session->rs_state == RFCOMM_SESSION_OPEN); 253 KKASSERT(dlc->rd_state == RFCOMM_DLC_WAIT_SESSION); 254 255 /* 256 * If we have not already sent a PN on the session, we must send 257 * a PN to negotiate Credit Flow Control, and this setting will 258 * apply to all future connections for this session. We ask for 259 * this every time, in order to establish initial credits. 260 */ 261 memset(&pn, 0, sizeof(pn)); 262 pn.dlci = dlc->rd_dlci; 263 pn.priority = dlc->rd_dlci | 0x07; 264 pn.mtu = htole16(dlc->rd_mtu); 265 266 pn.flow_control = 0xf0; 267 dlc->rd_rxcred = (dlc->rd_rxsize / dlc->rd_mtu); 268 dlc->rd_rxcred = min(dlc->rd_rxcred, RFCOMM_CREDITS_DEFAULT); 269 pn.credits = dlc->rd_rxcred; 270 271 err = rfcomm_session_send_mcc(dlc->rd_session, 1, 272 RFCOMM_MCC_PN, &pn, sizeof(pn)); 273 if (err) 274 return err; 275 276 dlc->rd_state = RFCOMM_DLC_WAIT_CONNECT; 277 callout_reset(&dlc->rd_timeout, rfcomm_mcc_timeout * hz, 278 rfcomm_dlc_timeout, dlc); 279 return 0; 280 } 281 282 /* 283 * rfcomm_dlc_open(rfcomm_dlc) 284 * 285 * send "Modem Status Command" and mark DLC as open. 286 */ 287 int 288 rfcomm_dlc_open(struct rfcomm_dlc *dlc) 289 { 290 struct rfcomm_mcc_msc msc; 291 int err; 292 293 KKASSERT(dlc->rd_session != NULL); 294 KKASSERT(dlc->rd_session->rs_state == RFCOMM_SESSION_OPEN); 295 296 memset(&msc, 0, sizeof(msc)); 297 msc.address = RFCOMM_MKADDRESS(1, dlc->rd_dlci); 298 msc.modem = dlc->rd_lmodem & 0xfe; /* EA = 0 */ 299 msc.brk = 0x00 | 0x01; /* EA = 1 */ 300 301 err = rfcomm_session_send_mcc(dlc->rd_session, 1, 302 RFCOMM_MCC_MSC, &msc, sizeof(msc)); 303 if (err) 304 return err; 305 306 callout_reset(&dlc->rd_timeout, rfcomm_mcc_timeout * hz, 307 rfcomm_dlc_timeout, dlc); 308 309 dlc->rd_state = RFCOMM_DLC_OPEN; 310 (*dlc->rd_proto->connected)(dlc->rd_upper); 311 312 return 0; 313 } 314 315 /* 316 * rfcomm_dlc_start(rfcomm_dlc) 317 * 318 * Start sending data (and/or credits) for DLC. Our strategy is to 319 * send anything we can down to the l2cap layer. When credits run 320 * out, data will naturally bunch up. When not using credit flow 321 * control, we limit the number of packets we have pending to reduce 322 * flow control lag. 323 * We should deal with channel priority somehow. 324 */ 325 void 326 rfcomm_dlc_start(struct rfcomm_dlc *dlc) 327 { 328 struct rfcomm_session *rs = dlc->rd_session; 329 struct mbuf *m; 330 int len, credits; 331 332 KKASSERT(rs != NULL); 333 KKASSERT(rs->rs_state == RFCOMM_SESSION_OPEN); 334 KKASSERT(dlc->rd_state == RFCOMM_DLC_OPEN); 335 336 for (;;) { 337 credits = 0; 338 len = dlc->rd_mtu; 339 if (rs->rs_flags & RFCOMM_SESSION_CFC) { 340 credits = (dlc->rd_rxsize / dlc->rd_mtu); 341 credits -= dlc->rd_rxcred; 342 credits = min(credits, RFCOMM_CREDITS_MAX); 343 344 if (credits > 0) 345 len--; 346 347 if (dlc->rd_txcred == 0) 348 len = 0; 349 } else { 350 if (rs->rs_flags & RFCOMM_SESSION_RFC) 351 break; 352 353 if (dlc->rd_rmodem & RFCOMM_MSC_FC) 354 break; 355 356 if (dlc->rd_pending > RFCOMM_CREDITS_DEFAULT) 357 break; 358 } 359 360 if (dlc->rd_txbuf == NULL) 361 len = 0; 362 363 if (len == 0) { 364 if (credits == 0) 365 break; 366 367 /* 368 * No need to send small numbers of credits on their 369 * own unless the other end hasn't many left. 370 */ 371 if (credits < RFCOMM_CREDITS_DEFAULT 372 && dlc->rd_rxcred > RFCOMM_CREDITS_DEFAULT) 373 break; 374 375 m = NULL; 376 } else { 377 /* 378 * take what data we can from (front of) txbuf 379 */ 380 m = dlc->rd_txbuf; 381 if (len < m->m_pkthdr.len) { 382 dlc->rd_txbuf = m_split(m, len, M_NOWAIT); 383 if (dlc->rd_txbuf == NULL) { 384 dlc->rd_txbuf = m; 385 break; 386 } 387 } else { 388 dlc->rd_txbuf = NULL; 389 len = m->m_pkthdr.len; 390 } 391 } 392 393 DPRINTFN(10, "dlci %d send %d bytes, %d credits, rxcred = %d\n", 394 dlc->rd_dlci, len, credits, dlc->rd_rxcred); 395 396 if (rfcomm_session_send_uih(rs, dlc, credits, m)) { 397 kprintf("%s: lost %d bytes on DLCI %d\n", 398 __func__, len, dlc->rd_dlci); 399 400 break; 401 } 402 403 dlc->rd_pending++; 404 405 if (rs->rs_flags & RFCOMM_SESSION_CFC) { 406 if (len > 0) 407 dlc->rd_txcred--; 408 409 if (credits > 0) 410 dlc->rd_rxcred += credits; 411 } 412 } 413 } 414