usr.sbin/bluetooth/hccontrol/send_recv.c

   1 /*-
   2  * send_recv.c
   3  *
   4  * SPDX-License-Identifier: BSD-2-Clause-FreeBSD
   5  *
   6  * Copyright (c) 2001-2002 Maksim Yevmenkin <m_evmenkin@yahoo.com>
   7  * All rights reserved.
   8  *
   9  * Redistribution and use in source and binary forms, with or without
  10  * modification, are permitted provided that the following conditions
  11  * are met:
  12  * 1. Redistributions of source code must retain the above copyright
  13  *    notice, this list of conditions and the following disclaimer.
  14  * 2. Redistributions in binary form must reproduce the above copyright
  15  *    notice, this list of conditions and the following disclaimer in the
  16  *    documentation and/or other materials provided with the distribution.
  17  *
  18  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
  19  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  21  * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
  22  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
  23  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
  24  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
  25  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  26  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
  27  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
  28  * SUCH DAMAGE.
  29  *
  30  * $Id: send_recv.c,v 1.2 2003/05/21 22:40:30 max Exp $
  31  * $FreeBSD$
  32  */
  33
  34 #include <sys/types.h>
  35 #include <sys/socket.h>
  36 #include <sys/time.h>
  37 #include <sys/endian.h>
  38 #include <assert.h>
  39 #include <errno.h>
  40 #include <netgraph/bluetooth/include/ng_hci.h>
  41 #include <string.h>
  42 #include <unistd.h>
  43 #include "hccontrol.h"
  44
  45 /* Send HCI request to the unit */
  46 int
  47 hci_request(int s, int opcode, char const *cp, int cp_size, char *rp, int *rp_size)
  48 {
  49         char                     buffer[512];
  50         int                      n;
  51         ng_hci_cmd_pkt_t        *c = (ng_hci_cmd_pkt_t *) buffer;
  52         ng_hci_event_pkt_t      *e = (ng_hci_event_pkt_t *) buffer;
  53
  54         assert(rp != NULL);
  55         assert(rp_size != NULL);
  56         assert(*rp_size > 0);
  57
  58         c->type = NG_HCI_CMD_PKT;
  59         c->opcode = (uint16_t) opcode;
  60         c->opcode = htole16(c->opcode);
  61
  62         if (cp != NULL) {
  63                 assert(0 < cp_size && cp_size <= NG_HCI_CMD_PKT_SIZE);
  64
  65                 c->length = (uint8_t) cp_size;
  66                 memcpy(buffer + sizeof(*c), cp, cp_size);
  67         } else
  68                 c->length = 0;
  69
  70         if (hci_send(s, buffer, sizeof(*c) + cp_size) == ERROR)
  71                 return (ERROR);
  72
  73 again:
  74         n = sizeof(buffer);
  75         if (hci_recv(s, buffer, &n) == ERROR)
  76                 return (ERROR);
  77
  78         if (n < sizeof(*e)) {
  79                 errno = EMSGSIZE;
  80                 return (ERROR);
  81         }
  82
  83         if (e->type != NG_HCI_EVENT_PKT) {
  84                 errno = EIO;
  85                 return (ERROR);
  86         }
  87
  88         switch (e->event) {
  89         case NG_HCI_EVENT_COMMAND_COMPL: {
  90                 ng_hci_command_compl_ep *cc =
  91                                 (ng_hci_command_compl_ep *)(e + 1);
  92
  93                 cc->opcode = le16toh(cc->opcode);
  94
  95                 if (cc->opcode == 0x0000 || cc->opcode != opcode)
  96                         goto again;
  97
  98                 n -= (sizeof(*e) + sizeof(*cc));
  99                 if (n < *rp_size)
 100                         *rp_size = n;
 101
 102                 memcpy(rp, buffer + sizeof(*e) + sizeof(*cc), *rp_size);
 103                 } break;
 104
 105         case NG_HCI_EVENT_COMMAND_STATUS: {
 106                 ng_hci_command_status_ep        *cs =
 107                                 (ng_hci_command_status_ep *)(e + 1);
 108
 109                 cs->opcode = le16toh(cs->opcode);
 110
 111                 if (cs->opcode == 0x0000 || cs->opcode != opcode)
 112                         goto again;
 113
 114                 *rp_size = 1;
 115                 *rp = cs->status;
 116                 } break;
 117
 118         default:
 119                 goto again;
 120         }
 121
 122         return (OK);
 123 } /* hci_request */
 124
 125 /* Send simple HCI request - Just HCI command packet (no parameters) */
 126 int
 127 hci_simple_request(int s, int opcode, char *rp, int *rp_size)
 128 {
 129         return (hci_request(s, opcode, NULL, 0, rp, rp_size));
 130 } /* hci_simple_request */
 131
 132 /* Send HCI data to the unit */
 133 int
 134 hci_send(int s, char const *buffer, int size)
 135 {
 136         assert(buffer != NULL);
 137         assert(size >= sizeof(ng_hci_cmd_pkt_t));
 138         assert(size <= sizeof(ng_hci_cmd_pkt_t) + NG_HCI_CMD_PKT_SIZE);
 139
 140         if (send(s, buffer, size, 0) < 0)
 141                 return (ERROR);
 142
 143         return (OK);
 144 } /* hci_send */
 145
 146 /* Receive HCI data from the unit */
 147 int
 148 hci_recv(int s, char *buffer, int *size)
 149 {
 150         struct timeval  tv;
 151         fd_set          rfd;
 152         int             n;
 153
 154         assert(buffer != NULL);
 155         assert(size != NULL);
 156         assert(*size > sizeof(ng_hci_event_pkt_t));
 157
 158 again:
 159         FD_ZERO(&rfd);
 160         FD_SET(s, &rfd);
 161
 162         tv.tv_sec = timeout;
 163         tv.tv_usec = 0;
 164
 165         n = select(s + 1, &rfd, NULL, NULL, &tv);
 166         if (n <= 0) {
 167                 if (n < 0) {
 168                         if (errno == EINTR)
 169                                 goto again;
 170                 } else
 171                         errno = ETIMEDOUT;
 172
 173                 return (ERROR);
 174         }
 175
 176         assert(FD_ISSET(s, &rfd));
 177
 178         n = recv(s, buffer, *size, 0);
 179         if (n < 0)
 180                 return (ERROR);
 181
 182         *size = n;
 183
 184         return (OK);
 185 } /* hci_recv */
 186