Annotation of qemu/bt-vhci.c, revision 1.1.1.2

1.1       root        1: /*
                      2:  * Support for host VHCIs inside qemu scatternets.
                      3:  *
                      4:  * Copyright (C) 2008 Andrzej Zaborowski  <balrog@zabor.org>
                      5:  *
                      6:  * This program is free software; you can redistribute it and/or
                      7:  * modify it under the terms of the GNU General Public License as
                      8:  * published by the Free Software Foundation; either version 2 or
                      9:  * (at your option) version 3 of the License.
                     10:  *
                     11:  * This program is distributed in the hope that it will be useful,
                     12:  * but WITHOUT ANY WARRANTY; without even the implied warranty of
                     13:  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
                     14:  * GNU General Public License for more details.
                     15:  *
                     16:  * You should have received a copy of the GNU General Public License along
1.1.1.2 ! root       17:  * with this program; if not, see <http://www.gnu.org/licenses/>.
1.1       root       18:  */
                     19: 
                     20: #include "qemu-common.h"
                     21: #include "qemu-char.h"
                     22: #include "sysemu.h"
                     23: #include "net.h"
                     24: #include "hw/bt.h"
                     25: 
                     26: #define VHCI_DEV       "/dev/vhci"
                     27: #define VHCI_UDEV      "/dev/hci_vhci"
                     28: 
                     29: struct bt_vhci_s {
                     30:     int fd;
                     31:     struct HCIInfo *info;
                     32: 
                     33:     uint8_t hdr[4096];
                     34:     int len;
                     35: };
                     36: 
                     37: static void vhci_read(void *opaque)
                     38: {
                     39:     struct bt_vhci_s *s = (struct bt_vhci_s *) opaque;
                     40:     uint8_t *pkt;
                     41:     int pktlen;
                     42: 
                     43:     /* Seems that we can't read only the header first and then the amount
                     44:      * of data indicated in the header because Linux will discard everything
                     45:      * that's not been read in one go.  */
                     46:     s->len = read(s->fd, s->hdr, sizeof(s->hdr));
                     47: 
                     48:     if (s->len < 0) {
                     49:         fprintf(stderr, "qemu: error %i reading the PDU\n", errno);
                     50:         return;
                     51:     }
                     52: 
                     53:     pkt = s->hdr;
                     54:     while (s->len --)
                     55:         switch (*pkt ++) {
                     56:         case HCI_COMMAND_PKT:
                     57:             if (s->len < 3)
                     58:                 goto bad_pkt;
                     59: 
                     60:             pktlen = MIN(pkt[2] + 3, s->len);
                     61:             s->info->cmd_send(s->info, pkt, pktlen);
                     62:             s->len -= pktlen;
                     63:             pkt += pktlen;
                     64:             break;
                     65: 
                     66:         case HCI_ACLDATA_PKT:
                     67:             if (s->len < 4)
                     68:                 goto bad_pkt;
                     69: 
                     70:             pktlen = MIN(((pkt[3] << 8) | pkt[2]) + 4, s->len);
                     71:             s->info->acl_send(s->info, pkt, pktlen);
                     72:             s->len -= pktlen;
                     73:             pkt += pktlen;
                     74:             break;
                     75: 
                     76:         case HCI_SCODATA_PKT:
                     77:             if (s->len < 3)
                     78:                 goto bad_pkt;
                     79: 
                     80:             pktlen = MIN(pkt[2] + 3, s->len);
                     81:             s->info->sco_send(s->info, pkt, pktlen);
                     82:             s->len -= pktlen;
                     83:             pkt += pktlen;
                     84:             break;
                     85: 
                     86:         default:
                     87:         bad_pkt:
                     88:             fprintf(stderr, "qemu: bad HCI packet type %02x\n", pkt[-1]);
                     89:         }
                     90: }
                     91: 
                     92: static void vhci_host_send(void *opaque,
                     93:                 int type, const uint8_t *data, int len)
                     94: {
                     95:     struct bt_vhci_s *s = (struct bt_vhci_s *) opaque;
                     96: #if 0
                     97:     uint8_t pkt = type;
                     98:     struct iovec iv[2];
                     99: 
                    100:     iv[0].iov_base = &pkt;
                    101:     iv[0].iov_len  = 1;
                    102:     iv[1].iov_base = (void *) data;
                    103:     iv[1].iov_len  = len;
                    104: 
                    105:     while (writev(s->fd, iv, 2) < 0)
                    106:         if (errno != EAGAIN && errno != EINTR) {
                    107:             fprintf(stderr, "qemu: error %i writing bluetooth packet.\n",
                    108:                             errno);
                    109:             return;
                    110:         }
                    111: #else
                    112:     /* Apparently VHCI wants us to write everything in one chunk :-(  */
                    113:     static uint8_t buf[4096];
                    114: 
                    115:     buf[0] = type;
                    116:     memcpy(buf + 1, data, len);
                    117: 
                    118:     while (write(s->fd, buf, len + 1) < 0)
                    119:         if (errno != EAGAIN && errno != EINTR) {
                    120:             fprintf(stderr, "qemu: error %i writing bluetooth packet.\n",
                    121:                             errno);
                    122:             return;
                    123:         }
                    124: #endif
                    125: }
                    126: 
                    127: static void vhci_out_hci_packet_event(void *opaque,
                    128:                 const uint8_t *data, int len)
                    129: {
                    130:     vhci_host_send(opaque, HCI_EVENT_PKT, data, len);
                    131: }
                    132: 
                    133: static void vhci_out_hci_packet_acl(void *opaque,
                    134:                 const uint8_t *data, int len)
                    135: {
                    136:     vhci_host_send(opaque, HCI_ACLDATA_PKT, data, len);
                    137: }
                    138: 
                    139: void bt_vhci_init(struct HCIInfo *info)
                    140: {
                    141:     struct bt_vhci_s *s;
                    142:     int err[2];
                    143:     int fd;
                    144: 
                    145:     fd = open(VHCI_DEV, O_RDWR);
                    146:     err[0] = errno;
                    147:     if (fd < 0) {
                    148:         fd = open(VHCI_UDEV, O_RDWR);
                    149:         err[1] = errno;
                    150:     }
                    151: 
                    152:     if (fd < 0) {
                    153:         fprintf(stderr, "qemu: Can't open `%s': %s (%i)\n",
                    154:                         VHCI_DEV, strerror(err[0]), err[0]);
                    155:         fprintf(stderr, "qemu: Can't open `%s': %s (%i)\n",
                    156:                         VHCI_UDEV, strerror(err[1]), err[1]);
                    157:         exit(-1);
                    158:     }
                    159: 
                    160:     s = qemu_mallocz(sizeof(struct bt_vhci_s));
                    161:     s->fd = fd;
                    162:     s->info = info ?: qemu_next_hci();
                    163:     s->info->opaque = s;
                    164:     s->info->evt_recv = vhci_out_hci_packet_event;
                    165:     s->info->acl_recv = vhci_out_hci_packet_acl;
                    166: 
1.1.1.2 ! root      167:     qemu_set_fd_handler(s->fd, vhci_read, NULL, s);
1.1       root      168: }

unix.superglobalmegacorp.com