/*	$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));
}