bluetooth/rfcomm/core.c

56 static int rfcomm_send_sabm(struct rfcomm_session *s, u8 dlci);
57 static int rfcomm_send_disc(struct rfcomm_session *s, u8 dlci);
61 static int rfcomm_send_msc(struct rfcomm_session *s, int cr, u8 dlci, u8 v24_sig);
85 #define __addr(cr, dlci)       (((dlci & 0x3f) << 2) | (cr << 1) | 0x01)
88 #define __srv_channel(dlci)    (dlci >> 1)
355 static struct rfcomm_dlc *rfcomm_dlc_get(struct rfcomm_session *s, u8 dlci)
360 		if (d->dlci == dlci)
375 	u8 dlci;
393 	dlci = __dlci(__session_dir(s), channel);
396 	if (rfcomm_dlc_get(s, dlci))
401 	d->dlci     = dlci;
402 	d->addr     = __addr(s->initiator, dlci);
443 		rfcomm_send_disc(s, d->dlci);
457 	BT_DBG("dlc %p state %ld dlci %d err %d session %p",
458 			d, d->state, d->dlci, err, s);
509 	BT_DBG("dlc %p state %ld dlci %d err %d", d, d->state, d->dlci, err);
541 	u8 dlci;
549 		dlci = __dlci(__session_dir(s), channel);
550 		dlc = rfcomm_dlc_get(s, dlci);
851 static int rfcomm_send_sabm(struct rfcomm_session *s, u8 dlci)
855 	BT_DBG("%p dlci %d", s, dlci);
857 	cmd.addr = __addr(s->initiator, dlci);
865 static int rfcomm_send_ua(struct rfcomm_session *s, u8 dlci)
869 	BT_DBG("%p dlci %d", s, dlci);
871 	cmd.addr = __addr(!s->initiator, dlci);
879 static int rfcomm_send_disc(struct rfcomm_session *s, u8 dlci)
883 	BT_DBG("%p dlci %d", s, dlci);
885 	cmd.addr = __addr(s->initiator, dlci);
898 	BT_DBG("dlc %p dlci %d", d, d->dlci);
915 static int rfcomm_send_dm(struct rfcomm_session *s, u8 dlci)
919 	BT_DBG("%p dlci %d", s, dlci);
921 	cmd.addr = __addr(!s->initiator, dlci);
961 	BT_DBG("%p cr %d dlci %d mtu %d", s, cr, d->dlci, d->mtu);
973 	pn->dlci        = d->dlci;
996 int rfcomm_send_rpn(struct rfcomm_session *s, int cr, u8 dlci,
1006 	BT_DBG("%p cr %d dlci %d bit_r 0x%x data_b 0x%x stop_b 0x%x parity 0x%x"
1008 		s, cr, dlci, bit_rate, data_bits, stop_bits, parity,
1021 	rpn->dlci          = __addr(1, dlci);
1034 static int rfcomm_send_rls(struct rfcomm_session *s, int cr, u8 dlci, u8 status)
1053 	rls->dlci   = __addr(1, dlci);
1061 static int rfcomm_send_msc(struct rfcomm_session *s, int cr, u8 dlci, u8 v24_sig)
1080 	msc->dlci    = __addr(1, dlci);
1204 static struct rfcomm_session *rfcomm_recv_ua(struct rfcomm_session *s, u8 dlci)
1206 	BT_DBG("session %p state %ld dlci %d", s, s->state, dlci);
1208 	if (dlci) {
1210 		struct rfcomm_dlc *d = rfcomm_dlc_get(s, dlci);
1212 			rfcomm_send_dm(s, dlci);
1225 			rfcomm_send_msc(s, 1, dlci, d->v24_sig);
1256 static struct rfcomm_session *rfcomm_recv_dm(struct rfcomm_session *s, u8 dlci)
1260 	BT_DBG("session %p state %ld dlci %d", s, s->state, dlci);
1262 	if (dlci) {
1264 		struct rfcomm_dlc *d = rfcomm_dlc_get(s, dlci);
1286 					       u8 dlci)
1290 	BT_DBG("session %p state %ld dlci %d", s, s->state, dlci);
1292 	if (dlci) {
1293 		struct rfcomm_dlc *d = rfcomm_dlc_get(s, dlci);
1295 			rfcomm_send_ua(s, dlci);
1305 			rfcomm_send_dm(s, dlci);
1327 	rfcomm_send_ua(d->session, d->dlci);
1339 	rfcomm_send_msc(d->session, 1, d->dlci, d->v24_sig);
1361 static int rfcomm_recv_sabm(struct rfcomm_session *s, u8 dlci)
1366 	BT_DBG("session %p state %ld dlci %d", s, s->state, dlci);
1368 	if (!dlci) {
1379 	d = rfcomm_dlc_get(s, dlci);
1389 	channel = __srv_channel(dlci);
1391 		d->dlci = dlci;
1392 		d->addr = __addr(s->initiator, dlci);
1397 		rfcomm_send_dm(s, dlci);
1407 	BT_DBG("dlc %p state %ld dlci %d mtu %d fc 0x%x credits %d",
1408 			d, d->state, d->dlci, pn->mtu, pn->flow_ctrl, pn->credits);
1436 	u8 dlci = pn->dlci;
1438 	BT_DBG("session %p state %ld dlci %d", s, s->state, dlci);
1440 	if (!dlci)
1443 	d = rfcomm_dlc_get(s, dlci);
1456 				rfcomm_send_sabm(s, d->dlci);
1461 		u8 channel = __srv_channel(dlci);
1469 			d->dlci = dlci;
1470 			d->addr = __addr(s->initiator, dlci);
1478 			rfcomm_send_dm(s, dlci);
1487 	u8 dlci = __get_dlci(rpn->dlci);
1498 	BT_DBG("dlci %d cr %d len 0x%x bitr 0x%x line 0x%x flow 0x%x xonc 0x%x xoffc 0x%x pm 0x%x",
1499 		dlci, cr, len, rpn->bit_rate, rpn->line_settings, rpn->flow_ctrl,
1584 	rfcomm_send_rpn(s, 0, dlci, bit_rate, data_bits, stop_bits,
1593 	u8 dlci = __get_dlci(rls->dlci);
1595 	BT_DBG("dlci %d cr %d status 0x%x", dlci, cr, rls->status);
1604 	rfcomm_send_rls(s, 0, dlci, rls->status);
1613 	u8 dlci = __get_dlci(msc->dlci);
1615 	BT_DBG("dlci %d cr %d v24 0x%x", dlci, cr, msc->v24_sig);
1617 	d = rfcomm_dlc_get(s, dlci);
1636 		rfcomm_send_msc(s, 0, dlci, msc->v24_sig);
1705 static int rfcomm_recv_data(struct rfcomm_session *s, u8 dlci, int pf, struct sk_buff *skb)
1709 	BT_DBG("session %p state %ld dlci %d pf %d", s, s->state, dlci, pf);
1711 	d = rfcomm_dlc_get(s, dlci);
1713 		rfcomm_send_dm(s, dlci);
1742 	u8 type, dlci, fcs;
1750 	dlci = __get_dlci(hdr->addr);
1771 			rfcomm_recv_sabm(s, dlci);
1776 			s = rfcomm_recv_disc(s, dlci);
1781 			s = rfcomm_recv_ua(s, dlci);
1785 		s = rfcomm_recv_dm(s, dlci);
1789 		if (dlci) {
1790 			rfcomm_recv_data(s, dlci, __test_pf(hdr->ctrl), skb);
1838 		rfcomm_send_msc(d->session, 1, d->dlci, d->v24_sig);
1914 				rfcomm_send_dm(s, d->dlci);
2198 				   d->state, d->dlci, d->mtu,