/*
 * Copyright (C) 2014 BlueKitchen GmbH
 *
 * 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.
 * 3. Neither the name of the copyright holders nor the names of
 *    contributors may be used to endorse or promote products derived
 *    from this software without specific prior written permission.
 * 4. Any redistribution, use, or modification is done solely for
 *    personal benefit and not for any commercial purpose or for
 *    monetary gain.
 *
 * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH 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 MATTHIAS
 * RINGWALD 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.
 *
 * Please inquire about commercial licensing options at 
 * contact@bluekitchen-gmbh.com
 *
 */

/*
 *  bt_control_csr.c
 *
 *  Adapter to use CSR-based chipsets with BTstack
 *  
 */

#include "bt_control_csr.h"

#include <stddef.h>   /* NULL */
#include <stdio.h> 
#include <string.h>   /* memcpy */

#include "bt_control.h"
#include "debug.h"
#include "utils.h"

// minimal CSR init script to configure PSKEYs and activate them
static const uint8_t init_script[] = { 
    //  Set ANA_Freq PSKEY to 26MHz
    0x01, 0x00, 0xFC, 0x13, 0xc2, 0x02, 0x00, 0x09, 0x00, 0x01, 0x00, 0x03, 0x70, 0x00, 0x00, 0xfe, 0x01, 0x01, 0x00, 0x00, 0x00, 0x90, 0x65,
    //  Set HCI_NOP_DISABLE
    0x01, 0x00, 0xFC, 0x13, 0xc2, 0x02, 0x00, 0x09, 0x00, 0x01, 0x00, 0x03, 0x70, 0x00, 0x00, 0xf2, 0x00, 0x01, 0x00, 0x00, 0x00, 0x01, 0x00,
    //  Set UART baudrate to 115200
    0x01, 0x00, 0xFC, 0x15, 0xc2, 0x02, 0x00, 0x0a, 0x00, 0x02, 0x00, 0x03, 0x70, 0x00, 0x00, 0xea, 0x01, 0x02, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0xc2,
    //  WarmReset
    0x01, 0x00, 0xFC, 0x13, 0xc2, 0x02, 0x00, 0x09, 0x00, 0x03, 0x0e, 0x02, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00,
};
static const uint16_t init_script_size = sizeof(init_script);

//
static uint32_t init_script_offset  = 0;

static int bt_control_csr_on(void *config){
	init_script_offset = 0;
	return 0;
}

// set requested baud rate
static void bt_control_csr_update_command(hci_uart_config_t *config, uint8_t *hci_cmd_buffer){
    uint16_t varid = READ_BT_16(hci_cmd_buffer, 10);
    if (varid != 0x7003) return;
    uint16_t key = READ_BT_16(hci_cmd_buffer, 14);
    if (key != 0x01ea) return;
    uint32_t baudrate = config->baudrate_main;
    if (baudrate == 0){
        baudrate = config->baudrate_init;
    }
    // uint32_t is stored as 2 x uint16_t with most important 16 bits first
    bt_store_16(hci_cmd_buffer, 20, baudrate >> 16);
    bt_store_16(hci_cmd_buffer, 22, baudrate &  0xffff);
}

static int bt_control_csr_next_cmd(void *config, uint8_t *hci_cmd_buffer){

    if (init_script_offset >= init_script_size) {
        return 0;
    }

    // init script is stored with the HCI Command Packet Type
    init_script_offset++;
    // copy command header
    memcpy(&hci_cmd_buffer[0], (uint8_t *) &init_script[init_script_offset], 3); 
    init_script_offset += 3;
    int payload_len = hci_cmd_buffer[2];
    // copy command payload
    memcpy(&hci_cmd_buffer[3], (uint8_t *) &init_script[init_script_offset], payload_len);

    // support for on-the-fly configuration updates
    bt_control_csr_update_command((hci_uart_config_t*)config, hci_cmd_buffer);

    init_script_offset += payload_len;

    // support for warm boot command
    uint16_t varid = READ_BT_16(hci_cmd_buffer, 10);
    log_info("csr: varid 0x%04x", varid);
    if (varid == 0x4002){
        return 2;
    }

    return 1; 
}

// MARK: const structs 

static const bt_control_t bt_control_csr = {
    bt_control_csr_on,                  // on
    NULL,                               // off
    NULL,                               // sleep
    NULL,                               // wake
    NULL,                               // valid
    NULL,                               // name
    NULL,                               // baudrate_cmd
    bt_control_csr_next_cmd,            // next_cmd
    NULL,                               // register_for_power_notifications
    NULL,                               // hw_error
    NULL,                               // set_bd_addr_cmd
};

static const hci_uart_config_t hci_uart_config_csr = {
    NULL,
    115200,
    0,  // 1000000,
    0
};

// MARK: public API
void bt_control_csr_set_power(int16_t power_in_dB){
}

bt_control_t *bt_control_csr_instance(void){
    return (bt_control_t*) &bt_control_csr;
}

hci_uart_config_t *hci_uart_config_csr_instance(void){
    return (hci_uart_config_t*) &hci_uart_config_csr;
}