NetBSD/usr.sbin/btattach/init_bcm43xx.c

159 lines
4.4 KiB
C

/* $NetBSD: init_bcm43xx.c,v 1.5 2017/09/03 22:54:12 nat Exp $ */
/*-
* Copyright (c) 2017 Nathanial Sloss <nathanialsloss@yahoo.com.au>
* All rights reserved.
*
* Copyright (c) 2008 Iain Hibbert
* 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 ``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 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.
*/
/*
* init information in this file gleaned from hciattach(8)
* command from BlueZ for Linux - see http://www.bluez.org/
*/
#include <sys/cdefs.h>
__RCSID("$NetBSD: init_bcm43xx.c,v 1.5 2017/09/03 22:54:12 nat Exp $");
#include <sys/param.h>
#include <bluetooth.h>
#include <err.h>
#include <errno.h>
#include <fcntl.h>
#include <stdlib.h>
#include <string.h>
#include <termios.h>
#include <unistd.h>
#include "btattach.h"
#include "firmload.h"
#define HCI_CMD_BCM43XX_SET_UART_BAUD_RATE \
HCI_OPCODE(HCI_OGF_VENDOR, 0x018)
#define HCI_CMD_BCM43XX_SET_BDADDR \
HCI_OPCODE(HCI_OGF_VENDOR, 0x006)
#define HCI_CMD_BCM43XX_SET_CLOCK \
HCI_OPCODE(HCI_OGF_VENDOR, 0x045)
#define HCI_CMD_43XXFWDN \
HCI_OPCODE(HCI_OGF_VENDOR, 0x02e)
#define HCI_CMD_GET_LOCAL_NAME 0x0c14
#define BCM43XX_CLK_48 1
#define BCM43XX_CLK_24 2
static int
bcm43xx_get_local_name(int fd, char *name, size_t namelen)
{
char buf[256];
size_t len;
memset(buf, 0, sizeof(buf));
uart_send_cmd(fd, HCI_CMD_GET_LOCAL_NAME, NULL, 0);
len = uart_recv_cc(fd, HCI_CMD_GET_LOCAL_NAME, buf, sizeof(buf));
if (len == 0)
return EIO;
strlcpy(name, &buf[1], MIN(len - 1, namelen));
if (strlen(name) == 0)
return EIO;
return 0;
}
void
init_bcm43xx(int fd, unsigned int speed)
{
uint8_t rate[6], clock;
uint8_t fw_buf[1024];
int fwfd, fw_len;
uint8_t resp[7];
uint16_t fw_cmd;
char local_name[256];
char fw[260];
memset(rate, 0, sizeof(rate));
memset(local_name, 0, sizeof(local_name));
uart_send_cmd(fd, HCI_CMD_RESET, NULL, 0);
uart_recv_cc(fd, HCI_CMD_RESET, &resp, sizeof(resp));
/* assume it succeeded? */
if (bcm43xx_get_local_name(fd, local_name, sizeof(local_name)) != 0) {
fprintf(stderr, "Couldn't read local name\n");
return;
}
snprintf(fw, sizeof(fw), "%s.hcd", local_name);
fwfd = firmware_open("bcm43xx", fw);
if (fwfd < 0) {
fprintf(stderr, "Unable to open firmware bcm43xx/%s: %s\n",
fw, strerror(errno));
return;
}
uart_send_cmd(fd, HCI_CMD_43XXFWDN, NULL, 0);
uart_recv_cc(fd, HCI_CMD_43XXFWDN, &resp, sizeof(resp));
sleep(1);
while (read(fwfd, &fw_buf[1], 3) == 3) {
fw_buf[0] = HCI_CMD_PKT;
fw_len = fw_buf[3];
if (read(fwfd, &fw_buf[4], fw_len) != fw_len)
break;
fw_cmd = fw_buf[2] << 8 | fw_buf[1];
uart_send_cmd(fd, fw_cmd, &fw_buf[4], fw_len);
uart_recv_cc(fd, fw_cmd, &resp, sizeof(resp));
}
close(fwfd);
sleep(4);
uart_send_cmd(fd, HCI_CMD_RESET, NULL, 0);
uart_recv_cc(fd, HCI_CMD_RESET, &resp, sizeof(resp));
/* assume it succeeded? */
if (speed >= 3000000)
clock = BCM43XX_CLK_48;
else
clock = BCM43XX_CLK_24;
uart_send_cmd(fd, HCI_CMD_BCM43XX_SET_CLOCK, &clock, sizeof(clock));
uart_recv_cc(fd, HCI_CMD_BCM43XX_SET_CLOCK, &resp, sizeof(resp));
rate[2] = speed;
rate[3] = speed >> 8;
rate[4] = speed >> 16;
rate[5] = speed >> 24;
uart_send_cmd(fd, HCI_CMD_BCM43XX_SET_UART_BAUD_RATE, &rate, sizeof(rate));
uart_recv_cc(fd, HCI_CMD_BCM43XX_SET_UART_BAUD_RATE, &resp, sizeof(resp));
}