1878ed226SJulian Elischer /*
2878ed226SJulian Elischer * ng_btsocket_l2cap.c
3c398230bSWarner Losh */
4c398230bSWarner Losh
5c398230bSWarner Losh /*-
64d846d26SWarner Losh * SPDX-License-Identifier: BSD-2-Clause
7fe267a55SPedro F. Giffuni *
8878ed226SJulian Elischer * Copyright (c) 2001-2002 Maksim Yevmenkin <m_evmenkin@yahoo.com>
9878ed226SJulian Elischer * All rights reserved.
10878ed226SJulian Elischer *
11878ed226SJulian Elischer * Redistribution and use in source and binary forms, with or without
12878ed226SJulian Elischer * modification, are permitted provided that the following conditions
13878ed226SJulian Elischer * are met:
14878ed226SJulian Elischer * 1. Redistributions of source code must retain the above copyright
15878ed226SJulian Elischer * notice, this list of conditions and the following disclaimer.
16878ed226SJulian Elischer * 2. Redistributions in binary form must reproduce the above copyright
17878ed226SJulian Elischer * notice, this list of conditions and the following disclaimer in the
18878ed226SJulian Elischer * documentation and/or other materials provided with the distribution.
19878ed226SJulian Elischer *
20878ed226SJulian Elischer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
21878ed226SJulian Elischer * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
22878ed226SJulian Elischer * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
23878ed226SJulian Elischer * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
24878ed226SJulian Elischer * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
25878ed226SJulian Elischer * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
26878ed226SJulian Elischer * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
27878ed226SJulian Elischer * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
28878ed226SJulian Elischer * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
29878ed226SJulian Elischer * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
30878ed226SJulian Elischer * SUCH DAMAGE.
31878ed226SJulian Elischer *
320986ab12SMaksim Yevmenkin * $Id: ng_btsocket_l2cap.c,v 1.16 2003/09/14 23:29:06 max Exp $
33878ed226SJulian Elischer */
34878ed226SJulian Elischer
35878ed226SJulian Elischer #include <sys/param.h>
36878ed226SJulian Elischer #include <sys/systm.h>
370986ab12SMaksim Yevmenkin #include <sys/bitstring.h>
38878ed226SJulian Elischer #include <sys/domain.h>
39878ed226SJulian Elischer #include <sys/endian.h>
40878ed226SJulian Elischer #include <sys/errno.h>
41878ed226SJulian Elischer #include <sys/filedesc.h>
42878ed226SJulian Elischer #include <sys/ioccom.h>
43878ed226SJulian Elischer #include <sys/kernel.h>
44878ed226SJulian Elischer #include <sys/lock.h>
45878ed226SJulian Elischer #include <sys/malloc.h>
46878ed226SJulian Elischer #include <sys/mbuf.h>
47878ed226SJulian Elischer #include <sys/mutex.h>
48878ed226SJulian Elischer #include <sys/protosw.h>
49878ed226SJulian Elischer #include <sys/queue.h>
50878ed226SJulian Elischer #include <sys/socket.h>
51878ed226SJulian Elischer #include <sys/socketvar.h>
52878ed226SJulian Elischer #include <sys/sysctl.h>
53878ed226SJulian Elischer #include <sys/taskqueue.h>
541fb51a12SBjoern A. Zeeb
551fb51a12SBjoern A. Zeeb #include <net/vnet.h>
561fb51a12SBjoern A. Zeeb
57878ed226SJulian Elischer #include <netgraph/ng_message.h>
58878ed226SJulian Elischer #include <netgraph/netgraph.h>
59b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_bluetooth.h>
60b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_hci.h>
61b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_l2cap.h>
62b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_btsocket.h>
63b84b10f9SMaksim Yevmenkin #include <netgraph/bluetooth/include/ng_btsocket_l2cap.h>
64878ed226SJulian Elischer
65878ed226SJulian Elischer /* MALLOC define */
66878ed226SJulian Elischer #ifdef NG_SEPARATE_MALLOC
67d745c852SEd Schouten static MALLOC_DEFINE(M_NETGRAPH_BTSOCKET_L2CAP, "netgraph_btsocks_l2cap",
68878ed226SJulian Elischer "Netgraph Bluetooth L2CAP sockets");
69878ed226SJulian Elischer #else
70878ed226SJulian Elischer #define M_NETGRAPH_BTSOCKET_L2CAP M_NETGRAPH
71878ed226SJulian Elischer #endif /* NG_SEPARATE_MALLOC */
72878ed226SJulian Elischer
73878ed226SJulian Elischer /* Netgraph node methods */
74878ed226SJulian Elischer static ng_constructor_t ng_btsocket_l2cap_node_constructor;
75878ed226SJulian Elischer static ng_rcvmsg_t ng_btsocket_l2cap_node_rcvmsg;
76878ed226SJulian Elischer static ng_shutdown_t ng_btsocket_l2cap_node_shutdown;
77878ed226SJulian Elischer static ng_newhook_t ng_btsocket_l2cap_node_newhook;
78878ed226SJulian Elischer static ng_connect_t ng_btsocket_l2cap_node_connect;
79878ed226SJulian Elischer static ng_rcvdata_t ng_btsocket_l2cap_node_rcvdata;
80878ed226SJulian Elischer static ng_disconnect_t ng_btsocket_l2cap_node_disconnect;
81878ed226SJulian Elischer
82878ed226SJulian Elischer static void ng_btsocket_l2cap_input (void *, int);
83878ed226SJulian Elischer static void ng_btsocket_l2cap_rtclean (void *, int);
84878ed226SJulian Elischer
85878ed226SJulian Elischer /* Netgraph type descriptor */
86878ed226SJulian Elischer static struct ng_type typestruct = {
87f8aae777SJulian Elischer .version = NG_ABI_VERSION,
88f8aae777SJulian Elischer .name = NG_BTSOCKET_L2CAP_NODE_TYPE,
89f8aae777SJulian Elischer .constructor = ng_btsocket_l2cap_node_constructor,
90f8aae777SJulian Elischer .rcvmsg = ng_btsocket_l2cap_node_rcvmsg,
91f8aae777SJulian Elischer .shutdown = ng_btsocket_l2cap_node_shutdown,
92f8aae777SJulian Elischer .newhook = ng_btsocket_l2cap_node_newhook,
93f8aae777SJulian Elischer .connect = ng_btsocket_l2cap_node_connect,
94f8aae777SJulian Elischer .rcvdata = ng_btsocket_l2cap_node_rcvdata,
95f8aae777SJulian Elischer .disconnect = ng_btsocket_l2cap_node_disconnect,
96878ed226SJulian Elischer };
97878ed226SJulian Elischer
98878ed226SJulian Elischer /* Globals */
99878ed226SJulian Elischer extern int ifqmaxlen;
100878ed226SJulian Elischer static u_int32_t ng_btsocket_l2cap_debug_level;
101878ed226SJulian Elischer static node_p ng_btsocket_l2cap_node;
102878ed226SJulian Elischer static struct ng_bt_itemq ng_btsocket_l2cap_queue;
103878ed226SJulian Elischer static struct mtx ng_btsocket_l2cap_queue_mtx;
104878ed226SJulian Elischer static struct task ng_btsocket_l2cap_queue_task;
105878ed226SJulian Elischer static LIST_HEAD(, ng_btsocket_l2cap_pcb) ng_btsocket_l2cap_sockets;
106878ed226SJulian Elischer static struct mtx ng_btsocket_l2cap_sockets_mtx;
107878ed226SJulian Elischer static LIST_HEAD(, ng_btsocket_l2cap_rtentry) ng_btsocket_l2cap_rt;
108878ed226SJulian Elischer static struct mtx ng_btsocket_l2cap_rt_mtx;
109878ed226SJulian Elischer static struct task ng_btsocket_l2cap_rt_task;
1104fa708efSMaksim Yevmenkin static struct timeval ng_btsocket_l2cap_lasttime;
1114fa708efSMaksim Yevmenkin static int ng_btsocket_l2cap_curpps;
112878ed226SJulian Elischer
113878ed226SJulian Elischer /* Sysctl tree */
114878ed226SJulian Elischer SYSCTL_DECL(_net_bluetooth_l2cap_sockets);
1157029da5cSPawel Biernacki static SYSCTL_NODE(_net_bluetooth_l2cap_sockets, OID_AUTO, seq,
1167029da5cSPawel Biernacki CTLFLAG_RW | CTLFLAG_MPSAFE, 0,
1177029da5cSPawel Biernacki "Bluetooth SEQPACKET L2CAP sockets family");
118f29fc085SMatthew D Fleming SYSCTL_UINT(_net_bluetooth_l2cap_sockets_seq, OID_AUTO, debug_level,
119878ed226SJulian Elischer CTLFLAG_RW,
120878ed226SJulian Elischer &ng_btsocket_l2cap_debug_level, NG_BTSOCKET_WARN_LEVEL,
121878ed226SJulian Elischer "Bluetooth SEQPACKET L2CAP sockets debug level");
122f29fc085SMatthew D Fleming SYSCTL_UINT(_net_bluetooth_l2cap_sockets_seq, OID_AUTO, queue_len,
123878ed226SJulian Elischer CTLFLAG_RD,
124878ed226SJulian Elischer &ng_btsocket_l2cap_queue.len, 0,
125878ed226SJulian Elischer "Bluetooth SEQPACKET L2CAP sockets input queue length");
126f29fc085SMatthew D Fleming SYSCTL_UINT(_net_bluetooth_l2cap_sockets_seq, OID_AUTO, queue_maxlen,
127878ed226SJulian Elischer CTLFLAG_RD,
128878ed226SJulian Elischer &ng_btsocket_l2cap_queue.maxlen, 0,
129878ed226SJulian Elischer "Bluetooth SEQPACKET L2CAP sockets input queue max. length");
130f29fc085SMatthew D Fleming SYSCTL_UINT(_net_bluetooth_l2cap_sockets_seq, OID_AUTO, queue_drops,
131878ed226SJulian Elischer CTLFLAG_RD,
132878ed226SJulian Elischer &ng_btsocket_l2cap_queue.drops, 0,
133878ed226SJulian Elischer "Bluetooth SEQPACKET L2CAP sockets input queue drops");
134878ed226SJulian Elischer
135878ed226SJulian Elischer /* Debug */
136878ed226SJulian Elischer #define NG_BTSOCKET_L2CAP_INFO \
1374fa708efSMaksim Yevmenkin if (ng_btsocket_l2cap_debug_level >= NG_BTSOCKET_INFO_LEVEL && \
1384fa708efSMaksim Yevmenkin ppsratecheck(&ng_btsocket_l2cap_lasttime, &ng_btsocket_l2cap_curpps, 1)) \
139878ed226SJulian Elischer printf
140878ed226SJulian Elischer
141878ed226SJulian Elischer #define NG_BTSOCKET_L2CAP_WARN \
1424fa708efSMaksim Yevmenkin if (ng_btsocket_l2cap_debug_level >= NG_BTSOCKET_WARN_LEVEL && \
1434fa708efSMaksim Yevmenkin ppsratecheck(&ng_btsocket_l2cap_lasttime, &ng_btsocket_l2cap_curpps, 1)) \
144878ed226SJulian Elischer printf
145878ed226SJulian Elischer
146878ed226SJulian Elischer #define NG_BTSOCKET_L2CAP_ERR \
1474fa708efSMaksim Yevmenkin if (ng_btsocket_l2cap_debug_level >= NG_BTSOCKET_ERR_LEVEL && \
1484fa708efSMaksim Yevmenkin ppsratecheck(&ng_btsocket_l2cap_lasttime, &ng_btsocket_l2cap_curpps, 1)) \
149878ed226SJulian Elischer printf
150878ed226SJulian Elischer
151878ed226SJulian Elischer #define NG_BTSOCKET_L2CAP_ALERT \
1524fa708efSMaksim Yevmenkin if (ng_btsocket_l2cap_debug_level >= NG_BTSOCKET_ALERT_LEVEL && \
1534fa708efSMaksim Yevmenkin ppsratecheck(&ng_btsocket_l2cap_lasttime, &ng_btsocket_l2cap_curpps, 1)) \
154878ed226SJulian Elischer printf
155878ed226SJulian Elischer
156878ed226SJulian Elischer /*
157878ed226SJulian Elischer * Netgraph message processing routines
158878ed226SJulian Elischer */
159878ed226SJulian Elischer
160878ed226SJulian Elischer static int ng_btsocket_l2cap_process_l2ca_con_req_rsp
1617c380856SMaksim Yevmenkin (struct ng_mesg *, ng_btsocket_l2cap_rtentry_p);
162878ed226SJulian Elischer static int ng_btsocket_l2cap_process_l2ca_con_rsp_rsp
1637c380856SMaksim Yevmenkin (struct ng_mesg *, ng_btsocket_l2cap_rtentry_p);
164878ed226SJulian Elischer static int ng_btsocket_l2cap_process_l2ca_con_ind
1657c380856SMaksim Yevmenkin (struct ng_mesg *, ng_btsocket_l2cap_rtentry_p);
166878ed226SJulian Elischer
167878ed226SJulian Elischer static int ng_btsocket_l2cap_process_l2ca_cfg_req_rsp
1687c380856SMaksim Yevmenkin (struct ng_mesg *, ng_btsocket_l2cap_rtentry_p);
169878ed226SJulian Elischer static int ng_btsocket_l2cap_process_l2ca_cfg_rsp_rsp
1707c380856SMaksim Yevmenkin (struct ng_mesg *, ng_btsocket_l2cap_rtentry_p);
171878ed226SJulian Elischer static int ng_btsocket_l2cap_process_l2ca_cfg_ind
1727c380856SMaksim Yevmenkin (struct ng_mesg *, ng_btsocket_l2cap_rtentry_p);
173878ed226SJulian Elischer
174878ed226SJulian Elischer static int ng_btsocket_l2cap_process_l2ca_discon_rsp
1757c380856SMaksim Yevmenkin (struct ng_mesg *, ng_btsocket_l2cap_rtentry_p);
176878ed226SJulian Elischer static int ng_btsocket_l2cap_process_l2ca_discon_ind
1777c380856SMaksim Yevmenkin (struct ng_mesg *, ng_btsocket_l2cap_rtentry_p);
178878ed226SJulian Elischer
179878ed226SJulian Elischer static int ng_btsocket_l2cap_process_l2ca_write_rsp
1807c380856SMaksim Yevmenkin (struct ng_mesg *, ng_btsocket_l2cap_rtentry_p);
181878ed226SJulian Elischer
182878ed226SJulian Elischer /*
183878ed226SJulian Elischer * Send L2CA_xxx messages to the lower layer
184878ed226SJulian Elischer */
185878ed226SJulian Elischer
186878ed226SJulian Elischer static int ng_btsocket_l2cap_send_l2ca_con_req
187878ed226SJulian Elischer (ng_btsocket_l2cap_pcb_p);
188878ed226SJulian Elischer static int ng_btsocket_l2cap_send_l2ca_con_rsp_req
189fbc48c2bSTakanori Watanabe (u_int32_t, ng_btsocket_l2cap_rtentry_p, bdaddr_p, int, int, int, int);
190878ed226SJulian Elischer static int ng_btsocket_l2cap_send_l2ca_cfg_req
191878ed226SJulian Elischer (ng_btsocket_l2cap_pcb_p);
192878ed226SJulian Elischer static int ng_btsocket_l2cap_send_l2ca_cfg_rsp
193878ed226SJulian Elischer (ng_btsocket_l2cap_pcb_p);
194878ed226SJulian Elischer static int ng_btsocket_l2cap_send_l2ca_discon_req
195878ed226SJulian Elischer (u_int32_t, ng_btsocket_l2cap_pcb_p);
196878ed226SJulian Elischer
197878ed226SJulian Elischer static int ng_btsocket_l2cap_send2
198878ed226SJulian Elischer (ng_btsocket_l2cap_pcb_p);
199878ed226SJulian Elischer
200878ed226SJulian Elischer /*
201878ed226SJulian Elischer * Timeout processing routines
202878ed226SJulian Elischer */
203878ed226SJulian Elischer
204878ed226SJulian Elischer static void ng_btsocket_l2cap_timeout (ng_btsocket_l2cap_pcb_p);
205878ed226SJulian Elischer static void ng_btsocket_l2cap_untimeout (ng_btsocket_l2cap_pcb_p);
206878ed226SJulian Elischer static void ng_btsocket_l2cap_process_timeout (void *);
207878ed226SJulian Elischer
208878ed226SJulian Elischer /*
209878ed226SJulian Elischer * Other stuff
210878ed226SJulian Elischer */
211878ed226SJulian Elischer
212878ed226SJulian Elischer static ng_btsocket_l2cap_pcb_p ng_btsocket_l2cap_pcb_by_addr(bdaddr_p, int);
213878ed226SJulian Elischer static ng_btsocket_l2cap_pcb_p ng_btsocket_l2cap_pcb_by_token(u_int32_t);
214fbc48c2bSTakanori Watanabe static ng_btsocket_l2cap_pcb_p ng_btsocket_l2cap_pcb_by_cid (bdaddr_p, int,int);
215878ed226SJulian Elischer static int ng_btsocket_l2cap_result2errno(int);
216878ed226SJulian Elischer
217fbc48c2bSTakanori Watanabe static int ng_btsock_l2cap_addrtype_to_linktype(int addrtype);
2183a601a23STakanori Watanabe
219f2bb1caeSJulian Elischer #define ng_btsocket_l2cap_wakeup_input_task() \
220f2bb1caeSJulian Elischer taskqueue_enqueue(taskqueue_swi_giant, &ng_btsocket_l2cap_queue_task)
221f2bb1caeSJulian Elischer
222f2bb1caeSJulian Elischer #define ng_btsocket_l2cap_wakeup_route_task() \
223f2bb1caeSJulian Elischer taskqueue_enqueue(taskqueue_swi_giant, &ng_btsocket_l2cap_rt_task)
224f2bb1caeSJulian Elischer
ng_btsock_l2cap_addrtype_to_linktype(int addrtype)225fbc48c2bSTakanori Watanabe int ng_btsock_l2cap_addrtype_to_linktype(int addrtype)
226fbc48c2bSTakanori Watanabe {
227fbc48c2bSTakanori Watanabe switch(addrtype){
228fbc48c2bSTakanori Watanabe case BDADDR_LE_PUBLIC:
229fbc48c2bSTakanori Watanabe return NG_HCI_LINK_LE_PUBLIC;
230fbc48c2bSTakanori Watanabe case BDADDR_LE_RANDOM:
231fbc48c2bSTakanori Watanabe return NG_HCI_LINK_LE_RANDOM;
232fbc48c2bSTakanori Watanabe default:
233fbc48c2bSTakanori Watanabe return NG_HCI_LINK_ACL;
234fbc48c2bSTakanori Watanabe }
235fbc48c2bSTakanori Watanabe }
236fbc48c2bSTakanori Watanabe
237878ed226SJulian Elischer /*****************************************************************************
238878ed226SJulian Elischer *****************************************************************************
239878ed226SJulian Elischer ** Netgraph node interface
240878ed226SJulian Elischer *****************************************************************************
241878ed226SJulian Elischer *****************************************************************************/
242878ed226SJulian Elischer
243878ed226SJulian Elischer /*
244878ed226SJulian Elischer * Netgraph node constructor. Do not allow to create node of this type.
245878ed226SJulian Elischer */
246878ed226SJulian Elischer
247878ed226SJulian Elischer static int
ng_btsocket_l2cap_node_constructor(node_p node)248878ed226SJulian Elischer ng_btsocket_l2cap_node_constructor(node_p node)
249878ed226SJulian Elischer {
250878ed226SJulian Elischer return (EINVAL);
251878ed226SJulian Elischer } /* ng_btsocket_l2cap_node_constructor */
252878ed226SJulian Elischer
253878ed226SJulian Elischer /*
254878ed226SJulian Elischer * Do local shutdown processing. Let old node go and create new fresh one.
255878ed226SJulian Elischer */
256878ed226SJulian Elischer
257878ed226SJulian Elischer static int
ng_btsocket_l2cap_node_shutdown(node_p node)258878ed226SJulian Elischer ng_btsocket_l2cap_node_shutdown(node_p node)
259878ed226SJulian Elischer {
260878ed226SJulian Elischer int error = 0;
261878ed226SJulian Elischer
262878ed226SJulian Elischer NG_NODE_UNREF(node);
263878ed226SJulian Elischer
264878ed226SJulian Elischer /* Create new node */
265878ed226SJulian Elischer error = ng_make_node_common(&typestruct, &ng_btsocket_l2cap_node);
266878ed226SJulian Elischer if (error != 0) {
267878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ALERT(
268878ed226SJulian Elischer "%s: Could not create Netgraph node, error=%d\n", __func__, error);
269878ed226SJulian Elischer
270878ed226SJulian Elischer ng_btsocket_l2cap_node = NULL;
271878ed226SJulian Elischer
272878ed226SJulian Elischer return (error);
273878ed226SJulian Elischer }
274878ed226SJulian Elischer
275878ed226SJulian Elischer error = ng_name_node(ng_btsocket_l2cap_node,
276878ed226SJulian Elischer NG_BTSOCKET_L2CAP_NODE_TYPE);
277b9fe2d6cSAlfred Perlstein if (error != 0) {
278878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ALERT(
279878ed226SJulian Elischer "%s: Could not name Netgraph node, error=%d\n", __func__, error);
280878ed226SJulian Elischer
281878ed226SJulian Elischer NG_NODE_UNREF(ng_btsocket_l2cap_node);
282878ed226SJulian Elischer ng_btsocket_l2cap_node = NULL;
283878ed226SJulian Elischer
284878ed226SJulian Elischer return (error);
285878ed226SJulian Elischer }
286878ed226SJulian Elischer
287878ed226SJulian Elischer return (0);
288878ed226SJulian Elischer } /* ng_btsocket_l2cap_node_shutdown */
289878ed226SJulian Elischer
290878ed226SJulian Elischer /*
291878ed226SJulian Elischer * We allow any hook to be connected to the node.
292878ed226SJulian Elischer */
293878ed226SJulian Elischer
294878ed226SJulian Elischer static int
ng_btsocket_l2cap_node_newhook(node_p node,hook_p hook,char const * name)295878ed226SJulian Elischer ng_btsocket_l2cap_node_newhook(node_p node, hook_p hook, char const *name)
296878ed226SJulian Elischer {
297878ed226SJulian Elischer return (0);
298878ed226SJulian Elischer } /* ng_btsocket_l2cap_node_newhook */
299878ed226SJulian Elischer
300878ed226SJulian Elischer /*
301878ed226SJulian Elischer * Just say "YEP, that's OK by me!"
302878ed226SJulian Elischer */
303878ed226SJulian Elischer
304878ed226SJulian Elischer static int
ng_btsocket_l2cap_node_connect(hook_p hook)305878ed226SJulian Elischer ng_btsocket_l2cap_node_connect(hook_p hook)
306878ed226SJulian Elischer {
307878ed226SJulian Elischer NG_HOOK_SET_PRIVATE(hook, NULL);
308878ed226SJulian Elischer NG_HOOK_REF(hook); /* Keep extra reference to the hook */
309878ed226SJulian Elischer
310878ed226SJulian Elischer #if 0
311878ed226SJulian Elischer NG_HOOK_FORCE_QUEUE(NG_HOOK_PEER(hook));
312878ed226SJulian Elischer NG_HOOK_FORCE_QUEUE(hook);
313878ed226SJulian Elischer #endif
314878ed226SJulian Elischer
315878ed226SJulian Elischer return (0);
316878ed226SJulian Elischer } /* ng_btsocket_l2cap_node_connect */
317878ed226SJulian Elischer
318878ed226SJulian Elischer /*
319878ed226SJulian Elischer * Hook disconnection. Schedule route cleanup task
320878ed226SJulian Elischer */
321878ed226SJulian Elischer
322878ed226SJulian Elischer static int
ng_btsocket_l2cap_node_disconnect(hook_p hook)323878ed226SJulian Elischer ng_btsocket_l2cap_node_disconnect(hook_p hook)
324878ed226SJulian Elischer {
325878ed226SJulian Elischer /*
326878ed226SJulian Elischer * If hook has private information than we must have this hook in
327878ed226SJulian Elischer * the routing table and must schedule cleaning for the routing table.
328878ed226SJulian Elischer * Otherwise hook was connected but we never got "hook_info" message,
329878ed226SJulian Elischer * so we have never added this hook to the routing table and it save
330878ed226SJulian Elischer * to just delete it.
331878ed226SJulian Elischer */
332878ed226SJulian Elischer
333878ed226SJulian Elischer if (NG_HOOK_PRIVATE(hook) != NULL)
334f2bb1caeSJulian Elischer return (ng_btsocket_l2cap_wakeup_route_task());
335878ed226SJulian Elischer
336878ed226SJulian Elischer NG_HOOK_UNREF(hook); /* Remove extra reference */
337878ed226SJulian Elischer
338878ed226SJulian Elischer return (0);
339878ed226SJulian Elischer } /* ng_btsocket_l2cap_node_disconnect */
340878ed226SJulian Elischer
341878ed226SJulian Elischer /*
342878ed226SJulian Elischer * Process incoming messages
343878ed226SJulian Elischer */
344878ed226SJulian Elischer
345878ed226SJulian Elischer static int
ng_btsocket_l2cap_node_rcvmsg(node_p node,item_p item,hook_p hook)346878ed226SJulian Elischer ng_btsocket_l2cap_node_rcvmsg(node_p node, item_p item, hook_p hook)
347878ed226SJulian Elischer {
348878ed226SJulian Elischer struct ng_mesg *msg = NGI_MSG(item); /* item still has message */
349878ed226SJulian Elischer int error = 0;
350878ed226SJulian Elischer
351878ed226SJulian Elischer if (msg != NULL && msg->header.typecookie == NGM_L2CAP_COOKIE) {
352878ed226SJulian Elischer mtx_lock(&ng_btsocket_l2cap_queue_mtx);
353878ed226SJulian Elischer if (NG_BT_ITEMQ_FULL(&ng_btsocket_l2cap_queue)) {
354878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
355878ed226SJulian Elischer "%s: Input queue is full (msg)\n", __func__);
356878ed226SJulian Elischer
357878ed226SJulian Elischer NG_BT_ITEMQ_DROP(&ng_btsocket_l2cap_queue);
358878ed226SJulian Elischer NG_FREE_ITEM(item);
359878ed226SJulian Elischer error = ENOBUFS;
360878ed226SJulian Elischer } else {
361878ed226SJulian Elischer if (hook != NULL) {
362878ed226SJulian Elischer NG_HOOK_REF(hook);
363878ed226SJulian Elischer NGI_SET_HOOK(item, hook);
364878ed226SJulian Elischer }
365878ed226SJulian Elischer
366878ed226SJulian Elischer NG_BT_ITEMQ_ENQUEUE(&ng_btsocket_l2cap_queue, item);
367f2bb1caeSJulian Elischer error = ng_btsocket_l2cap_wakeup_input_task();
368878ed226SJulian Elischer }
369878ed226SJulian Elischer mtx_unlock(&ng_btsocket_l2cap_queue_mtx);
370878ed226SJulian Elischer } else {
371878ed226SJulian Elischer NG_FREE_ITEM(item);
372878ed226SJulian Elischer error = EINVAL;
373878ed226SJulian Elischer }
374878ed226SJulian Elischer
375878ed226SJulian Elischer return (error);
376878ed226SJulian Elischer } /* ng_btsocket_l2cap_node_rcvmsg */
377878ed226SJulian Elischer
378878ed226SJulian Elischer /*
379878ed226SJulian Elischer * Receive data on a hook
380878ed226SJulian Elischer */
381878ed226SJulian Elischer
382878ed226SJulian Elischer static int
ng_btsocket_l2cap_node_rcvdata(hook_p hook,item_p item)383878ed226SJulian Elischer ng_btsocket_l2cap_node_rcvdata(hook_p hook, item_p item)
384878ed226SJulian Elischer {
385878ed226SJulian Elischer int error = 0;
386878ed226SJulian Elischer
387878ed226SJulian Elischer mtx_lock(&ng_btsocket_l2cap_queue_mtx);
388878ed226SJulian Elischer if (NG_BT_ITEMQ_FULL(&ng_btsocket_l2cap_queue)) {
389878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
390878ed226SJulian Elischer "%s: Input queue is full (data)\n", __func__);
391878ed226SJulian Elischer
392878ed226SJulian Elischer NG_BT_ITEMQ_DROP(&ng_btsocket_l2cap_queue);
393878ed226SJulian Elischer NG_FREE_ITEM(item);
394878ed226SJulian Elischer error = ENOBUFS;
395878ed226SJulian Elischer } else {
396878ed226SJulian Elischer NG_HOOK_REF(hook);
397878ed226SJulian Elischer NGI_SET_HOOK(item, hook);
398878ed226SJulian Elischer
399878ed226SJulian Elischer NG_BT_ITEMQ_ENQUEUE(&ng_btsocket_l2cap_queue, item);
400f2bb1caeSJulian Elischer error = ng_btsocket_l2cap_wakeup_input_task();
401878ed226SJulian Elischer }
402878ed226SJulian Elischer mtx_unlock(&ng_btsocket_l2cap_queue_mtx);
403878ed226SJulian Elischer
404878ed226SJulian Elischer return (error);
405878ed226SJulian Elischer } /* ng_btsocket_l2cap_node_rcvdata */
406878ed226SJulian Elischer
407878ed226SJulian Elischer /*
408878ed226SJulian Elischer * Process L2CA_Connect respose. Socket layer must have initiated connection,
409878ed226SJulian Elischer * so we have to have a socket associated with message token.
410878ed226SJulian Elischer */
411878ed226SJulian Elischer
412878ed226SJulian Elischer static int
ng_btsocket_l2cap_process_l2ca_con_req_rsp(struct ng_mesg * msg,ng_btsocket_l2cap_rtentry_p rt)413878ed226SJulian Elischer ng_btsocket_l2cap_process_l2ca_con_req_rsp(struct ng_mesg *msg,
4147c380856SMaksim Yevmenkin ng_btsocket_l2cap_rtentry_p rt)
415878ed226SJulian Elischer {
416878ed226SJulian Elischer ng_l2cap_l2ca_con_op *op = NULL;
417878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = NULL;
418878ed226SJulian Elischer int error = 0;
419878ed226SJulian Elischer
420878ed226SJulian Elischer if (msg->header.arglen != sizeof(*op))
421878ed226SJulian Elischer return (EMSGSIZE);
422878ed226SJulian Elischer
423878ed226SJulian Elischer op = (ng_l2cap_l2ca_con_op *)(msg->data);
424878ed226SJulian Elischer
425f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
426f2bb1caeSJulian Elischer
427878ed226SJulian Elischer /* Look for the socket with the token */
428878ed226SJulian Elischer pcb = ng_btsocket_l2cap_pcb_by_token(msg->header.token);
429f2bb1caeSJulian Elischer if (pcb == NULL) {
430f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
431878ed226SJulian Elischer return (ENOENT);
432f2bb1caeSJulian Elischer }
433878ed226SJulian Elischer
434878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
435878ed226SJulian Elischer
436878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
437878ed226SJulian Elischer "%s: Got L2CA_Connect response, token=%d, src bdaddr=%x:%x:%x:%x:%x:%x, " \
438878ed226SJulian Elischer "dst bdaddr=%x:%x:%x:%x:%x:%x, psm=%d, lcid=%d, result=%d, status=%d, " \
439878ed226SJulian Elischer "state=%d\n", __func__, msg->header.token,
440878ed226SJulian Elischer pcb->src.b[5], pcb->src.b[4], pcb->src.b[3],
441878ed226SJulian Elischer pcb->src.b[2], pcb->src.b[1], pcb->src.b[0],
442878ed226SJulian Elischer pcb->dst.b[5], pcb->dst.b[4], pcb->dst.b[3],
443878ed226SJulian Elischer pcb->dst.b[2], pcb->dst.b[1], pcb->dst.b[0],
444878ed226SJulian Elischer pcb->psm, op->lcid, op->result, op->status,
445878ed226SJulian Elischer pcb->state);
446878ed226SJulian Elischer
447878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_CONNECTING) {
448878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
449f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
450f2bb1caeSJulian Elischer
451878ed226SJulian Elischer return (ENOENT);
452878ed226SJulian Elischer }
453878ed226SJulian Elischer
454878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
455878ed226SJulian Elischer
456878ed226SJulian Elischer if (op->result == NG_L2CAP_PENDING) {
457878ed226SJulian Elischer ng_btsocket_l2cap_timeout(pcb);
458878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
459f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
460f2bb1caeSJulian Elischer
461878ed226SJulian Elischer return (0);
462878ed226SJulian Elischer }
463878ed226SJulian Elischer
464878ed226SJulian Elischer if (op->result == NG_L2CAP_SUCCESS){
4653a601a23STakanori Watanabe if((pcb->idtype == NG_L2CAP_L2CA_IDTYPE_ATT)||
4663a601a23STakanori Watanabe (pcb->idtype == NG_L2CAP_L2CA_IDTYPE_SMP)){
4673a601a23STakanori Watanabe pcb->encryption = op->encryption; pcb->cid = op->lcid;
4683a601a23STakanori Watanabe if(pcb->need_encrypt && !(pcb->encryption)){
469483ed395STakanori Watanabe ng_btsocket_l2cap_timeout(pcb);
4703a601a23STakanori Watanabe pcb->state = NG_BTSOCKET_L2CAP_W4_ENC_CHANGE;
4713a601a23STakanori Watanabe }else{
472fbc48c2bSTakanori Watanabe pcb->state = NG_BTSOCKET_L2CAP_OPEN;
473fbc48c2bSTakanori Watanabe soisconnected(pcb->so);
4743a601a23STakanori Watanabe }
475fbc48c2bSTakanori Watanabe }else{
476878ed226SJulian Elischer /*
477878ed226SJulian Elischer * Channel is now open, so update local channel ID and
478878ed226SJulian Elischer * start configuration process. Source and destination
479878ed226SJulian Elischer * addresses as well as route must be already set.
480878ed226SJulian Elischer */
481878ed226SJulian Elischer
482878ed226SJulian Elischer pcb->cid = op->lcid;
4833a601a23STakanori Watanabe pcb->encryption = op->encryption;
484878ed226SJulian Elischer error = ng_btsocket_l2cap_send_l2ca_cfg_req(pcb);
485878ed226SJulian Elischer if (error != 0) {
486878ed226SJulian Elischer /* Send disconnect request with "zero" token */
487878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_discon_req(0, pcb);
488878ed226SJulian Elischer
489878ed226SJulian Elischer /* ... and close the socket */
490878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
491878ed226SJulian Elischer soisdisconnected(pcb->so);
492878ed226SJulian Elischer } else {
493878ed226SJulian Elischer pcb->cfg_state = NG_BTSOCKET_L2CAP_CFG_IN_SENT;
494878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CONFIGURING;
495878ed226SJulian Elischer
496878ed226SJulian Elischer ng_btsocket_l2cap_timeout(pcb);
497878ed226SJulian Elischer }
498fbc48c2bSTakanori Watanabe }
499878ed226SJulian Elischer } else {
500878ed226SJulian Elischer /*
501878ed226SJulian Elischer * We have failed to open connection, so convert result
502878ed226SJulian Elischer * code to "errno" code and disconnect the socket. Channel
503878ed226SJulian Elischer * already has been closed.
504878ed226SJulian Elischer */
505878ed226SJulian Elischer
506878ed226SJulian Elischer pcb->so->so_error = ng_btsocket_l2cap_result2errno(op->result);
507878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
508878ed226SJulian Elischer soisdisconnected(pcb->so);
509878ed226SJulian Elischer }
510878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
511f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
512878ed226SJulian Elischer
513878ed226SJulian Elischer return (error);
514878ed226SJulian Elischer } /* ng_btsocket_l2cap_process_l2ca_con_req_rsp */
515878ed226SJulian Elischer
516878ed226SJulian Elischer /*
517878ed226SJulian Elischer * Process L2CA_ConnectRsp response
518878ed226SJulian Elischer */
519878ed226SJulian Elischer
520878ed226SJulian Elischer static int
ng_btsocket_l2cap_process_l2ca_con_rsp_rsp(struct ng_mesg * msg,ng_btsocket_l2cap_rtentry_p rt)521878ed226SJulian Elischer ng_btsocket_l2cap_process_l2ca_con_rsp_rsp(struct ng_mesg *msg,
5227c380856SMaksim Yevmenkin ng_btsocket_l2cap_rtentry_p rt)
523878ed226SJulian Elischer {
524878ed226SJulian Elischer ng_l2cap_l2ca_con_rsp_op *op = NULL;
525878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = NULL;
526878ed226SJulian Elischer
527878ed226SJulian Elischer if (msg->header.arglen != sizeof(*op))
528878ed226SJulian Elischer return (EMSGSIZE);
529878ed226SJulian Elischer
530878ed226SJulian Elischer op = (ng_l2cap_l2ca_con_rsp_op *)(msg->data);
531878ed226SJulian Elischer
532f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
533f2bb1caeSJulian Elischer
534878ed226SJulian Elischer /* Look for the socket with the token */
535878ed226SJulian Elischer pcb = ng_btsocket_l2cap_pcb_by_token(msg->header.token);
536f2bb1caeSJulian Elischer if (pcb == NULL) {
537f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
538878ed226SJulian Elischer return (ENOENT);
539f2bb1caeSJulian Elischer }
540878ed226SJulian Elischer
541878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
542878ed226SJulian Elischer
543878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
544878ed226SJulian Elischer "%s: Got L2CA_ConnectRsp response, token=%d, src bdaddr=%x:%x:%x:%x:%x:%x, " \
545878ed226SJulian Elischer "dst bdaddr=%x:%x:%x:%x:%x:%x, psm=%d, lcid=%d, result=%d, state=%d\n",
546878ed226SJulian Elischer __func__, msg->header.token,
547878ed226SJulian Elischer pcb->src.b[5], pcb->src.b[4], pcb->src.b[3],
548878ed226SJulian Elischer pcb->src.b[2], pcb->src.b[1], pcb->src.b[0],
549878ed226SJulian Elischer pcb->dst.b[5], pcb->dst.b[4], pcb->dst.b[3],
550878ed226SJulian Elischer pcb->dst.b[2], pcb->dst.b[1], pcb->dst.b[0],
551878ed226SJulian Elischer pcb->psm, pcb->cid, op->result, pcb->state);
552878ed226SJulian Elischer
553878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_CONNECTING) {
554878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
555f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
556f2bb1caeSJulian Elischer
557878ed226SJulian Elischer return (ENOENT);
558878ed226SJulian Elischer }
559878ed226SJulian Elischer
560878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
561878ed226SJulian Elischer
562878ed226SJulian Elischer /* Check the result and disconnect the socket on failure */
563878ed226SJulian Elischer if (op->result != NG_L2CAP_SUCCESS) {
564878ed226SJulian Elischer /* Close the socket - channel already closed */
565878ed226SJulian Elischer pcb->so->so_error = ng_btsocket_l2cap_result2errno(op->result);
566878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
567878ed226SJulian Elischer soisdisconnected(pcb->so);
568878ed226SJulian Elischer } else {
569878ed226SJulian Elischer /* Move to CONFIGURING state and wait for CONFIG_IND */
570878ed226SJulian Elischer pcb->cfg_state = 0;
571878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CONFIGURING;
572878ed226SJulian Elischer ng_btsocket_l2cap_timeout(pcb);
573878ed226SJulian Elischer }
574878ed226SJulian Elischer
575878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
576f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
577878ed226SJulian Elischer
578878ed226SJulian Elischer return (0);
579878ed226SJulian Elischer } /* ng_btsocket_process_l2ca_con_rsp_rsp */
580878ed226SJulian Elischer
581878ed226SJulian Elischer /*
582878ed226SJulian Elischer * Process L2CA_Connect indicator. Find socket that listens on address
583878ed226SJulian Elischer * and PSM. Find exact or closest match. Create new socket and initiate
584878ed226SJulian Elischer * connection.
585878ed226SJulian Elischer */
586878ed226SJulian Elischer
587878ed226SJulian Elischer static int
ng_btsocket_l2cap_process_l2ca_con_ind(struct ng_mesg * msg,ng_btsocket_l2cap_rtentry_p rt)588878ed226SJulian Elischer ng_btsocket_l2cap_process_l2ca_con_ind(struct ng_mesg *msg,
5897c380856SMaksim Yevmenkin ng_btsocket_l2cap_rtentry_p rt)
590878ed226SJulian Elischer {
591878ed226SJulian Elischer ng_l2cap_l2ca_con_ind_ip *ip = NULL;
592878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = NULL, *pcb1 = NULL;
593878ed226SJulian Elischer int error = 0;
594878ed226SJulian Elischer u_int32_t token = 0;
595878ed226SJulian Elischer u_int16_t result = 0;
596878ed226SJulian Elischer
597878ed226SJulian Elischer if (msg->header.arglen != sizeof(*ip))
598878ed226SJulian Elischer return (EMSGSIZE);
599878ed226SJulian Elischer
600878ed226SJulian Elischer ip = (ng_l2cap_l2ca_con_ind_ip *)(msg->data);
601878ed226SJulian Elischer
602878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
603878ed226SJulian Elischer "%s: Got L2CA_Connect indicator, src bdaddr=%x:%x:%x:%x:%x:%x, " \
604878ed226SJulian Elischer "dst bdaddr=%x:%x:%x:%x:%x:%x, psm=%d, lcid=%d, ident=%d\n",
605878ed226SJulian Elischer __func__,
606878ed226SJulian Elischer rt->src.b[5], rt->src.b[4], rt->src.b[3],
607878ed226SJulian Elischer rt->src.b[2], rt->src.b[1], rt->src.b[0],
608878ed226SJulian Elischer ip->bdaddr.b[5], ip->bdaddr.b[4], ip->bdaddr.b[3],
609878ed226SJulian Elischer ip->bdaddr.b[2], ip->bdaddr.b[1], ip->bdaddr.b[0],
610878ed226SJulian Elischer ip->psm, ip->lcid, ip->ident);
611878ed226SJulian Elischer
612f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
613f2bb1caeSJulian Elischer
614878ed226SJulian Elischer pcb = ng_btsocket_l2cap_pcb_by_addr(&rt->src, ip->psm);
615878ed226SJulian Elischer if (pcb != NULL) {
616779f106aSGleb Smirnoff struct socket *so1;
617878ed226SJulian Elischer
618878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
619878ed226SJulian Elischer
6201fb51a12SBjoern A. Zeeb CURVNET_SET(pcb->so->so_vnet);
621878ed226SJulian Elischer so1 = sonewconn(pcb->so, 0);
6221fb51a12SBjoern A. Zeeb CURVNET_RESTORE();
623878ed226SJulian Elischer if (so1 == NULL) {
624878ed226SJulian Elischer result = NG_L2CAP_NO_RESOURCES;
625878ed226SJulian Elischer goto respond;
626878ed226SJulian Elischer }
627878ed226SJulian Elischer
628878ed226SJulian Elischer /*
629878ed226SJulian Elischer * If we got here than we have created new socket. So complete
630878ed226SJulian Elischer * connection. If we we listening on specific address then copy
631878ed226SJulian Elischer * source address from listening socket, otherwise copy source
632878ed226SJulian Elischer * address from hook's routing information.
633878ed226SJulian Elischer */
634878ed226SJulian Elischer
635878ed226SJulian Elischer pcb1 = so2l2cap_pcb(so1);
636878ed226SJulian Elischer KASSERT((pcb1 != NULL),
637878ed226SJulian Elischer ("%s: pcb1 == NULL\n", __func__));
638878ed226SJulian Elischer
639878ed226SJulian Elischer mtx_lock(&pcb1->pcb_mtx);
640878ed226SJulian Elischer
641878ed226SJulian Elischer if (bcmp(&pcb->src, NG_HCI_BDADDR_ANY, sizeof(pcb->src)) != 0)
642878ed226SJulian Elischer bcopy(&pcb->src, &pcb1->src, sizeof(pcb1->src));
643878ed226SJulian Elischer else
644878ed226SJulian Elischer bcopy(&rt->src, &pcb1->src, sizeof(pcb1->src));
645878ed226SJulian Elischer
646878ed226SJulian Elischer pcb1->flags &= ~NG_BTSOCKET_L2CAP_CLIENT;
647878ed226SJulian Elischer
648878ed226SJulian Elischer bcopy(&ip->bdaddr, &pcb1->dst, sizeof(pcb1->dst));
649878ed226SJulian Elischer pcb1->psm = ip->psm;
650878ed226SJulian Elischer pcb1->cid = ip->lcid;
651878ed226SJulian Elischer pcb1->rt = rt;
652878ed226SJulian Elischer
653878ed226SJulian Elischer /* Copy socket settings */
654878ed226SJulian Elischer pcb1->imtu = pcb->imtu;
655878ed226SJulian Elischer bcopy(&pcb->oflow, &pcb1->oflow, sizeof(pcb1->oflow));
656878ed226SJulian Elischer pcb1->flush_timo = pcb->flush_timo;
657878ed226SJulian Elischer
658878ed226SJulian Elischer token = pcb1->token;
659878ed226SJulian Elischer } else
660878ed226SJulian Elischer /* Nobody listens on requested BDADDR/PSM */
661878ed226SJulian Elischer result = NG_L2CAP_PSM_NOT_SUPPORTED;
662878ed226SJulian Elischer
663878ed226SJulian Elischer respond:
664878ed226SJulian Elischer error = ng_btsocket_l2cap_send_l2ca_con_rsp_req(token, rt,
665fbc48c2bSTakanori Watanabe &ip->bdaddr,
666fbc48c2bSTakanori Watanabe ip->ident, ip->lcid,
667fbc48c2bSTakanori Watanabe result,ip->linktype);
668878ed226SJulian Elischer if (pcb1 != NULL) {
669878ed226SJulian Elischer if (error != 0) {
670878ed226SJulian Elischer pcb1->so->so_error = error;
671878ed226SJulian Elischer pcb1->state = NG_BTSOCKET_L2CAP_CLOSED;
672878ed226SJulian Elischer soisdisconnected(pcb1->so);
673878ed226SJulian Elischer } else {
674878ed226SJulian Elischer pcb1->state = NG_BTSOCKET_L2CAP_CONNECTING;
675878ed226SJulian Elischer soisconnecting(pcb1->so);
676878ed226SJulian Elischer
677878ed226SJulian Elischer ng_btsocket_l2cap_timeout(pcb1);
678878ed226SJulian Elischer }
679878ed226SJulian Elischer
680878ed226SJulian Elischer mtx_unlock(&pcb1->pcb_mtx);
681878ed226SJulian Elischer }
682878ed226SJulian Elischer
683878ed226SJulian Elischer if (pcb != NULL)
684878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
685878ed226SJulian Elischer
686f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
687f2bb1caeSJulian Elischer
688878ed226SJulian Elischer return (error);
689878ed226SJulian Elischer } /* ng_btsocket_l2cap_process_l2ca_con_ind */
6903a601a23STakanori Watanabe /*Encryption Change*/
ng_btsocket_l2cap_process_l2ca_enc_change(struct ng_mesg * msg,ng_btsocket_l2cap_rtentry_p rt)6913a601a23STakanori Watanabe static int ng_btsocket_l2cap_process_l2ca_enc_change(struct ng_mesg *msg, ng_btsocket_l2cap_rtentry_p rt)
6923a601a23STakanori Watanabe {
6933a601a23STakanori Watanabe ng_l2cap_l2ca_enc_chg_op *op = NULL;
6943a601a23STakanori Watanabe ng_btsocket_l2cap_pcb_t *pcb = NULL;
695878ed226SJulian Elischer
6963a601a23STakanori Watanabe if (msg->header.arglen != sizeof(*op))
6973a601a23STakanori Watanabe return (EMSGSIZE);
6983a601a23STakanori Watanabe
6993a601a23STakanori Watanabe op = (ng_l2cap_l2ca_enc_chg_op *)(msg->data);
7003a601a23STakanori Watanabe
70174cc817dSMaksim Yevmenkin mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
70274cc817dSMaksim Yevmenkin
7033a601a23STakanori Watanabe pcb = ng_btsocket_l2cap_pcb_by_cid(&rt->src, op->lcid,
7043a601a23STakanori Watanabe op->idtype);
70574cc817dSMaksim Yevmenkin if (pcb == NULL) {
70674cc817dSMaksim Yevmenkin mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
70774cc817dSMaksim Yevmenkin return (ENOENT);
70874cc817dSMaksim Yevmenkin }
70974cc817dSMaksim Yevmenkin
7103a601a23STakanori Watanabe mtx_lock(&pcb->pcb_mtx);
7113a601a23STakanori Watanabe pcb->encryption = op->result;
7123a601a23STakanori Watanabe
7133a601a23STakanori Watanabe if(pcb->need_encrypt){
714483ed395STakanori Watanabe ng_btsocket_l2cap_untimeout(pcb);
7153a601a23STakanori Watanabe if(pcb->state != NG_BTSOCKET_L2CAP_W4_ENC_CHANGE){
7163a601a23STakanori Watanabe NG_BTSOCKET_L2CAP_WARN("%s: Invalid pcb status %d",
7173a601a23STakanori Watanabe __func__, pcb->state);
7183a601a23STakanori Watanabe }else if(pcb->encryption){
7193a601a23STakanori Watanabe pcb->state = NG_BTSOCKET_L2CAP_OPEN;
7203a601a23STakanori Watanabe soisconnected(pcb->so);
7213a601a23STakanori Watanabe }else{
7223a601a23STakanori Watanabe pcb->so->so_error = EPERM;
723483ed395STakanori Watanabe ng_btsocket_l2cap_send_l2ca_discon_req(0, pcb);
7243a601a23STakanori Watanabe pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
7253a601a23STakanori Watanabe soisdisconnected(pcb->so);
7263a601a23STakanori Watanabe }
7273a601a23STakanori Watanabe }
7283a601a23STakanori Watanabe mtx_unlock(&pcb->pcb_mtx);
72974cc817dSMaksim Yevmenkin mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
7303a601a23STakanori Watanabe
7313a601a23STakanori Watanabe return 0;
7323a601a23STakanori Watanabe }
733878ed226SJulian Elischer /*
734878ed226SJulian Elischer * Process L2CA_Config response
735878ed226SJulian Elischer */
736878ed226SJulian Elischer
737878ed226SJulian Elischer static int
ng_btsocket_l2cap_process_l2ca_cfg_req_rsp(struct ng_mesg * msg,ng_btsocket_l2cap_rtentry_p rt)738878ed226SJulian Elischer ng_btsocket_l2cap_process_l2ca_cfg_req_rsp(struct ng_mesg *msg,
7397c380856SMaksim Yevmenkin ng_btsocket_l2cap_rtentry_p rt)
740878ed226SJulian Elischer {
741878ed226SJulian Elischer ng_l2cap_l2ca_cfg_op *op = NULL;
742878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p pcb = NULL;
743878ed226SJulian Elischer
744878ed226SJulian Elischer if (msg->header.arglen != sizeof(*op))
745878ed226SJulian Elischer return (EMSGSIZE);
746878ed226SJulian Elischer
747878ed226SJulian Elischer op = (ng_l2cap_l2ca_cfg_op *)(msg->data);
748878ed226SJulian Elischer
749f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
750f2bb1caeSJulian Elischer
751878ed226SJulian Elischer /*
752878ed226SJulian Elischer * Socket must have issued a Configure request, so we must have a
753878ed226SJulian Elischer * socket that wants to be configured. Use Netgraph message token
754878ed226SJulian Elischer * to find it
755878ed226SJulian Elischer */
756878ed226SJulian Elischer
757878ed226SJulian Elischer pcb = ng_btsocket_l2cap_pcb_by_token(msg->header.token);
758878ed226SJulian Elischer if (pcb == NULL) {
759878ed226SJulian Elischer /*
760878ed226SJulian Elischer * XXX FIXME what to do here? We could not find a
761878ed226SJulian Elischer * socket with requested token. We even can not send
762878ed226SJulian Elischer * Disconnect, because we do not know channel ID
763878ed226SJulian Elischer */
764878ed226SJulian Elischer
765f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
766878ed226SJulian Elischer return (ENOENT);
767878ed226SJulian Elischer }
768878ed226SJulian Elischer
769878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
770878ed226SJulian Elischer
771878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
772878ed226SJulian Elischer "%s: Got L2CA_Config response, token=%d, src bdaddr=%x:%x:%x:%x:%x:%x, " \
773878ed226SJulian Elischer "dst bdaddr=%x:%x:%x:%x:%x:%x, psm=%d, lcid=%d, result=%d, state=%d, " \
774878ed226SJulian Elischer "cfg_state=%x\n",
775878ed226SJulian Elischer __func__, msg->header.token,
776878ed226SJulian Elischer pcb->src.b[5], pcb->src.b[4], pcb->src.b[3],
777878ed226SJulian Elischer pcb->src.b[2], pcb->src.b[1], pcb->src.b[0],
778878ed226SJulian Elischer pcb->dst.b[5], pcb->dst.b[4], pcb->dst.b[3],
779878ed226SJulian Elischer pcb->dst.b[2], pcb->dst.b[1], pcb->dst.b[0],
780878ed226SJulian Elischer pcb->psm, pcb->cid, op->result, pcb->state, pcb->cfg_state);
781878ed226SJulian Elischer
782878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_CONFIGURING) {
783878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
784f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
785f2bb1caeSJulian Elischer
786878ed226SJulian Elischer return (ENOENT);
787878ed226SJulian Elischer }
788878ed226SJulian Elischer
789878ed226SJulian Elischer if (op->result == NG_L2CAP_SUCCESS) {
790878ed226SJulian Elischer /*
791878ed226SJulian Elischer * XXX FIXME Actually set flush and link timeout.
792878ed226SJulian Elischer * Set QoS here if required. Resolve conficts (flush_timo).
793878ed226SJulian Elischer * Save incoming MTU (peer's outgoing MTU) and outgoing flow
794878ed226SJulian Elischer * spec.
795878ed226SJulian Elischer */
796878ed226SJulian Elischer
797878ed226SJulian Elischer pcb->imtu = op->imtu;
798878ed226SJulian Elischer bcopy(&op->oflow, &pcb->oflow, sizeof(pcb->oflow));
799878ed226SJulian Elischer pcb->flush_timo = op->flush_timo;
800878ed226SJulian Elischer
801878ed226SJulian Elischer /*
802878ed226SJulian Elischer * We have configured incoming side, so record it and check
803878ed226SJulian Elischer * if configuration is complete. If complete then mark socket
804878ed226SJulian Elischer * as connected, otherwise wait for the peer.
805878ed226SJulian Elischer */
806878ed226SJulian Elischer
807878ed226SJulian Elischer pcb->cfg_state &= ~NG_BTSOCKET_L2CAP_CFG_IN_SENT;
808878ed226SJulian Elischer pcb->cfg_state |= NG_BTSOCKET_L2CAP_CFG_IN;
809878ed226SJulian Elischer
810878ed226SJulian Elischer if (pcb->cfg_state == NG_BTSOCKET_L2CAP_CFG_BOTH) {
811878ed226SJulian Elischer /* Configuration complete - mark socket as open */
812878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
813878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_OPEN;
814878ed226SJulian Elischer soisconnected(pcb->so);
815878ed226SJulian Elischer }
816878ed226SJulian Elischer } else {
817878ed226SJulian Elischer /*
818878ed226SJulian Elischer * Something went wrong. Could be unacceptable parameters,
819878ed226SJulian Elischer * reject or unknown option. That's too bad, but we will
820878ed226SJulian Elischer * not negotiate. Send Disconnect and close the channel.
821878ed226SJulian Elischer */
822878ed226SJulian Elischer
823878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
824878ed226SJulian Elischer
825878ed226SJulian Elischer switch (op->result) {
826878ed226SJulian Elischer case NG_L2CAP_UNACCEPTABLE_PARAMS:
827878ed226SJulian Elischer case NG_L2CAP_UNKNOWN_OPTION:
828878ed226SJulian Elischer pcb->so->so_error = EINVAL;
829878ed226SJulian Elischer break;
830878ed226SJulian Elischer
831878ed226SJulian Elischer default:
832878ed226SJulian Elischer pcb->so->so_error = ECONNRESET;
833878ed226SJulian Elischer break;
834878ed226SJulian Elischer }
835878ed226SJulian Elischer
836878ed226SJulian Elischer /* Send disconnect with "zero" token */
837878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_discon_req(0, pcb);
838878ed226SJulian Elischer
839878ed226SJulian Elischer /* ... and close the socket */
840878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
841878ed226SJulian Elischer soisdisconnected(pcb->so);
842878ed226SJulian Elischer }
843878ed226SJulian Elischer
844878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
845f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
846878ed226SJulian Elischer
847878ed226SJulian Elischer return (0);
848878ed226SJulian Elischer } /* ng_btsocket_l2cap_process_l2ca_cfg_req_rsp */
849878ed226SJulian Elischer
850878ed226SJulian Elischer /*
851878ed226SJulian Elischer * Process L2CA_ConfigRsp response
852878ed226SJulian Elischer */
853878ed226SJulian Elischer
854878ed226SJulian Elischer static int
ng_btsocket_l2cap_process_l2ca_cfg_rsp_rsp(struct ng_mesg * msg,ng_btsocket_l2cap_rtentry_p rt)855878ed226SJulian Elischer ng_btsocket_l2cap_process_l2ca_cfg_rsp_rsp(struct ng_mesg *msg,
8567c380856SMaksim Yevmenkin ng_btsocket_l2cap_rtentry_p rt)
857878ed226SJulian Elischer {
858878ed226SJulian Elischer ng_l2cap_l2ca_cfg_rsp_op *op = NULL;
859878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = NULL;
860878ed226SJulian Elischer int error = 0;
861878ed226SJulian Elischer
862878ed226SJulian Elischer if (msg->header.arglen != sizeof(*op))
863878ed226SJulian Elischer return (EMSGSIZE);
864878ed226SJulian Elischer
865878ed226SJulian Elischer op = (ng_l2cap_l2ca_cfg_rsp_op *)(msg->data);
866878ed226SJulian Elischer
867f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
868f2bb1caeSJulian Elischer
869878ed226SJulian Elischer /* Look for the socket with the token */
870878ed226SJulian Elischer pcb = ng_btsocket_l2cap_pcb_by_token(msg->header.token);
871f2bb1caeSJulian Elischer if (pcb == NULL) {
872f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
873878ed226SJulian Elischer return (ENOENT);
874f2bb1caeSJulian Elischer }
875878ed226SJulian Elischer
876878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
877878ed226SJulian Elischer
878878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
879878ed226SJulian Elischer "%s: Got L2CA_ConfigRsp response, token=%d, src bdaddr=%x:%x:%x:%x:%x:%x, " \
880878ed226SJulian Elischer "dst bdaddr=%x:%x:%x:%x:%x:%x, psm=%d, lcid=%d, result=%d, state=%d, " \
881878ed226SJulian Elischer "cfg_state=%x\n",
882878ed226SJulian Elischer __func__, msg->header.token,
883878ed226SJulian Elischer pcb->src.b[5], pcb->src.b[4], pcb->src.b[3],
884878ed226SJulian Elischer pcb->src.b[2], pcb->src.b[1], pcb->src.b[0],
885878ed226SJulian Elischer pcb->dst.b[5], pcb->dst.b[4], pcb->dst.b[3],
886878ed226SJulian Elischer pcb->dst.b[2], pcb->dst.b[1], pcb->dst.b[0],
887878ed226SJulian Elischer pcb->psm, pcb->cid, op->result, pcb->state, pcb->cfg_state);
888878ed226SJulian Elischer
889878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_CONFIGURING) {
890878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
891f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
892f2bb1caeSJulian Elischer
893878ed226SJulian Elischer return (ENOENT);
894878ed226SJulian Elischer }
895878ed226SJulian Elischer
896878ed226SJulian Elischer /* Check the result and disconnect socket of failure */
897878ed226SJulian Elischer if (op->result != NG_L2CAP_SUCCESS)
898878ed226SJulian Elischer goto disconnect;
899878ed226SJulian Elischer
900878ed226SJulian Elischer /*
901878ed226SJulian Elischer * Now we done with remote side configuration. Configure local
902878ed226SJulian Elischer * side if we have not done it yet.
903878ed226SJulian Elischer */
904878ed226SJulian Elischer
905878ed226SJulian Elischer pcb->cfg_state &= ~NG_BTSOCKET_L2CAP_CFG_OUT_SENT;
906878ed226SJulian Elischer pcb->cfg_state |= NG_BTSOCKET_L2CAP_CFG_OUT;
907878ed226SJulian Elischer
908878ed226SJulian Elischer if (pcb->cfg_state == NG_BTSOCKET_L2CAP_CFG_BOTH) {
909878ed226SJulian Elischer /* Configuration complete - mask socket as open */
910878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
911878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_OPEN;
912878ed226SJulian Elischer soisconnected(pcb->so);
913878ed226SJulian Elischer } else {
914878ed226SJulian Elischer if (!(pcb->cfg_state & NG_BTSOCKET_L2CAP_CFG_IN_SENT)) {
915878ed226SJulian Elischer /* Send L2CA_Config request - incoming path */
916878ed226SJulian Elischer error = ng_btsocket_l2cap_send_l2ca_cfg_req(pcb);
917878ed226SJulian Elischer if (error != 0)
918878ed226SJulian Elischer goto disconnect;
919878ed226SJulian Elischer
920878ed226SJulian Elischer pcb->cfg_state |= NG_BTSOCKET_L2CAP_CFG_IN_SENT;
921878ed226SJulian Elischer }
922878ed226SJulian Elischer }
923878ed226SJulian Elischer
924878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
925f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
926878ed226SJulian Elischer
927878ed226SJulian Elischer return (error);
928878ed226SJulian Elischer
929878ed226SJulian Elischer disconnect:
930878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
931878ed226SJulian Elischer
932878ed226SJulian Elischer /* Send disconnect with "zero" token */
933878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_discon_req(0, pcb);
934878ed226SJulian Elischer
935878ed226SJulian Elischer /* ... and close the socket */
936878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
937878ed226SJulian Elischer soisdisconnected(pcb->so);
938878ed226SJulian Elischer
939878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
940f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
941878ed226SJulian Elischer
942878ed226SJulian Elischer return (error);
943878ed226SJulian Elischer } /* ng_btsocket_l2cap_process_l2ca_cfg_rsp_rsp */
944878ed226SJulian Elischer
945878ed226SJulian Elischer /*
946878ed226SJulian Elischer * Process L2CA_Config indicator
947878ed226SJulian Elischer */
948878ed226SJulian Elischer
949878ed226SJulian Elischer static int
ng_btsocket_l2cap_process_l2ca_cfg_ind(struct ng_mesg * msg,ng_btsocket_l2cap_rtentry_p rt)950878ed226SJulian Elischer ng_btsocket_l2cap_process_l2ca_cfg_ind(struct ng_mesg *msg,
9517c380856SMaksim Yevmenkin ng_btsocket_l2cap_rtentry_p rt)
952878ed226SJulian Elischer {
953878ed226SJulian Elischer ng_l2cap_l2ca_cfg_ind_ip *ip = NULL;
954878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = NULL;
955878ed226SJulian Elischer int error = 0;
956878ed226SJulian Elischer
957878ed226SJulian Elischer if (msg->header.arglen != sizeof(*ip))
958878ed226SJulian Elischer return (EMSGSIZE);
959878ed226SJulian Elischer
960878ed226SJulian Elischer ip = (ng_l2cap_l2ca_cfg_ind_ip *)(msg->data);
961878ed226SJulian Elischer
962f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
963f2bb1caeSJulian Elischer
964878ed226SJulian Elischer /* Check for the open socket that has given channel ID */
965fbc48c2bSTakanori Watanabe pcb = ng_btsocket_l2cap_pcb_by_cid(&rt->src, ip->lcid,
966fbc48c2bSTakanori Watanabe NG_L2CAP_L2CA_IDTYPE_BREDR);
967f2bb1caeSJulian Elischer if (pcb == NULL) {
968f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
969878ed226SJulian Elischer return (ENOENT);
970f2bb1caeSJulian Elischer }
971878ed226SJulian Elischer
972878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
973878ed226SJulian Elischer
974878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
975878ed226SJulian Elischer "%s: Got L2CA_Config indicator, src bdaddr=%x:%x:%x:%x:%x:%x, " \
976878ed226SJulian Elischer "dst bdaddr=%x:%x:%x:%x:%x:%x, psm=%d, lcid=%d, state=%d, cfg_state=%x\n",
977878ed226SJulian Elischer __func__,
978878ed226SJulian Elischer pcb->src.b[5], pcb->src.b[4], pcb->src.b[3],
979878ed226SJulian Elischer pcb->src.b[2], pcb->src.b[1], pcb->src.b[0],
980878ed226SJulian Elischer pcb->dst.b[5], pcb->dst.b[4], pcb->dst.b[3],
981878ed226SJulian Elischer pcb->dst.b[2], pcb->dst.b[1], pcb->dst.b[0],
982878ed226SJulian Elischer pcb->psm, pcb->cid, pcb->state, pcb->cfg_state);
983878ed226SJulian Elischer
984878ed226SJulian Elischer /* XXX FIXME re-configuration on open socket */
985878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_CONFIGURING) {
986878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
987f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
988f2bb1caeSJulian Elischer
989878ed226SJulian Elischer return (ENOENT);
990878ed226SJulian Elischer }
991878ed226SJulian Elischer
992878ed226SJulian Elischer /*
993878ed226SJulian Elischer * XXX FIXME Actually set flush and link timeout. Set QoS here if
994878ed226SJulian Elischer * required. Resolve conficts (flush_timo). Note outgoing MTU (peer's
995878ed226SJulian Elischer * incoming MTU) and incoming flow spec.
996878ed226SJulian Elischer */
997878ed226SJulian Elischer
998878ed226SJulian Elischer pcb->omtu = ip->omtu;
999878ed226SJulian Elischer bcopy(&ip->iflow, &pcb->iflow, sizeof(pcb->iflow));
1000878ed226SJulian Elischer pcb->flush_timo = ip->flush_timo;
1001878ed226SJulian Elischer
1002878ed226SJulian Elischer /*
1003878ed226SJulian Elischer * Send L2CA_Config response to our peer and check for the errors,
1004878ed226SJulian Elischer * if any send disconnect to close the channel.
1005878ed226SJulian Elischer */
1006878ed226SJulian Elischer
1007878ed226SJulian Elischer if (!(pcb->cfg_state & NG_BTSOCKET_L2CAP_CFG_OUT_SENT)) {
1008878ed226SJulian Elischer error = ng_btsocket_l2cap_send_l2ca_cfg_rsp(pcb);
1009878ed226SJulian Elischer if (error != 0) {
1010878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
1011878ed226SJulian Elischer
1012878ed226SJulian Elischer pcb->so->so_error = error;
1013878ed226SJulian Elischer
1014878ed226SJulian Elischer /* Send disconnect with "zero" token */
1015878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_discon_req(0, pcb);
1016878ed226SJulian Elischer
1017878ed226SJulian Elischer /* ... and close the socket */
1018878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
1019878ed226SJulian Elischer soisdisconnected(pcb->so);
1020f2bb1caeSJulian Elischer } else
1021f2bb1caeSJulian Elischer pcb->cfg_state |= NG_BTSOCKET_L2CAP_CFG_OUT_SENT;
1022878ed226SJulian Elischer }
1023878ed226SJulian Elischer
1024878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1025f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1026878ed226SJulian Elischer
1027878ed226SJulian Elischer return (error);
1028878ed226SJulian Elischer } /* ng_btsocket_l2cap_process_l2cap_cfg_ind */
1029878ed226SJulian Elischer
1030878ed226SJulian Elischer /*
1031878ed226SJulian Elischer * Process L2CA_Disconnect response
1032878ed226SJulian Elischer */
1033878ed226SJulian Elischer
1034878ed226SJulian Elischer static int
ng_btsocket_l2cap_process_l2ca_discon_rsp(struct ng_mesg * msg,ng_btsocket_l2cap_rtentry_p rt)1035878ed226SJulian Elischer ng_btsocket_l2cap_process_l2ca_discon_rsp(struct ng_mesg *msg,
10367c380856SMaksim Yevmenkin ng_btsocket_l2cap_rtentry_p rt)
1037878ed226SJulian Elischer {
1038878ed226SJulian Elischer ng_l2cap_l2ca_discon_op *op = NULL;
1039878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = NULL;
1040878ed226SJulian Elischer
1041878ed226SJulian Elischer /* Check message */
1042878ed226SJulian Elischer if (msg->header.arglen != sizeof(*op))
1043878ed226SJulian Elischer return (EMSGSIZE);
1044878ed226SJulian Elischer
1045878ed226SJulian Elischer op = (ng_l2cap_l2ca_discon_op *)(msg->data);
1046878ed226SJulian Elischer
1047f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
1048f2bb1caeSJulian Elischer
1049878ed226SJulian Elischer /*
1050878ed226SJulian Elischer * Socket layer must have issued L2CA_Disconnect request, so there
1051878ed226SJulian Elischer * must be a socket that wants to be disconnected. Use Netgraph
1052878ed226SJulian Elischer * message token to find it.
1053878ed226SJulian Elischer */
1054878ed226SJulian Elischer
1055878ed226SJulian Elischer pcb = ng_btsocket_l2cap_pcb_by_token(msg->header.token);
1056f2bb1caeSJulian Elischer if (pcb == NULL) {
1057f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1058878ed226SJulian Elischer return (0);
1059f2bb1caeSJulian Elischer }
1060878ed226SJulian Elischer
1061878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
1062878ed226SJulian Elischer
1063878ed226SJulian Elischer /* XXX Close socket no matter what op->result says */
1064878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_CLOSED) {
1065878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
1066878ed226SJulian Elischer "%s: Got L2CA_Disconnect response, token=%d, src bdaddr=%x:%x:%x:%x:%x:%x, " \
1067878ed226SJulian Elischer "dst bdaddr=%x:%x:%x:%x:%x:%x, psm=%d, lcid=%d, result=%d, state=%d\n",
1068878ed226SJulian Elischer __func__, msg->header.token,
1069878ed226SJulian Elischer pcb->src.b[5], pcb->src.b[4], pcb->src.b[3],
1070878ed226SJulian Elischer pcb->src.b[2], pcb->src.b[1], pcb->src.b[0],
1071878ed226SJulian Elischer pcb->dst.b[5], pcb->dst.b[4], pcb->dst.b[3],
1072878ed226SJulian Elischer pcb->dst.b[2], pcb->dst.b[1], pcb->dst.b[0],
1073878ed226SJulian Elischer pcb->psm, pcb->cid, op->result, pcb->state);
1074878ed226SJulian Elischer
1075878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
1076878ed226SJulian Elischer
1077878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
1078878ed226SJulian Elischer soisdisconnected(pcb->so);
1079878ed226SJulian Elischer }
1080878ed226SJulian Elischer
1081878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1082f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1083878ed226SJulian Elischer
1084878ed226SJulian Elischer return (0);
1085878ed226SJulian Elischer } /* ng_btsocket_l2cap_process_l2ca_discon_rsp */
1086878ed226SJulian Elischer
1087878ed226SJulian Elischer /*
1088878ed226SJulian Elischer * Process L2CA_Disconnect indicator
1089878ed226SJulian Elischer */
1090878ed226SJulian Elischer
1091878ed226SJulian Elischer static int
ng_btsocket_l2cap_process_l2ca_discon_ind(struct ng_mesg * msg,ng_btsocket_l2cap_rtentry_p rt)1092878ed226SJulian Elischer ng_btsocket_l2cap_process_l2ca_discon_ind(struct ng_mesg *msg,
10937c380856SMaksim Yevmenkin ng_btsocket_l2cap_rtentry_p rt)
1094878ed226SJulian Elischer {
1095878ed226SJulian Elischer ng_l2cap_l2ca_discon_ind_ip *ip = NULL;
1096878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = NULL;
1097878ed226SJulian Elischer
1098878ed226SJulian Elischer /* Check message */
1099878ed226SJulian Elischer if (msg->header.arglen != sizeof(*ip))
1100878ed226SJulian Elischer return (EMSGSIZE);
1101878ed226SJulian Elischer
1102878ed226SJulian Elischer ip = (ng_l2cap_l2ca_discon_ind_ip *)(msg->data);
1103878ed226SJulian Elischer
1104f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
1105f2bb1caeSJulian Elischer
1106878ed226SJulian Elischer /* Look for the socket with given channel ID */
1107fbc48c2bSTakanori Watanabe pcb = ng_btsocket_l2cap_pcb_by_cid(&rt->src, ip->lcid,
1108b32073c4STakanori Watanabe ip->idtype);
1109f2bb1caeSJulian Elischer if (pcb == NULL) {
1110f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1111878ed226SJulian Elischer return (0);
1112f2bb1caeSJulian Elischer }
1113878ed226SJulian Elischer
1114878ed226SJulian Elischer /*
1115878ed226SJulian Elischer * Channel has already been destroyed, so disconnect the socket
1116878ed226SJulian Elischer * and be done with it. If there was any pending request we can
1117878ed226SJulian Elischer * not do anything here anyway.
1118878ed226SJulian Elischer */
1119878ed226SJulian Elischer
1120878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
1121878ed226SJulian Elischer
1122878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
1123878ed226SJulian Elischer "%s: Got L2CA_Disconnect indicator, src bdaddr=%x:%x:%x:%x:%x:%x, " \
1124878ed226SJulian Elischer "dst bdaddr=%x:%x:%x:%x:%x:%x, psm=%d, lcid=%d, state=%d\n",
1125878ed226SJulian Elischer __func__,
1126878ed226SJulian Elischer pcb->src.b[5], pcb->src.b[4], pcb->src.b[3],
1127878ed226SJulian Elischer pcb->src.b[2], pcb->src.b[1], pcb->src.b[0],
1128878ed226SJulian Elischer pcb->dst.b[5], pcb->dst.b[4], pcb->dst.b[3],
1129878ed226SJulian Elischer pcb->dst.b[2], pcb->dst.b[1], pcb->dst.b[0],
1130878ed226SJulian Elischer pcb->psm, pcb->cid, pcb->state);
1131878ed226SJulian Elischer
1132878ed226SJulian Elischer if (pcb->flags & NG_BTSOCKET_L2CAP_TIMO)
1133878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
1134878ed226SJulian Elischer
1135878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
1136878ed226SJulian Elischer soisdisconnected(pcb->so);
1137878ed226SJulian Elischer
1138878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1139f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1140878ed226SJulian Elischer
1141878ed226SJulian Elischer return (0);
1142878ed226SJulian Elischer } /* ng_btsocket_l2cap_process_l2ca_discon_ind */
1143878ed226SJulian Elischer
1144878ed226SJulian Elischer /*
1145878ed226SJulian Elischer * Process L2CA_Write response
1146878ed226SJulian Elischer */
1147878ed226SJulian Elischer
1148878ed226SJulian Elischer static int
ng_btsocket_l2cap_process_l2ca_write_rsp(struct ng_mesg * msg,ng_btsocket_l2cap_rtentry_p rt)1149878ed226SJulian Elischer ng_btsocket_l2cap_process_l2ca_write_rsp(struct ng_mesg *msg,
11507c380856SMaksim Yevmenkin ng_btsocket_l2cap_rtentry_p rt)
1151878ed226SJulian Elischer {
1152878ed226SJulian Elischer ng_l2cap_l2ca_write_op *op = NULL;
1153878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = NULL;
1154878ed226SJulian Elischer
1155878ed226SJulian Elischer /* Check message */
1156878ed226SJulian Elischer if (msg->header.arglen != sizeof(*op))
1157878ed226SJulian Elischer return (EMSGSIZE);
1158878ed226SJulian Elischer
1159878ed226SJulian Elischer op = (ng_l2cap_l2ca_write_op *)(msg->data);
1160878ed226SJulian Elischer
1161f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
1162f2bb1caeSJulian Elischer
1163878ed226SJulian Elischer /* Look for the socket with given token */
1164878ed226SJulian Elischer pcb = ng_btsocket_l2cap_pcb_by_token(msg->header.token);
1165f2bb1caeSJulian Elischer if (pcb == NULL) {
1166f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1167878ed226SJulian Elischer return (ENOENT);
1168f2bb1caeSJulian Elischer }
1169878ed226SJulian Elischer
1170878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
1171878ed226SJulian Elischer
1172878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
1173878ed226SJulian Elischer "%s: Got L2CA_Write response, src bdaddr=%x:%x:%x:%x:%x:%x, " \
1174878ed226SJulian Elischer "dst bdaddr=%x:%x:%x:%x:%x:%x, psm=%d, lcid=%d, result=%d, length=%d, " \
1175878ed226SJulian Elischer "state=%d\n", __func__,
1176878ed226SJulian Elischer pcb->src.b[5], pcb->src.b[4], pcb->src.b[3],
1177878ed226SJulian Elischer pcb->src.b[2], pcb->src.b[1], pcb->src.b[0],
1178878ed226SJulian Elischer pcb->dst.b[5], pcb->dst.b[4], pcb->dst.b[3],
1179878ed226SJulian Elischer pcb->dst.b[2], pcb->dst.b[1], pcb->dst.b[0],
1180878ed226SJulian Elischer pcb->psm, pcb->cid, op->result, op->length,
1181878ed226SJulian Elischer pcb->state);
1182878ed226SJulian Elischer
1183878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_OPEN) {
1184878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1185f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1186f2bb1caeSJulian Elischer
1187878ed226SJulian Elischer return (ENOENT);
1188878ed226SJulian Elischer }
1189878ed226SJulian Elischer
1190878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
1191878ed226SJulian Elischer
1192878ed226SJulian Elischer /*
1193878ed226SJulian Elischer * Check if we have more data to send
1194878ed226SJulian Elischer */
1195878ed226SJulian Elischer sbdroprecord(&pcb->so->so_snd);
1196cfa6009eSGleb Smirnoff if (sbavail(&pcb->so->so_snd) > 0) {
1197878ed226SJulian Elischer if (ng_btsocket_l2cap_send2(pcb) == 0)
1198878ed226SJulian Elischer ng_btsocket_l2cap_timeout(pcb);
1199878ed226SJulian Elischer else
1200878ed226SJulian Elischer sbdroprecord(&pcb->so->so_snd); /* XXX */
1201878ed226SJulian Elischer }
1202878ed226SJulian Elischer
1203878ed226SJulian Elischer /*
1204878ed226SJulian Elischer * Now set the result, drop packet from the socket send queue and
1205878ed226SJulian Elischer * ask for more (wakeup sender)
1206878ed226SJulian Elischer */
1207878ed226SJulian Elischer
1208878ed226SJulian Elischer pcb->so->so_error = ng_btsocket_l2cap_result2errno(op->result);
1209878ed226SJulian Elischer sowwakeup(pcb->so);
1210878ed226SJulian Elischer
1211878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1212f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1213878ed226SJulian Elischer
1214878ed226SJulian Elischer return (0);
1215878ed226SJulian Elischer } /* ng_btsocket_l2cap_process_l2ca_write_rsp */
1216878ed226SJulian Elischer
1217878ed226SJulian Elischer /*
1218878ed226SJulian Elischer * Send L2CA_Connect request
1219878ed226SJulian Elischer */
1220878ed226SJulian Elischer
1221878ed226SJulian Elischer static int
ng_btsocket_l2cap_send_l2ca_con_req(ng_btsocket_l2cap_pcb_p pcb)1222878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_con_req(ng_btsocket_l2cap_pcb_p pcb)
1223878ed226SJulian Elischer {
1224878ed226SJulian Elischer struct ng_mesg *msg = NULL;
1225878ed226SJulian Elischer ng_l2cap_l2ca_con_ip *ip = NULL;
1226878ed226SJulian Elischer int error = 0;
1227878ed226SJulian Elischer
1228878ed226SJulian Elischer mtx_assert(&pcb->pcb_mtx, MA_OWNED);
1229878ed226SJulian Elischer
1230878ed226SJulian Elischer if (pcb->rt == NULL ||
1231878ed226SJulian Elischer pcb->rt->hook == NULL || NG_HOOK_NOT_VALID(pcb->rt->hook))
1232878ed226SJulian Elischer return (ENETDOWN);
1233878ed226SJulian Elischer
1234878ed226SJulian Elischer NG_MKMESSAGE(msg, NGM_L2CAP_COOKIE, NGM_L2CAP_L2CA_CON,
1235878ed226SJulian Elischer sizeof(*ip), M_NOWAIT);
1236878ed226SJulian Elischer if (msg == NULL)
1237878ed226SJulian Elischer return (ENOMEM);
1238878ed226SJulian Elischer
1239878ed226SJulian Elischer msg->header.token = pcb->token;
1240878ed226SJulian Elischer
1241878ed226SJulian Elischer ip = (ng_l2cap_l2ca_con_ip *)(msg->data);
1242878ed226SJulian Elischer bcopy(&pcb->dst, &ip->bdaddr, sizeof(ip->bdaddr));
1243878ed226SJulian Elischer ip->psm = pcb->psm;
1244fbc48c2bSTakanori Watanabe ip->linktype = ng_btsock_l2cap_addrtype_to_linktype(pcb->dsttype);
12453a601a23STakanori Watanabe ip->idtype = pcb->idtype;
1246b9fe2d6cSAlfred Perlstein NG_SEND_MSG_HOOK(error, ng_btsocket_l2cap_node, msg,pcb->rt->hook, 0);
1247878ed226SJulian Elischer
1248878ed226SJulian Elischer return (error);
1249878ed226SJulian Elischer } /* ng_btsocket_l2cap_send_l2ca_con_req */
1250878ed226SJulian Elischer
1251878ed226SJulian Elischer /*
1252878ed226SJulian Elischer * Send L2CA_Connect response
1253878ed226SJulian Elischer */
1254878ed226SJulian Elischer
1255878ed226SJulian Elischer static int
ng_btsocket_l2cap_send_l2ca_con_rsp_req(u_int32_t token,ng_btsocket_l2cap_rtentry_p rt,bdaddr_p dst,int ident,int lcid,int result,int linktype)1256878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_con_rsp_req(u_int32_t token,
1257878ed226SJulian Elischer ng_btsocket_l2cap_rtentry_p rt, bdaddr_p dst, int ident,
1258fbc48c2bSTakanori Watanabe int lcid, int result, int linktype)
1259878ed226SJulian Elischer {
1260878ed226SJulian Elischer struct ng_mesg *msg = NULL;
1261878ed226SJulian Elischer ng_l2cap_l2ca_con_rsp_ip *ip = NULL;
1262878ed226SJulian Elischer int error = 0;
1263878ed226SJulian Elischer
1264878ed226SJulian Elischer if (rt == NULL || rt->hook == NULL || NG_HOOK_NOT_VALID(rt->hook))
1265878ed226SJulian Elischer return (ENETDOWN);
1266878ed226SJulian Elischer
1267878ed226SJulian Elischer NG_MKMESSAGE(msg, NGM_L2CAP_COOKIE, NGM_L2CAP_L2CA_CON_RSP,
1268878ed226SJulian Elischer sizeof(*ip), M_NOWAIT);
1269878ed226SJulian Elischer if (msg == NULL)
1270878ed226SJulian Elischer return (ENOMEM);
1271878ed226SJulian Elischer
1272878ed226SJulian Elischer msg->header.token = token;
1273878ed226SJulian Elischer
1274878ed226SJulian Elischer ip = (ng_l2cap_l2ca_con_rsp_ip *)(msg->data);
1275878ed226SJulian Elischer bcopy(dst, &ip->bdaddr, sizeof(ip->bdaddr));
1276878ed226SJulian Elischer ip->ident = ident;
1277878ed226SJulian Elischer ip->lcid = lcid;
1278fbc48c2bSTakanori Watanabe ip->linktype = linktype;
1279878ed226SJulian Elischer ip->result = result;
1280878ed226SJulian Elischer ip->status = 0;
1281878ed226SJulian Elischer
1282b9fe2d6cSAlfred Perlstein NG_SEND_MSG_HOOK(error, ng_btsocket_l2cap_node, msg, rt->hook, 0);
1283878ed226SJulian Elischer
1284878ed226SJulian Elischer return (error);
1285878ed226SJulian Elischer } /* ng_btsocket_l2cap_send_l2ca_con_rsp_req */
1286878ed226SJulian Elischer
1287878ed226SJulian Elischer /*
1288878ed226SJulian Elischer * Send L2CA_Config request
1289878ed226SJulian Elischer */
1290878ed226SJulian Elischer
1291878ed226SJulian Elischer static int
ng_btsocket_l2cap_send_l2ca_cfg_req(ng_btsocket_l2cap_pcb_p pcb)1292878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_cfg_req(ng_btsocket_l2cap_pcb_p pcb)
1293878ed226SJulian Elischer {
1294878ed226SJulian Elischer struct ng_mesg *msg = NULL;
1295878ed226SJulian Elischer ng_l2cap_l2ca_cfg_ip *ip = NULL;
1296878ed226SJulian Elischer int error = 0;
1297878ed226SJulian Elischer
1298878ed226SJulian Elischer mtx_assert(&pcb->pcb_mtx, MA_OWNED);
1299878ed226SJulian Elischer
1300878ed226SJulian Elischer if (pcb->rt == NULL ||
1301878ed226SJulian Elischer pcb->rt->hook == NULL || NG_HOOK_NOT_VALID(pcb->rt->hook))
1302878ed226SJulian Elischer return (ENETDOWN);
1303878ed226SJulian Elischer
1304878ed226SJulian Elischer NG_MKMESSAGE(msg, NGM_L2CAP_COOKIE, NGM_L2CAP_L2CA_CFG,
1305878ed226SJulian Elischer sizeof(*ip), M_NOWAIT);
1306878ed226SJulian Elischer if (msg == NULL)
1307878ed226SJulian Elischer return (ENOMEM);
1308878ed226SJulian Elischer
1309878ed226SJulian Elischer msg->header.token = pcb->token;
1310878ed226SJulian Elischer
1311878ed226SJulian Elischer ip = (ng_l2cap_l2ca_cfg_ip *)(msg->data);
1312878ed226SJulian Elischer ip->lcid = pcb->cid;
1313878ed226SJulian Elischer ip->imtu = pcb->imtu;
1314878ed226SJulian Elischer bcopy(&pcb->oflow, &ip->oflow, sizeof(ip->oflow));
1315878ed226SJulian Elischer ip->flush_timo = pcb->flush_timo;
1316878ed226SJulian Elischer ip->link_timo = pcb->link_timo;
1317878ed226SJulian Elischer
1318b9fe2d6cSAlfred Perlstein NG_SEND_MSG_HOOK(error, ng_btsocket_l2cap_node, msg,pcb->rt->hook, 0);
1319878ed226SJulian Elischer
1320878ed226SJulian Elischer return (error);
1321878ed226SJulian Elischer } /* ng_btsocket_l2cap_send_l2ca_cfg_req */
1322878ed226SJulian Elischer
1323878ed226SJulian Elischer /*
1324878ed226SJulian Elischer * Send L2CA_Config response
1325878ed226SJulian Elischer */
1326878ed226SJulian Elischer
1327878ed226SJulian Elischer static int
ng_btsocket_l2cap_send_l2ca_cfg_rsp(ng_btsocket_l2cap_pcb_p pcb)1328878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_cfg_rsp(ng_btsocket_l2cap_pcb_p pcb)
1329878ed226SJulian Elischer {
1330878ed226SJulian Elischer struct ng_mesg *msg = NULL;
1331878ed226SJulian Elischer ng_l2cap_l2ca_cfg_rsp_ip *ip = NULL;
1332878ed226SJulian Elischer int error = 0;
1333878ed226SJulian Elischer
1334878ed226SJulian Elischer mtx_assert(&pcb->pcb_mtx, MA_OWNED);
1335878ed226SJulian Elischer
1336878ed226SJulian Elischer if (pcb->rt == NULL ||
1337878ed226SJulian Elischer pcb->rt->hook == NULL || NG_HOOK_NOT_VALID(pcb->rt->hook))
1338878ed226SJulian Elischer return (ENETDOWN);
1339878ed226SJulian Elischer
1340878ed226SJulian Elischer NG_MKMESSAGE(msg, NGM_L2CAP_COOKIE, NGM_L2CAP_L2CA_CFG_RSP,
1341878ed226SJulian Elischer sizeof(*ip), M_NOWAIT);
1342878ed226SJulian Elischer if (msg == NULL)
1343878ed226SJulian Elischer return (ENOMEM);
1344878ed226SJulian Elischer
1345878ed226SJulian Elischer msg->header.token = pcb->token;
1346878ed226SJulian Elischer
1347878ed226SJulian Elischer ip = (ng_l2cap_l2ca_cfg_rsp_ip *)(msg->data);
1348878ed226SJulian Elischer ip->lcid = pcb->cid;
1349878ed226SJulian Elischer ip->omtu = pcb->omtu;
1350878ed226SJulian Elischer bcopy(&pcb->iflow, &ip->iflow, sizeof(ip->iflow));
1351878ed226SJulian Elischer
1352b9fe2d6cSAlfred Perlstein NG_SEND_MSG_HOOK(error, ng_btsocket_l2cap_node, msg, pcb->rt->hook, 0);
1353878ed226SJulian Elischer
1354878ed226SJulian Elischer return (error);
1355878ed226SJulian Elischer } /* ng_btsocket_l2cap_send_l2ca_cfg_rsp */
1356878ed226SJulian Elischer
1357878ed226SJulian Elischer /*
1358878ed226SJulian Elischer * Send L2CA_Disconnect request
1359878ed226SJulian Elischer */
1360878ed226SJulian Elischer
1361878ed226SJulian Elischer static int
ng_btsocket_l2cap_send_l2ca_discon_req(u_int32_t token,ng_btsocket_l2cap_pcb_p pcb)1362878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_discon_req(u_int32_t token,
1363878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p pcb)
1364878ed226SJulian Elischer {
1365878ed226SJulian Elischer struct ng_mesg *msg = NULL;
1366878ed226SJulian Elischer ng_l2cap_l2ca_discon_ip *ip = NULL;
1367878ed226SJulian Elischer int error = 0;
1368878ed226SJulian Elischer
1369878ed226SJulian Elischer mtx_assert(&pcb->pcb_mtx, MA_OWNED);
1370878ed226SJulian Elischer
1371878ed226SJulian Elischer if (pcb->rt == NULL ||
1372878ed226SJulian Elischer pcb->rt->hook == NULL || NG_HOOK_NOT_VALID(pcb->rt->hook))
1373878ed226SJulian Elischer return (ENETDOWN);
1374878ed226SJulian Elischer
1375878ed226SJulian Elischer NG_MKMESSAGE(msg, NGM_L2CAP_COOKIE, NGM_L2CAP_L2CA_DISCON,
1376878ed226SJulian Elischer sizeof(*ip), M_NOWAIT);
1377878ed226SJulian Elischer if (msg == NULL)
1378878ed226SJulian Elischer return (ENOMEM);
1379878ed226SJulian Elischer
1380878ed226SJulian Elischer msg->header.token = token;
1381878ed226SJulian Elischer
1382878ed226SJulian Elischer ip = (ng_l2cap_l2ca_discon_ip *)(msg->data);
1383878ed226SJulian Elischer ip->lcid = pcb->cid;
13843a601a23STakanori Watanabe ip->idtype = pcb->idtype;
1385878ed226SJulian Elischer
1386b9fe2d6cSAlfred Perlstein NG_SEND_MSG_HOOK(error, ng_btsocket_l2cap_node, msg,pcb->rt->hook, 0);
1387878ed226SJulian Elischer
1388878ed226SJulian Elischer return (error);
1389878ed226SJulian Elischer } /* ng_btsocket_l2cap_send_l2ca_discon_req */
1390878ed226SJulian Elischer
1391878ed226SJulian Elischer /*****************************************************************************
1392878ed226SJulian Elischer *****************************************************************************
1393878ed226SJulian Elischer ** Socket interface
1394878ed226SJulian Elischer *****************************************************************************
1395878ed226SJulian Elischer *****************************************************************************/
1396878ed226SJulian Elischer
1397878ed226SJulian Elischer /*
1398878ed226SJulian Elischer * L2CAP sockets data input routine
1399878ed226SJulian Elischer */
1400878ed226SJulian Elischer
1401878ed226SJulian Elischer static void
ng_btsocket_l2cap_data_input(struct mbuf * m,hook_p hook)1402878ed226SJulian Elischer ng_btsocket_l2cap_data_input(struct mbuf *m, hook_p hook)
1403878ed226SJulian Elischer {
1404878ed226SJulian Elischer ng_l2cap_hdr_t *hdr = NULL;
1405878ed226SJulian Elischer ng_l2cap_clt_hdr_t *clt_hdr = NULL;
1406878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = NULL;
1407878ed226SJulian Elischer ng_btsocket_l2cap_rtentry_t *rt = NULL;
1408fbc48c2bSTakanori Watanabe uint16_t idtype;
1409878ed226SJulian Elischer
1410878ed226SJulian Elischer if (hook == NULL) {
1411878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ALERT(
1412878ed226SJulian Elischer "%s: Invalid source hook for L2CAP data packet\n", __func__);
1413878ed226SJulian Elischer goto drop;
1414878ed226SJulian Elischer }
1415878ed226SJulian Elischer
1416878ed226SJulian Elischer rt = (ng_btsocket_l2cap_rtentry_t *) NG_HOOK_PRIVATE(hook);
1417878ed226SJulian Elischer if (rt == NULL) {
1418878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ALERT(
1419878ed226SJulian Elischer "%s: Could not find out source bdaddr for L2CAP data packet\n", __func__);
1420878ed226SJulian Elischer goto drop;
1421878ed226SJulian Elischer }
1422878ed226SJulian Elischer
1423fbc48c2bSTakanori Watanabe m = m_pullup(m, sizeof(uint16_t));
1424fbc48c2bSTakanori Watanabe idtype = *mtod(m, uint16_t *);
1425fbc48c2bSTakanori Watanabe m_adj(m, sizeof(uint16_t));
1426fbc48c2bSTakanori Watanabe
1427878ed226SJulian Elischer /* Make sure we can access header */
1428878ed226SJulian Elischer if (m->m_pkthdr.len < sizeof(*hdr)) {
1429878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
1430878ed226SJulian Elischer "%s: L2CAP data packet too small, len=%d\n", __func__, m->m_pkthdr.len);
1431878ed226SJulian Elischer goto drop;
1432878ed226SJulian Elischer }
1433878ed226SJulian Elischer
1434878ed226SJulian Elischer if (m->m_len < sizeof(*hdr)) {
1435878ed226SJulian Elischer m = m_pullup(m, sizeof(*hdr));
1436878ed226SJulian Elischer if (m == NULL)
1437878ed226SJulian Elischer goto drop;
1438878ed226SJulian Elischer }
1439878ed226SJulian Elischer
1440878ed226SJulian Elischer /* Strip L2CAP packet header and verify packet length */
1441878ed226SJulian Elischer hdr = mtod(m, ng_l2cap_hdr_t *);
1442878ed226SJulian Elischer m_adj(m, sizeof(*hdr));
1443878ed226SJulian Elischer
1444878ed226SJulian Elischer if (hdr->length != m->m_pkthdr.len) {
1445878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
1446878ed226SJulian Elischer "%s: Bad L2CAP data packet length, len=%d, length=%d\n",
1447878ed226SJulian Elischer __func__, m->m_pkthdr.len, hdr->length);
1448878ed226SJulian Elischer goto drop;
1449878ed226SJulian Elischer }
1450878ed226SJulian Elischer
1451878ed226SJulian Elischer /*
1452878ed226SJulian Elischer * Now process packet. Two cases:
1453878ed226SJulian Elischer *
1454878ed226SJulian Elischer * 1) Normal packet (cid != 2) then find connected socket and append
1455878ed226SJulian Elischer * mbuf to the socket queue. Wakeup socket.
1456878ed226SJulian Elischer *
1457878ed226SJulian Elischer * 2) Broadcast packet (cid == 2) then find all sockets that connected
1458878ed226SJulian Elischer * to the given PSM and have SO_BROADCAST bit set and append mbuf
1459878ed226SJulian Elischer * to the socket queue. Wakeup socket.
1460878ed226SJulian Elischer */
1461878ed226SJulian Elischer
1462878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
1463f2bb1caeSJulian Elischer "%s: Received L2CAP data packet: src bdaddr=%x:%x:%x:%x:%x:%x, " \
1464878ed226SJulian Elischer "dcid=%d, length=%d\n",
1465878ed226SJulian Elischer __func__,
1466878ed226SJulian Elischer rt->src.b[5], rt->src.b[4], rt->src.b[3],
1467878ed226SJulian Elischer rt->src.b[2], rt->src.b[1], rt->src.b[0],
1468878ed226SJulian Elischer hdr->dcid, hdr->length);
1469878ed226SJulian Elischer
1470fbc48c2bSTakanori Watanabe if ((hdr->dcid >= NG_L2CAP_FIRST_CID) ||
14713a601a23STakanori Watanabe (idtype == NG_L2CAP_L2CA_IDTYPE_ATT)||
14723a601a23STakanori Watanabe (idtype == NG_L2CAP_L2CA_IDTYPE_SMP)
14733a601a23STakanori Watanabe ){
1474f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
1475f2bb1caeSJulian Elischer
1476878ed226SJulian Elischer /* Normal packet: find connected socket */
1477fbc48c2bSTakanori Watanabe pcb = ng_btsocket_l2cap_pcb_by_cid(&rt->src, hdr->dcid,idtype);
1478f2bb1caeSJulian Elischer if (pcb == NULL) {
1479f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1480878ed226SJulian Elischer goto drop;
1481f2bb1caeSJulian Elischer }
1482878ed226SJulian Elischer
1483878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
1484878ed226SJulian Elischer
1485878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_OPEN) {
1486878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
1487878ed226SJulian Elischer "%s: No connected socket found, src bdaddr=%x:%x:%x:%x:%x:%x, dcid=%d, " \
1488878ed226SJulian Elischer "state=%d\n", __func__,
1489878ed226SJulian Elischer rt->src.b[5], rt->src.b[4], rt->src.b[3],
1490878ed226SJulian Elischer rt->src.b[2], rt->src.b[1], rt->src.b[0],
1491878ed226SJulian Elischer hdr->dcid, pcb->state);
1492878ed226SJulian Elischer
1493878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1494f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1495878ed226SJulian Elischer goto drop;
1496878ed226SJulian Elischer }
1497878ed226SJulian Elischer
1498878ed226SJulian Elischer /* Check packet size against socket's incoming MTU */
1499878ed226SJulian Elischer if (hdr->length > pcb->imtu) {
1500878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
1501878ed226SJulian Elischer "%s: L2CAP data packet too big, src bdaddr=%x:%x:%x:%x:%x:%x, " \
1502878ed226SJulian Elischer "dcid=%d, length=%d, imtu=%d\n",
1503878ed226SJulian Elischer __func__,
1504878ed226SJulian Elischer rt->src.b[5], rt->src.b[4], rt->src.b[3],
1505878ed226SJulian Elischer rt->src.b[2], rt->src.b[1], rt->src.b[0],
1506878ed226SJulian Elischer hdr->dcid, hdr->length, pcb->imtu);
1507878ed226SJulian Elischer
1508878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1509f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1510878ed226SJulian Elischer goto drop;
1511878ed226SJulian Elischer }
1512878ed226SJulian Elischer
1513878ed226SJulian Elischer /* Check if we have enough space in socket receive queue */
1514878ed226SJulian Elischer if (m->m_pkthdr.len > sbspace(&pcb->so->so_rcv)) {
1515878ed226SJulian Elischer /*
1516878ed226SJulian Elischer * This is really bad. Receive queue on socket does
1517878ed226SJulian Elischer * not have enough space for the packet. We do not
1518878ed226SJulian Elischer * have any other choice but drop the packet. L2CAP
1519878ed226SJulian Elischer * does not provide any flow control.
1520878ed226SJulian Elischer */
1521878ed226SJulian Elischer
1522878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
1523878ed226SJulian Elischer "%s: Not enough space in socket receive queue. Dropping L2CAP data packet, " \
1524878ed226SJulian Elischer "src bdaddr=%x:%x:%x:%x:%x:%x, dcid=%d, len=%d, space=%ld\n",
1525878ed226SJulian Elischer __func__,
1526878ed226SJulian Elischer rt->src.b[5], rt->src.b[4], rt->src.b[3],
1527878ed226SJulian Elischer rt->src.b[2], rt->src.b[1], rt->src.b[0],
1528878ed226SJulian Elischer hdr->dcid, m->m_pkthdr.len,
1529878ed226SJulian Elischer sbspace(&pcb->so->so_rcv));
1530878ed226SJulian Elischer
1531878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1532f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1533878ed226SJulian Elischer goto drop;
1534878ed226SJulian Elischer }
1535878ed226SJulian Elischer
1536878ed226SJulian Elischer /* Append packet to the socket receive queue and wakeup */
1537878ed226SJulian Elischer sbappendrecord(&pcb->so->so_rcv, m);
1538878ed226SJulian Elischer m = NULL;
1539878ed226SJulian Elischer
1540878ed226SJulian Elischer sorwakeup(pcb->so);
1541f2bb1caeSJulian Elischer
1542878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1543f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1544878ed226SJulian Elischer } else if (hdr->dcid == NG_L2CAP_CLT_CID) {
1545878ed226SJulian Elischer /* Broadcast packet: give packet to all sockets */
1546878ed226SJulian Elischer
1547878ed226SJulian Elischer /* Check packet size against connectionless MTU */
1548878ed226SJulian Elischer if (hdr->length > NG_L2CAP_MTU_DEFAULT) {
1549878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
1550878ed226SJulian Elischer "%s: Connectionless L2CAP data packet too big, " \
1551878ed226SJulian Elischer "src bdaddr=%x:%x:%x:%x:%x:%x, length=%d\n",
1552878ed226SJulian Elischer __func__,
1553878ed226SJulian Elischer rt->src.b[5], rt->src.b[4], rt->src.b[3],
1554878ed226SJulian Elischer rt->src.b[2], rt->src.b[1], rt->src.b[0],
1555878ed226SJulian Elischer hdr->length);
1556878ed226SJulian Elischer goto drop;
1557878ed226SJulian Elischer }
1558878ed226SJulian Elischer
1559878ed226SJulian Elischer /* Make sure we can access connectionless header */
1560878ed226SJulian Elischer if (m->m_pkthdr.len < sizeof(*clt_hdr)) {
1561878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
1562878ed226SJulian Elischer "%s: Can not get L2CAP connectionless packet header, " \
1563878ed226SJulian Elischer "src bdaddr=%x:%x:%x:%x:%x:%x, length=%d\n",
1564878ed226SJulian Elischer __func__,
1565878ed226SJulian Elischer rt->src.b[5], rt->src.b[4], rt->src.b[3],
1566878ed226SJulian Elischer rt->src.b[2], rt->src.b[1], rt->src.b[0],
1567878ed226SJulian Elischer hdr->length);
1568878ed226SJulian Elischer goto drop;
1569878ed226SJulian Elischer }
1570878ed226SJulian Elischer
1571878ed226SJulian Elischer if (m->m_len < sizeof(*clt_hdr)) {
1572878ed226SJulian Elischer m = m_pullup(m, sizeof(*clt_hdr));
1573878ed226SJulian Elischer if (m == NULL)
1574878ed226SJulian Elischer goto drop;
1575878ed226SJulian Elischer }
1576878ed226SJulian Elischer
1577878ed226SJulian Elischer /* Strip connectionless header and deliver packet */
1578878ed226SJulian Elischer clt_hdr = mtod(m, ng_l2cap_clt_hdr_t *);
1579878ed226SJulian Elischer m_adj(m, sizeof(*clt_hdr));
1580878ed226SJulian Elischer
1581878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
1582878ed226SJulian Elischer "%s: Got L2CAP connectionless data packet, " \
1583878ed226SJulian Elischer "src bdaddr=%x:%x:%x:%x:%x:%x, psm=%d, length=%d\n",
1584878ed226SJulian Elischer __func__,
1585878ed226SJulian Elischer rt->src.b[5], rt->src.b[4], rt->src.b[3],
1586878ed226SJulian Elischer rt->src.b[2], rt->src.b[1], rt->src.b[0],
1587878ed226SJulian Elischer clt_hdr->psm, hdr->length);
1588878ed226SJulian Elischer
1589878ed226SJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
1590878ed226SJulian Elischer
1591878ed226SJulian Elischer LIST_FOREACH(pcb, &ng_btsocket_l2cap_sockets, next) {
1592878ed226SJulian Elischer struct mbuf *copy = NULL;
1593878ed226SJulian Elischer
1594878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
1595878ed226SJulian Elischer
1596878ed226SJulian Elischer if (bcmp(&rt->src, &pcb->src, sizeof(pcb->src)) != 0 ||
1597878ed226SJulian Elischer pcb->psm != clt_hdr->psm ||
1598878ed226SJulian Elischer pcb->state != NG_BTSOCKET_L2CAP_OPEN ||
1599878ed226SJulian Elischer (pcb->so->so_options & SO_BROADCAST) == 0 ||
1600878ed226SJulian Elischer m->m_pkthdr.len > sbspace(&pcb->so->so_rcv))
1601878ed226SJulian Elischer goto next;
1602878ed226SJulian Elischer
1603878ed226SJulian Elischer /*
1604878ed226SJulian Elischer * Create a copy of the packet and append it to the
1605878ed226SJulian Elischer * socket's queue. If m_dup() failed - no big deal
1606878ed226SJulian Elischer * it is a broadcast traffic after all
1607878ed226SJulian Elischer */
1608878ed226SJulian Elischer
1609eb1b1807SGleb Smirnoff copy = m_dup(m, M_NOWAIT);
1610878ed226SJulian Elischer if (copy != NULL) {
1611878ed226SJulian Elischer sbappendrecord(&pcb->so->so_rcv, copy);
1612878ed226SJulian Elischer sorwakeup(pcb->so);
1613878ed226SJulian Elischer }
1614878ed226SJulian Elischer next:
1615878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1616878ed226SJulian Elischer }
1617878ed226SJulian Elischer
1618878ed226SJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1619878ed226SJulian Elischer }
1620878ed226SJulian Elischer drop:
1621878ed226SJulian Elischer NG_FREE_M(m); /* checks for m != NULL */
1622878ed226SJulian Elischer } /* ng_btsocket_l2cap_data_input */
1623878ed226SJulian Elischer
1624878ed226SJulian Elischer /*
1625878ed226SJulian Elischer * L2CAP sockets default message input routine
1626878ed226SJulian Elischer */
1627878ed226SJulian Elischer
1628878ed226SJulian Elischer static void
ng_btsocket_l2cap_default_msg_input(struct ng_mesg * msg,hook_p hook)1629878ed226SJulian Elischer ng_btsocket_l2cap_default_msg_input(struct ng_mesg *msg, hook_p hook)
1630878ed226SJulian Elischer {
1631878ed226SJulian Elischer switch (msg->header.cmd) {
1632878ed226SJulian Elischer case NGM_L2CAP_NODE_HOOK_INFO: {
1633878ed226SJulian Elischer ng_btsocket_l2cap_rtentry_t *rt = NULL;
1634fbc48c2bSTakanori Watanabe ng_l2cap_node_hook_info_ep *ep =
1635fbc48c2bSTakanori Watanabe (ng_l2cap_node_hook_info_ep *)msg->data;
1636fbc48c2bSTakanori Watanabe if (hook == NULL || msg->header.arglen != sizeof(*ep))
1637878ed226SJulian Elischer break;
1638878ed226SJulian Elischer
1639fbc48c2bSTakanori Watanabe if (bcmp(&ep->addr, NG_HCI_BDADDR_ANY, sizeof(bdaddr_t)) == 0)
1640878ed226SJulian Elischer break;
1641878ed226SJulian Elischer
1642f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_rt_mtx);
1643f2bb1caeSJulian Elischer
1644878ed226SJulian Elischer rt = (ng_btsocket_l2cap_rtentry_t *) NG_HOOK_PRIVATE(hook);
1645878ed226SJulian Elischer if (rt == NULL) {
16461ede983cSDag-Erling Smørgrav rt = malloc(sizeof(*rt),
1647878ed226SJulian Elischer M_NETGRAPH_BTSOCKET_L2CAP, M_NOWAIT|M_ZERO);
1648f2bb1caeSJulian Elischer if (rt == NULL) {
1649878ed226SJulian Elischer mtx_unlock(&ng_btsocket_l2cap_rt_mtx);
1650f2bb1caeSJulian Elischer break;
1651f2bb1caeSJulian Elischer }
1652f2bb1caeSJulian Elischer
1653f2bb1caeSJulian Elischer LIST_INSERT_HEAD(&ng_btsocket_l2cap_rt, rt, next);
1654878ed226SJulian Elischer
1655878ed226SJulian Elischer NG_HOOK_SET_PRIVATE(hook, rt);
1656878ed226SJulian Elischer }
1657878ed226SJulian Elischer
1658fbc48c2bSTakanori Watanabe bcopy(&ep->addr, &rt->src, sizeof(rt->src));
1659878ed226SJulian Elischer rt->hook = hook;
1660878ed226SJulian Elischer
1661f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_rt_mtx);
1662f2bb1caeSJulian Elischer
1663878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
1664878ed226SJulian Elischer "%s: Updating hook \"%s\", src bdaddr=%x:%x:%x:%x:%x:%x\n",
1665878ed226SJulian Elischer __func__, NG_HOOK_NAME(hook),
1666878ed226SJulian Elischer rt->src.b[5], rt->src.b[4], rt->src.b[3],
1667878ed226SJulian Elischer rt->src.b[2], rt->src.b[1], rt->src.b[0]);
1668878ed226SJulian Elischer } break;
1669878ed226SJulian Elischer
1670878ed226SJulian Elischer default:
1671878ed226SJulian Elischer NG_BTSOCKET_L2CAP_WARN(
1672878ed226SJulian Elischer "%s: Unknown message, cmd=%d\n", __func__, msg->header.cmd);
1673878ed226SJulian Elischer break;
1674878ed226SJulian Elischer }
1675878ed226SJulian Elischer
1676878ed226SJulian Elischer NG_FREE_MSG(msg); /* Checks for msg != NULL */
1677878ed226SJulian Elischer } /* ng_btsocket_l2cap_default_msg_input */
1678878ed226SJulian Elischer
1679878ed226SJulian Elischer /*
1680878ed226SJulian Elischer * L2CAP sockets L2CA message input routine
1681878ed226SJulian Elischer */
1682878ed226SJulian Elischer
1683878ed226SJulian Elischer static void
ng_btsocket_l2cap_l2ca_msg_input(struct ng_mesg * msg,hook_p hook)1684878ed226SJulian Elischer ng_btsocket_l2cap_l2ca_msg_input(struct ng_mesg *msg, hook_p hook)
1685878ed226SJulian Elischer {
1686878ed226SJulian Elischer ng_btsocket_l2cap_rtentry_p rt = NULL;
1687878ed226SJulian Elischer
1688878ed226SJulian Elischer if (hook == NULL) {
1689878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ALERT(
1690878ed226SJulian Elischer "%s: Invalid source hook for L2CA message\n", __func__);
1691878ed226SJulian Elischer goto drop;
1692878ed226SJulian Elischer }
1693878ed226SJulian Elischer
1694878ed226SJulian Elischer rt = (ng_btsocket_l2cap_rtentry_p) NG_HOOK_PRIVATE(hook);
1695878ed226SJulian Elischer if (rt == NULL) {
1696878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ALERT(
1697878ed226SJulian Elischer "%s: Could not find out source bdaddr for L2CA message\n", __func__);
1698878ed226SJulian Elischer goto drop;
1699878ed226SJulian Elischer }
1700878ed226SJulian Elischer
1701878ed226SJulian Elischer switch (msg->header.cmd) {
1702878ed226SJulian Elischer case NGM_L2CAP_L2CA_CON: /* L2CA_Connect response */
17037c380856SMaksim Yevmenkin ng_btsocket_l2cap_process_l2ca_con_req_rsp(msg, rt);
1704878ed226SJulian Elischer break;
1705878ed226SJulian Elischer
1706878ed226SJulian Elischer case NGM_L2CAP_L2CA_CON_RSP: /* L2CA_ConnectRsp response */
17077c380856SMaksim Yevmenkin ng_btsocket_l2cap_process_l2ca_con_rsp_rsp(msg, rt);
1708878ed226SJulian Elischer break;
1709878ed226SJulian Elischer
1710878ed226SJulian Elischer case NGM_L2CAP_L2CA_CON_IND: /* L2CA_Connect indicator */
17117c380856SMaksim Yevmenkin ng_btsocket_l2cap_process_l2ca_con_ind(msg, rt);
1712878ed226SJulian Elischer break;
1713878ed226SJulian Elischer
1714878ed226SJulian Elischer case NGM_L2CAP_L2CA_CFG: /* L2CA_Config response */
17157c380856SMaksim Yevmenkin ng_btsocket_l2cap_process_l2ca_cfg_req_rsp(msg, rt);
1716878ed226SJulian Elischer break;
1717878ed226SJulian Elischer
1718878ed226SJulian Elischer case NGM_L2CAP_L2CA_CFG_RSP: /* L2CA_ConfigRsp response */
17197c380856SMaksim Yevmenkin ng_btsocket_l2cap_process_l2ca_cfg_rsp_rsp(msg, rt);
1720878ed226SJulian Elischer break;
1721878ed226SJulian Elischer
1722878ed226SJulian Elischer case NGM_L2CAP_L2CA_CFG_IND: /* L2CA_Config indicator */
17237c380856SMaksim Yevmenkin ng_btsocket_l2cap_process_l2ca_cfg_ind(msg, rt);
1724878ed226SJulian Elischer break;
1725878ed226SJulian Elischer
1726878ed226SJulian Elischer case NGM_L2CAP_L2CA_DISCON: /* L2CA_Disconnect response */
17277c380856SMaksim Yevmenkin ng_btsocket_l2cap_process_l2ca_discon_rsp(msg, rt);
1728878ed226SJulian Elischer break;
1729878ed226SJulian Elischer
1730878ed226SJulian Elischer case NGM_L2CAP_L2CA_DISCON_IND: /* L2CA_Disconnect indicator */
17317c380856SMaksim Yevmenkin ng_btsocket_l2cap_process_l2ca_discon_ind(msg, rt);
1732878ed226SJulian Elischer break;
1733878ed226SJulian Elischer
1734878ed226SJulian Elischer case NGM_L2CAP_L2CA_WRITE: /* L2CA_Write response */
17357c380856SMaksim Yevmenkin ng_btsocket_l2cap_process_l2ca_write_rsp(msg, rt);
1736878ed226SJulian Elischer break;
17373a601a23STakanori Watanabe case NGM_L2CAP_L2CA_ENC_CHANGE:
17383a601a23STakanori Watanabe ng_btsocket_l2cap_process_l2ca_enc_change(msg, rt);
1739878ed226SJulian Elischer
17403a601a23STakanori Watanabe break;
1741878ed226SJulian Elischer /* XXX FIXME add other L2CA messages */
1742878ed226SJulian Elischer
1743878ed226SJulian Elischer default:
1744878ed226SJulian Elischer NG_BTSOCKET_L2CAP_WARN(
1745878ed226SJulian Elischer "%s: Unknown L2CA message, cmd=%d\n", __func__, msg->header.cmd);
1746878ed226SJulian Elischer break;
1747878ed226SJulian Elischer }
1748878ed226SJulian Elischer drop:
1749878ed226SJulian Elischer NG_FREE_MSG(msg);
1750878ed226SJulian Elischer } /* ng_btsocket_l2cap_l2ca_msg_input */
1751878ed226SJulian Elischer
1752878ed226SJulian Elischer /*
1753878ed226SJulian Elischer * L2CAP sockets input routine
1754878ed226SJulian Elischer */
1755878ed226SJulian Elischer
1756878ed226SJulian Elischer static void
ng_btsocket_l2cap_input(void * context,int pending)1757878ed226SJulian Elischer ng_btsocket_l2cap_input(void *context, int pending)
1758878ed226SJulian Elischer {
1759878ed226SJulian Elischer item_p item = NULL;
1760878ed226SJulian Elischer hook_p hook = NULL;
1761878ed226SJulian Elischer
1762878ed226SJulian Elischer for (;;) {
1763878ed226SJulian Elischer mtx_lock(&ng_btsocket_l2cap_queue_mtx);
1764878ed226SJulian Elischer NG_BT_ITEMQ_DEQUEUE(&ng_btsocket_l2cap_queue, item);
1765878ed226SJulian Elischer mtx_unlock(&ng_btsocket_l2cap_queue_mtx);
1766878ed226SJulian Elischer
1767878ed226SJulian Elischer if (item == NULL)
1768878ed226SJulian Elischer break;
1769878ed226SJulian Elischer
1770878ed226SJulian Elischer NGI_GET_HOOK(item, hook);
1771878ed226SJulian Elischer if (hook != NULL && NG_HOOK_NOT_VALID(hook))
1772878ed226SJulian Elischer goto drop;
1773878ed226SJulian Elischer
1774878ed226SJulian Elischer switch(item->el_flags & NGQF_TYPE) {
1775878ed226SJulian Elischer case NGQF_DATA: {
1776878ed226SJulian Elischer struct mbuf *m = NULL;
1777878ed226SJulian Elischer
1778878ed226SJulian Elischer NGI_GET_M(item, m);
1779878ed226SJulian Elischer ng_btsocket_l2cap_data_input(m, hook);
1780878ed226SJulian Elischer } break;
1781878ed226SJulian Elischer
1782878ed226SJulian Elischer case NGQF_MESG: {
1783878ed226SJulian Elischer struct ng_mesg *msg = NULL;
1784878ed226SJulian Elischer
1785878ed226SJulian Elischer NGI_GET_MSG(item, msg);
1786878ed226SJulian Elischer
1787878ed226SJulian Elischer switch (msg->header.cmd) {
1788878ed226SJulian Elischer case NGM_L2CAP_L2CA_CON:
1789878ed226SJulian Elischer case NGM_L2CAP_L2CA_CON_RSP:
1790878ed226SJulian Elischer case NGM_L2CAP_L2CA_CON_IND:
1791878ed226SJulian Elischer case NGM_L2CAP_L2CA_CFG:
1792878ed226SJulian Elischer case NGM_L2CAP_L2CA_CFG_RSP:
1793878ed226SJulian Elischer case NGM_L2CAP_L2CA_CFG_IND:
1794878ed226SJulian Elischer case NGM_L2CAP_L2CA_DISCON:
1795878ed226SJulian Elischer case NGM_L2CAP_L2CA_DISCON_IND:
1796878ed226SJulian Elischer case NGM_L2CAP_L2CA_WRITE:
17973a601a23STakanori Watanabe case NGM_L2CAP_L2CA_ENC_CHANGE:
1798878ed226SJulian Elischer /* XXX FIXME add other L2CA messages */
1799878ed226SJulian Elischer ng_btsocket_l2cap_l2ca_msg_input(msg, hook);
1800878ed226SJulian Elischer break;
1801878ed226SJulian Elischer
1802878ed226SJulian Elischer default:
1803878ed226SJulian Elischer ng_btsocket_l2cap_default_msg_input(msg, hook);
1804878ed226SJulian Elischer break;
1805878ed226SJulian Elischer }
1806878ed226SJulian Elischer } break;
1807878ed226SJulian Elischer
1808878ed226SJulian Elischer default:
1809878ed226SJulian Elischer KASSERT(0,
1810878ed226SJulian Elischer ("%s: invalid item type=%ld\n", __func__, (item->el_flags & NGQF_TYPE)));
1811878ed226SJulian Elischer break;
1812878ed226SJulian Elischer }
1813878ed226SJulian Elischer drop:
1814878ed226SJulian Elischer if (hook != NULL)
1815878ed226SJulian Elischer NG_HOOK_UNREF(hook);
1816878ed226SJulian Elischer
1817878ed226SJulian Elischer NG_FREE_ITEM(item);
1818878ed226SJulian Elischer }
1819878ed226SJulian Elischer } /* ng_btsocket_l2cap_input */
1820878ed226SJulian Elischer
1821878ed226SJulian Elischer /*
1822878ed226SJulian Elischer * Route cleanup task. Gets scheduled when hook is disconnected. Here we
1823878ed226SJulian Elischer * will find all sockets that use "invalid" hook and disconnect them.
1824878ed226SJulian Elischer */
1825878ed226SJulian Elischer
1826878ed226SJulian Elischer static void
ng_btsocket_l2cap_rtclean(void * context,int pending)1827878ed226SJulian Elischer ng_btsocket_l2cap_rtclean(void *context, int pending)
1828878ed226SJulian Elischer {
1829f2bb1caeSJulian Elischer ng_btsocket_l2cap_pcb_p pcb = NULL, pcb_next = NULL;
1830878ed226SJulian Elischer ng_btsocket_l2cap_rtentry_p rt = NULL;
1831878ed226SJulian Elischer
1832878ed226SJulian Elischer mtx_lock(&ng_btsocket_l2cap_rt_mtx);
1833878ed226SJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
1834878ed226SJulian Elischer
1835878ed226SJulian Elischer /*
1836878ed226SJulian Elischer * First disconnect all sockets that use "invalid" hook
1837878ed226SJulian Elischer */
1838878ed226SJulian Elischer
1839f2bb1caeSJulian Elischer for (pcb = LIST_FIRST(&ng_btsocket_l2cap_sockets); pcb != NULL; ) {
1840878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
1841f2bb1caeSJulian Elischer pcb_next = LIST_NEXT(pcb, next);
1842878ed226SJulian Elischer
1843878ed226SJulian Elischer if (pcb->rt != NULL &&
1844878ed226SJulian Elischer pcb->rt->hook != NULL && NG_HOOK_NOT_VALID(pcb->rt->hook)) {
1845878ed226SJulian Elischer if (pcb->flags & NG_BTSOCKET_L2CAP_TIMO)
1846878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
1847878ed226SJulian Elischer
1848878ed226SJulian Elischer pcb->so->so_error = ENETDOWN;
1849878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
1850878ed226SJulian Elischer soisdisconnected(pcb->so);
1851878ed226SJulian Elischer
1852878ed226SJulian Elischer pcb->token = 0;
1853f2bb1caeSJulian Elischer pcb->cid = 0;
1854878ed226SJulian Elischer pcb->rt = NULL;
1855878ed226SJulian Elischer }
1856878ed226SJulian Elischer
1857878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
1858f2bb1caeSJulian Elischer pcb = pcb_next;
1859878ed226SJulian Elischer }
1860878ed226SJulian Elischer
1861878ed226SJulian Elischer /*
1862878ed226SJulian Elischer * Now cleanup routing table
1863878ed226SJulian Elischer */
1864878ed226SJulian Elischer
1865f2bb1caeSJulian Elischer for (rt = LIST_FIRST(&ng_btsocket_l2cap_rt); rt != NULL; ) {
1866878ed226SJulian Elischer ng_btsocket_l2cap_rtentry_p rt_next = LIST_NEXT(rt, next);
1867878ed226SJulian Elischer
1868878ed226SJulian Elischer if (rt->hook != NULL && NG_HOOK_NOT_VALID(rt->hook)) {
1869878ed226SJulian Elischer LIST_REMOVE(rt, next);
1870878ed226SJulian Elischer
1871878ed226SJulian Elischer NG_HOOK_SET_PRIVATE(rt->hook, NULL);
1872878ed226SJulian Elischer NG_HOOK_UNREF(rt->hook); /* Remove extra reference */
1873878ed226SJulian Elischer
1874878ed226SJulian Elischer bzero(rt, sizeof(*rt));
18751ede983cSDag-Erling Smørgrav free(rt, M_NETGRAPH_BTSOCKET_L2CAP);
1876878ed226SJulian Elischer }
1877878ed226SJulian Elischer
1878878ed226SJulian Elischer rt = rt_next;
1879878ed226SJulian Elischer }
1880878ed226SJulian Elischer
1881878ed226SJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
1882878ed226SJulian Elischer mtx_unlock(&ng_btsocket_l2cap_rt_mtx);
1883878ed226SJulian Elischer } /* ng_btsocket_l2cap_rtclean */
1884878ed226SJulian Elischer
1885878ed226SJulian Elischer /*
1886878ed226SJulian Elischer * Initialize everything
1887878ed226SJulian Elischer */
1888878ed226SJulian Elischer
188989128ff3SGleb Smirnoff static void
ng_btsocket_l2cap_init(void * arg __unused)189089128ff3SGleb Smirnoff ng_btsocket_l2cap_init(void *arg __unused)
1891878ed226SJulian Elischer {
1892878ed226SJulian Elischer int error = 0;
1893878ed226SJulian Elischer
1894878ed226SJulian Elischer ng_btsocket_l2cap_node = NULL;
1895878ed226SJulian Elischer ng_btsocket_l2cap_debug_level = NG_BTSOCKET_WARN_LEVEL;
1896878ed226SJulian Elischer
1897878ed226SJulian Elischer /* Register Netgraph node type */
1898878ed226SJulian Elischer error = ng_newtype(&typestruct);
1899878ed226SJulian Elischer if (error != 0) {
1900878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ALERT(
1901878ed226SJulian Elischer "%s: Could not register Netgraph node type, error=%d\n", __func__, error);
1902878ed226SJulian Elischer
1903878ed226SJulian Elischer return;
1904878ed226SJulian Elischer }
1905878ed226SJulian Elischer
1906878ed226SJulian Elischer /* Create Netgrapg node */
1907878ed226SJulian Elischer error = ng_make_node_common(&typestruct, &ng_btsocket_l2cap_node);
1908878ed226SJulian Elischer if (error != 0) {
1909878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ALERT(
1910878ed226SJulian Elischer "%s: Could not create Netgraph node, error=%d\n", __func__, error);
1911878ed226SJulian Elischer
1912878ed226SJulian Elischer ng_btsocket_l2cap_node = NULL;
1913878ed226SJulian Elischer
1914878ed226SJulian Elischer return;
1915878ed226SJulian Elischer }
1916878ed226SJulian Elischer
1917878ed226SJulian Elischer error = ng_name_node(ng_btsocket_l2cap_node,
1918878ed226SJulian Elischer NG_BTSOCKET_L2CAP_NODE_TYPE);
1919878ed226SJulian Elischer if (error != 0) {
1920878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ALERT(
1921878ed226SJulian Elischer "%s: Could not name Netgraph node, error=%d\n", __func__, error);
1922878ed226SJulian Elischer
1923878ed226SJulian Elischer NG_NODE_UNREF(ng_btsocket_l2cap_node);
1924878ed226SJulian Elischer ng_btsocket_l2cap_node = NULL;
1925878ed226SJulian Elischer
1926878ed226SJulian Elischer return;
1927878ed226SJulian Elischer }
1928878ed226SJulian Elischer
1929878ed226SJulian Elischer /* Create input queue */
1930878ed226SJulian Elischer NG_BT_ITEMQ_INIT(&ng_btsocket_l2cap_queue, ifqmaxlen);
1931878ed226SJulian Elischer mtx_init(&ng_btsocket_l2cap_queue_mtx,
1932878ed226SJulian Elischer "btsocks_l2cap_queue_mtx", NULL, MTX_DEF);
1933878ed226SJulian Elischer TASK_INIT(&ng_btsocket_l2cap_queue_task, 0,
1934878ed226SJulian Elischer ng_btsocket_l2cap_input, NULL);
1935878ed226SJulian Elischer
1936878ed226SJulian Elischer /* Create list of sockets */
1937878ed226SJulian Elischer LIST_INIT(&ng_btsocket_l2cap_sockets);
1938878ed226SJulian Elischer mtx_init(&ng_btsocket_l2cap_sockets_mtx,
1939878ed226SJulian Elischer "btsocks_l2cap_sockets_mtx", NULL, MTX_DEF);
1940878ed226SJulian Elischer
1941878ed226SJulian Elischer /* Routing table */
1942878ed226SJulian Elischer LIST_INIT(&ng_btsocket_l2cap_rt);
1943878ed226SJulian Elischer mtx_init(&ng_btsocket_l2cap_rt_mtx,
1944878ed226SJulian Elischer "btsocks_l2cap_rt_mtx", NULL, MTX_DEF);
1945878ed226SJulian Elischer TASK_INIT(&ng_btsocket_l2cap_rt_task, 0,
1946878ed226SJulian Elischer ng_btsocket_l2cap_rtclean, NULL);
1947878ed226SJulian Elischer } /* ng_btsocket_l2cap_init */
194889128ff3SGleb Smirnoff SYSINIT(ng_btsocket_l2cap_init, SI_SUB_PROTO_DOMAIN, SI_ORDER_THIRD,
194989128ff3SGleb Smirnoff ng_btsocket_l2cap_init, NULL);
1950878ed226SJulian Elischer
1951878ed226SJulian Elischer /*
1952878ed226SJulian Elischer * Abort connection on socket
1953878ed226SJulian Elischer */
1954878ed226SJulian Elischer
1955ac45e92fSRobert Watson void
ng_btsocket_l2cap_abort(struct socket * so)1956878ed226SJulian Elischer ng_btsocket_l2cap_abort(struct socket *so)
1957878ed226SJulian Elischer {
1958878ed226SJulian Elischer so->so_error = ECONNABORTED;
1959878ed226SJulian Elischer
1960a152f8a3SRobert Watson (void)ng_btsocket_l2cap_disconnect(so);
1961878ed226SJulian Elischer } /* ng_btsocket_l2cap_abort */
1962878ed226SJulian Elischer
1963a152f8a3SRobert Watson void
ng_btsocket_l2cap_close(struct socket * so)1964a152f8a3SRobert Watson ng_btsocket_l2cap_close(struct socket *so)
1965a152f8a3SRobert Watson {
1966a152f8a3SRobert Watson
1967a152f8a3SRobert Watson (void)ng_btsocket_l2cap_disconnect(so);
1968a152f8a3SRobert Watson } /* ng_btsocket_l2cap_close */
1969a152f8a3SRobert Watson
1970878ed226SJulian Elischer /*
1971878ed226SJulian Elischer * Create and attach new socket
1972878ed226SJulian Elischer */
1973878ed226SJulian Elischer
1974878ed226SJulian Elischer int
ng_btsocket_l2cap_attach(struct socket * so,int proto,struct thread * td)1975878ed226SJulian Elischer ng_btsocket_l2cap_attach(struct socket *so, int proto, struct thread *td)
1976878ed226SJulian Elischer {
1977f2bb1caeSJulian Elischer static u_int32_t token = 0;
1978878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p pcb = so2l2cap_pcb(so);
1979878ed226SJulian Elischer int error;
1980878ed226SJulian Elischer
1981878ed226SJulian Elischer /* Check socket and protocol */
1982878ed226SJulian Elischer if (ng_btsocket_l2cap_node == NULL)
1983878ed226SJulian Elischer return (EPROTONOSUPPORT);
1984878ed226SJulian Elischer if (so->so_type != SOCK_SEQPACKET)
1985878ed226SJulian Elischer return (ESOCKTNOSUPPORT);
1986878ed226SJulian Elischer
1987878ed226SJulian Elischer #if 0 /* XXX sonewconn() calls "pru_attach" with proto == 0 */
1988878ed226SJulian Elischer if (proto != 0)
1989878ed226SJulian Elischer if (proto != BLUETOOTH_PROTO_L2CAP)
1990878ed226SJulian Elischer return (EPROTONOSUPPORT);
1991878ed226SJulian Elischer #endif /* XXX */
1992878ed226SJulian Elischer
1993878ed226SJulian Elischer if (pcb != NULL)
1994878ed226SJulian Elischer return (EISCONN);
1995878ed226SJulian Elischer
1996878ed226SJulian Elischer /* Reserve send and receive space if it is not reserved yet */
1997878ed226SJulian Elischer if ((so->so_snd.sb_hiwat == 0) || (so->so_rcv.sb_hiwat == 0)) {
1998878ed226SJulian Elischer error = soreserve(so, NG_BTSOCKET_L2CAP_SENDSPACE,
1999878ed226SJulian Elischer NG_BTSOCKET_L2CAP_RECVSPACE);
2000878ed226SJulian Elischer if (error != 0)
2001878ed226SJulian Elischer return (error);
2002878ed226SJulian Elischer }
2003878ed226SJulian Elischer
2004878ed226SJulian Elischer /* Allocate the PCB */
20051ede983cSDag-Erling Smørgrav pcb = malloc(sizeof(*pcb),
2006878ed226SJulian Elischer M_NETGRAPH_BTSOCKET_L2CAP, M_NOWAIT | M_ZERO);
2007878ed226SJulian Elischer if (pcb == NULL)
2008878ed226SJulian Elischer return (ENOMEM);
2009878ed226SJulian Elischer
2010878ed226SJulian Elischer /* Link the PCB and the socket */
2011878ed226SJulian Elischer so->so_pcb = (caddr_t) pcb;
2012878ed226SJulian Elischer pcb->so = so;
2013878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
2014878ed226SJulian Elischer
2015878ed226SJulian Elischer /* Initialize PCB */
2016878ed226SJulian Elischer pcb->imtu = pcb->omtu = NG_L2CAP_MTU_DEFAULT;
2017878ed226SJulian Elischer
2018878ed226SJulian Elischer /* Default flow */
2019878ed226SJulian Elischer pcb->iflow.flags = 0x0;
2020878ed226SJulian Elischer pcb->iflow.service_type = NG_HCI_SERVICE_TYPE_BEST_EFFORT;
2021878ed226SJulian Elischer pcb->iflow.token_rate = 0xffffffff; /* maximum */
2022878ed226SJulian Elischer pcb->iflow.token_bucket_size = 0xffffffff; /* maximum */
2023878ed226SJulian Elischer pcb->iflow.peak_bandwidth = 0x00000000; /* maximum */
2024878ed226SJulian Elischer pcb->iflow.latency = 0xffffffff; /* don't care */
2025878ed226SJulian Elischer pcb->iflow.delay_variation = 0xffffffff; /* don't care */
2026878ed226SJulian Elischer
2027878ed226SJulian Elischer bcopy(&pcb->iflow, &pcb->oflow, sizeof(pcb->oflow));
2028878ed226SJulian Elischer
2029878ed226SJulian Elischer pcb->flush_timo = NG_L2CAP_FLUSH_TIMO_DEFAULT;
2030878ed226SJulian Elischer pcb->link_timo = NG_L2CAP_LINK_TIMO_DEFAULT;
2031878ed226SJulian Elischer
2032f2bb1caeSJulian Elischer /*
2033f2bb1caeSJulian Elischer * XXX Mark PCB mutex as DUPOK to prevent "duplicated lock of
2034f2bb1caeSJulian Elischer * the same type" message. When accepting new L2CAP connection
2035f2bb1caeSJulian Elischer * ng_btsocket_l2cap_process_l2ca_con_ind() holds both PCB mutexes
2036f2bb1caeSJulian Elischer * for "old" (accepting) PCB and "new" (created) PCB.
2037f2bb1caeSJulian Elischer */
2038f2bb1caeSJulian Elischer
2039f2bb1caeSJulian Elischer mtx_init(&pcb->pcb_mtx, "btsocks_l2cap_pcb_mtx", NULL,
2040f2bb1caeSJulian Elischer MTX_DEF|MTX_DUPOK);
20413d1592efSJohn Baldwin callout_init_mtx(&pcb->timo, &pcb->pcb_mtx, 0);
2042f2bb1caeSJulian Elischer
2043f2bb1caeSJulian Elischer /*
2044f2bb1caeSJulian Elischer * Add the PCB to the list
2045f2bb1caeSJulian Elischer *
2046f2bb1caeSJulian Elischer * XXX FIXME VERY IMPORTANT!
2047f2bb1caeSJulian Elischer *
2048f2bb1caeSJulian Elischer * This is totally FUBAR. We could get here in two cases:
2049f2bb1caeSJulian Elischer *
2050f2bb1caeSJulian Elischer * 1) When user calls socket()
2051053359b7SPedro F. Giffuni * 2) When we need to accept new incoming connection and call
2052f2bb1caeSJulian Elischer * sonewconn()
2053f2bb1caeSJulian Elischer *
2054e1e8f51bSRobert Watson * In the first case we must acquire ng_btsocket_l2cap_sockets_mtx.
2055f2bb1caeSJulian Elischer * In the second case we hold ng_btsocket_l2cap_sockets_mtx already.
2056f2bb1caeSJulian Elischer * So we now need to distinguish between these cases. From reading
20572701afd0SMaxim Konovalov * /sys/kern/uipc_socket.c we can find out that sonewconn() calls
2058f2bb1caeSJulian Elischer * pru_attach with proto == 0 and td == NULL. For now use this fact
2059f2bb1caeSJulian Elischer * to figure out if we were called from socket() or from sonewconn().
2060f2bb1caeSJulian Elischer */
2061f2bb1caeSJulian Elischer
2062f2bb1caeSJulian Elischer if (td != NULL)
2063878ed226SJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
2064f2bb1caeSJulian Elischer else
2065f2bb1caeSJulian Elischer mtx_assert(&ng_btsocket_l2cap_sockets_mtx, MA_OWNED);
2066f2bb1caeSJulian Elischer
2067f2bb1caeSJulian Elischer /* Set PCB token. Use ng_btsocket_l2cap_sockets_mtx for protection */
2068f2bb1caeSJulian Elischer if (++ token == 0)
2069f2bb1caeSJulian Elischer token ++;
2070f2bb1caeSJulian Elischer
2071f2bb1caeSJulian Elischer pcb->token = token;
2072f2bb1caeSJulian Elischer
2073878ed226SJulian Elischer LIST_INSERT_HEAD(&ng_btsocket_l2cap_sockets, pcb, next);
2074f2bb1caeSJulian Elischer
2075f2bb1caeSJulian Elischer if (td != NULL)
2076878ed226SJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
2077878ed226SJulian Elischer
2078878ed226SJulian Elischer return (0);
2079878ed226SJulian Elischer } /* ng_btsocket_l2cap_attach */
2080878ed226SJulian Elischer
2081878ed226SJulian Elischer /*
2082878ed226SJulian Elischer * Bind socket
2083878ed226SJulian Elischer */
2084878ed226SJulian Elischer
2085878ed226SJulian Elischer int
ng_btsocket_l2cap_bind(struct socket * so,struct sockaddr * nam,struct thread * td)2086878ed226SJulian Elischer ng_btsocket_l2cap_bind(struct socket *so, struct sockaddr *nam,
2087878ed226SJulian Elischer struct thread *td)
2088878ed226SJulian Elischer {
2089878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = NULL;
2090878ed226SJulian Elischer struct sockaddr_l2cap *sa = (struct sockaddr_l2cap *) nam;
2091878ed226SJulian Elischer int psm, error = 0;
2092878ed226SJulian Elischer
2093878ed226SJulian Elischer if (ng_btsocket_l2cap_node == NULL)
2094878ed226SJulian Elischer return (EINVAL);
2095878ed226SJulian Elischer
2096878ed226SJulian Elischer /* Verify address */
2097878ed226SJulian Elischer if (sa == NULL)
2098878ed226SJulian Elischer return (EINVAL);
2099878ed226SJulian Elischer if (sa->l2cap_family != AF_BLUETOOTH)
2100878ed226SJulian Elischer return (EAFNOSUPPORT);
2101fbc48c2bSTakanori Watanabe /*For the time being, Not support LE binding.*/
2102fbc48c2bSTakanori Watanabe if ((sa->l2cap_len != sizeof(*sa))&&
2103fbc48c2bSTakanori Watanabe (sa->l2cap_len != sizeof(struct sockaddr_l2cap_compat)))
2104878ed226SJulian Elischer return (EINVAL);
2105878ed226SJulian Elischer
2106878ed226SJulian Elischer psm = le16toh(sa->l2cap_psm);
2107878ed226SJulian Elischer
2108878ed226SJulian Elischer /*
2109878ed226SJulian Elischer * Check if other socket has this address already (look for exact
2110878ed226SJulian Elischer * match PSM and bdaddr) and assign socket address if it's available.
2111878ed226SJulian Elischer *
2112878ed226SJulian Elischer * Note: socket can be bound to ANY PSM (zero) thus allowing several
2113878ed226SJulian Elischer * channels with the same PSM between the same pair of BD_ADDR'es.
2114878ed226SJulian Elischer */
2115878ed226SJulian Elischer
2116878ed226SJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
2117878ed226SJulian Elischer
2118878ed226SJulian Elischer LIST_FOREACH(pcb, &ng_btsocket_l2cap_sockets, next)
2119878ed226SJulian Elischer if (psm != 0 && psm == pcb->psm &&
2120878ed226SJulian Elischer bcmp(&pcb->src, &sa->l2cap_bdaddr, sizeof(bdaddr_t)) == 0)
2121878ed226SJulian Elischer break;
2122878ed226SJulian Elischer
2123878ed226SJulian Elischer if (pcb == NULL) {
2124878ed226SJulian Elischer /* Set socket address */
2125878ed226SJulian Elischer pcb = so2l2cap_pcb(so);
2126878ed226SJulian Elischer if (pcb != NULL) {
2127878ed226SJulian Elischer bcopy(&sa->l2cap_bdaddr, &pcb->src, sizeof(pcb->src));
2128878ed226SJulian Elischer pcb->psm = psm;
2129878ed226SJulian Elischer } else
2130878ed226SJulian Elischer error = EINVAL;
2131878ed226SJulian Elischer } else
2132878ed226SJulian Elischer error = EADDRINUSE;
2133878ed226SJulian Elischer
2134878ed226SJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
2135878ed226SJulian Elischer
2136878ed226SJulian Elischer return (error);
2137878ed226SJulian Elischer } /* ng_btsocket_l2cap_bind */
2138878ed226SJulian Elischer
2139878ed226SJulian Elischer /*
2140878ed226SJulian Elischer * Connect socket
2141878ed226SJulian Elischer */
2142878ed226SJulian Elischer
2143878ed226SJulian Elischer int
ng_btsocket_l2cap_connect(struct socket * so,struct sockaddr * nam,struct thread * td)2144878ed226SJulian Elischer ng_btsocket_l2cap_connect(struct socket *so, struct sockaddr *nam,
2145878ed226SJulian Elischer struct thread *td)
2146878ed226SJulian Elischer {
2147878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = so2l2cap_pcb(so);
2148fbc48c2bSTakanori Watanabe struct sockaddr_l2cap_compat *sal = (struct sockaddr_l2cap_compat *) nam;
2149878ed226SJulian Elischer struct sockaddr_l2cap *sa = (struct sockaddr_l2cap *)nam;
2150fbc48c2bSTakanori Watanabe struct sockaddr_l2cap ba;
2151878ed226SJulian Elischer ng_btsocket_l2cap_rtentry_t *rt = NULL;
2152878ed226SJulian Elischer int have_src, error = 0;
21533a601a23STakanori Watanabe int idtype = NG_L2CAP_L2CA_IDTYPE_BREDR;
2154878ed226SJulian Elischer /* Check socket */
2155878ed226SJulian Elischer if (pcb == NULL)
2156878ed226SJulian Elischer return (EINVAL);
2157878ed226SJulian Elischer if (ng_btsocket_l2cap_node == NULL)
2158878ed226SJulian Elischer return (EINVAL);
2159878ed226SJulian Elischer if (pcb->state == NG_BTSOCKET_L2CAP_CONNECTING)
2160878ed226SJulian Elischer return (EINPROGRESS);
2161878ed226SJulian Elischer
2162878ed226SJulian Elischer /* Verify address */
2163878ed226SJulian Elischer if (sa == NULL)
2164878ed226SJulian Elischer return (EINVAL);
2165878ed226SJulian Elischer if (sa->l2cap_family != AF_BLUETOOTH)
2166878ed226SJulian Elischer return (EAFNOSUPPORT);
2167fbc48c2bSTakanori Watanabe if (sa->l2cap_len == sizeof(*sal)){
2168fbc48c2bSTakanori Watanabe bcopy(sal, &ba, sizeof(*sal));
2169fbc48c2bSTakanori Watanabe sa = &ba;
2170fbc48c2bSTakanori Watanabe sa->l2cap_len = sizeof(*sa);
2171fbc48c2bSTakanori Watanabe sa->l2cap_bdaddr_type = BDADDR_BREDR;
2172fbc48c2bSTakanori Watanabe }
2173878ed226SJulian Elischer if (sa->l2cap_len != sizeof(*sa))
2174878ed226SJulian Elischer return (EINVAL);
2175fbc48c2bSTakanori Watanabe if ((sa->l2cap_psm && sa->l2cap_cid))
2176fbc48c2bSTakanori Watanabe return EINVAL;
2177fbc48c2bSTakanori Watanabe if (bcmp(&sa->l2cap_bdaddr, NG_HCI_BDADDR_ANY, sizeof(bdaddr_t)) == 0)
2178878ed226SJulian Elischer return (EDESTADDRREQ);
2179fbc48c2bSTakanori Watanabe if((sa->l2cap_bdaddr_type == BDADDR_BREDR)&&
2180fbc48c2bSTakanori Watanabe (sa->l2cap_psm == 0))
2181fbc48c2bSTakanori Watanabe return EDESTADDRREQ;
21823a601a23STakanori Watanabe if(sa->l2cap_bdaddr_type != BDADDR_BREDR){
21833a601a23STakanori Watanabe if(sa->l2cap_cid == NG_L2CAP_ATT_CID){
21843a601a23STakanori Watanabe idtype = NG_L2CAP_L2CA_IDTYPE_ATT;
21853a601a23STakanori Watanabe }else if (sa->l2cap_cid == NG_L2CAP_SMP_CID){
21863a601a23STakanori Watanabe idtype =NG_L2CAP_L2CA_IDTYPE_SMP;
21873a601a23STakanori Watanabe }else{
21883a601a23STakanori Watanabe //if cid == 0 idtype = NG_L2CAP_L2CA_IDTYPE_LE;
21893a601a23STakanori Watanabe // Not supported yet
2190fbc48c2bSTakanori Watanabe return EINVAL;
2191fbc48c2bSTakanori Watanabe }
21923a601a23STakanori Watanabe }
2193878ed226SJulian Elischer if (pcb->psm != 0 && pcb->psm != le16toh(sa->l2cap_psm))
2194878ed226SJulian Elischer return (EINVAL);
2195878ed226SJulian Elischer /*
2196878ed226SJulian Elischer * Routing. Socket should be bound to some source address. The source
2197878ed226SJulian Elischer * address can be ANY. Destination address must be set and it must not
2198878ed226SJulian Elischer * be ANY. If source address is ANY then find first rtentry that has
2199878ed226SJulian Elischer * src != dst.
2200878ed226SJulian Elischer */
2201878ed226SJulian Elischer
2202f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_rt_mtx);
2203f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
2204f2bb1caeSJulian Elischer mtx_lock(&pcb->pcb_mtx);
2205f2bb1caeSJulian Elischer
2206f2bb1caeSJulian Elischer /* Send destination address and PSM */
2207f2bb1caeSJulian Elischer bcopy(&sa->l2cap_bdaddr, &pcb->dst, sizeof(pcb->dst));
2208f2bb1caeSJulian Elischer pcb->psm = le16toh(sa->l2cap_psm);
2209fbc48c2bSTakanori Watanabe pcb->dsttype = sa->l2cap_bdaddr_type;
22103a601a23STakanori Watanabe pcb->cid = 0;
22113a601a23STakanori Watanabe pcb->idtype = idtype;
2212878ed226SJulian Elischer pcb->rt = NULL;
2213878ed226SJulian Elischer have_src = bcmp(&pcb->src, NG_HCI_BDADDR_ANY, sizeof(pcb->src));
2214878ed226SJulian Elischer
2215878ed226SJulian Elischer LIST_FOREACH(rt, &ng_btsocket_l2cap_rt, next) {
2216878ed226SJulian Elischer if (rt->hook == NULL || NG_HOOK_NOT_VALID(rt->hook))
2217878ed226SJulian Elischer continue;
2218878ed226SJulian Elischer
2219878ed226SJulian Elischer /* Match src and dst */
2220878ed226SJulian Elischer if (have_src) {
2221878ed226SJulian Elischer if (bcmp(&pcb->src, &rt->src, sizeof(rt->src)) == 0)
2222878ed226SJulian Elischer break;
2223878ed226SJulian Elischer } else {
2224878ed226SJulian Elischer if (bcmp(&pcb->dst, &rt->src, sizeof(rt->src)) != 0)
2225878ed226SJulian Elischer break;
2226878ed226SJulian Elischer }
2227878ed226SJulian Elischer }
2228878ed226SJulian Elischer
2229878ed226SJulian Elischer if (rt != NULL) {
2230878ed226SJulian Elischer pcb->rt = rt;
2231878ed226SJulian Elischer
2232fbc48c2bSTakanori Watanabe if (!have_src){
2233878ed226SJulian Elischer bcopy(&rt->src, &pcb->src, sizeof(pcb->src));
2234fbc48c2bSTakanori Watanabe pcb->srctype =
2235fbc48c2bSTakanori Watanabe (sa->l2cap_bdaddr_type == BDADDR_BREDR)?
22363a601a23STakanori Watanabe BDADDR_BREDR : BDADDR_LE_PUBLIC;
2237fbc48c2bSTakanori Watanabe }
2238878ed226SJulian Elischer } else
2239878ed226SJulian Elischer error = EHOSTUNREACH;
2240878ed226SJulian Elischer
2241878ed226SJulian Elischer /*
2242878ed226SJulian Elischer * Send L2CA_Connect request
2243878ed226SJulian Elischer */
2244878ed226SJulian Elischer
2245878ed226SJulian Elischer if (error == 0) {
2246878ed226SJulian Elischer error = ng_btsocket_l2cap_send_l2ca_con_req(pcb);
2247878ed226SJulian Elischer if (error == 0) {
2248878ed226SJulian Elischer pcb->flags |= NG_BTSOCKET_L2CAP_CLIENT;
2249878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CONNECTING;
2250878ed226SJulian Elischer soisconnecting(pcb->so);
2251878ed226SJulian Elischer
2252878ed226SJulian Elischer ng_btsocket_l2cap_timeout(pcb);
2253878ed226SJulian Elischer }
2254878ed226SJulian Elischer }
2255878ed226SJulian Elischer
2256f2bb1caeSJulian Elischer mtx_unlock(&pcb->pcb_mtx);
2257f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
2258f2bb1caeSJulian Elischer mtx_unlock(&ng_btsocket_l2cap_rt_mtx);
2259f2bb1caeSJulian Elischer
2260878ed226SJulian Elischer return (error);
2261878ed226SJulian Elischer } /* ng_btsocket_l2cap_connect */
2262878ed226SJulian Elischer
2263878ed226SJulian Elischer /*
2264878ed226SJulian Elischer * Process ioctl's calls on socket
2265878ed226SJulian Elischer */
2266878ed226SJulian Elischer
2267878ed226SJulian Elischer int
ng_btsocket_l2cap_control(struct socket * so,u_long cmd,void * data,struct ifnet * ifp,struct thread * td)2268f277746eSGleb Smirnoff ng_btsocket_l2cap_control(struct socket *so, u_long cmd, void *data,
2269878ed226SJulian Elischer struct ifnet *ifp, struct thread *td)
2270878ed226SJulian Elischer {
2271878ed226SJulian Elischer return (EINVAL);
2272878ed226SJulian Elischer } /* ng_btsocket_l2cap_control */
2273878ed226SJulian Elischer
2274878ed226SJulian Elischer /*
2275878ed226SJulian Elischer * Process getsockopt/setsockopt system calls
2276878ed226SJulian Elischer */
2277878ed226SJulian Elischer
2278878ed226SJulian Elischer int
ng_btsocket_l2cap_ctloutput(struct socket * so,struct sockopt * sopt)2279878ed226SJulian Elischer ng_btsocket_l2cap_ctloutput(struct socket *so, struct sockopt *sopt)
2280878ed226SJulian Elischer {
2281878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p pcb = so2l2cap_pcb(so);
2282878ed226SJulian Elischer int error = 0;
2283878ed226SJulian Elischer ng_l2cap_cfg_opt_val_t v;
2284878ed226SJulian Elischer
2285878ed226SJulian Elischer if (pcb == NULL)
2286878ed226SJulian Elischer return (EINVAL);
2287878ed226SJulian Elischer if (ng_btsocket_l2cap_node == NULL)
2288878ed226SJulian Elischer return (EINVAL);
2289878ed226SJulian Elischer
2290878ed226SJulian Elischer if (sopt->sopt_level != SOL_L2CAP)
2291878ed226SJulian Elischer return (0);
2292878ed226SJulian Elischer
2293878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
2294878ed226SJulian Elischer
2295878ed226SJulian Elischer switch (sopt->sopt_dir) {
2296878ed226SJulian Elischer case SOPT_GET:
2297878ed226SJulian Elischer switch (sopt->sopt_name) {
2298878ed226SJulian Elischer case SO_L2CAP_IMTU: /* get incoming MTU */
2299878ed226SJulian Elischer error = sooptcopyout(sopt, &pcb->imtu,
2300878ed226SJulian Elischer sizeof(pcb->imtu));
2301878ed226SJulian Elischer break;
2302878ed226SJulian Elischer
2303878ed226SJulian Elischer case SO_L2CAP_OMTU: /* get outgoing (peer incoming) MTU */
2304878ed226SJulian Elischer error = sooptcopyout(sopt, &pcb->omtu,
2305878ed226SJulian Elischer sizeof(pcb->omtu));
2306878ed226SJulian Elischer break;
2307878ed226SJulian Elischer
2308878ed226SJulian Elischer case SO_L2CAP_IFLOW: /* get incoming flow spec. */
2309878ed226SJulian Elischer error = sooptcopyout(sopt, &pcb->iflow,
2310878ed226SJulian Elischer sizeof(pcb->iflow));
2311878ed226SJulian Elischer break;
2312878ed226SJulian Elischer
2313878ed226SJulian Elischer case SO_L2CAP_OFLOW: /* get outgoing flow spec. */
2314878ed226SJulian Elischer error = sooptcopyout(sopt, &pcb->oflow,
2315878ed226SJulian Elischer sizeof(pcb->oflow));
2316878ed226SJulian Elischer break;
2317878ed226SJulian Elischer
2318878ed226SJulian Elischer case SO_L2CAP_FLUSH: /* get flush timeout */
2319878ed226SJulian Elischer error = sooptcopyout(sopt, &pcb->flush_timo,
2320878ed226SJulian Elischer sizeof(pcb->flush_timo));
2321878ed226SJulian Elischer break;
23223a601a23STakanori Watanabe case SO_L2CAP_ENCRYPTED: /* get encrypt required */
23233a601a23STakanori Watanabe error = sooptcopyout(sopt, &pcb->need_encrypt,
23243a601a23STakanori Watanabe sizeof(pcb->need_encrypt));
23253a601a23STakanori Watanabe break;
23263a601a23STakanori Watanabe
2327878ed226SJulian Elischer default:
2328878ed226SJulian Elischer error = ENOPROTOOPT;
2329878ed226SJulian Elischer break;
2330878ed226SJulian Elischer }
2331878ed226SJulian Elischer break;
2332878ed226SJulian Elischer
2333878ed226SJulian Elischer case SOPT_SET:
2334878ed226SJulian Elischer /*
2335f2bb1caeSJulian Elischer * XXX
2336f2bb1caeSJulian Elischer * We do not allow to change these parameters while socket is
2337f2bb1caeSJulian Elischer * connected or we are in the process of creating a connection.
2338f2bb1caeSJulian Elischer * May be this should indicate re-configuration of the open
2339f2bb1caeSJulian Elischer * channel?
2340878ed226SJulian Elischer */
2341878ed226SJulian Elischer
2342b64b9bb2SMaksim Yevmenkin if (pcb->state != NG_BTSOCKET_L2CAP_CLOSED) {
2343b64b9bb2SMaksim Yevmenkin error = EACCES;
2344b64b9bb2SMaksim Yevmenkin break;
2345b64b9bb2SMaksim Yevmenkin }
2346878ed226SJulian Elischer
2347878ed226SJulian Elischer switch (sopt->sopt_name) {
2348878ed226SJulian Elischer case SO_L2CAP_IMTU: /* set incoming MTU */
2349878ed226SJulian Elischer error = sooptcopyin(sopt, &v, sizeof(v), sizeof(v.mtu));
2350878ed226SJulian Elischer if (error == 0)
2351878ed226SJulian Elischer pcb->imtu = v.mtu;
2352878ed226SJulian Elischer break;
2353878ed226SJulian Elischer
2354878ed226SJulian Elischer case SO_L2CAP_OFLOW: /* set outgoing flow spec. */
2355878ed226SJulian Elischer error = sooptcopyin(sopt, &v, sizeof(v),sizeof(v.flow));
2356878ed226SJulian Elischer if (error == 0)
2357878ed226SJulian Elischer bcopy(&v.flow, &pcb->oflow, sizeof(pcb->oflow));
2358878ed226SJulian Elischer break;
2359878ed226SJulian Elischer
2360878ed226SJulian Elischer case SO_L2CAP_FLUSH: /* set flush timeout */
2361878ed226SJulian Elischer error = sooptcopyin(sopt, &v, sizeof(v),
2362878ed226SJulian Elischer sizeof(v.flush_timo));
2363878ed226SJulian Elischer if (error == 0)
2364878ed226SJulian Elischer pcb->flush_timo = v.flush_timo;
2365878ed226SJulian Elischer break;
23663a601a23STakanori Watanabe case SO_L2CAP_ENCRYPTED: /*set connect encryption opt*/
23673a601a23STakanori Watanabe if((pcb->state != NG_BTSOCKET_L2CAP_OPEN) &&
23683a601a23STakanori Watanabe (pcb->state != NG_BTSOCKET_L2CAP_W4_ENC_CHANGE)){
23693a601a23STakanori Watanabe error = sooptcopyin(sopt, &v, sizeof(v),
23703a601a23STakanori Watanabe sizeof(v.encryption));
23713a601a23STakanori Watanabe if(error == 0)
23723a601a23STakanori Watanabe pcb->need_encrypt = (v.encryption)?1:0;
23733a601a23STakanori Watanabe }else{
23743a601a23STakanori Watanabe error = EINVAL;
23753a601a23STakanori Watanabe }
23763a601a23STakanori Watanabe break;
2377878ed226SJulian Elischer default:
2378878ed226SJulian Elischer error = ENOPROTOOPT;
2379878ed226SJulian Elischer break;
2380878ed226SJulian Elischer }
2381878ed226SJulian Elischer break;
2382878ed226SJulian Elischer
2383878ed226SJulian Elischer default:
2384878ed226SJulian Elischer error = EINVAL;
2385878ed226SJulian Elischer break;
2386878ed226SJulian Elischer }
2387878ed226SJulian Elischer
2388878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
2389878ed226SJulian Elischer
2390878ed226SJulian Elischer return (error);
2391878ed226SJulian Elischer } /* ng_btsocket_l2cap_ctloutput */
2392878ed226SJulian Elischer
2393878ed226SJulian Elischer /*
2394878ed226SJulian Elischer * Detach and destroy socket
2395878ed226SJulian Elischer */
2396878ed226SJulian Elischer
2397bc725eafSRobert Watson void
ng_btsocket_l2cap_detach(struct socket * so)2398878ed226SJulian Elischer ng_btsocket_l2cap_detach(struct socket *so)
2399878ed226SJulian Elischer {
2400878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p pcb = so2l2cap_pcb(so);
2401878ed226SJulian Elischer
2402bc725eafSRobert Watson KASSERT(pcb != NULL, ("ng_btsocket_l2cap_detach: pcb == NULL"));
2403bc725eafSRobert Watson
2404878ed226SJulian Elischer if (ng_btsocket_l2cap_node == NULL)
2405bc725eafSRobert Watson return;
2406878ed226SJulian Elischer
2407f2bb1caeSJulian Elischer mtx_lock(&ng_btsocket_l2cap_sockets_mtx);
2408878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
2409878ed226SJulian Elischer
2410878ed226SJulian Elischer /* XXX what to do with pending request? */
2411878ed226SJulian Elischer if (pcb->flags & NG_BTSOCKET_L2CAP_TIMO)
2412878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
2413878ed226SJulian Elischer
2414878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_CLOSED &&
2415878ed226SJulian Elischer pcb->state != NG_BTSOCKET_L2CAP_DISCONNECTING)
2416878ed226SJulian Elischer /* Send disconnect request with "zero" token */
2417878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_discon_req(0, pcb);
2418878ed226SJulian Elischer
2419878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
2420878ed226SJulian Elischer
2421f2bb1caeSJulian Elischer LIST_REMOVE(pcb, next);
2422878ed226SJulian Elischer
2423878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
2424878ed226SJulian Elischer mtx_unlock(&ng_btsocket_l2cap_sockets_mtx);
2425878ed226SJulian Elischer
2426878ed226SJulian Elischer mtx_destroy(&pcb->pcb_mtx);
2427878ed226SJulian Elischer bzero(pcb, sizeof(*pcb));
24281ede983cSDag-Erling Smørgrav free(pcb, M_NETGRAPH_BTSOCKET_L2CAP);
2429878ed226SJulian Elischer
2430f2bb1caeSJulian Elischer soisdisconnected(so);
2431f2bb1caeSJulian Elischer so->so_pcb = NULL;
2432878ed226SJulian Elischer } /* ng_btsocket_l2cap_detach */
2433878ed226SJulian Elischer
2434878ed226SJulian Elischer /*
2435878ed226SJulian Elischer * Disconnect socket
2436878ed226SJulian Elischer */
2437878ed226SJulian Elischer
2438878ed226SJulian Elischer int
ng_btsocket_l2cap_disconnect(struct socket * so)2439878ed226SJulian Elischer ng_btsocket_l2cap_disconnect(struct socket *so)
2440878ed226SJulian Elischer {
2441878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p pcb = so2l2cap_pcb(so);
2442878ed226SJulian Elischer int error = 0;
2443878ed226SJulian Elischer
2444878ed226SJulian Elischer if (pcb == NULL)
2445878ed226SJulian Elischer return (EINVAL);
2446878ed226SJulian Elischer if (ng_btsocket_l2cap_node == NULL)
2447878ed226SJulian Elischer return (EINVAL);
2448878ed226SJulian Elischer
2449878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
2450878ed226SJulian Elischer
2451878ed226SJulian Elischer if (pcb->state == NG_BTSOCKET_L2CAP_DISCONNECTING) {
2452878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
2453878ed226SJulian Elischer return (EINPROGRESS);
2454878ed226SJulian Elischer }
2455878ed226SJulian Elischer
2456878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_CLOSED) {
2457878ed226SJulian Elischer /* XXX FIXME what to do with pending request? */
2458878ed226SJulian Elischer if (pcb->flags & NG_BTSOCKET_L2CAP_TIMO)
2459878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(pcb);
2460878ed226SJulian Elischer
2461878ed226SJulian Elischer error = ng_btsocket_l2cap_send_l2ca_discon_req(pcb->token, pcb);
2462878ed226SJulian Elischer if (error == 0) {
2463878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_DISCONNECTING;
2464878ed226SJulian Elischer soisdisconnecting(so);
2465878ed226SJulian Elischer
2466878ed226SJulian Elischer ng_btsocket_l2cap_timeout(pcb);
2467878ed226SJulian Elischer }
2468878ed226SJulian Elischer
2469878ed226SJulian Elischer /* XXX FIXME what to do if error != 0 */
2470878ed226SJulian Elischer }
2471878ed226SJulian Elischer
2472878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
2473878ed226SJulian Elischer
2474878ed226SJulian Elischer return (error);
2475878ed226SJulian Elischer } /* ng_btsocket_l2cap_disconnect */
2476878ed226SJulian Elischer
2477878ed226SJulian Elischer /*
2478878ed226SJulian Elischer * Listen on socket
2479878ed226SJulian Elischer */
2480878ed226SJulian Elischer
2481878ed226SJulian Elischer int
ng_btsocket_l2cap_listen(struct socket * so,int backlog,struct thread * td)2482d374e81eSRobert Watson ng_btsocket_l2cap_listen(struct socket *so, int backlog, struct thread *td)
2483878ed226SJulian Elischer {
2484878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p pcb = so2l2cap_pcb(so);
24850daccb9cSRobert Watson int error;
2486878ed226SJulian Elischer
24870daccb9cSRobert Watson SOCK_LOCK(so);
24880daccb9cSRobert Watson error = solisten_proto_check(so);
24890daccb9cSRobert Watson if (error != 0)
24900daccb9cSRobert Watson goto out;
24910daccb9cSRobert Watson if (pcb == NULL) {
2492bd4a39ccSMark Johnston solisten_proto_abort(so);
24930daccb9cSRobert Watson error = EINVAL;
24940daccb9cSRobert Watson goto out;
24950daccb9cSRobert Watson }
24960daccb9cSRobert Watson if (ng_btsocket_l2cap_node == NULL) {
2497bd4a39ccSMark Johnston solisten_proto_abort(so);
24980daccb9cSRobert Watson error = EINVAL;
24990daccb9cSRobert Watson goto out;
25000daccb9cSRobert Watson }
25010daccb9cSRobert Watson if (pcb->psm == 0) {
2502bd4a39ccSMark Johnston solisten_proto_abort(so);
2503d46210e6SMaksim Yevmenkin error = EADDRNOTAVAIL;
25040daccb9cSRobert Watson goto out;
25050daccb9cSRobert Watson }
2506d374e81eSRobert Watson solisten_proto(so, backlog);
25070daccb9cSRobert Watson out:
25080daccb9cSRobert Watson SOCK_UNLOCK(so);
25090daccb9cSRobert Watson return (error);
2510878ed226SJulian Elischer } /* ng_btsocket_listen */
2511878ed226SJulian Elischer
25120fac350cSGleb Smirnoff /*
25130fac350cSGleb Smirnoff * Return peer address for getpeername(2) or for accept(2). For the latter
25140fac350cSGleb Smirnoff * case no extra work to do here, socket must be connected and ready.
25150fac350cSGleb Smirnoff */
25160fac350cSGleb Smirnoff int
ng_btsocket_l2cap_peeraddr(struct socket * so,struct sockaddr * sa)25170fac350cSGleb Smirnoff ng_btsocket_l2cap_peeraddr(struct socket *so, struct sockaddr *sa)
2518878ed226SJulian Elischer {
2519878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p pcb = so2l2cap_pcb(so);
25200fac350cSGleb Smirnoff struct sockaddr_l2cap *l2cap = (struct sockaddr_l2cap *)sa;
2521878ed226SJulian Elischer
2522878ed226SJulian Elischer if (pcb == NULL)
2523878ed226SJulian Elischer return (EINVAL);
2524878ed226SJulian Elischer if (ng_btsocket_l2cap_node == NULL)
2525878ed226SJulian Elischer return (EINVAL);
2526878ed226SJulian Elischer
25270fac350cSGleb Smirnoff *l2cap = (struct sockaddr_l2cap ){
2528cfb1e929SGleb Smirnoff .l2cap_len = sizeof(struct sockaddr_l2cap),
2529cfb1e929SGleb Smirnoff .l2cap_family = AF_BLUETOOTH,
2530cfb1e929SGleb Smirnoff .l2cap_psm = htole16(pcb->psm),
2531cfb1e929SGleb Smirnoff };
25320fac350cSGleb Smirnoff bcopy(&pcb->dst, &l2cap->l2cap_bdaddr, sizeof(l2cap->l2cap_bdaddr));
25333a601a23STakanori Watanabe switch(pcb->idtype){
25343a601a23STakanori Watanabe case NG_L2CAP_L2CA_IDTYPE_ATT:
25350fac350cSGleb Smirnoff l2cap->l2cap_cid = NG_L2CAP_ATT_CID;
25363a601a23STakanori Watanabe break;
25373a601a23STakanori Watanabe case NG_L2CAP_L2CA_IDTYPE_SMP:
25380fac350cSGleb Smirnoff l2cap->l2cap_cid = NG_L2CAP_SMP_CID;
25393a601a23STakanori Watanabe break;
25403a601a23STakanori Watanabe default:
25410fac350cSGleb Smirnoff l2cap->l2cap_cid = 0;
25423a601a23STakanori Watanabe break;
25433a601a23STakanori Watanabe }
25440fac350cSGleb Smirnoff l2cap->l2cap_bdaddr_type = pcb->dsttype;
2545cfb1e929SGleb Smirnoff
2546cfb1e929SGleb Smirnoff return (0);
2547cfb1e929SGleb Smirnoff }
2548cfb1e929SGleb Smirnoff
2549cfb1e929SGleb Smirnoff /*
2550878ed226SJulian Elischer * Send data to socket
2551878ed226SJulian Elischer */
2552878ed226SJulian Elischer
2553878ed226SJulian Elischer int
ng_btsocket_l2cap_send(struct socket * so,int flags,struct mbuf * m,struct sockaddr * nam,struct mbuf * control,struct thread * td)2554878ed226SJulian Elischer ng_btsocket_l2cap_send(struct socket *so, int flags, struct mbuf *m,
2555878ed226SJulian Elischer struct sockaddr *nam, struct mbuf *control, struct thread *td)
2556878ed226SJulian Elischer {
2557878ed226SJulian Elischer ng_btsocket_l2cap_pcb_t *pcb = so2l2cap_pcb(so);
2558878ed226SJulian Elischer int error = 0;
2559878ed226SJulian Elischer
2560878ed226SJulian Elischer if (ng_btsocket_l2cap_node == NULL) {
2561878ed226SJulian Elischer error = ENETDOWN;
2562878ed226SJulian Elischer goto drop;
2563878ed226SJulian Elischer }
2564878ed226SJulian Elischer
2565878ed226SJulian Elischer /* Check socket and input */
2566878ed226SJulian Elischer if (pcb == NULL || m == NULL || control != NULL) {
2567878ed226SJulian Elischer error = EINVAL;
2568878ed226SJulian Elischer goto drop;
2569878ed226SJulian Elischer }
2570878ed226SJulian Elischer
2571878ed226SJulian Elischer mtx_lock(&pcb->pcb_mtx);
2572878ed226SJulian Elischer
2573878ed226SJulian Elischer /* Make sure socket is connected */
2574878ed226SJulian Elischer if (pcb->state != NG_BTSOCKET_L2CAP_OPEN) {
2575878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
2576878ed226SJulian Elischer error = ENOTCONN;
2577878ed226SJulian Elischer goto drop;
2578878ed226SJulian Elischer }
2579878ed226SJulian Elischer
2580878ed226SJulian Elischer /* Check route */
2581878ed226SJulian Elischer if (pcb->rt == NULL ||
2582878ed226SJulian Elischer pcb->rt->hook == NULL || NG_HOOK_NOT_VALID(pcb->rt->hook)) {
2583878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
2584878ed226SJulian Elischer error = ENETDOWN;
2585878ed226SJulian Elischer goto drop;
2586878ed226SJulian Elischer }
2587878ed226SJulian Elischer
2588053359b7SPedro F. Giffuni /* Check packet size against outgoing (peer's incoming) MTU) */
2589878ed226SJulian Elischer if (m->m_pkthdr.len > pcb->omtu) {
2590878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
2591878ed226SJulian Elischer "%s: Packet too big, len=%d, omtu=%d\n", __func__, m->m_pkthdr.len, pcb->omtu);
2592878ed226SJulian Elischer
2593878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
2594878ed226SJulian Elischer error = EMSGSIZE;
2595878ed226SJulian Elischer goto drop;
2596878ed226SJulian Elischer }
2597878ed226SJulian Elischer
2598878ed226SJulian Elischer /*
2599878ed226SJulian Elischer * First put packet on socket send queue. Then check if we have
2600878ed226SJulian Elischer * pending timeout. If we do not have timeout then we must send
2601878ed226SJulian Elischer * packet and schedule timeout. Otherwise do nothing and wait for
2602878ed226SJulian Elischer * L2CA_WRITE_RSP.
2603878ed226SJulian Elischer */
2604878ed226SJulian Elischer
2605878ed226SJulian Elischer sbappendrecord(&pcb->so->so_snd, m);
2606878ed226SJulian Elischer m = NULL;
2607878ed226SJulian Elischer
2608878ed226SJulian Elischer if (!(pcb->flags & NG_BTSOCKET_L2CAP_TIMO)) {
2609878ed226SJulian Elischer error = ng_btsocket_l2cap_send2(pcb);
2610878ed226SJulian Elischer if (error == 0)
2611878ed226SJulian Elischer ng_btsocket_l2cap_timeout(pcb);
2612878ed226SJulian Elischer else
2613878ed226SJulian Elischer sbdroprecord(&pcb->so->so_snd); /* XXX */
2614878ed226SJulian Elischer }
2615878ed226SJulian Elischer
2616878ed226SJulian Elischer mtx_unlock(&pcb->pcb_mtx);
2617878ed226SJulian Elischer drop:
2618878ed226SJulian Elischer NG_FREE_M(m); /* checks for != NULL */
2619878ed226SJulian Elischer NG_FREE_M(control);
2620878ed226SJulian Elischer
2621878ed226SJulian Elischer return (error);
2622878ed226SJulian Elischer } /* ng_btsocket_l2cap_send */
2623878ed226SJulian Elischer
2624878ed226SJulian Elischer /*
2625878ed226SJulian Elischer * Send first packet in the socket queue to the L2CAP layer
2626878ed226SJulian Elischer */
2627878ed226SJulian Elischer
2628878ed226SJulian Elischer static int
ng_btsocket_l2cap_send2(ng_btsocket_l2cap_pcb_p pcb)2629878ed226SJulian Elischer ng_btsocket_l2cap_send2(ng_btsocket_l2cap_pcb_p pcb)
2630878ed226SJulian Elischer {
2631878ed226SJulian Elischer struct mbuf *m = NULL;
2632878ed226SJulian Elischer ng_l2cap_l2ca_hdr_t *hdr = NULL;
2633878ed226SJulian Elischer int error = 0;
2634878ed226SJulian Elischer
2635878ed226SJulian Elischer mtx_assert(&pcb->pcb_mtx, MA_OWNED);
2636878ed226SJulian Elischer
2637cfa6009eSGleb Smirnoff if (sbavail(&pcb->so->so_snd) == 0)
2638878ed226SJulian Elischer return (EINVAL); /* XXX */
2639878ed226SJulian Elischer
2640eb1b1807SGleb Smirnoff m = m_dup(pcb->so->so_snd.sb_mb, M_NOWAIT);
2641878ed226SJulian Elischer if (m == NULL)
2642878ed226SJulian Elischer return (ENOBUFS);
2643878ed226SJulian Elischer
2644878ed226SJulian Elischer /* Create L2CA packet header */
2645eb1b1807SGleb Smirnoff M_PREPEND(m, sizeof(*hdr), M_NOWAIT);
2646878ed226SJulian Elischer if (m != NULL)
2647878ed226SJulian Elischer if (m->m_len < sizeof(*hdr))
2648878ed226SJulian Elischer m = m_pullup(m, sizeof(*hdr));
2649878ed226SJulian Elischer
2650878ed226SJulian Elischer if (m == NULL) {
2651878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
2652878ed226SJulian Elischer "%s: Failed to create L2CA packet header\n", __func__);
2653878ed226SJulian Elischer
2654878ed226SJulian Elischer return (ENOBUFS);
2655878ed226SJulian Elischer }
2656878ed226SJulian Elischer
2657878ed226SJulian Elischer hdr = mtod(m, ng_l2cap_l2ca_hdr_t *);
2658878ed226SJulian Elischer hdr->token = pcb->token;
2659878ed226SJulian Elischer hdr->length = m->m_pkthdr.len - sizeof(*hdr);
2660878ed226SJulian Elischer hdr->lcid = pcb->cid;
26613a601a23STakanori Watanabe hdr->idtype = pcb->idtype;
2662878ed226SJulian Elischer NG_BTSOCKET_L2CAP_INFO(
2663878ed226SJulian Elischer "%s: Sending packet: len=%d, length=%d, lcid=%d, token=%d, state=%d\n",
2664878ed226SJulian Elischer __func__, m->m_pkthdr.len, hdr->length, hdr->lcid,
2665878ed226SJulian Elischer hdr->token, pcb->state);
2666878ed226SJulian Elischer
2667878ed226SJulian Elischer /*
2668053359b7SPedro F. Giffuni * If we got here than we have successfully creates new L2CAP
2669878ed226SJulian Elischer * data packet and now we can send it to the L2CAP layer
2670878ed226SJulian Elischer */
2671878ed226SJulian Elischer
2672878ed226SJulian Elischer NG_SEND_DATA_ONLY(error, pcb->rt->hook, m);
2673878ed226SJulian Elischer
2674878ed226SJulian Elischer return (error);
2675878ed226SJulian Elischer } /* ng_btsocket_l2cap_send2 */
2676878ed226SJulian Elischer
2677878ed226SJulian Elischer /*
2678878ed226SJulian Elischer * Get socket address
2679878ed226SJulian Elischer */
2680878ed226SJulian Elischer int
ng_btsocket_l2cap_sockaddr(struct socket * so,struct sockaddr * sa)26810fac350cSGleb Smirnoff ng_btsocket_l2cap_sockaddr(struct socket *so, struct sockaddr *sa)
2682878ed226SJulian Elischer {
2683878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p pcb = so2l2cap_pcb(so);
26840fac350cSGleb Smirnoff struct sockaddr_l2cap *l2cap = (struct sockaddr_l2cap *)sa;
2685878ed226SJulian Elischer
2686878ed226SJulian Elischer if (pcb == NULL)
2687878ed226SJulian Elischer return (EINVAL);
2688878ed226SJulian Elischer if (ng_btsocket_l2cap_node == NULL)
2689878ed226SJulian Elischer return (EINVAL);
2690878ed226SJulian Elischer
26910fac350cSGleb Smirnoff *l2cap = (struct sockaddr_l2cap ){
26920fac350cSGleb Smirnoff .l2cap_len = sizeof(struct sockaddr_l2cap),
26930fac350cSGleb Smirnoff .l2cap_family = AF_BLUETOOTH,
26940fac350cSGleb Smirnoff .l2cap_psm = htole16(pcb->psm),
26950fac350cSGleb Smirnoff .l2cap_bdaddr_type = pcb->srctype,
26960fac350cSGleb Smirnoff };
26970fac350cSGleb Smirnoff bcopy(&pcb->src, &l2cap->l2cap_bdaddr, sizeof(l2cap->l2cap_bdaddr));
2698878ed226SJulian Elischer
26990fac350cSGleb Smirnoff return (0);
27000fac350cSGleb Smirnoff }
2701878ed226SJulian Elischer
2702878ed226SJulian Elischer /*****************************************************************************
2703878ed226SJulian Elischer *****************************************************************************
2704878ed226SJulian Elischer ** Misc. functions
2705878ed226SJulian Elischer *****************************************************************************
2706878ed226SJulian Elischer *****************************************************************************/
2707878ed226SJulian Elischer
2708878ed226SJulian Elischer /*
2709878ed226SJulian Elischer * Look for the socket that listens on given PSM and bdaddr. Returns exact or
2710f2bb1caeSJulian Elischer * close match (if any). Caller must hold ng_btsocket_l2cap_sockets_mtx.
2711878ed226SJulian Elischer */
2712878ed226SJulian Elischer
2713878ed226SJulian Elischer static ng_btsocket_l2cap_pcb_p
ng_btsocket_l2cap_pcb_by_addr(bdaddr_p bdaddr,int psm)2714878ed226SJulian Elischer ng_btsocket_l2cap_pcb_by_addr(bdaddr_p bdaddr, int psm)
2715878ed226SJulian Elischer {
2716878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p p = NULL, p1 = NULL;
2717878ed226SJulian Elischer
2718f2bb1caeSJulian Elischer mtx_assert(&ng_btsocket_l2cap_sockets_mtx, MA_OWNED);
2719878ed226SJulian Elischer
2720878ed226SJulian Elischer LIST_FOREACH(p, &ng_btsocket_l2cap_sockets, next) {
2721f4bb1869SMark Johnston if (p->so == NULL || !SOLISTENING(p->so) || p->psm != psm)
2722878ed226SJulian Elischer continue;
2723878ed226SJulian Elischer
2724878ed226SJulian Elischer if (bcmp(&p->src, bdaddr, sizeof(p->src)) == 0)
2725878ed226SJulian Elischer break;
2726878ed226SJulian Elischer
2727878ed226SJulian Elischer if (bcmp(&p->src, NG_HCI_BDADDR_ANY, sizeof(p->src)) == 0)
2728878ed226SJulian Elischer p1 = p;
2729878ed226SJulian Elischer }
2730878ed226SJulian Elischer
2731878ed226SJulian Elischer return ((p != NULL)? p : p1);
2732878ed226SJulian Elischer } /* ng_btsocket_l2cap_pcb_by_addr */
2733878ed226SJulian Elischer
2734878ed226SJulian Elischer /*
2735f2bb1caeSJulian Elischer * Look for the socket that has given token.
2736f2bb1caeSJulian Elischer * Caller must hold ng_btsocket_l2cap_sockets_mtx.
2737878ed226SJulian Elischer */
2738878ed226SJulian Elischer
2739878ed226SJulian Elischer static ng_btsocket_l2cap_pcb_p
ng_btsocket_l2cap_pcb_by_token(u_int32_t token)2740878ed226SJulian Elischer ng_btsocket_l2cap_pcb_by_token(u_int32_t token)
2741878ed226SJulian Elischer {
2742878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p p = NULL;
2743878ed226SJulian Elischer
2744f2bb1caeSJulian Elischer if (token == 0)
2745f2bb1caeSJulian Elischer return (NULL);
2746f2bb1caeSJulian Elischer
2747f2bb1caeSJulian Elischer mtx_assert(&ng_btsocket_l2cap_sockets_mtx, MA_OWNED);
2748878ed226SJulian Elischer
2749878ed226SJulian Elischer LIST_FOREACH(p, &ng_btsocket_l2cap_sockets, next)
2750878ed226SJulian Elischer if (p->token == token)
2751878ed226SJulian Elischer break;
2752878ed226SJulian Elischer
2753878ed226SJulian Elischer return (p);
2754878ed226SJulian Elischer } /* ng_btsocket_l2cap_pcb_by_token */
2755878ed226SJulian Elischer
2756878ed226SJulian Elischer /*
2757f2bb1caeSJulian Elischer * Look for the socket that assigned to given source address and channel ID.
2758f2bb1caeSJulian Elischer * Caller must hold ng_btsocket_l2cap_sockets_mtx
2759878ed226SJulian Elischer */
2760878ed226SJulian Elischer
2761878ed226SJulian Elischer static ng_btsocket_l2cap_pcb_p
ng_btsocket_l2cap_pcb_by_cid(bdaddr_p src,int cid,int idtype)2762fbc48c2bSTakanori Watanabe ng_btsocket_l2cap_pcb_by_cid(bdaddr_p src, int cid, int idtype)
2763878ed226SJulian Elischer {
2764878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p p = NULL;
2765878ed226SJulian Elischer
2766f2bb1caeSJulian Elischer mtx_assert(&ng_btsocket_l2cap_sockets_mtx, MA_OWNED);
2767878ed226SJulian Elischer
2768fbc48c2bSTakanori Watanabe LIST_FOREACH(p, &ng_btsocket_l2cap_sockets, next){
2769fbc48c2bSTakanori Watanabe if (p->cid == cid &&
2770fbc48c2bSTakanori Watanabe bcmp(src, &p->src, sizeof(p->src)) == 0&&
27713a601a23STakanori Watanabe p->idtype == idtype)
2772878ed226SJulian Elischer break;
2773fbc48c2bSTakanori Watanabe }
2774878ed226SJulian Elischer return (p);
2775878ed226SJulian Elischer } /* ng_btsocket_l2cap_pcb_by_cid */
2776878ed226SJulian Elischer
2777878ed226SJulian Elischer /*
2778878ed226SJulian Elischer * Set timeout on socket
2779878ed226SJulian Elischer */
2780878ed226SJulian Elischer
2781878ed226SJulian Elischer static void
ng_btsocket_l2cap_timeout(ng_btsocket_l2cap_pcb_p pcb)2782878ed226SJulian Elischer ng_btsocket_l2cap_timeout(ng_btsocket_l2cap_pcb_p pcb)
2783878ed226SJulian Elischer {
2784878ed226SJulian Elischer mtx_assert(&pcb->pcb_mtx, MA_OWNED);
2785878ed226SJulian Elischer
2786878ed226SJulian Elischer if (!(pcb->flags & NG_BTSOCKET_L2CAP_TIMO)) {
2787878ed226SJulian Elischer pcb->flags |= NG_BTSOCKET_L2CAP_TIMO;
27883d1592efSJohn Baldwin callout_reset(&pcb->timo, bluetooth_l2cap_ertx_timeout(),
27893d1592efSJohn Baldwin ng_btsocket_l2cap_process_timeout, pcb);
2790878ed226SJulian Elischer } else
2791878ed226SJulian Elischer KASSERT(0,
2792878ed226SJulian Elischer ("%s: Duplicated socket timeout?!\n", __func__));
2793878ed226SJulian Elischer } /* ng_btsocket_l2cap_timeout */
2794878ed226SJulian Elischer
2795878ed226SJulian Elischer /*
2796878ed226SJulian Elischer * Unset timeout on socket
2797878ed226SJulian Elischer */
2798878ed226SJulian Elischer
2799878ed226SJulian Elischer static void
ng_btsocket_l2cap_untimeout(ng_btsocket_l2cap_pcb_p pcb)2800878ed226SJulian Elischer ng_btsocket_l2cap_untimeout(ng_btsocket_l2cap_pcb_p pcb)
2801878ed226SJulian Elischer {
2802878ed226SJulian Elischer mtx_assert(&pcb->pcb_mtx, MA_OWNED);
2803878ed226SJulian Elischer
2804878ed226SJulian Elischer if (pcb->flags & NG_BTSOCKET_L2CAP_TIMO) {
28053d1592efSJohn Baldwin callout_stop(&pcb->timo);
2806878ed226SJulian Elischer pcb->flags &= ~NG_BTSOCKET_L2CAP_TIMO;
2807878ed226SJulian Elischer } else
2808878ed226SJulian Elischer KASSERT(0,
2809878ed226SJulian Elischer ("%s: No socket timeout?!\n", __func__));
2810878ed226SJulian Elischer } /* ng_btsocket_l2cap_untimeout */
2811878ed226SJulian Elischer
2812878ed226SJulian Elischer /*
2813878ed226SJulian Elischer * Process timeout on socket
2814878ed226SJulian Elischer */
2815878ed226SJulian Elischer
2816878ed226SJulian Elischer static void
ng_btsocket_l2cap_process_timeout(void * xpcb)2817878ed226SJulian Elischer ng_btsocket_l2cap_process_timeout(void *xpcb)
2818878ed226SJulian Elischer {
2819878ed226SJulian Elischer ng_btsocket_l2cap_pcb_p pcb = (ng_btsocket_l2cap_pcb_p) xpcb;
2820878ed226SJulian Elischer
28213d1592efSJohn Baldwin mtx_assert(&pcb->pcb_mtx, MA_OWNED);
2822878ed226SJulian Elischer
2823878ed226SJulian Elischer pcb->flags &= ~NG_BTSOCKET_L2CAP_TIMO;
2824878ed226SJulian Elischer pcb->so->so_error = ETIMEDOUT;
2825878ed226SJulian Elischer
2826878ed226SJulian Elischer switch (pcb->state) {
2827878ed226SJulian Elischer case NG_BTSOCKET_L2CAP_CONNECTING:
2828878ed226SJulian Elischer case NG_BTSOCKET_L2CAP_CONFIGURING:
2829483ed395STakanori Watanabe case NG_BTSOCKET_L2CAP_W4_ENC_CHANGE:
2830878ed226SJulian Elischer /* Send disconnect request with "zero" token */
2831878ed226SJulian Elischer if (pcb->cid != 0)
2832878ed226SJulian Elischer ng_btsocket_l2cap_send_l2ca_discon_req(0, pcb);
2833878ed226SJulian Elischer
2834878ed226SJulian Elischer /* ... and close the socket */
2835878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
2836878ed226SJulian Elischer soisdisconnected(pcb->so);
2837878ed226SJulian Elischer break;
2838878ed226SJulian Elischer
2839878ed226SJulian Elischer case NG_BTSOCKET_L2CAP_OPEN:
2840878ed226SJulian Elischer /* Send timeout - drop packet and wakeup sender */
2841878ed226SJulian Elischer sbdroprecord(&pcb->so->so_snd);
2842878ed226SJulian Elischer sowwakeup(pcb->so);
2843878ed226SJulian Elischer break;
2844878ed226SJulian Elischer
2845878ed226SJulian Elischer case NG_BTSOCKET_L2CAP_DISCONNECTING:
2846878ed226SJulian Elischer /* Disconnect timeout - disconnect the socket anyway */
2847878ed226SJulian Elischer pcb->state = NG_BTSOCKET_L2CAP_CLOSED;
2848878ed226SJulian Elischer soisdisconnected(pcb->so);
2849878ed226SJulian Elischer break;
2850878ed226SJulian Elischer
2851878ed226SJulian Elischer default:
2852878ed226SJulian Elischer NG_BTSOCKET_L2CAP_ERR(
2853878ed226SJulian Elischer "%s: Invalid socket state=%d\n", __func__, pcb->state);
2854878ed226SJulian Elischer break;
2855878ed226SJulian Elischer }
2856878ed226SJulian Elischer } /* ng_btsocket_l2cap_process_timeout */
2857878ed226SJulian Elischer
2858878ed226SJulian Elischer /*
2859878ed226SJulian Elischer * Translate HCI/L2CAP error code into "errno" code
2860878ed226SJulian Elischer * XXX Note: Some L2CAP and HCI error codes have the same value, but
2861878ed226SJulian Elischer * different meaning
2862878ed226SJulian Elischer */
2863878ed226SJulian Elischer
2864878ed226SJulian Elischer static int
ng_btsocket_l2cap_result2errno(int result)2865878ed226SJulian Elischer ng_btsocket_l2cap_result2errno(int result)
2866878ed226SJulian Elischer {
2867878ed226SJulian Elischer switch (result) {
2868878ed226SJulian Elischer case 0x00: /* No error */
2869878ed226SJulian Elischer return (0);
2870878ed226SJulian Elischer
2871878ed226SJulian Elischer case 0x01: /* Unknown HCI command */
2872878ed226SJulian Elischer return (ENODEV);
2873878ed226SJulian Elischer
2874878ed226SJulian Elischer case 0x02: /* No connection */
2875878ed226SJulian Elischer return (ENOTCONN);
2876878ed226SJulian Elischer
2877878ed226SJulian Elischer case 0x03: /* Hardware failure */
2878878ed226SJulian Elischer return (EIO);
2879878ed226SJulian Elischer
2880878ed226SJulian Elischer case 0x04: /* Page timeout */
2881878ed226SJulian Elischer return (EHOSTDOWN);
2882878ed226SJulian Elischer
2883878ed226SJulian Elischer case 0x05: /* Authentication failure */
2884878ed226SJulian Elischer case 0x06: /* Key missing */
2885878ed226SJulian Elischer case 0x18: /* Pairing not allowed */
2886878ed226SJulian Elischer case 0x21: /* Role change not allowed */
2887878ed226SJulian Elischer case 0x24: /* LMP PSU not allowed */
2888878ed226SJulian Elischer case 0x25: /* Encryption mode not acceptable */
2889878ed226SJulian Elischer case 0x26: /* Unit key used */
2890878ed226SJulian Elischer return (EACCES);
2891878ed226SJulian Elischer
2892878ed226SJulian Elischer case 0x07: /* Memory full */
2893878ed226SJulian Elischer return (ENOMEM);
2894878ed226SJulian Elischer
2895878ed226SJulian Elischer case 0x08: /* Connection timeout */
2896878ed226SJulian Elischer case 0x10: /* Host timeout */
2897878ed226SJulian Elischer case 0x22: /* LMP response timeout */
2898878ed226SJulian Elischer case 0xee: /* HCI timeout */
2899878ed226SJulian Elischer case 0xeeee: /* L2CAP timeout */
2900878ed226SJulian Elischer return (ETIMEDOUT);
2901878ed226SJulian Elischer
2902878ed226SJulian Elischer case 0x09: /* Max number of connections */
2903878ed226SJulian Elischer case 0x0a: /* Max number of SCO connections to a unit */
2904878ed226SJulian Elischer return (EMLINK);
2905878ed226SJulian Elischer
2906878ed226SJulian Elischer case 0x0b: /* ACL connection already exists */
2907878ed226SJulian Elischer return (EEXIST);
2908878ed226SJulian Elischer
2909878ed226SJulian Elischer case 0x0c: /* Command disallowed */
2910878ed226SJulian Elischer return (EBUSY);
2911878ed226SJulian Elischer
2912878ed226SJulian Elischer case 0x0d: /* Host rejected due to limited resources */
2913878ed226SJulian Elischer case 0x0e: /* Host rejected due to securiity reasons */
2914878ed226SJulian Elischer case 0x0f: /* Host rejected due to remote unit is a personal unit */
2915878ed226SJulian Elischer case 0x1b: /* SCO offset rejected */
2916878ed226SJulian Elischer case 0x1c: /* SCO interval rejected */
2917878ed226SJulian Elischer case 0x1d: /* SCO air mode rejected */
2918878ed226SJulian Elischer return (ECONNREFUSED);
2919878ed226SJulian Elischer
2920878ed226SJulian Elischer case 0x11: /* Unsupported feature or parameter value */
2921878ed226SJulian Elischer case 0x19: /* Unknown LMP PDU */
2922878ed226SJulian Elischer case 0x1a: /* Unsupported remote feature */
2923878ed226SJulian Elischer case 0x20: /* Unsupported LMP parameter value */
2924878ed226SJulian Elischer case 0x27: /* QoS is not supported */
2925878ed226SJulian Elischer case 0x29: /* Paring with unit key not supported */
2926878ed226SJulian Elischer return (EOPNOTSUPP);
2927878ed226SJulian Elischer
2928878ed226SJulian Elischer case 0x12: /* Invalid HCI command parameter */
2929878ed226SJulian Elischer case 0x1e: /* Invalid LMP parameters */
2930878ed226SJulian Elischer return (EINVAL);
2931878ed226SJulian Elischer
2932878ed226SJulian Elischer case 0x13: /* Other end terminated connection: User ended connection */
2933878ed226SJulian Elischer case 0x14: /* Other end terminated connection: Low resources */
2934878ed226SJulian Elischer case 0x15: /* Other end terminated connection: About to power off */
2935878ed226SJulian Elischer return (ECONNRESET);
2936878ed226SJulian Elischer
2937878ed226SJulian Elischer case 0x16: /* Connection terminated by local host */
2938878ed226SJulian Elischer return (ECONNABORTED);
2939878ed226SJulian Elischer
2940878ed226SJulian Elischer #if 0 /* XXX not yet */
2941878ed226SJulian Elischer case 0x17: /* Repeated attempts */
2942878ed226SJulian Elischer case 0x1f: /* Unspecified error */
2943878ed226SJulian Elischer case 0x23: /* LMP error transaction collision */
2944878ed226SJulian Elischer case 0x28: /* Instant passed */
2945878ed226SJulian Elischer #endif
2946878ed226SJulian Elischer }
2947878ed226SJulian Elischer
2948878ed226SJulian Elischer return (ENOSYS);
2949878ed226SJulian Elischer } /* ng_btsocket_l2cap_result2errno */
2950