1/*
2 * ng_hci_evnt.c
3 *
4 * Copyright (c) Maksim Yevmenkin <m_evmenkin@yahoo.com>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 *
28 * $Id: ng_hci_evnt.c,v 1.18 2002/11/12 22:35:39 max Exp $
| 1/*
2 * ng_hci_evnt.c
3 *
4 * Copyright (c) Maksim Yevmenkin <m_evmenkin@yahoo.com>
5 * All rights reserved.
6 *
7 * Redistribution and use in source and binary forms, with or without
8 * modification, are permitted provided that the following conditions
9 * are met:
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * 2. Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
14 * documentation and/or other materials provided with the distribution.
15 *
16 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 * SUCH DAMAGE.
27 *
28 * $Id: ng_hci_evnt.c,v 1.18 2002/11/12 22:35:39 max Exp $
|
29 * $FreeBSD: head/sys/netgraph/bluetooth/hci/ng_hci_evnt.c 107120 2002-11-20 23:01:59Z julian $
| 29 * $FreeBSD: head/sys/netgraph/bluetooth/hci/ng_hci_evnt.c 109623 2003-01-21 08:56:16Z alfred $
|
30 */
31
32#include <sys/param.h>
33#include <sys/systm.h>
34#include <sys/kernel.h>
35#include <sys/endian.h>
36#include <sys/malloc.h>
37#include <sys/mbuf.h>
38#include <sys/queue.h>
39#include <netgraph/ng_message.h>
40#include <netgraph/netgraph.h>
41#include "ng_bluetooth.h"
42#include "ng_hci.h"
43#include "ng_hci_var.h"
44#include "ng_hci_cmds.h"
45#include "ng_hci_evnt.h"
46#include "ng_hci_ulpi.h"
47#include "ng_hci_misc.h"
48
49/******************************************************************************
50 ******************************************************************************
51 ** HCI event processing module
52 ******************************************************************************
53 ******************************************************************************/
54
55/*
56 * Event processing routines
57 */
58
59static int inquiry_result (ng_hci_unit_p, struct mbuf *);
60static int con_compl (ng_hci_unit_p, struct mbuf *);
61static int con_req (ng_hci_unit_p, struct mbuf *);
62static int discon_compl (ng_hci_unit_p, struct mbuf *);
63static int read_remote_features_compl (ng_hci_unit_p, struct mbuf *);
64static int qos_setup_compl (ng_hci_unit_p, struct mbuf *);
65static int hardware_error (ng_hci_unit_p, struct mbuf *);
66static int role_change (ng_hci_unit_p, struct mbuf *);
67static int num_compl_pkts (ng_hci_unit_p, struct mbuf *);
68static int mode_change (ng_hci_unit_p, struct mbuf *);
69static int data_buffer_overflow (ng_hci_unit_p, struct mbuf *);
70static int read_clock_offset_compl (ng_hci_unit_p, struct mbuf *);
71static int qos_violation (ng_hci_unit_p, struct mbuf *);
72static int page_scan_mode_change (ng_hci_unit_p, struct mbuf *);
73static int page_scan_rep_mode_change (ng_hci_unit_p, struct mbuf *);
74static int sync_con_queue (ng_hci_unit_p, ng_hci_unit_con_p, int);
75static int send_data_packets (ng_hci_unit_p, int, int);
76
77/*
78 * Process HCI event packet
79 */
80
81int
82ng_hci_process_event(ng_hci_unit_p unit, struct mbuf *event)
83{
84 ng_hci_event_pkt_t *hdr = NULL;
85 int error = 0;
86
87 /* Get event packet header */
88 NG_HCI_M_PULLUP(event, sizeof(*hdr));
89 if (event == NULL)
90 return (ENOBUFS);
91
92 hdr = mtod(event, ng_hci_event_pkt_t *);
93
94 NG_HCI_INFO(
95"%s: %s - got HCI event=%#x, length=%d\n",
96 __func__, NG_NODE_NAME(unit->node), hdr->event, hdr->length);
97
98 /* Get rid of event header and process event */
99 m_adj(event, sizeof(*hdr));
100
101 switch (hdr->event) {
102 case NG_HCI_EVENT_INQUIRY_COMPL:
103/* case NG_HCI_EVENT_MODE_CHANGE: */
104 case NG_HCI_EVENT_RETURN_LINK_KEYS:
105 case NG_HCI_EVENT_PIN_CODE_REQ:
106 case NG_HCI_EVENT_LINK_KEY_REQ:
107 case NG_HCI_EVENT_LINK_KEY_NOTIFICATION:
108 case NG_HCI_EVENT_LOOPBACK_COMMAND:
109 case NG_HCI_EVENT_AUTH_COMPL:
110 case NG_HCI_EVENT_ENCRYPTION_CHANGE:
111 case NG_HCI_EVENT_CHANGE_CON_LINK_KEY_COMPL:
112 case NG_HCI_EVENT_MASTER_LINK_KEY_COMPL:
113 case NG_HCI_EVENT_FLUSH_OCCUR: /* XXX Do we have to handle it? */
114/* case NG_HCI_EVENT_ROLE_CHANGE: */
115 case NG_HCI_EVENT_MAX_SLOT_CHANGE:
116 case NG_HCI_EVENT_CON_PKT_TYPE_CHANGED:
117 case NG_HCI_EVENT_BT_LOGO:
118 case NG_HCI_EVENT_VENDOR:
119 case NG_HCI_EVENT_REMOTE_NAME_REQ_COMPL:
120 case NG_HCI_EVENT_READ_REMOTE_VER_INFO_COMPL:
121 /* These do not need post processing */
122 NG_FREE_M(event);
123 break;
124
125 case NG_HCI_EVENT_INQUIRY_RESULT:
126 error = inquiry_result(unit, event);
127 break;
128
129 case NG_HCI_EVENT_CON_COMPL:
130 error = con_compl(unit, event);
131 break;
132
133 case NG_HCI_EVENT_CON_REQ:
134 error = con_req(unit, event);
135 break;
136
137 case NG_HCI_EVENT_DISCON_COMPL:
138 error = discon_compl(unit, event);
139 break;
140
141 case NG_HCI_EVENT_READ_REMOTE_FEATURES_COMPL:
142 error = read_remote_features_compl(unit, event);
143 break;
144
145 case NG_HCI_EVENT_QOS_SETUP_COMPL:
146 error = qos_setup_compl(unit, event);
147 break;
148
149 case NG_HCI_EVENT_COMMAND_COMPL:
150 error = ng_hci_process_command_complete(unit, event);
151 break;
152
153 case NG_HCI_EVENT_COMMAND_STATUS:
154 error = ng_hci_process_command_status(unit, event);
155 break;
156
157 case NG_HCI_EVENT_HARDWARE_ERROR:
158 error = hardware_error(unit, event);
159 break;
160
161 case NG_HCI_EVENT_ROLE_CHANGE:
162 error = role_change(unit, event);
163 break;
164
165 case NG_HCI_EVENT_NUM_COMPL_PKTS:
166 error = num_compl_pkts(unit, event);
167 break;
168
169 case NG_HCI_EVENT_MODE_CHANGE:
170 error = mode_change(unit, event);
171 break;
172
173 case NG_HCI_EVENT_DATA_BUFFER_OVERFLOW:
174 error = data_buffer_overflow(unit, event);
175 break;
176
177 case NG_HCI_EVENT_READ_CLOCK_OFFSET_COMPL:
178 error = read_clock_offset_compl(unit, event);
179 break;
180
181 case NG_HCI_EVENT_QOS_VIOLATION:
182 error = qos_violation(unit, event);
183 break;
184
185 case NG_HCI_EVENT_PAGE_SCAN_MODE_CHANGE:
186 error = page_scan_mode_change(unit, event);
187 break;
188
189 case NG_HCI_EVENT_PAGE_SCAN_REP_MODE_CHANGE:
190 error = page_scan_rep_mode_change(unit, event);
191 break;
192
193 default:
194 NG_FREE_M(event);
195 error = EINVAL;
196 break;
197 }
198
199 return (error);
200} /* ng_hci_process_event */
201
202/*
203 * Send ACL and/or SCO data to the unit driver
204 */
205
206void
207ng_hci_send_data(ng_hci_unit_p unit)
208{
209 int count;
210
211 /* Send ACL data */
212 NG_HCI_BUFF_ACL_AVAIL(unit->buffer, count);
213
214 NG_HCI_INFO(
215"%s: %s - sending ACL data packets, count=%d\n",
216 __func__, NG_NODE_NAME(unit->node), count);
217
218 if (count > 0) {
219 count = send_data_packets(unit, NG_HCI_LINK_ACL, count);
220 NG_HCI_STAT_ACL_SENT(unit->stat, count);
221 NG_HCI_BUFF_ACL_USE(unit->buffer, count);
222 }
223
224 /* Send SCO data */
225 NG_HCI_BUFF_SCO_AVAIL(unit->buffer, count);
226
227 NG_HCI_INFO(
228"%s: %s - sending SCO data packets, count=%d\n",
229 __func__, NG_NODE_NAME(unit->node), count);
230
231 if (count > 0) {
232 count = send_data_packets(unit, NG_HCI_LINK_SCO, count);
233 NG_HCI_STAT_SCO_SENT(unit->stat, count);
234 NG_HCI_BUFF_SCO_USE(unit->buffer, count);
235 }
236} /* ng_hci_send_data */
237
238/*
239 * Send data packets to the lower layer.
240 */
241
242static int
243send_data_packets(ng_hci_unit_p unit, int link_type, int limit)
244{
245 ng_hci_unit_con_p con = NULL, winner = NULL;
246 item_p item = NULL;
247 int min_pending, total_sent, sent, error, v;
248
249 for (total_sent = 0; limit > 0; ) {
250 min_pending = 0x0fffffff;
251 winner = NULL;
252
253 /*
254 * Find the connection that has has data to send
255 * and the smallest number of pending packets
256 */
257
258 LIST_FOREACH(con, &unit->con_list, next) {
259 if (con->link_type != link_type)
260 continue;
261 if (NG_BT_ITEMQ_LEN(&con->conq) == 0)
262 continue;
263
264 if (con->pending < min_pending) {
265 winner = con;
266 min_pending = con->pending;
267 }
268 }
269
270 if (winner == NULL)
271 break;
272
273 /*
274 * OK, we have a winner now send as much packets as we can
275 * Count the number of packets we have sent and then sync
276 * winner connection queue.
277 */
278
279 for (sent = 0; limit > 0; limit --, total_sent ++, sent ++) {
280 NG_BT_ITEMQ_DEQUEUE(&winner->conq, item);
281 if (item == NULL)
282 break;
283
284 NG_HCI_INFO(
285"%s: %s - sending data packet, handle=%d, len=%d\n",
286 __func__, NG_NODE_NAME(unit->node),
287 winner->con_handle, NGI_M(item)->m_pkthdr.len);
288
289 /* Check if driver hook still there */
290 v = (unit->drv != NULL && NG_HOOK_IS_VALID(unit->drv));
291 if (!v || (unit->state & NG_HCI_UNIT_READY) !=
292 NG_HCI_UNIT_READY) {
293 NG_HCI_ERR(
294"%s: %s - could not send data. Hook \"%s\" is %svalid, state=%#x\n",
295 __func__, NG_NODE_NAME(unit->node),
296 NG_HCI_HOOK_DRV, ((v)? "" : "not "),
297 unit->state);
298
299 NG_FREE_ITEM(item);
300 error = ENOTCONN;
301 } else {
302 v = NGI_M(item)->m_pkthdr.len;
303
304 /* Give packet to raw hook */
305 ng_hci_mtap(unit, NGI_M(item));
306
307 /* ... and forward item to the driver */
308 NG_FWD_ITEM_HOOK(error, item, unit->drv);
309 }
310
311 if (error != 0) {
312 NG_HCI_ERR(
313"%s: %s - could not send data packet, handle=%d, error=%d\n",
314 __func__, NG_NODE_NAME(unit->node),
315 winner->con_handle, error);
316 break;
317 }
318
319 winner->pending ++;
320 NG_HCI_STAT_BYTES_SENT(unit->stat, v);
321 }
322
323 /*
324 * Sync connection queue for the winner
325 */
326
327 sync_con_queue(unit, winner, sent);
328 }
329
330 return (total_sent);
331} /* send_data_packets */
332
333/*
334 * Send flow control messages to the upper layer
335 */
336
337static int
338sync_con_queue(ng_hci_unit_p unit, ng_hci_unit_con_p con, int completed)
339{
340 hook_p hook = NULL;
341 struct ng_mesg *msg = NULL;
342 ng_hci_sync_con_queue_ep *state = NULL;
343 int error;
344
345 hook = (con->link_type == NG_HCI_LINK_ACL)? unit->acl : unit->sco;
346 if (hook == NULL || NG_HOOK_NOT_VALID(hook))
347 return (ENOTCONN);
348
349 NG_MKMESSAGE(msg, NGM_HCI_COOKIE, NGM_HCI_SYNC_CON_QUEUE,
350 sizeof(*state), M_NOWAIT);
351 if (msg == NULL)
352 return (ENOMEM);
353
354 state = (ng_hci_sync_con_queue_ep *)(msg->data);
355 state->con_handle = con->con_handle;
356 state->completed = completed;
357
358 NG_SEND_MSG_HOOK(error, unit->node, msg, hook, NULL);
359
360 return (error);
361} /* sync_con_queue */
362
363/* Inquiry result event */
364static int
365inquiry_result(ng_hci_unit_p unit, struct mbuf *event)
366{
367 ng_hci_inquiry_result_ep *ep = NULL;
368 ng_hci_neighbor_p n = NULL;
369 bdaddr_t bdaddr;
370 int error = 0;
371
372 NG_HCI_M_PULLUP(event, sizeof(*ep));
373 if (event == NULL)
374 return (ENOBUFS);
375
376 ep = mtod(event, ng_hci_inquiry_result_ep *);
377 m_adj(event, sizeof(*ep));
378
379 for (; ep->num_responses > 0; ep->num_responses --) {
380 /* Get remote unit address */
381 m_copydata(event, 0, sizeof(bdaddr), (caddr_t) &bdaddr);
382 m_adj(event, sizeof(bdaddr));
383
384 /* Lookup entry in the cache */
385 n = ng_hci_get_neighbor(unit, &bdaddr);
386 if (n == NULL) {
387 /* Create new entry */
388 n = ng_hci_new_neighbor(unit);
389 if (n == NULL) {
390 error = ENOMEM;
391 break;
392 }
393 } else
394 getmicrotime(&n->updated);
395
396 bcopy(&bdaddr, &n->bdaddr, sizeof(n->bdaddr));
397
398 /* XXX call m_pullup here? */
399
400 n->page_scan_rep_mode = *mtod(event, u_int8_t *);
401 m_adj(event, sizeof(u_int8_t));
402
403 /* page_scan_period_mode */
404 m_adj(event, sizeof(u_int8_t));
405
406 n->page_scan_mode = *mtod(event, u_int8_t *);
407 m_adj(event, sizeof(u_int8_t));
408
409 /* class */
410 m_adj(event, NG_HCI_CLASS_SIZE);
411
412 /* clock offset */
413 m_copydata(event, 0, sizeof(n->clock_offset),
414 (caddr_t) &n->clock_offset);
415 n->clock_offset = le16toh(n->clock_offset);
416 }
417
418 NG_FREE_M(event);
419
420 return (error);
421} /* inquiry_result */
422
423/* Connection complete event */
424static int
425con_compl(ng_hci_unit_p unit, struct mbuf *event)
426{
427 ng_hci_con_compl_ep *ep = NULL;
428 ng_hci_unit_con_p con = NULL;
429 int error = 0;
430
431 NG_HCI_M_PULLUP(event, sizeof(*ep));
432 if (event == NULL)
433 return (ENOBUFS);
434
435 ep = mtod(event, ng_hci_con_compl_ep *);
436
437 /*
438 * Find the first connection descriptor that matches the following:
439 *
440 * 1) con->link_type == ep->link_type
441 * 2) con->state == NG_HCI_CON_W4_CONN_COMPLETE
442 * 3) con->bdaddr == ep->bdaddr
443 */
444
445 LIST_FOREACH(con, &unit->con_list, next)
446 if (con->link_type == ep->link_type &&
447 con->state == NG_HCI_CON_W4_CONN_COMPLETE &&
448 bcmp(&con->bdaddr, &ep->bdaddr, sizeof(bdaddr_t)) == 0)
449 break;
450
451 /*
452 * Two possible cases:
453 *
454 * 1) We have found connection descriptor. That means upper layer has
455 * requested this connection via LP_CON_REQ message
456 *
457 * 2) We do not have connection descriptor. That means upper layer
458 * nas not requested this connection or (less likely) we gave up
459 * on this connection (timeout). The most likely scenario is that
460 * we have received Create_Connection/Add_SCO_Connection command
461 * from the RAW hook
462 */
463
464 if (con == NULL) {
465 if (ep->status != 0)
466 goto out;
467
468 con = ng_hci_new_con(unit, ep->link_type);
469 if (con == NULL) {
470 error = ENOMEM;
471 goto out;
472 }
473
474 bcopy(&ep->bdaddr, &con->bdaddr, sizeof(con->bdaddr));
475 } else
476 ng_hci_con_untimeout(con);
477
478 /*
479 * Update connection descriptor and send notification
480 * to the upper layers.
481 */
482
483 con->con_handle = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
484 con->encryption_mode = ep->encryption_mode;
485
486 ng_hci_lp_con_cfm(con, ep->status);
487
488 /* Adjust connection state */
489 if (ep->status != 0)
490 ng_hci_free_con(con);
491 else {
492 con->state = NG_HCI_CON_OPEN;
493
494 /*
495 * Change link policy for the ACL connections. Enable all
496 * supported link modes. Enable Role switch as well if
497 * device supports it.
498 */
499
500 if (ep->link_type == NG_HCI_LINK_ACL) {
501 struct __link_policy {
502 ng_hci_cmd_pkt_t hdr;
503 ng_hci_write_link_policy_settings_cp cp;
504 } __attribute__ ((packed)) *lp;
505 struct mbuf *m;
506
| 30 */
31
32#include <sys/param.h>
33#include <sys/systm.h>
34#include <sys/kernel.h>
35#include <sys/endian.h>
36#include <sys/malloc.h>
37#include <sys/mbuf.h>
38#include <sys/queue.h>
39#include <netgraph/ng_message.h>
40#include <netgraph/netgraph.h>
41#include "ng_bluetooth.h"
42#include "ng_hci.h"
43#include "ng_hci_var.h"
44#include "ng_hci_cmds.h"
45#include "ng_hci_evnt.h"
46#include "ng_hci_ulpi.h"
47#include "ng_hci_misc.h"
48
49/******************************************************************************
50 ******************************************************************************
51 ** HCI event processing module
52 ******************************************************************************
53 ******************************************************************************/
54
55/*
56 * Event processing routines
57 */
58
59static int inquiry_result (ng_hci_unit_p, struct mbuf *);
60static int con_compl (ng_hci_unit_p, struct mbuf *);
61static int con_req (ng_hci_unit_p, struct mbuf *);
62static int discon_compl (ng_hci_unit_p, struct mbuf *);
63static int read_remote_features_compl (ng_hci_unit_p, struct mbuf *);
64static int qos_setup_compl (ng_hci_unit_p, struct mbuf *);
65static int hardware_error (ng_hci_unit_p, struct mbuf *);
66static int role_change (ng_hci_unit_p, struct mbuf *);
67static int num_compl_pkts (ng_hci_unit_p, struct mbuf *);
68static int mode_change (ng_hci_unit_p, struct mbuf *);
69static int data_buffer_overflow (ng_hci_unit_p, struct mbuf *);
70static int read_clock_offset_compl (ng_hci_unit_p, struct mbuf *);
71static int qos_violation (ng_hci_unit_p, struct mbuf *);
72static int page_scan_mode_change (ng_hci_unit_p, struct mbuf *);
73static int page_scan_rep_mode_change (ng_hci_unit_p, struct mbuf *);
74static int sync_con_queue (ng_hci_unit_p, ng_hci_unit_con_p, int);
75static int send_data_packets (ng_hci_unit_p, int, int);
76
77/*
78 * Process HCI event packet
79 */
80
81int
82ng_hci_process_event(ng_hci_unit_p unit, struct mbuf *event)
83{
84 ng_hci_event_pkt_t *hdr = NULL;
85 int error = 0;
86
87 /* Get event packet header */
88 NG_HCI_M_PULLUP(event, sizeof(*hdr));
89 if (event == NULL)
90 return (ENOBUFS);
91
92 hdr = mtod(event, ng_hci_event_pkt_t *);
93
94 NG_HCI_INFO(
95"%s: %s - got HCI event=%#x, length=%d\n",
96 __func__, NG_NODE_NAME(unit->node), hdr->event, hdr->length);
97
98 /* Get rid of event header and process event */
99 m_adj(event, sizeof(*hdr));
100
101 switch (hdr->event) {
102 case NG_HCI_EVENT_INQUIRY_COMPL:
103/* case NG_HCI_EVENT_MODE_CHANGE: */
104 case NG_HCI_EVENT_RETURN_LINK_KEYS:
105 case NG_HCI_EVENT_PIN_CODE_REQ:
106 case NG_HCI_EVENT_LINK_KEY_REQ:
107 case NG_HCI_EVENT_LINK_KEY_NOTIFICATION:
108 case NG_HCI_EVENT_LOOPBACK_COMMAND:
109 case NG_HCI_EVENT_AUTH_COMPL:
110 case NG_HCI_EVENT_ENCRYPTION_CHANGE:
111 case NG_HCI_EVENT_CHANGE_CON_LINK_KEY_COMPL:
112 case NG_HCI_EVENT_MASTER_LINK_KEY_COMPL:
113 case NG_HCI_EVENT_FLUSH_OCCUR: /* XXX Do we have to handle it? */
114/* case NG_HCI_EVENT_ROLE_CHANGE: */
115 case NG_HCI_EVENT_MAX_SLOT_CHANGE:
116 case NG_HCI_EVENT_CON_PKT_TYPE_CHANGED:
117 case NG_HCI_EVENT_BT_LOGO:
118 case NG_HCI_EVENT_VENDOR:
119 case NG_HCI_EVENT_REMOTE_NAME_REQ_COMPL:
120 case NG_HCI_EVENT_READ_REMOTE_VER_INFO_COMPL:
121 /* These do not need post processing */
122 NG_FREE_M(event);
123 break;
124
125 case NG_HCI_EVENT_INQUIRY_RESULT:
126 error = inquiry_result(unit, event);
127 break;
128
129 case NG_HCI_EVENT_CON_COMPL:
130 error = con_compl(unit, event);
131 break;
132
133 case NG_HCI_EVENT_CON_REQ:
134 error = con_req(unit, event);
135 break;
136
137 case NG_HCI_EVENT_DISCON_COMPL:
138 error = discon_compl(unit, event);
139 break;
140
141 case NG_HCI_EVENT_READ_REMOTE_FEATURES_COMPL:
142 error = read_remote_features_compl(unit, event);
143 break;
144
145 case NG_HCI_EVENT_QOS_SETUP_COMPL:
146 error = qos_setup_compl(unit, event);
147 break;
148
149 case NG_HCI_EVENT_COMMAND_COMPL:
150 error = ng_hci_process_command_complete(unit, event);
151 break;
152
153 case NG_HCI_EVENT_COMMAND_STATUS:
154 error = ng_hci_process_command_status(unit, event);
155 break;
156
157 case NG_HCI_EVENT_HARDWARE_ERROR:
158 error = hardware_error(unit, event);
159 break;
160
161 case NG_HCI_EVENT_ROLE_CHANGE:
162 error = role_change(unit, event);
163 break;
164
165 case NG_HCI_EVENT_NUM_COMPL_PKTS:
166 error = num_compl_pkts(unit, event);
167 break;
168
169 case NG_HCI_EVENT_MODE_CHANGE:
170 error = mode_change(unit, event);
171 break;
172
173 case NG_HCI_EVENT_DATA_BUFFER_OVERFLOW:
174 error = data_buffer_overflow(unit, event);
175 break;
176
177 case NG_HCI_EVENT_READ_CLOCK_OFFSET_COMPL:
178 error = read_clock_offset_compl(unit, event);
179 break;
180
181 case NG_HCI_EVENT_QOS_VIOLATION:
182 error = qos_violation(unit, event);
183 break;
184
185 case NG_HCI_EVENT_PAGE_SCAN_MODE_CHANGE:
186 error = page_scan_mode_change(unit, event);
187 break;
188
189 case NG_HCI_EVENT_PAGE_SCAN_REP_MODE_CHANGE:
190 error = page_scan_rep_mode_change(unit, event);
191 break;
192
193 default:
194 NG_FREE_M(event);
195 error = EINVAL;
196 break;
197 }
198
199 return (error);
200} /* ng_hci_process_event */
201
202/*
203 * Send ACL and/or SCO data to the unit driver
204 */
205
206void
207ng_hci_send_data(ng_hci_unit_p unit)
208{
209 int count;
210
211 /* Send ACL data */
212 NG_HCI_BUFF_ACL_AVAIL(unit->buffer, count);
213
214 NG_HCI_INFO(
215"%s: %s - sending ACL data packets, count=%d\n",
216 __func__, NG_NODE_NAME(unit->node), count);
217
218 if (count > 0) {
219 count = send_data_packets(unit, NG_HCI_LINK_ACL, count);
220 NG_HCI_STAT_ACL_SENT(unit->stat, count);
221 NG_HCI_BUFF_ACL_USE(unit->buffer, count);
222 }
223
224 /* Send SCO data */
225 NG_HCI_BUFF_SCO_AVAIL(unit->buffer, count);
226
227 NG_HCI_INFO(
228"%s: %s - sending SCO data packets, count=%d\n",
229 __func__, NG_NODE_NAME(unit->node), count);
230
231 if (count > 0) {
232 count = send_data_packets(unit, NG_HCI_LINK_SCO, count);
233 NG_HCI_STAT_SCO_SENT(unit->stat, count);
234 NG_HCI_BUFF_SCO_USE(unit->buffer, count);
235 }
236} /* ng_hci_send_data */
237
238/*
239 * Send data packets to the lower layer.
240 */
241
242static int
243send_data_packets(ng_hci_unit_p unit, int link_type, int limit)
244{
245 ng_hci_unit_con_p con = NULL, winner = NULL;
246 item_p item = NULL;
247 int min_pending, total_sent, sent, error, v;
248
249 for (total_sent = 0; limit > 0; ) {
250 min_pending = 0x0fffffff;
251 winner = NULL;
252
253 /*
254 * Find the connection that has has data to send
255 * and the smallest number of pending packets
256 */
257
258 LIST_FOREACH(con, &unit->con_list, next) {
259 if (con->link_type != link_type)
260 continue;
261 if (NG_BT_ITEMQ_LEN(&con->conq) == 0)
262 continue;
263
264 if (con->pending < min_pending) {
265 winner = con;
266 min_pending = con->pending;
267 }
268 }
269
270 if (winner == NULL)
271 break;
272
273 /*
274 * OK, we have a winner now send as much packets as we can
275 * Count the number of packets we have sent and then sync
276 * winner connection queue.
277 */
278
279 for (sent = 0; limit > 0; limit --, total_sent ++, sent ++) {
280 NG_BT_ITEMQ_DEQUEUE(&winner->conq, item);
281 if (item == NULL)
282 break;
283
284 NG_HCI_INFO(
285"%s: %s - sending data packet, handle=%d, len=%d\n",
286 __func__, NG_NODE_NAME(unit->node),
287 winner->con_handle, NGI_M(item)->m_pkthdr.len);
288
289 /* Check if driver hook still there */
290 v = (unit->drv != NULL && NG_HOOK_IS_VALID(unit->drv));
291 if (!v || (unit->state & NG_HCI_UNIT_READY) !=
292 NG_HCI_UNIT_READY) {
293 NG_HCI_ERR(
294"%s: %s - could not send data. Hook \"%s\" is %svalid, state=%#x\n",
295 __func__, NG_NODE_NAME(unit->node),
296 NG_HCI_HOOK_DRV, ((v)? "" : "not "),
297 unit->state);
298
299 NG_FREE_ITEM(item);
300 error = ENOTCONN;
301 } else {
302 v = NGI_M(item)->m_pkthdr.len;
303
304 /* Give packet to raw hook */
305 ng_hci_mtap(unit, NGI_M(item));
306
307 /* ... and forward item to the driver */
308 NG_FWD_ITEM_HOOK(error, item, unit->drv);
309 }
310
311 if (error != 0) {
312 NG_HCI_ERR(
313"%s: %s - could not send data packet, handle=%d, error=%d\n",
314 __func__, NG_NODE_NAME(unit->node),
315 winner->con_handle, error);
316 break;
317 }
318
319 winner->pending ++;
320 NG_HCI_STAT_BYTES_SENT(unit->stat, v);
321 }
322
323 /*
324 * Sync connection queue for the winner
325 */
326
327 sync_con_queue(unit, winner, sent);
328 }
329
330 return (total_sent);
331} /* send_data_packets */
332
333/*
334 * Send flow control messages to the upper layer
335 */
336
337static int
338sync_con_queue(ng_hci_unit_p unit, ng_hci_unit_con_p con, int completed)
339{
340 hook_p hook = NULL;
341 struct ng_mesg *msg = NULL;
342 ng_hci_sync_con_queue_ep *state = NULL;
343 int error;
344
345 hook = (con->link_type == NG_HCI_LINK_ACL)? unit->acl : unit->sco;
346 if (hook == NULL || NG_HOOK_NOT_VALID(hook))
347 return (ENOTCONN);
348
349 NG_MKMESSAGE(msg, NGM_HCI_COOKIE, NGM_HCI_SYNC_CON_QUEUE,
350 sizeof(*state), M_NOWAIT);
351 if (msg == NULL)
352 return (ENOMEM);
353
354 state = (ng_hci_sync_con_queue_ep *)(msg->data);
355 state->con_handle = con->con_handle;
356 state->completed = completed;
357
358 NG_SEND_MSG_HOOK(error, unit->node, msg, hook, NULL);
359
360 return (error);
361} /* sync_con_queue */
362
363/* Inquiry result event */
364static int
365inquiry_result(ng_hci_unit_p unit, struct mbuf *event)
366{
367 ng_hci_inquiry_result_ep *ep = NULL;
368 ng_hci_neighbor_p n = NULL;
369 bdaddr_t bdaddr;
370 int error = 0;
371
372 NG_HCI_M_PULLUP(event, sizeof(*ep));
373 if (event == NULL)
374 return (ENOBUFS);
375
376 ep = mtod(event, ng_hci_inquiry_result_ep *);
377 m_adj(event, sizeof(*ep));
378
379 for (; ep->num_responses > 0; ep->num_responses --) {
380 /* Get remote unit address */
381 m_copydata(event, 0, sizeof(bdaddr), (caddr_t) &bdaddr);
382 m_adj(event, sizeof(bdaddr));
383
384 /* Lookup entry in the cache */
385 n = ng_hci_get_neighbor(unit, &bdaddr);
386 if (n == NULL) {
387 /* Create new entry */
388 n = ng_hci_new_neighbor(unit);
389 if (n == NULL) {
390 error = ENOMEM;
391 break;
392 }
393 } else
394 getmicrotime(&n->updated);
395
396 bcopy(&bdaddr, &n->bdaddr, sizeof(n->bdaddr));
397
398 /* XXX call m_pullup here? */
399
400 n->page_scan_rep_mode = *mtod(event, u_int8_t *);
401 m_adj(event, sizeof(u_int8_t));
402
403 /* page_scan_period_mode */
404 m_adj(event, sizeof(u_int8_t));
405
406 n->page_scan_mode = *mtod(event, u_int8_t *);
407 m_adj(event, sizeof(u_int8_t));
408
409 /* class */
410 m_adj(event, NG_HCI_CLASS_SIZE);
411
412 /* clock offset */
413 m_copydata(event, 0, sizeof(n->clock_offset),
414 (caddr_t) &n->clock_offset);
415 n->clock_offset = le16toh(n->clock_offset);
416 }
417
418 NG_FREE_M(event);
419
420 return (error);
421} /* inquiry_result */
422
423/* Connection complete event */
424static int
425con_compl(ng_hci_unit_p unit, struct mbuf *event)
426{
427 ng_hci_con_compl_ep *ep = NULL;
428 ng_hci_unit_con_p con = NULL;
429 int error = 0;
430
431 NG_HCI_M_PULLUP(event, sizeof(*ep));
432 if (event == NULL)
433 return (ENOBUFS);
434
435 ep = mtod(event, ng_hci_con_compl_ep *);
436
437 /*
438 * Find the first connection descriptor that matches the following:
439 *
440 * 1) con->link_type == ep->link_type
441 * 2) con->state == NG_HCI_CON_W4_CONN_COMPLETE
442 * 3) con->bdaddr == ep->bdaddr
443 */
444
445 LIST_FOREACH(con, &unit->con_list, next)
446 if (con->link_type == ep->link_type &&
447 con->state == NG_HCI_CON_W4_CONN_COMPLETE &&
448 bcmp(&con->bdaddr, &ep->bdaddr, sizeof(bdaddr_t)) == 0)
449 break;
450
451 /*
452 * Two possible cases:
453 *
454 * 1) We have found connection descriptor. That means upper layer has
455 * requested this connection via LP_CON_REQ message
456 *
457 * 2) We do not have connection descriptor. That means upper layer
458 * nas not requested this connection or (less likely) we gave up
459 * on this connection (timeout). The most likely scenario is that
460 * we have received Create_Connection/Add_SCO_Connection command
461 * from the RAW hook
462 */
463
464 if (con == NULL) {
465 if (ep->status != 0)
466 goto out;
467
468 con = ng_hci_new_con(unit, ep->link_type);
469 if (con == NULL) {
470 error = ENOMEM;
471 goto out;
472 }
473
474 bcopy(&ep->bdaddr, &con->bdaddr, sizeof(con->bdaddr));
475 } else
476 ng_hci_con_untimeout(con);
477
478 /*
479 * Update connection descriptor and send notification
480 * to the upper layers.
481 */
482
483 con->con_handle = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
484 con->encryption_mode = ep->encryption_mode;
485
486 ng_hci_lp_con_cfm(con, ep->status);
487
488 /* Adjust connection state */
489 if (ep->status != 0)
490 ng_hci_free_con(con);
491 else {
492 con->state = NG_HCI_CON_OPEN;
493
494 /*
495 * Change link policy for the ACL connections. Enable all
496 * supported link modes. Enable Role switch as well if
497 * device supports it.
498 */
499
500 if (ep->link_type == NG_HCI_LINK_ACL) {
501 struct __link_policy {
502 ng_hci_cmd_pkt_t hdr;
503 ng_hci_write_link_policy_settings_cp cp;
504 } __attribute__ ((packed)) *lp;
505 struct mbuf *m;
506
|
507 MGETHDR(m, M_DONTWAIT, MT_DATA);
| 507 MGETHDR(m, M_NOWAIT, MT_DATA);
|
508 if (m != NULL) {
509 m->m_pkthdr.len = m->m_len = sizeof(*lp);
510 lp = mtod(m, struct __link_policy *);
511
512 lp->hdr.type = NG_HCI_CMD_PKT;
513 lp->hdr.opcode = htole16(NG_HCI_OPCODE(
514 NG_HCI_OGF_LINK_POLICY,
515 NG_HCI_OCF_WRITE_LINK_POLICY_SETTINGS));
516 lp->hdr.length = sizeof(lp->cp);
517
518 lp->cp.con_handle = ep->con_handle;
519
520 lp->cp.settings = 0;
521 if (unit->features[0] & NG_HCI_LMP_SWITCH)
522 lp->cp.settings |= 0x1;
523 if (unit->features[0] & NG_HCI_LMP_HOLD_MODE)
524 lp->cp.settings |= 0x2;
525 if (unit->features[0] & NG_HCI_LMP_SNIFF_MODE)
526 lp->cp.settings |= 0x4;
527 if (unit->features[1] & NG_HCI_LMP_PARK_MODE)
528 lp->cp.settings |= 0x8;
529
530 lp->cp.settings &= unit->link_policy_mask;
531 lp->cp.settings = htole16(lp->cp.settings);
532
533 NG_BT_MBUFQ_ENQUEUE(&unit->cmdq, m);
534 if (!(unit->state & NG_HCI_UNIT_COMMAND_PENDING))
535 ng_hci_send_command(unit);
536 }
537 }
538 }
539out:
540 NG_FREE_M(event);
541
542 return (error);
543} /* com_compl */
544
545/* Connection request event */
546static int
547con_req(ng_hci_unit_p unit, struct mbuf *event)
548{
549 ng_hci_con_req_ep *ep = NULL;
550 ng_hci_unit_con_p con = NULL;
551 int error = 0;
552
553 NG_HCI_M_PULLUP(event, sizeof(*ep));
554 if (event == NULL)
555 return (ENOBUFS);
556
557 ep = mtod(event, ng_hci_con_req_ep *);
558
559 /*
560 * Find the first connection descriptor that matches the following:
561 *
562 * 1) con->link_type == ep->link_type
563 *
564 * 2) con->state == NG_HCI_CON_W4_LP_CON_RSP ||
565 * con->state == NG_HCI_CON_W4_CONN_COMPL
566 *
567 * 3) con->bdaddr == ep->bdaddr
568 *
569 * Possible cases:
570 *
571 * 1) We do not have connection descriptor. This is simple. Create
572 * new fresh connection descriptor and send notification to the
573 * appropriate upstream hook (based on link_type).
574 *
575 * 2) We found connection handle. This is more complicated.
576 *
577 * 2.1) ACL links
578 *
579 * Since only one ACL link can exist between each pair of
580 * units then we have a race. Our upper layer has requested
581 * an ACL connection to the remote unit, but we did not send
582 * command yet. At the same time the remote unit has requested
583 * an ACL connection from us. In this case we will ignore
584 * Connection_Request event. This probably will cause connect
585 * failure on both units.
586 *
587 * 2.2) SCO links
588 *
589 * The spec on page 45 says :
590 *
591 * "The master can support up to three SCO links to the same
592 * slave or to different slaves. A slave can support up to
593 * three SCO links from the same master, or two SCO links if
594 * the links originate from different masters."
595 *
596 * The only problem is how to handle multiple SCO links between
597 * matster and slave. For now we will assume that multiple SCO
598 * links MUST be opened one after another.
599 */
600
601 LIST_FOREACH(con, &unit->con_list, next)
602 if (con->link_type == ep->link_type &&
603 (con->state == NG_HCI_CON_W4_LP_CON_RSP ||
604 con->state == NG_HCI_CON_W4_CONN_COMPLETE) &&
605 bcmp(&con->bdaddr, &ep->bdaddr, sizeof(bdaddr_t)) == 0)
606 break;
607
608 if (con == NULL) {
609 con = ng_hci_new_con(unit, ep->link_type);
610 if (con != NULL) {
611 bcopy(&ep->bdaddr, &con->bdaddr, sizeof(con->bdaddr));
612
613 con->state = NG_HCI_CON_W4_LP_CON_RSP;
614 ng_hci_con_timeout(con);
615
616 error = ng_hci_lp_con_ind(con, ep->uclass);
617 if (error != 0)
618 ng_hci_free_con(con);
619 } else
620 error = ENOMEM;
621 }
622
623 NG_FREE_M(event);
624
625 return (error);
626} /* con_req */
627
628/* Disconnect complete event */
629static int
630discon_compl(ng_hci_unit_p unit, struct mbuf *event)
631{
632 ng_hci_discon_compl_ep *ep = NULL;
633 ng_hci_unit_con_p con = NULL;
634 int error = 0;
635 u_int16_t h;
636
637 NG_HCI_M_PULLUP(event, sizeof(*ep));
638 if (event == NULL)
639 return (ENOBUFS);
640
641 ep = mtod(event, ng_hci_discon_compl_ep *);
642
643 /*
644 * XXX
645 * Do we have to send notification if ep->status != 0?
646 * For now we will send notification for both ACL and SCO connections
647 * ONLY if ep->status == 0.
648 */
649
650 if (ep->status == 0) {
651 h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
652 con = ng_hci_con_by_handle(unit, h);
653 if (con != NULL) {
654 error = ng_hci_lp_discon_ind(con, ep->reason);
655 ng_hci_free_con(con);
656 } else {
657 NG_HCI_ALERT(
658"%s: %s - invalid connection handle=%d\n",
659 __func__, NG_NODE_NAME(unit->node), h);
660 error = ENOENT;
661 }
662 }
663
664 NG_FREE_M(event);
665
666 return (error);
667} /* discon_compl */
668
669/* Read remote feature complete event */
670static int
671read_remote_features_compl(ng_hci_unit_p unit, struct mbuf *event)
672{
673 ng_hci_read_remote_features_compl_ep *ep = NULL;
674 ng_hci_unit_con_p con = NULL;
675 ng_hci_neighbor_p n = NULL;
676 u_int16_t h;
677 int error = 0;
678
679 NG_HCI_M_PULLUP(event, sizeof(*ep));
680 if (event == NULL)
681 return (ENOBUFS);
682
683 ep = mtod(event, ng_hci_read_remote_features_compl_ep *);
684
685 if (ep->status == 0) {
686 /* Check if we have this connection handle */
687 h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
688 con = ng_hci_con_by_handle(unit, h);
689 if (con == NULL) {
690 NG_HCI_ALERT(
691"%s: %s - invalid connection handle=%d\n",
692 __func__, NG_NODE_NAME(unit->node), h);
693 error = ENOENT;
694 goto out;
695 }
696
697 /* Update cache entry */
698 n = ng_hci_get_neighbor(unit, &con->bdaddr);
699 if (n == NULL) {
700 n = ng_hci_new_neighbor(unit);
701 if (n == NULL) {
702 error = ENOMEM;
703 goto out;
704 }
705
706 bcopy(&con->bdaddr, &n->bdaddr, sizeof(n->bdaddr));
707 } else
708 getmicrotime(&n->updated);
709
710 bcopy(ep->features, n->features, sizeof(n->features));
711 } else
712 NG_HCI_ERR(
713"%s: %s - failed to read remote unit features, status=%d\n",
714 __func__, NG_NODE_NAME(unit->node), ep->status);
715out:
716 NG_FREE_M(event);
717
718 return (error);
719} /* read_remote_features_compl */
720
721/* QoS setup complete event */
722static int
723qos_setup_compl(ng_hci_unit_p unit, struct mbuf *event)
724{
725 ng_hci_qos_setup_compl_ep *ep = NULL;
726 ng_hci_unit_con_p con = NULL;
727 u_int16_t h;
728 int error = 0;
729
730 NG_HCI_M_PULLUP(event, sizeof(*ep));
731 if (event == NULL)
732 return (ENOBUFS);
733
734 ep = mtod(event, ng_hci_qos_setup_compl_ep *);
735
736 /* Check if we have this connection handle */
737 h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
738 con = ng_hci_con_by_handle(unit, h);
739 if (con == NULL) {
740 NG_HCI_ALERT(
741"%s: %s - invalid connection handle=%d\n",
742 __func__, NG_NODE_NAME(unit->node), h);
743 error = ENOENT;
744 } else if (con->link_type != NG_HCI_LINK_ACL) {
745 NG_HCI_ALERT(
746"%s: %s - invalid link type=%d, handle=%d\n",
747 __func__, NG_NODE_NAME(unit->node), con->link_type, h);
748 error = EINVAL;
749 } else if (con->state != NG_HCI_CON_OPEN) {
750 NG_HCI_ALERT(
751"%s: %s - invalid connection state=%d, handle=%d\n",
752 __func__, NG_NODE_NAME(unit->node),
753 con->state, h);
754 error = EINVAL;
755 } else /* Notify upper layer */
756 error = ng_hci_lp_qos_cfm(con, ep->status);
757
758 NG_FREE_M(event);
759
760 return (error);
761} /* qos_setup_compl */
762
763/* Hardware error event */
764static int
765hardware_error(ng_hci_unit_p unit, struct mbuf *event)
766{
767 NG_HCI_ALERT(
768"%s: %s - hardware error %#x\n",
769 __func__, NG_NODE_NAME(unit->node), *mtod(event, u_int8_t *));
770
771 NG_FREE_M(event);
772
773 return (0);
774} /* hardware_error */
775
776/* Role change event */
777static int
778role_change(ng_hci_unit_p unit, struct mbuf *event)
779{
780 ng_hci_role_change_ep *ep = NULL;
781 ng_hci_unit_con_p con = NULL;
782
783 NG_HCI_M_PULLUP(event, sizeof(*ep));
784 if (event == NULL)
785 return (ENOBUFS);
786
787 ep = mtod(event, ng_hci_role_change_ep *);
788
789 if (ep->status == 0) {
790 /* XXX shoud we also change "role" for SCO connections? */
791 con = ng_hci_con_by_bdaddr(unit, &ep->bdaddr, NG_HCI_LINK_ACL);
792 if (con != NULL)
793 con->role = ep->role;
794 else
795 NG_HCI_ALERT(
796"%s: %s - ACL connection does not exist, bdaddr=%x:%x:%x:%x:%x:%x\n",
797 __func__, NG_NODE_NAME(unit->node),
798 ep->bdaddr.b[5], ep->bdaddr.b[4],
799 ep->bdaddr.b[3], ep->bdaddr.b[2],
800 ep->bdaddr.b[1], ep->bdaddr.b[0]);
801 } else
802 NG_HCI_ERR(
803"%s: %s - failed to change role, status=%d, bdaddr=%x:%x:%x:%x:%x:%x\n",
804 __func__, NG_NODE_NAME(unit->node), ep->status,
805 ep->bdaddr.b[5], ep->bdaddr.b[4], ep->bdaddr.b[3],
806 ep->bdaddr.b[2], ep->bdaddr.b[1], ep->bdaddr.b[0]);
807
808 NG_FREE_M(event);
809
810 return (0);
811} /* role_change */
812
813/* Number of completed packets event */
814static int
815num_compl_pkts(ng_hci_unit_p unit, struct mbuf *event)
816{
817 ng_hci_num_compl_pkts_ep *ep = NULL;
818 ng_hci_unit_con_p con = NULL;
819 u_int16_t h, p;
820
821 NG_HCI_M_PULLUP(event, sizeof(*ep));
822 if (event == NULL)
823 return (ENOBUFS);
824
825 ep = mtod(event, ng_hci_num_compl_pkts_ep *);
826 m_adj(event, sizeof(*ep));
827
828 for (; ep->num_con_handles > 0; ep->num_con_handles --) {
829 /* Get connection handle */
830 m_copydata(event, 0, sizeof(h), (caddr_t) &h);
831 m_adj(event, sizeof(h));
832 h = NG_HCI_CON_HANDLE(le16toh(h));
833
834 /* Get number of completed packets */
835 m_copydata(event, 0, sizeof(p), (caddr_t) &p);
836 m_adj(event, sizeof(p));
837 p = le16toh(p);
838
839 /* Check if we have this connection handle */
840 con = ng_hci_con_by_handle(unit, h);
841 if (con != NULL) {
842 con->pending -= p;
843 if (con->pending < 0) {
844 NG_HCI_WARN(
845"%s: %s - pending packet counter is out of sync! " \
846"handle=%d, pending=%d, ncp=%d\n", __func__, NG_NODE_NAME(unit->node),
847 con->con_handle, con->pending, p);
848
849 con->pending = 0;
850 }
851
852 /* Update buffer descriptor */
853 if (con->link_type == NG_HCI_LINK_ACL)
854 NG_HCI_BUFF_ACL_FREE(unit->buffer, p);
855 else
856 NG_HCI_BUFF_SCO_FREE(unit->buffer, p);
857 } else
858 NG_HCI_ALERT(
859"%s: %s - invalid connection handle=%d\n",
860 __func__, NG_NODE_NAME(unit->node), h);
861 }
862
863 NG_FREE_M(event);
864
865 /* Send more data */
866 ng_hci_send_data(unit);
867
868 return (0);
869} /* num_compl_pkts */
870
871/* Mode change event */
872static int
873mode_change(ng_hci_unit_p unit, struct mbuf *event)
874{
875 ng_hci_mode_change_ep *ep = NULL;
876 ng_hci_unit_con_p con = NULL;
877 int error = 0;
878
879 NG_HCI_M_PULLUP(event, sizeof(*ep));
880 if (event == NULL)
881 return (ENOBUFS);
882
883 ep = mtod(event, ng_hci_mode_change_ep *);
884
885 if (ep->status == 0) {
886 u_int16_t h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
887
888 con = ng_hci_con_by_handle(unit, h);
889 if (con == NULL) {
890 NG_HCI_ALERT(
891"%s: %s - invalid connection handle=%d\n",
892 __func__, NG_NODE_NAME(unit->node), h);
893 error = ENOENT;
894 } else if (con->link_type != NG_HCI_LINK_ACL) {
895 NG_HCI_ALERT(
896"%s: %s - invalid link type=%d\n",
897 __func__, NG_NODE_NAME(unit->node),
898 con->link_type);
899 error = EINVAL;
900 } else
901 con->mode = ep->unit_mode;
902 } else
903 NG_HCI_ERR(
904"%s: %s - failed to change mode, status=%d\n",
905 __func__, NG_NODE_NAME(unit->node), ep->status);
906
907 NG_FREE_M(event);
908
909 return (error);
910} /* mode_change */
911
912/* Data buffer overflow event */
913static int
914data_buffer_overflow(ng_hci_unit_p unit, struct mbuf *event)
915{
916 NG_HCI_ALERT(
917"%s: %s - %s data buffer overflow\n",
918 __func__, NG_NODE_NAME(unit->node),
919 (*mtod(event, u_int8_t *) == NG_HCI_LINK_ACL)? "ACL" : "SCO");
920
921 NG_FREE_M(event);
922
923 return (0);
924} /* data_buffer_overflow */
925
926/* Read clock offset complete event */
927static int
928read_clock_offset_compl(ng_hci_unit_p unit, struct mbuf *event)
929{
930 ng_hci_read_clock_offset_compl_ep *ep = NULL;
931 ng_hci_unit_con_p con = NULL;
932 ng_hci_neighbor_p n = NULL;
933 int error = 0;
934
935 NG_HCI_M_PULLUP(event, sizeof(*ep));
936 if (event == NULL)
937 return (ENOBUFS);
938
939 ep = mtod(event, ng_hci_read_clock_offset_compl_ep *);
940
941 if (ep->status == 0) {
942 u_int16_t h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
943
944 con = ng_hci_con_by_handle(unit, h);
945 if (con == NULL) {
946 NG_HCI_ALERT(
947"%s: %s - invalid connection handle=%d\n",
948 __func__, NG_NODE_NAME(unit->node), h);
949 error = ENOENT;
950 goto out;
951 }
952
953 /* Update cache entry */
954 n = ng_hci_get_neighbor(unit, &con->bdaddr);
955 if (n == NULL) {
956 n = ng_hci_new_neighbor(unit);
957 if (n == NULL) {
958 error = ENOMEM;
959 goto out;
960 }
961
962 bcopy(&con->bdaddr, &n->bdaddr, sizeof(n->bdaddr));
963 } else
964 getmicrotime(&n->updated);
965
966 n->clock_offset = le16toh(ep->clock_offset);
967 } else
968 NG_HCI_ERR(
969"%s: %s - failed to Read Remote Clock Offset, status=%d\n",
970 __func__, NG_NODE_NAME(unit->node), ep->status);
971out:
972 NG_FREE_M(event);
973
974 return (error);
975} /* read_clock_offset_compl */
976
977/* QoS violation event */
978static int
979qos_violation(ng_hci_unit_p unit, struct mbuf *event)
980{
981 ng_hci_qos_violation_ep *ep = NULL;
982 ng_hci_unit_con_p con = NULL;
983 u_int16_t h;
984 int error = 0;
985
986 NG_HCI_M_PULLUP(event, sizeof(*ep));
987 if (event == NULL)
988 return (ENOBUFS);
989
990 ep = mtod(event, ng_hci_qos_violation_ep *);
991
992 /* Check if we have this connection handle */
993 h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
994 con = ng_hci_con_by_handle(unit, h);
995 if (con == NULL) {
996 NG_HCI_ALERT(
997"%s: %s - invalid connection handle=%d\n",
998 __func__, NG_NODE_NAME(unit->node), h);
999 error = ENOENT;
1000 } else if (con->link_type != NG_HCI_LINK_ACL) {
1001 NG_HCI_ALERT(
1002"%s: %s - invalid link type=%d\n",
1003 __func__, NG_NODE_NAME(unit->node), con->link_type);
1004 error = EINVAL;
1005 } else if (con->state != NG_HCI_CON_OPEN) {
1006 NG_HCI_ALERT(
1007"%s: %s - invalid connection state=%d, handle=%d\n",
1008 __func__, NG_NODE_NAME(unit->node), con->state, h);
1009 error = EINVAL;
1010 } else /* Notify upper layer */
1011 error = ng_hci_lp_qos_ind(con);
1012
1013 NG_FREE_M(event);
1014
1015 return (error);
1016} /* qos_violation */
1017
1018/* Page scan mode change event */
1019static int
1020page_scan_mode_change(ng_hci_unit_p unit, struct mbuf *event)
1021{
1022 ng_hci_page_scan_mode_change_ep *ep = NULL;
1023 ng_hci_neighbor_p n = NULL;
1024 int error = 0;
1025
1026 NG_HCI_M_PULLUP(event, sizeof(*ep));
1027 if (event == NULL)
1028 return (ENOBUFS);
1029
1030 ep = mtod(event, ng_hci_page_scan_mode_change_ep *);
1031
1032 /* Update cache entry */
1033 n = ng_hci_get_neighbor(unit, &ep->bdaddr);
1034 if (n == NULL) {
1035 n = ng_hci_new_neighbor(unit);
1036 if (n == NULL) {
1037 error = ENOMEM;
1038 goto out;
1039 }
1040
1041 bcopy(&ep->bdaddr, &n->bdaddr, sizeof(n->bdaddr));
1042 } else
1043 getmicrotime(&n->updated);
1044
1045 n->page_scan_mode = ep->page_scan_mode;
1046out:
1047 NG_FREE_M(event);
1048
1049 return (error);
1050} /* page_scan_mode_change */
1051
1052/* Page scan repetition mode change event */
1053static int
1054page_scan_rep_mode_change(ng_hci_unit_p unit, struct mbuf *event)
1055{
1056 ng_hci_page_scan_rep_mode_change_ep *ep = NULL;
1057 ng_hci_neighbor_p n = NULL;
1058 int error = 0;
1059
1060 NG_HCI_M_PULLUP(event, sizeof(*ep));
1061 if (event == NULL)
1062 return (ENOBUFS);
1063
1064 ep = mtod(event, ng_hci_page_scan_rep_mode_change_ep *);
1065
1066 /* Update cache entry */
1067 n = ng_hci_get_neighbor(unit, &ep->bdaddr);
1068 if (n == NULL) {
1069 n = ng_hci_new_neighbor(unit);
1070 if (n == NULL) {
1071 error = ENOMEM;
1072 goto out;
1073 }
1074
1075 bcopy(&ep->bdaddr, &n->bdaddr, sizeof(n->bdaddr));
1076 } else
1077 getmicrotime(&n->updated);
1078
1079 n->page_scan_rep_mode = ep->page_scan_rep_mode;
1080out:
1081 NG_FREE_M(event);
1082
1083 return (error);
1084} /* page_scan_rep_mode_change */
1085
| 508 if (m != NULL) {
509 m->m_pkthdr.len = m->m_len = sizeof(*lp);
510 lp = mtod(m, struct __link_policy *);
511
512 lp->hdr.type = NG_HCI_CMD_PKT;
513 lp->hdr.opcode = htole16(NG_HCI_OPCODE(
514 NG_HCI_OGF_LINK_POLICY,
515 NG_HCI_OCF_WRITE_LINK_POLICY_SETTINGS));
516 lp->hdr.length = sizeof(lp->cp);
517
518 lp->cp.con_handle = ep->con_handle;
519
520 lp->cp.settings = 0;
521 if (unit->features[0] & NG_HCI_LMP_SWITCH)
522 lp->cp.settings |= 0x1;
523 if (unit->features[0] & NG_HCI_LMP_HOLD_MODE)
524 lp->cp.settings |= 0x2;
525 if (unit->features[0] & NG_HCI_LMP_SNIFF_MODE)
526 lp->cp.settings |= 0x4;
527 if (unit->features[1] & NG_HCI_LMP_PARK_MODE)
528 lp->cp.settings |= 0x8;
529
530 lp->cp.settings &= unit->link_policy_mask;
531 lp->cp.settings = htole16(lp->cp.settings);
532
533 NG_BT_MBUFQ_ENQUEUE(&unit->cmdq, m);
534 if (!(unit->state & NG_HCI_UNIT_COMMAND_PENDING))
535 ng_hci_send_command(unit);
536 }
537 }
538 }
539out:
540 NG_FREE_M(event);
541
542 return (error);
543} /* com_compl */
544
545/* Connection request event */
546static int
547con_req(ng_hci_unit_p unit, struct mbuf *event)
548{
549 ng_hci_con_req_ep *ep = NULL;
550 ng_hci_unit_con_p con = NULL;
551 int error = 0;
552
553 NG_HCI_M_PULLUP(event, sizeof(*ep));
554 if (event == NULL)
555 return (ENOBUFS);
556
557 ep = mtod(event, ng_hci_con_req_ep *);
558
559 /*
560 * Find the first connection descriptor that matches the following:
561 *
562 * 1) con->link_type == ep->link_type
563 *
564 * 2) con->state == NG_HCI_CON_W4_LP_CON_RSP ||
565 * con->state == NG_HCI_CON_W4_CONN_COMPL
566 *
567 * 3) con->bdaddr == ep->bdaddr
568 *
569 * Possible cases:
570 *
571 * 1) We do not have connection descriptor. This is simple. Create
572 * new fresh connection descriptor and send notification to the
573 * appropriate upstream hook (based on link_type).
574 *
575 * 2) We found connection handle. This is more complicated.
576 *
577 * 2.1) ACL links
578 *
579 * Since only one ACL link can exist between each pair of
580 * units then we have a race. Our upper layer has requested
581 * an ACL connection to the remote unit, but we did not send
582 * command yet. At the same time the remote unit has requested
583 * an ACL connection from us. In this case we will ignore
584 * Connection_Request event. This probably will cause connect
585 * failure on both units.
586 *
587 * 2.2) SCO links
588 *
589 * The spec on page 45 says :
590 *
591 * "The master can support up to three SCO links to the same
592 * slave or to different slaves. A slave can support up to
593 * three SCO links from the same master, or two SCO links if
594 * the links originate from different masters."
595 *
596 * The only problem is how to handle multiple SCO links between
597 * matster and slave. For now we will assume that multiple SCO
598 * links MUST be opened one after another.
599 */
600
601 LIST_FOREACH(con, &unit->con_list, next)
602 if (con->link_type == ep->link_type &&
603 (con->state == NG_HCI_CON_W4_LP_CON_RSP ||
604 con->state == NG_HCI_CON_W4_CONN_COMPLETE) &&
605 bcmp(&con->bdaddr, &ep->bdaddr, sizeof(bdaddr_t)) == 0)
606 break;
607
608 if (con == NULL) {
609 con = ng_hci_new_con(unit, ep->link_type);
610 if (con != NULL) {
611 bcopy(&ep->bdaddr, &con->bdaddr, sizeof(con->bdaddr));
612
613 con->state = NG_HCI_CON_W4_LP_CON_RSP;
614 ng_hci_con_timeout(con);
615
616 error = ng_hci_lp_con_ind(con, ep->uclass);
617 if (error != 0)
618 ng_hci_free_con(con);
619 } else
620 error = ENOMEM;
621 }
622
623 NG_FREE_M(event);
624
625 return (error);
626} /* con_req */
627
628/* Disconnect complete event */
629static int
630discon_compl(ng_hci_unit_p unit, struct mbuf *event)
631{
632 ng_hci_discon_compl_ep *ep = NULL;
633 ng_hci_unit_con_p con = NULL;
634 int error = 0;
635 u_int16_t h;
636
637 NG_HCI_M_PULLUP(event, sizeof(*ep));
638 if (event == NULL)
639 return (ENOBUFS);
640
641 ep = mtod(event, ng_hci_discon_compl_ep *);
642
643 /*
644 * XXX
645 * Do we have to send notification if ep->status != 0?
646 * For now we will send notification for both ACL and SCO connections
647 * ONLY if ep->status == 0.
648 */
649
650 if (ep->status == 0) {
651 h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
652 con = ng_hci_con_by_handle(unit, h);
653 if (con != NULL) {
654 error = ng_hci_lp_discon_ind(con, ep->reason);
655 ng_hci_free_con(con);
656 } else {
657 NG_HCI_ALERT(
658"%s: %s - invalid connection handle=%d\n",
659 __func__, NG_NODE_NAME(unit->node), h);
660 error = ENOENT;
661 }
662 }
663
664 NG_FREE_M(event);
665
666 return (error);
667} /* discon_compl */
668
669/* Read remote feature complete event */
670static int
671read_remote_features_compl(ng_hci_unit_p unit, struct mbuf *event)
672{
673 ng_hci_read_remote_features_compl_ep *ep = NULL;
674 ng_hci_unit_con_p con = NULL;
675 ng_hci_neighbor_p n = NULL;
676 u_int16_t h;
677 int error = 0;
678
679 NG_HCI_M_PULLUP(event, sizeof(*ep));
680 if (event == NULL)
681 return (ENOBUFS);
682
683 ep = mtod(event, ng_hci_read_remote_features_compl_ep *);
684
685 if (ep->status == 0) {
686 /* Check if we have this connection handle */
687 h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
688 con = ng_hci_con_by_handle(unit, h);
689 if (con == NULL) {
690 NG_HCI_ALERT(
691"%s: %s - invalid connection handle=%d\n",
692 __func__, NG_NODE_NAME(unit->node), h);
693 error = ENOENT;
694 goto out;
695 }
696
697 /* Update cache entry */
698 n = ng_hci_get_neighbor(unit, &con->bdaddr);
699 if (n == NULL) {
700 n = ng_hci_new_neighbor(unit);
701 if (n == NULL) {
702 error = ENOMEM;
703 goto out;
704 }
705
706 bcopy(&con->bdaddr, &n->bdaddr, sizeof(n->bdaddr));
707 } else
708 getmicrotime(&n->updated);
709
710 bcopy(ep->features, n->features, sizeof(n->features));
711 } else
712 NG_HCI_ERR(
713"%s: %s - failed to read remote unit features, status=%d\n",
714 __func__, NG_NODE_NAME(unit->node), ep->status);
715out:
716 NG_FREE_M(event);
717
718 return (error);
719} /* read_remote_features_compl */
720
721/* QoS setup complete event */
722static int
723qos_setup_compl(ng_hci_unit_p unit, struct mbuf *event)
724{
725 ng_hci_qos_setup_compl_ep *ep = NULL;
726 ng_hci_unit_con_p con = NULL;
727 u_int16_t h;
728 int error = 0;
729
730 NG_HCI_M_PULLUP(event, sizeof(*ep));
731 if (event == NULL)
732 return (ENOBUFS);
733
734 ep = mtod(event, ng_hci_qos_setup_compl_ep *);
735
736 /* Check if we have this connection handle */
737 h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
738 con = ng_hci_con_by_handle(unit, h);
739 if (con == NULL) {
740 NG_HCI_ALERT(
741"%s: %s - invalid connection handle=%d\n",
742 __func__, NG_NODE_NAME(unit->node), h);
743 error = ENOENT;
744 } else if (con->link_type != NG_HCI_LINK_ACL) {
745 NG_HCI_ALERT(
746"%s: %s - invalid link type=%d, handle=%d\n",
747 __func__, NG_NODE_NAME(unit->node), con->link_type, h);
748 error = EINVAL;
749 } else if (con->state != NG_HCI_CON_OPEN) {
750 NG_HCI_ALERT(
751"%s: %s - invalid connection state=%d, handle=%d\n",
752 __func__, NG_NODE_NAME(unit->node),
753 con->state, h);
754 error = EINVAL;
755 } else /* Notify upper layer */
756 error = ng_hci_lp_qos_cfm(con, ep->status);
757
758 NG_FREE_M(event);
759
760 return (error);
761} /* qos_setup_compl */
762
763/* Hardware error event */
764static int
765hardware_error(ng_hci_unit_p unit, struct mbuf *event)
766{
767 NG_HCI_ALERT(
768"%s: %s - hardware error %#x\n",
769 __func__, NG_NODE_NAME(unit->node), *mtod(event, u_int8_t *));
770
771 NG_FREE_M(event);
772
773 return (0);
774} /* hardware_error */
775
776/* Role change event */
777static int
778role_change(ng_hci_unit_p unit, struct mbuf *event)
779{
780 ng_hci_role_change_ep *ep = NULL;
781 ng_hci_unit_con_p con = NULL;
782
783 NG_HCI_M_PULLUP(event, sizeof(*ep));
784 if (event == NULL)
785 return (ENOBUFS);
786
787 ep = mtod(event, ng_hci_role_change_ep *);
788
789 if (ep->status == 0) {
790 /* XXX shoud we also change "role" for SCO connections? */
791 con = ng_hci_con_by_bdaddr(unit, &ep->bdaddr, NG_HCI_LINK_ACL);
792 if (con != NULL)
793 con->role = ep->role;
794 else
795 NG_HCI_ALERT(
796"%s: %s - ACL connection does not exist, bdaddr=%x:%x:%x:%x:%x:%x\n",
797 __func__, NG_NODE_NAME(unit->node),
798 ep->bdaddr.b[5], ep->bdaddr.b[4],
799 ep->bdaddr.b[3], ep->bdaddr.b[2],
800 ep->bdaddr.b[1], ep->bdaddr.b[0]);
801 } else
802 NG_HCI_ERR(
803"%s: %s - failed to change role, status=%d, bdaddr=%x:%x:%x:%x:%x:%x\n",
804 __func__, NG_NODE_NAME(unit->node), ep->status,
805 ep->bdaddr.b[5], ep->bdaddr.b[4], ep->bdaddr.b[3],
806 ep->bdaddr.b[2], ep->bdaddr.b[1], ep->bdaddr.b[0]);
807
808 NG_FREE_M(event);
809
810 return (0);
811} /* role_change */
812
813/* Number of completed packets event */
814static int
815num_compl_pkts(ng_hci_unit_p unit, struct mbuf *event)
816{
817 ng_hci_num_compl_pkts_ep *ep = NULL;
818 ng_hci_unit_con_p con = NULL;
819 u_int16_t h, p;
820
821 NG_HCI_M_PULLUP(event, sizeof(*ep));
822 if (event == NULL)
823 return (ENOBUFS);
824
825 ep = mtod(event, ng_hci_num_compl_pkts_ep *);
826 m_adj(event, sizeof(*ep));
827
828 for (; ep->num_con_handles > 0; ep->num_con_handles --) {
829 /* Get connection handle */
830 m_copydata(event, 0, sizeof(h), (caddr_t) &h);
831 m_adj(event, sizeof(h));
832 h = NG_HCI_CON_HANDLE(le16toh(h));
833
834 /* Get number of completed packets */
835 m_copydata(event, 0, sizeof(p), (caddr_t) &p);
836 m_adj(event, sizeof(p));
837 p = le16toh(p);
838
839 /* Check if we have this connection handle */
840 con = ng_hci_con_by_handle(unit, h);
841 if (con != NULL) {
842 con->pending -= p;
843 if (con->pending < 0) {
844 NG_HCI_WARN(
845"%s: %s - pending packet counter is out of sync! " \
846"handle=%d, pending=%d, ncp=%d\n", __func__, NG_NODE_NAME(unit->node),
847 con->con_handle, con->pending, p);
848
849 con->pending = 0;
850 }
851
852 /* Update buffer descriptor */
853 if (con->link_type == NG_HCI_LINK_ACL)
854 NG_HCI_BUFF_ACL_FREE(unit->buffer, p);
855 else
856 NG_HCI_BUFF_SCO_FREE(unit->buffer, p);
857 } else
858 NG_HCI_ALERT(
859"%s: %s - invalid connection handle=%d\n",
860 __func__, NG_NODE_NAME(unit->node), h);
861 }
862
863 NG_FREE_M(event);
864
865 /* Send more data */
866 ng_hci_send_data(unit);
867
868 return (0);
869} /* num_compl_pkts */
870
871/* Mode change event */
872static int
873mode_change(ng_hci_unit_p unit, struct mbuf *event)
874{
875 ng_hci_mode_change_ep *ep = NULL;
876 ng_hci_unit_con_p con = NULL;
877 int error = 0;
878
879 NG_HCI_M_PULLUP(event, sizeof(*ep));
880 if (event == NULL)
881 return (ENOBUFS);
882
883 ep = mtod(event, ng_hci_mode_change_ep *);
884
885 if (ep->status == 0) {
886 u_int16_t h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
887
888 con = ng_hci_con_by_handle(unit, h);
889 if (con == NULL) {
890 NG_HCI_ALERT(
891"%s: %s - invalid connection handle=%d\n",
892 __func__, NG_NODE_NAME(unit->node), h);
893 error = ENOENT;
894 } else if (con->link_type != NG_HCI_LINK_ACL) {
895 NG_HCI_ALERT(
896"%s: %s - invalid link type=%d\n",
897 __func__, NG_NODE_NAME(unit->node),
898 con->link_type);
899 error = EINVAL;
900 } else
901 con->mode = ep->unit_mode;
902 } else
903 NG_HCI_ERR(
904"%s: %s - failed to change mode, status=%d\n",
905 __func__, NG_NODE_NAME(unit->node), ep->status);
906
907 NG_FREE_M(event);
908
909 return (error);
910} /* mode_change */
911
912/* Data buffer overflow event */
913static int
914data_buffer_overflow(ng_hci_unit_p unit, struct mbuf *event)
915{
916 NG_HCI_ALERT(
917"%s: %s - %s data buffer overflow\n",
918 __func__, NG_NODE_NAME(unit->node),
919 (*mtod(event, u_int8_t *) == NG_HCI_LINK_ACL)? "ACL" : "SCO");
920
921 NG_FREE_M(event);
922
923 return (0);
924} /* data_buffer_overflow */
925
926/* Read clock offset complete event */
927static int
928read_clock_offset_compl(ng_hci_unit_p unit, struct mbuf *event)
929{
930 ng_hci_read_clock_offset_compl_ep *ep = NULL;
931 ng_hci_unit_con_p con = NULL;
932 ng_hci_neighbor_p n = NULL;
933 int error = 0;
934
935 NG_HCI_M_PULLUP(event, sizeof(*ep));
936 if (event == NULL)
937 return (ENOBUFS);
938
939 ep = mtod(event, ng_hci_read_clock_offset_compl_ep *);
940
941 if (ep->status == 0) {
942 u_int16_t h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
943
944 con = ng_hci_con_by_handle(unit, h);
945 if (con == NULL) {
946 NG_HCI_ALERT(
947"%s: %s - invalid connection handle=%d\n",
948 __func__, NG_NODE_NAME(unit->node), h);
949 error = ENOENT;
950 goto out;
951 }
952
953 /* Update cache entry */
954 n = ng_hci_get_neighbor(unit, &con->bdaddr);
955 if (n == NULL) {
956 n = ng_hci_new_neighbor(unit);
957 if (n == NULL) {
958 error = ENOMEM;
959 goto out;
960 }
961
962 bcopy(&con->bdaddr, &n->bdaddr, sizeof(n->bdaddr));
963 } else
964 getmicrotime(&n->updated);
965
966 n->clock_offset = le16toh(ep->clock_offset);
967 } else
968 NG_HCI_ERR(
969"%s: %s - failed to Read Remote Clock Offset, status=%d\n",
970 __func__, NG_NODE_NAME(unit->node), ep->status);
971out:
972 NG_FREE_M(event);
973
974 return (error);
975} /* read_clock_offset_compl */
976
977/* QoS violation event */
978static int
979qos_violation(ng_hci_unit_p unit, struct mbuf *event)
980{
981 ng_hci_qos_violation_ep *ep = NULL;
982 ng_hci_unit_con_p con = NULL;
983 u_int16_t h;
984 int error = 0;
985
986 NG_HCI_M_PULLUP(event, sizeof(*ep));
987 if (event == NULL)
988 return (ENOBUFS);
989
990 ep = mtod(event, ng_hci_qos_violation_ep *);
991
992 /* Check if we have this connection handle */
993 h = NG_HCI_CON_HANDLE(le16toh(ep->con_handle));
994 con = ng_hci_con_by_handle(unit, h);
995 if (con == NULL) {
996 NG_HCI_ALERT(
997"%s: %s - invalid connection handle=%d\n",
998 __func__, NG_NODE_NAME(unit->node), h);
999 error = ENOENT;
1000 } else if (con->link_type != NG_HCI_LINK_ACL) {
1001 NG_HCI_ALERT(
1002"%s: %s - invalid link type=%d\n",
1003 __func__, NG_NODE_NAME(unit->node), con->link_type);
1004 error = EINVAL;
1005 } else if (con->state != NG_HCI_CON_OPEN) {
1006 NG_HCI_ALERT(
1007"%s: %s - invalid connection state=%d, handle=%d\n",
1008 __func__, NG_NODE_NAME(unit->node), con->state, h);
1009 error = EINVAL;
1010 } else /* Notify upper layer */
1011 error = ng_hci_lp_qos_ind(con);
1012
1013 NG_FREE_M(event);
1014
1015 return (error);
1016} /* qos_violation */
1017
1018/* Page scan mode change event */
1019static int
1020page_scan_mode_change(ng_hci_unit_p unit, struct mbuf *event)
1021{
1022 ng_hci_page_scan_mode_change_ep *ep = NULL;
1023 ng_hci_neighbor_p n = NULL;
1024 int error = 0;
1025
1026 NG_HCI_M_PULLUP(event, sizeof(*ep));
1027 if (event == NULL)
1028 return (ENOBUFS);
1029
1030 ep = mtod(event, ng_hci_page_scan_mode_change_ep *);
1031
1032 /* Update cache entry */
1033 n = ng_hci_get_neighbor(unit, &ep->bdaddr);
1034 if (n == NULL) {
1035 n = ng_hci_new_neighbor(unit);
1036 if (n == NULL) {
1037 error = ENOMEM;
1038 goto out;
1039 }
1040
1041 bcopy(&ep->bdaddr, &n->bdaddr, sizeof(n->bdaddr));
1042 } else
1043 getmicrotime(&n->updated);
1044
1045 n->page_scan_mode = ep->page_scan_mode;
1046out:
1047 NG_FREE_M(event);
1048
1049 return (error);
1050} /* page_scan_mode_change */
1051
1052/* Page scan repetition mode change event */
1053static int
1054page_scan_rep_mode_change(ng_hci_unit_p unit, struct mbuf *event)
1055{
1056 ng_hci_page_scan_rep_mode_change_ep *ep = NULL;
1057 ng_hci_neighbor_p n = NULL;
1058 int error = 0;
1059
1060 NG_HCI_M_PULLUP(event, sizeof(*ep));
1061 if (event == NULL)
1062 return (ENOBUFS);
1063
1064 ep = mtod(event, ng_hci_page_scan_rep_mode_change_ep *);
1065
1066 /* Update cache entry */
1067 n = ng_hci_get_neighbor(unit, &ep->bdaddr);
1068 if (n == NULL) {
1069 n = ng_hci_new_neighbor(unit);
1070 if (n == NULL) {
1071 error = ENOMEM;
1072 goto out;
1073 }
1074
1075 bcopy(&ep->bdaddr, &n->bdaddr, sizeof(n->bdaddr));
1076 } else
1077 getmicrotime(&n->updated);
1078
1079 n->page_scan_rep_mode = ep->page_scan_rep_mode;
1080out:
1081 NG_FREE_M(event);
1082
1083 return (error);
1084} /* page_scan_rep_mode_change */
1085
|