diff options
Diffstat (limited to 'usr.sbin/bluetooth/hccontrol/send_recv.c')
-rw-r--r-- | usr.sbin/bluetooth/hccontrol/send_recv.c | 184 |
1 files changed, 0 insertions, 184 deletions
diff --git a/usr.sbin/bluetooth/hccontrol/send_recv.c b/usr.sbin/bluetooth/hccontrol/send_recv.c deleted file mode 100644 index 5c2aea9..0000000 --- a/usr.sbin/bluetooth/hccontrol/send_recv.c +++ /dev/null @@ -1,184 +0,0 @@ -/* - * send_recv.c - * - * Copyright (c) 2001-2002 Maksim Yevmenkin <m_evmenkin@yahoo.com> - * All rights reserved. - * - * Redistribution and use in source and binary forms, with or without - * modification, are permitted provided that the following conditions - * are met: - * 1. Redistributions of source code must retain the above copyright - * notice, this list of conditions and the following disclaimer. - * 2. Redistributions in binary form must reproduce the above copyright - * notice, this list of conditions and the following disclaimer in the - * documentation and/or other materials provided with the distribution. - * - * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND - * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE - * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE - * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE - * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL - * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS - * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) - * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT - * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY - * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF - * SUCH DAMAGE. - * - * $Id: send_recv.c,v 1.2 2003/05/21 22:40:30 max Exp $ - * $FreeBSD$ - */ - -#include <sys/types.h> -#include <sys/socket.h> -#include <sys/time.h> -#include <sys/endian.h> -#include <assert.h> -#include <errno.h> -#include <netgraph/bluetooth/include/ng_hci.h> -#include <string.h> -#include <unistd.h> -#include "hccontrol.h" - -/* Send HCI request to the unit */ -int -hci_request(int s, int opcode, char const *cp, int cp_size, char *rp, int *rp_size) -{ - char buffer[512]; - int n; - ng_hci_cmd_pkt_t *c = (ng_hci_cmd_pkt_t *) buffer; - ng_hci_event_pkt_t *e = (ng_hci_event_pkt_t *) buffer; - - assert(rp != NULL); - assert(rp_size != NULL); - assert(*rp_size > 0); - - c->type = NG_HCI_CMD_PKT; - c->opcode = (uint16_t) opcode; - c->opcode = htole16(c->opcode); - - if (cp != NULL) { - assert(0 < cp_size && cp_size <= NG_HCI_CMD_PKT_SIZE); - - c->length = (uint8_t) cp_size; - memcpy(buffer + sizeof(*c), cp, cp_size); - } else - c->length = 0; - - if (hci_send(s, buffer, sizeof(*c) + cp_size) == ERROR) - return (ERROR); - -again: - n = sizeof(buffer); - if (hci_recv(s, buffer, &n) == ERROR) - return (ERROR); - - if (n < sizeof(*e)) { - errno = EMSGSIZE; - return (ERROR); - } - - if (e->type != NG_HCI_EVENT_PKT) { - errno = EIO; - return (ERROR); - } - - switch (e->event) { - case NG_HCI_EVENT_COMMAND_COMPL: { - ng_hci_command_compl_ep *cc = - (ng_hci_command_compl_ep *)(e + 1); - - cc->opcode = le16toh(cc->opcode); - - if (cc->opcode == 0x0000 || cc->opcode != opcode) - goto again; - - n -= (sizeof(*e) + sizeof(*cc)); - if (n < *rp_size) - *rp_size = n; - - memcpy(rp, buffer + sizeof(*e) + sizeof(*cc), *rp_size); - } break; - - case NG_HCI_EVENT_COMMAND_STATUS: { - ng_hci_command_status_ep *cs = - (ng_hci_command_status_ep *)(e + 1); - - cs->opcode = le16toh(cs->opcode); - - if (cs->opcode == 0x0000 || cs->opcode != opcode) - goto again; - - *rp_size = 1; - *rp = cs->status; - } break; - - default: - goto again; - } - - return (OK); -} /* hci_request */ - -/* Send simple HCI request - Just HCI command packet (no parameters) */ -int -hci_simple_request(int s, int opcode, char *rp, int *rp_size) -{ - return (hci_request(s, opcode, NULL, 0, rp, rp_size)); -} /* hci_simple_request */ - -/* Send HCI data to the unit */ -int -hci_send(int s, char const *buffer, int size) -{ - assert(buffer != NULL); - assert(size >= sizeof(ng_hci_cmd_pkt_t)); - assert(size <= sizeof(ng_hci_cmd_pkt_t) + NG_HCI_CMD_PKT_SIZE); - - if (send(s, buffer, size, 0) < 0) - return (ERROR); - - return (OK); -} /* hci_send */ - -/* Receive HCI data from the unit */ -int -hci_recv(int s, char *buffer, int *size) -{ - struct timeval tv; - fd_set rfd; - int n; - - assert(buffer != NULL); - assert(size != NULL); - assert(*size > sizeof(ng_hci_event_pkt_t)); - -again: - FD_ZERO(&rfd); - FD_SET(s, &rfd); - - tv.tv_sec = timeout; - tv.tv_usec = 0; - - n = select(s + 1, &rfd, NULL, NULL, &tv); - if (n <= 0) { - if (n < 0) { - if (errno == EINTR) - goto again; - } else - errno = ETIMEDOUT; - - return (ERROR); - } - - assert(FD_ISSET(s, &rfd)); - - n = recv(s, buffer, *size, 0); - if (n < 0) - return (ERROR); - - *size = n; - - return (OK); -} /* hci_recv */ - |