Browse Source
This allows using a host's physical HCI as one of the HCIs attached to the virtual machine. This brings various limitations because not all commands/events are passed through by Linux kernel, some are interpreted by the host's kernel for a speed gain. git-svn-id: svn://svn.savannah.nongnu.org/qemu/trunk@5344 c046a42c-6fe2-441c-8c8c-71466251a162stable-0.10
balrog
18 years ago
4 changed files with 226 additions and 1 deletions
@ -0,0 +1,198 @@ |
|||
/*
|
|||
* Wrap a host Bluetooth HCI socket in a struct HCIInfo. |
|||
* |
|||
* Copyright (C) 2008 Andrzej Zaborowski <balrog@zabor.org> |
|||
* |
|||
* This program is free software; you can redistribute it and/or |
|||
* modify it under the terms of the GNU General Public License as |
|||
* published by the Free Software Foundation; either version 2 or |
|||
* (at your option) version 3 of the License. |
|||
* |
|||
* This program is distributed in the hope that it will be useful, |
|||
* but WITHOUT ANY WARRANTY; without even the implied warranty of |
|||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
|||
* GNU General Public License for more details. |
|||
* |
|||
* You should have received a copy of the GNU General Public License |
|||
* along with this program; if not, write to the Free Software |
|||
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
|||
* MA 02111-1307 USA |
|||
*/ |
|||
|
|||
#include "qemu-common.h" |
|||
#include "qemu-char.h" |
|||
#include "sysemu.h" |
|||
#include "net.h" |
|||
|
|||
#include <errno.h> |
|||
#include <sys/ioctl.h> |
|||
#include <sys/uio.h> |
|||
#ifdef CONFIG_BLUEZ |
|||
# include <bluetooth/bluetooth.h> |
|||
# include <bluetooth/hci.h> |
|||
# include <bluetooth/hci_lib.h> |
|||
#else |
|||
# include "hw/bt.h" |
|||
# define HCI_MAX_FRAME_SIZE 1028 |
|||
#endif |
|||
|
|||
struct bt_host_hci_s { |
|||
struct HCIInfo hci; |
|||
int fd; |
|||
|
|||
uint8_t hdr[HCI_MAX_FRAME_SIZE]; |
|||
int len; |
|||
}; |
|||
|
|||
static void bt_host_send(struct HCIInfo *hci, |
|||
int type, const uint8_t *data, int len) |
|||
{ |
|||
struct bt_host_hci_s *s = (struct bt_host_hci_s *) hci; |
|||
uint8_t pkt = type; |
|||
struct iovec iv[2]; |
|||
int ret; |
|||
|
|||
iv[0].iov_base = &pkt; |
|||
iv[0].iov_len = 1; |
|||
iv[1].iov_base = (void *) data; |
|||
iv[1].iov_len = len; |
|||
|
|||
while ((ret = writev(s->fd, iv, 2)) < 0) |
|||
if (errno != EAGAIN && errno != EINTR) { |
|||
fprintf(stderr, "qemu: error %i writing bluetooth packet.\n", |
|||
errno); |
|||
return; |
|||
} |
|||
} |
|||
|
|||
static void bt_host_cmd(struct HCIInfo *hci, const uint8_t *data, int len) |
|||
{ |
|||
bt_host_send(hci, HCI_COMMAND_PKT, data, len); |
|||
} |
|||
|
|||
static void bt_host_acl(struct HCIInfo *hci, const uint8_t *data, int len) |
|||
{ |
|||
bt_host_send(hci, HCI_ACLDATA_PKT, data, len); |
|||
} |
|||
|
|||
static void bt_host_sco(struct HCIInfo *hci, const uint8_t *data, int len) |
|||
{ |
|||
bt_host_send(hci, HCI_SCODATA_PKT, data, len); |
|||
} |
|||
|
|||
static int bt_host_read_poll(void *opaque) |
|||
{ |
|||
struct bt_host_hci_s *s = (struct bt_host_hci_s *) opaque; |
|||
|
|||
return !!s->hci.evt_recv; |
|||
} |
|||
|
|||
static void bt_host_read(void *opaque) |
|||
{ |
|||
struct bt_host_hci_s *s = (struct bt_host_hci_s *) opaque; |
|||
uint8_t *pkt; |
|||
int pktlen; |
|||
|
|||
/* Seems that we can't read only the header first and then the amount
|
|||
* of data indicated in the header because Linux will discard everything |
|||
* that's not been read in one go. */ |
|||
s->len = read(s->fd, s->hdr, sizeof(s->hdr)); |
|||
|
|||
if (s->len < 0) { |
|||
fprintf(stderr, "qemu: error %i reading HCI frame\n", errno); |
|||
return; |
|||
} |
|||
|
|||
pkt = s->hdr; |
|||
while (s->len --) |
|||
switch (*pkt ++) { |
|||
case HCI_EVENT_PKT: |
|||
if (s->len < 2) |
|||
goto bad_pkt; |
|||
|
|||
pktlen = MIN(pkt[1] + 2, s->len); |
|||
s->hci.evt_recv(s->hci.opaque, pkt, pktlen); |
|||
s->len -= pktlen; |
|||
pkt += pktlen; |
|||
|
|||
/* TODO: if this is an Inquiry Result event, it's also
|
|||
* interpreted by Linux kernel before we received it, possibly |
|||
* we should clean the kernel Inquiry cache through |
|||
* ioctl(s->fd, HCI_INQUIRY, ...). */ |
|||
break; |
|||
|
|||
case HCI_ACLDATA_PKT: |
|||
if (s->len < 4) |
|||
goto bad_pkt; |
|||
|
|||
pktlen = MIN(((pkt[3] << 8) | pkt[2]) + 4, s->len); |
|||
s->hci.acl_recv(s->hci.opaque, pkt, pktlen); |
|||
s->len -= pktlen; |
|||
pkt += pktlen; |
|||
break; |
|||
|
|||
case HCI_SCODATA_PKT: |
|||
if (s->len < 3) |
|||
goto bad_pkt; |
|||
|
|||
pktlen = MIN(pkt[2] + 3, s->len); |
|||
s->len -= pktlen; |
|||
pkt += pktlen; |
|||
|
|||
default: |
|||
bad_pkt: |
|||
fprintf(stderr, "qemu: bad HCI packet type %02x\n", pkt[-1]); |
|||
} |
|||
} |
|||
|
|||
static int bt_host_bdaddr_set(struct HCIInfo *hci, const uint8_t *bd_addr) |
|||
{ |
|||
return -ENOTSUP; |
|||
} |
|||
|
|||
struct HCIInfo *bt_host_hci(const char *id) |
|||
{ |
|||
struct bt_host_hci_s *s; |
|||
int fd = -1; |
|||
#ifdef CONFIG_BLUEZ |
|||
int dev_id = hci_devid(id); |
|||
struct hci_filter flt; |
|||
|
|||
if (dev_id < 0) { |
|||
fprintf(stderr, "qemu: `%s' not available\n", id); |
|||
return 0; |
|||
} |
|||
|
|||
fd = hci_open_dev(dev_id); |
|||
|
|||
/* XXX: can we ensure nobody else has the device opened? */ |
|||
#endif |
|||
|
|||
if (fd < 0) { |
|||
fprintf(stderr, "qemu: Can't open `%s': %s (%i)\n", |
|||
id, strerror(errno), errno); |
|||
return 0; |
|||
} |
|||
|
|||
#ifdef CONFIG_BLUEZ |
|||
hci_filter_clear(&flt); |
|||
hci_filter_all_ptypes(&flt); |
|||
hci_filter_all_events(&flt); |
|||
|
|||
if (setsockopt(fd, SOL_HCI, HCI_FILTER, &flt, sizeof(flt)) < 0) { |
|||
fprintf(stderr, "qemu: Can't set HCI filter on socket (%i)\n", errno); |
|||
return 0; |
|||
} |
|||
#endif |
|||
|
|||
s = qemu_mallocz(sizeof(struct bt_host_hci_s)); |
|||
s->fd = fd; |
|||
s->hci.cmd_send = bt_host_cmd; |
|||
s->hci.sco_send = bt_host_sco; |
|||
s->hci.acl_send = bt_host_acl; |
|||
s->hci.bdaddr_set = bt_host_bdaddr_set; |
|||
|
|||
qemu_set_fd_handler2(s->fd, bt_host_read_poll, bt_host_read, 0, s); |
|||
|
|||
return &s->hci; |
|||
} |
|||
Loading…
Reference in new issue