/*      $NetBSD: init_bcm43xx.c,v 1.6 2023/02/07 20:45:44 mlelstv Exp $ */

/*-
* Copyright (c) 2017 Nathanial Sloss <[email protected]>
* 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.6 2023/02/07 20:45:44 mlelstv 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));

       if (uart_send_cmd(fd, HCI_CMD_RESET, NULL, 0))
               return;
       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));
}