37 #include "pcap-int.h"
38 #include "pcap-bt-linux.h"
40 #include "diag-control.h"
68 	int dev_id;		/* device ID of device we're bound to */
94 		snprintf(err_str, PCAP_ERRBUF_SIZE, "Can't allocate %zu bytes for Bluetooth device list",  in bt_findalldevs()
104 	 * https://github.com/the-tcpdump-group/libpcap/issues/1083  in bt_findalldevs()
108 	dev_list->dev_num = HCI_MAX_DEV;  in bt_findalldevs()
113 		    errno, "Can't get Bluetooth device list via ioctl");  in bt_findalldevs()
118 	dev_req = dev_list->dev_req;  in bt_findalldevs()
119 	for (i = 0; i < dev_list->dev_num; i++, dev_req++) {  in bt_findalldevs()
122 		snprintf(dev_name, sizeof(dev_name), BT_IFACE"%u", dev_req->dev_id);  in bt_findalldevs()
127 		 * XXX - if there's the notion of associating with a  in bt_findalldevs()
149 bt_create(const char *device, char *ebuf, int *is_ours)  in bt_create()  argument
156 	/* Does this look like a Bluetooth device? */  in bt_create()
157 	cp = strrchr(device, '/');  in bt_create()
159 		cp = device;  in bt_create()
161 	if (strncmp(cp, BT_IFACE, sizeof BT_IFACE - 1) != 0) {  in bt_create()
166 	/* Yes - is BT_IFACE followed by a number? */  in bt_create()
167 	cp += sizeof BT_IFACE - 1;  in bt_create()
175 		/* Followed by a non-valid number. */  in bt_create()
187 	p->activate_op = bt_activate;  in bt_create()
192 bt_activate(pcap_t* handle)  in bt_activate()  argument
194 	struct pcap_bt *handlep = handle->priv;  in bt_activate()
202 	if (sscanf(handle->opt.device, BT_IFACE"%d", &dev_id) != 1)  in bt_activate()
204 		snprintf(handle->errbuf, PCAP_ERRBUF_SIZE,  in bt_activate()
205 			"Can't get Bluetooth device index from %s",  in bt_activate()
206 			 handle->opt.device);  in bt_activate()
218 	if (handle->snapshot <= 0 || handle->snapshot > MAXIMUM_SNAPLEN)  in bt_activate()
219 		handle->snapshot = MAXIMUM_SNAPLEN;  in bt_activate()
222 	handle->bufsize = BT_CTRL_SIZE+sizeof(pcap_bluetooth_h4_header)+handle->snapshot;  in bt_activate()
223 	handle->linktype = DLT_BLUETOOTH_HCI_H4_WITH_PHDR;  in bt_activate()
225 	handle->read_op = bt_read_linux;  in bt_activate()
226 	handle->inject_op = bt_inject_linux;  in bt_activate()
227 	handle->setfilter_op = pcapint_install_bpf_program; /* no kernel filtering */  in bt_activate()
228 	handle->setdirection_op = bt_setdirection_linux;  in bt_activate()
229 	handle->set_datalink_op = NULL;	/* can't change data link type */  in bt_activate()
230 	handle->getnonblock_op = pcapint_getnonblock_fd;  in bt_activate()
231 	handle->setnonblock_op = pcapint_setnonblock_fd;  in bt_activate()
232 	handle->stats_op = bt_stats_linux;  in bt_activate()
233 	handlep->dev_id = dev_id;  in bt_activate()
236 	handle->fd = socket(AF_BLUETOOTH, SOCK_RAW, BTPROTO_HCI);  in bt_activate()
237 	if (handle->fd < 0) {  in bt_activate()
238 		pcapint_fmt_errmsg_for_errno(handle->errbuf, PCAP_ERRBUF_SIZE,  in bt_activate()
243 	handle->buffer = malloc(handle->bufsize);  in bt_activate()
244 	if (!handle->buffer) {  in bt_activate()
245 		pcapint_fmt_errmsg_for_errno(handle->errbuf, PCAP_ERRBUF_SIZE,  in bt_activate()
251 	if (setsockopt(handle->fd, SOL_HCI, HCI_DATA_DIR, &opt, sizeof(opt)) < 0) {  in bt_activate()
252 		pcapint_fmt_errmsg_for_errno(handle->errbuf, PCAP_ERRBUF_SIZE,  in bt_activate()
258 	if (setsockopt(handle->fd, SOL_HCI, HCI_TIME_STAMP, &opt, sizeof(opt)) < 0) {  in bt_activate()
259 		pcapint_fmt_errmsg_for_errno(handle->errbuf, PCAP_ERRBUF_SIZE,  in bt_activate()
269 	if (setsockopt(handle->fd, SOL_HCI, HCI_FILTER, &flt, sizeof(flt)) < 0) {  in bt_activate()
270 		pcapint_fmt_errmsg_for_errno(handle->errbuf, PCAP_ERRBUF_SIZE,  in bt_activate()
276 	/* Bind socket to the HCI device */  in bt_activate()
278 	addr.hci_dev = handlep->dev_id;  in bt_activate()
282 	if (bind(handle->fd, (struct sockaddr *) &addr, sizeof(addr)) < 0) {  in bt_activate()
283 		pcapint_fmt_errmsg_for_errno(handle->errbuf, PCAP_ERRBUF_SIZE,  in bt_activate()
284 		    errno, "Can't attach to device %d", handlep->dev_id);  in bt_activate()
288 	if (handle->opt.rfmon) {  in bt_activate()
296 	if (handle->opt.buffer_size != 0) {  in bt_activate()
300 		if (setsockopt(handle->fd, SOL_SOCKET, SO_RCVBUF,  in bt_activate()
301 		    &handle->opt.buffer_size,  in bt_activate()
302 		    sizeof(handle->opt.buffer_size)) == -1) {  in bt_activate()
303 			pcapint_fmt_errmsg_for_errno(handle->errbuf,  in bt_activate()
309 	handle->selectable_fd = handle->fd;  in bt_activate()
313 	pcapint_cleanup_live_common(handle);  in bt_activate()
318 bt_read_linux(pcap_t *handle, int max_packets _U_, pcap_handler callback, u_char *user)  in bt_read_linux()  argument
329 	pktd = (u_char *)handle->buffer + BT_CTRL_SIZE;  in bt_read_linux()
332 	iv.iov_len  = handle->snapshot;  in bt_read_linux()
337 	msg.msg_control = handle->buffer;  in bt_read_linux()
342 		if (handle->break_loop)  in bt_read_linux()
344 			handle->break_loop = 0;  in bt_read_linux()
347 		ret = recvmsg(handle->fd, &msg, 0);  in bt_read_linux()
348 	} while ((ret == -1) && (errno == EINTR));  in bt_read_linux()
355 		pcapint_fmt_errmsg_for_errno(handle->errbuf, PCAP_ERRBUF_SIZE,  in bt_read_linux()
365 		switch (cmsg->cmsg_type) {  in bt_read_linux()
379 	switch (handle->direction) {  in bt_read_linux()
395 	bthdr->direction = htonl(in != 0);  in bt_read_linux()
398 	if (handle->fcode.bf_insns == NULL ||  in bt_read_linux()
399 	    pcapint_filter(handle->fcode.bf_insns, pktd, pkth.len, pkth.caplen)) {  in bt_read_linux()
407 bt_inject_linux(pcap_t *handle, const void *buf _U_, int size _U_)  in bt_inject_linux()  argument
409 	snprintf(handle->errbuf, PCAP_ERRBUF_SIZE,  in bt_inject_linux()
411 	return (-1);  in bt_inject_linux()
416 bt_stats_linux(pcap_t *handle, struct pcap_stat *stats)  in bt_stats_linux()  argument
418 	struct pcap_bt *handlep = handle->priv;  in bt_stats_linux()
422 	dev_info.dev_id = handlep->dev_id;  in bt_stats_linux()
426 		ret = ioctl(handle->fd, HCIGETDEVINFO, (void *)&dev_info);  in bt_stats_linux()
427 	} while ((ret == -1) && (errno == EINTR));  in bt_stats_linux()
430 		pcapint_fmt_errmsg_for_errno(handle->errbuf, PCAP_ERRBUF_SIZE,  in bt_stats_linux()
432 		return (-1);  in bt_stats_linux()
437 	stats->ps_recv = s->evt_rx + s->acl_rx + s->sco_rx + s->cmd_tx +  in bt_stats_linux()
438 		s->acl_tx +s->sco_tx;  in bt_stats_linux()
439 	stats->ps_drop = s->err_rx + s->err_tx;  in bt_stats_linux()
440 	stats->ps_ifdrop = 0;  in bt_stats_linux()
451 	p->direction = d;  in bt_setdirection_linux()