source: azure_iot_hub/trunk/asp3_dcre/tinet/netdev/if_btusb/if_btusb.c@ 388

/*
 *  TINET (TCP/IP Protocol Stack)
 * 
 *  Copyright (C) 2001-2009 by Dep. of Computer Science and Engineering
 *                   Tomakomai National College of Technology, JAPAN
 *  Copyright (C) 2014-2017 by Cores Co., Ltd. Japan
 * 
 *  上記著作権者
は，以下の(1)～(4)ã®æ¡ä»¶ã‚’æº€ãŸã™å ´åˆã«é™ã‚Šï¼Œæœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§
 *  ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
 *  変・再é…
å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
 *  (1) æœ¬ã‚½ãƒ•ãƒˆã‚¦ã‚§ã‚¢ã‚’ã‚½ãƒ¼ã‚¹ã‚³ãƒ¼ãƒ‰ã®å½¢ã§åˆ©ç”¨ã™ã‚‹å ´åˆã«ã¯ï¼Œä¸Šè¨˜ã®è‘—ä½œ
 *      権表示，この利用条件および下記の無保証規定が，そのままの形でソー
 *      スコード中に含まれていること．
 *  (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
 *      用できる形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
 *      者
マニュアルなど）に，上記の著作権表示，この利用条件および下記
 *      の無保証規定を掲載すること．
 *  (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
 *      用できない形で再é…
å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
 *      と．
 *    (a) 再é…
å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
マニュアルなど）に，上記の著
 *        作権表示，この利用条件および下記の無保証規定を掲載すること．
 *    (b) 再é…
å¸ƒã®å½¢æ…
‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
 *        å ±å‘Šã™ã‚‹ã“ã¨ï¼Ž
 *  (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
 *      害からも，上記著作権者
およびTOPPERSプロジェクトをå…
è²¬ã™ã‚‹ã“と．
 *      また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
 *      由に基づく請求からも，上記著作権者
およびTOPPERSプロジェクトを
 *      å…
è²¬ã™ã‚‹ã“と．
 * 
 *  本ソフトウェアは，無保証で提供されているものである．上記著作権者
お
 *  よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
 *  に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
 *  アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
 *  ã®è²¬ä»»ã‚’è² ã‚ãªã„ï¼Ž
 * 
 *  @(#) $Id: if_btusb.c 388 2019-05-22 11:25:18Z coas-nagasima $
 */

/*
 * Copyright (c) 1995, David Greenman
 * 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 unmodified, 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.
 * 
 * $FreeBSD: src/sys/i386/isa/if_ed.c,v 1.148.2.4 1999/09/25 13:08:18 nyan Exp $
 */

#define __BTSTACK_FILE__ "if_btusb.c"

#ifdef TARGET_KERNEL_ASP

#define CAST(type, val)         ((type)(val))

#include <kernel.h>
#include <sil.h>
#include <t_syslog.h>
#include "kernel_cfg.h"
#include "kernel/kernel_impl.h"
#include "btstack/utils.h"
#include "bt_main.h"
#include "usb_hbth.h"
//#include "hal_cpu.h"
//#include "hal_tick.h"
#include "hci.h"
#include "debug.h"

#endif  /* of #ifdef TARGET_KERNEL_ASP */

#ifdef TARGET_KERNEL_JSP

#include <s_services.h>
#include <t_services.h>
#include "kernel_id.h"

#endif  /* of #ifdef TARGET_KERNEL_JSP */

#include <tinet_defs.h>
#include <tinet_config.h>

#include <net/if.h>
#include <net/ethernet.h>
#include <net/if_arp.h>
#include <net/net.h>
#include <net/net_timer.h>
#include <net/net_count.h>
#include <net/net_buf.h>
#include "if_btusb.h"

#include <string.h>

#ifdef _MSC_VER
#include <stdlib.h>
#endif

#ifndef TMO_IF_BTUSB_GET_NET_BUF
#define TMO_IF_BTUSB_GET_NET_BUF                ULONG_C(1000000)        /* [us] */
#endif

uint8_t mac_addr[ETHER_ADDR_LEN];
static void (*btstack_network_send_packet_callback)(uint16_t bnep_cid, const uint8_t * packet, uint16_t size);

int btstack_network_input_spos = 0;
int btstack_network_input_rpos = 0;
T_NET_BUF *btstack_network_input[NUM_IF_BTUSB_RXBUF];

int btstack_network_output_spos = 0;
int btstack_network_output_rpos = 0;
T_NET_BUF *btstack_network_output[NUM_IF_BTUSB_TXBUF];

/*
 *  ネットワークインタフェースに依存するソフトウェア情
å ± 
 */

typedef struct t_btusb_softc {
        uint16_t bnep_cid;
        char bnep_name[10];
        bool_t over_flow;
} T_BTUSB_SOFTC;

/*
 *  ネットワークインタフェースのソフトウェア情
å ±
 */

/* ネットワークインタフェースに依存するソフトウェア情
å ± */

static T_BTUSB_SOFTC btusb_softc;

/* ネットワークインタフェースに依存しないソフトウェア情
å ± */

T_IF_SOFTC if_softc = {
        {{0,}},                                         /* ネットワークインタフェースのアドレス       */
        0,                                                      /* 送信タイムアウト                     */
        &btusb_softc,                           /* ディバイス依存のソフトウェア情
å ±     */
        SEM_IF_BTUSB_SBUF_READY,        /* 送信セマフォ                   */
        SEM_IF_BTUSB_RBUF_READY,        /* 受信セマフォ                   */

#ifdef SUPPORT_INET6

        IF_MADDR_INIT,                          /* マルチキャストアドレスリスト   */

#endif  /* of #ifdef SUPPORT_INET6 */
};

/*
 *  局所変数
 */

static void btusb_stop (T_BTUSB_SOFTC *sc);
static void btusb_init_sub (T_IF_SOFTC *ic);

#ifdef SUPPORT_INET6

static uint32_t ds_crc (uint8_t *addr);
static void ds_getmcaf (T_IF_SOFTC *ic, uint32_t *mcaf);

/*
 *  ds_crc -- イーサネットアドレスの CRC を計算する。
 */

#define POLYNOMIAL      0x04c11db6

static uint32_t
ds_crc (uint8_t *addr)
{
        uint32_t        crc = ULONG_C(0xffffffff);
        int_t           carry, len, bit;
        uint8_t         byte;

        for (len = ETHER_ADDR_LEN; len -- > 0; ) {
                byte = *addr ++;
                for (bit = 8; bit -- > 0; ) {
                        carry   = ((crc & ULONG_C(0x80000000)) ? 1 : 0) ^ (byte & UINT_C(0x01));
                        crc   <<= 1;
                        byte   >>= 1;
                        if (carry)
                                crc = (crc ^ POLYNOMIAL) | carry;
                }
        }
        return crc;
}

#undef POLYNOMIAL

/*
 *  ds_getmcaf -- マルチキャストアドレスのリストからマルチキャストアドレス
 *                フィルタを計算する。
 */

static void
ds_getmcaf (T_IF_SOFTC *ic, uint32_t *mcaf)
{
        uint32_t        count, index;
        uint8_t         *af = (uint8_t*)mcaf;

        mcaf[0] = mcaf[1] = 0;

        for (count = MAX_IF_MADDR_CNT; count -- > 0; ) {
                index = ds_crc(ic->maddrs[count].lladdr) >> 26;
                af[index >> 3] |= 1 << (index & 7);
        }
}

/*
 * btusb_setrcr -- 受信構成レジスタ (RCR) を設定する。
 */

static void
btusb_setrcr (T_IF_SOFTC *ic)
{
}

/*
 * btusb_addmulti -- ãƒžãƒ«ãƒã‚­ãƒ£ã‚¹ãƒˆã‚¢ãƒ‰ãƒ¬ã‚¹ã‚’è¿½åŠ ã™ã‚‹ã€‚
 */

ER
btusb_addmulti (T_IF_SOFTC *ic)
{
        btusb_setrcr(ic);
        return E_OK;
}

#endif  /* of #ifdef SUPPORT_INET6 */

void btstack_network_init(void (*send_packet_callback)(uint16_t bnep_cid, const uint8_t * packet, uint16_t size))
{
        btstack_network_send_packet_callback = send_packet_callback;
}

void btstack_network_up(uint16_t bnep_cid, bd_addr_t local_addr, bd_addr_t remote_addr)
{
        T_BTUSB_SOFTC *sc = if_softc.sc;

        sc->bnep_cid = bnep_cid;

        /* MACアドレスを更新 */
        memcpy(if_softc.ifaddr.lladdr, local_addr, sizeof(if_softc.ifaddr.lladdr));

        snprintf(sc->bnep_name, sizeof(sc->bnep_name), "BNEP%04x", bnep_cid);

        ether_set_link_up();
}

const char * btstack_network_get_name(uint16_t bnep_cid)
{
        T_BTUSB_SOFTC *sc = if_softc.sc;

        return sc->bnep_name;
}

int btstack_network_down(uint16_t bnep_cid)
{
        T_BTUSB_SOFTC *sc = if_softc.sc;

        if (sc->bnep_cid != bnep_cid)
                log_info("btstack_network_down(bnep_cid=%d)", bnep_cid);

        ether_set_link_down();

        sc->bnep_cid = 0;

        return 0;
}

/*
 *  btusb_stop -- ネットワークインタフェースを停止する。
 * 
 *    注意: NIC 割り込み禁止状æ…
‹ã§å‘¼ã³å‡ºã™ã“と。
 */

static void
btusb_stop (T_BTUSB_SOFTC *sc)
{
}

void btusb_bus_init() {}
void btusb_inter_init() {}

/*
 *  btusb_init_sub -- ネットワークインタフェースの初期化
 * 
 *    注意: NIC 割り込み禁止状æ…
‹ã§å‘¼ã³å‡ºã™ã“と。
 */

static void
btusb_init_sub (T_IF_SOFTC *ic)
{
#if defined(TARGET_KERNEL_ASP)

        /* ターゲット依存部の割込み初期化 */
        btusb_inter_init();

#endif  /* of #if defined(TARGET_KERNEL_ASP) */

#if defined(TARGET_KERNEL_JSP) && TKERNEL_PRVER >= 0x1042u      /* JSP-1.4.2 以降 */

        /* ターゲット依存部の割込み初期化 */
        btusb_inter_init();

#endif  /* of #if defined(TARGET_KERNEL_JSP) && TKERNEL_PRVER >= 0x1042u */
}

/*
 * btusb_reset -- ネットワークインタフェースをリセットする。
 */

void
btusb_reset (T_IF_SOFTC *ic)
{
        NET_COUNT_ETHER_NIC(net_count_ether_nic[NC_ETHER_NIC_RESETS], 1);
        btusb_stop(ic->sc);
        btusb_init_sub(ic);
}

/*
 *  get_btusb_softc -- ネットワークインタフェースのソフトウェア情
å ±ã‚’è¿”ã™ã€‚
 */

T_IF_SOFTC *
btusb_get_softc (void)
{
        return &if_softc;
}

/*
 * btusb_watchdog -- ネットワークインタフェースのワッチドッグタイムアウト
 */

void
btusb_watchdog (T_IF_SOFTC *ic)
{
        btusb_reset(ic);
}

/*
 * btusb_probe -- ネットワークインタフェースの検出
 */

void
btusb_probe (T_IF_SOFTC *ic)
{
        int i;
#if defined(TARGET_KERNEL_ASP)

        /* ターゲット依存部のバスの初期化 */
        btusb_bus_init();

#endif  /* of #if defined(TARGET_KERNEL_ASP) */
#if defined(TARGET_KERNEL_JSP) && TKERNEL_PRVER >= 0x1042u      /* JSP-1.4.2 以降 */

        /* ターゲット依存部のバスの初期化 */
        btusb_bus_init();

#endif  /* of #if defined(TARGET_KERNEL_JSP) && TKERNEL_PRVER >= 0x1042u */

        for(i = 0; i < ETHER_ADDR_LEN; i++){
                ic->ifaddr.lladdr[i] = mac_addr[i];
        }
}

/*
 * btusb_init -- ネットワークインタフェースの初期化
 */

void
btusb_init (T_IF_SOFTC *ic)
{
        /* btusb_init 本体を呼び出す。*/
        btusb_init_sub(ic);
}

/*
 * btstack_network_process_packet -- btstackからフレームの受信
 */

void
btstack_network_process_packet(uint16_t bnep_cid, const uint8_t * packet, uint16_t size)
{
        T_BTUSB_SOFTC *sc = if_softc.sc;
        T_NET_BUF *input = NULL;
        uint16_t align;
        uint8_t *dst;
        ER error;

        if (sc->bnep_cid != bnep_cid)
                log_info("btstack_network_process_packet(bnep_cid=%d)", bnep_cid);

        // 受信バッファがいっぱい
        if (btstack_network_input[btstack_network_input_spos] != NULL) {
                sc->over_flow = true;
                return;
        }

        /*
         *  +-----------+--------+---------+---------+
         *  | Ehter HDR | IP HDR | TCP HDR | TCP SDU |
         *  +-----------+--------+---------+---------+
         *        14        20        20        n
         *   <----------------- len ---------------->
         *              ^
         *              t_net_buf で 4 オクテット境界にアラインされている。
         *
         *  tcp_input と udp_input では、擬似ヘッダと SDU でチェックサムを
         *  計算するが、n が 4 オクテット境界になるように SDU の後ろに 0 を
         *  パッディングする。その分を考æ…
®ã—て net_buf を獲得しなければならない。
         */
        align = ((((size - sizeof(T_IF_HDR)) + 3) >> 2) << 2) + sizeof(T_IF_HDR);

        if ((error = tget_net_buf(&input, align, TMO_IF_BTUSB_GET_NET_BUF)) == E_OK && input != NULL) {
                dst = input->buf + IF_ETHER_NIC_HDR_ALIGN;
                memcpy(dst, (void *)packet, size);

                loc_cpu();

                btstack_network_input[btstack_network_input_spos] = input;
                btstack_network_input_spos++;
                if (btstack_network_input_spos == NUM_IF_BTUSB_RXBUF)
                        btstack_network_input_spos = 0;

                unl_cpu();

                sig_sem(if_softc.semid_rxb_ready);
        }
}

/*
 * btusb_read -- フレームの読み込み
 */

T_NET_BUF *
btusb_read (T_IF_SOFTC *ic)
{
        T_BTUSB_SOFTC *sc = ic->sc;
        T_NET_BUF *input;

        if (sc->over_flow) {
                sc->over_flow = false;
        }

        loc_cpu();

        input = btstack_network_input[btstack_network_input_rpos];
        btstack_network_input[btstack_network_input_rpos] = NULL;
        btstack_network_input_rpos++;
        if (btstack_network_input_rpos == NUM_IF_BTUSB_RXBUF)
                btstack_network_input_rpos = 0;

        unl_cpu();

        if (input == NULL) {
                NET_COUNT_ETHER_NIC(net_count_ether_nic[NC_ETHER_NIC_IN_ERR_PACKETS], 1);
                NET_COUNT_ETHER_NIC(net_count_ether_nic[NC_ETHER_NIC_NO_BUFS], 1);
        }

        return input;
}

/*
 * btusb_start -- 送信フレームをバッファリングする。
 */

void
btusb_start (T_IF_SOFTC *ic, T_NET_BUF *output)
{
        T_BTUSB_SOFTC *sc = ic->sc;
        bool_t send = (btstack_network_output_spos == btstack_network_output_rpos)
                && (btstack_network_output[btstack_network_output_rpos] == NULL);

        if ((btstack_network_send_packet_callback == NULL)
                || !bt_can_send_packet()) {
                sig_sem(if_softc.semid_txb_ready);
                return;
        }

        output->flags |= NB_FLG_NOREL_IFOUT;

        loc_cpu();

        btstack_network_output[btstack_network_output_spos] = output;
        btstack_network_output_spos++;
        if (btstack_network_output_spos == NUM_IF_BTUSB_TXBUF)
                btstack_network_output_spos = 0;

        unl_cpu();

        if (send)
                btstack_network_send_packet_callback(sc->bnep_cid, output->buf, output->len);
}

/*
 * btstack_network_packet_sent -- バッファした送信フレームの送信が完了する。
 */

void
btstack_network_packet_sent(uint16_t bnep_cid)
{
        T_BTUSB_SOFTC *sc = if_softc.sc;
        T_NET_BUF *rel, *output;

        if (sc->bnep_cid != bnep_cid)
                log_info("btstack_network_packet_sent(bnep_cid=%d)", bnep_cid);

        loc_cpu();

        rel = btstack_network_output[btstack_network_output_rpos];
        btstack_network_output[btstack_network_output_rpos] = NULL;
        btstack_network_output_rpos++;
        if (btstack_network_output_rpos == NUM_IF_BTUSB_TXBUF)
                btstack_network_output_rpos = 0;

        output = btstack_network_output[btstack_network_output_rpos];

        unl_cpu();

        if (rel != NULL)
                rel_net_buf(rel);

        sig_sem(if_softc.semid_txb_ready);

        if (output != NULL)
                btstack_network_send_packet_callback(sc->bnep_cid, output->buf, output->len);
}

static void dummy_handler(void) {};
static void(*tick_handler)(void) = &dummy_handler;
void hal_tick_handler();

void hal_tick_init(void)
{
        //    timer_regist_userfunc(hal_tick_handler);
}

void hal_tick_set_handler(void(*handler)(void))
{
        if (handler == NULL) {
                tick_handler = &dummy_handler;
                return;
        }
        tick_handler = handler;
}

int  hal_tick_get_tick_period_in_ms(void)
{
        return 1;
}

void hal_tick_handler()
{
        tick_handler();
}

uint32_t hal_time_ms(void)
{
        SYSTIM time;
        get_tim(&time);
        return time / 1000;
}

void hal_cpu_disable_irqs(void)
{
        loc_cpu();
}

void hal_cpu_enable_irqs(void)
{
        unl_cpu();
}

int btstack_sleep = 0;

void hal_cpu_enable_irqs_and_sleep(void)
{
        unl_cpu();
        btstack_sleep = 1;
}

//#define PACKET_DUMP
static void usb_dummy_handler(uint8_t packet_type, uint8_t *packet, uint16_t size);
static void(*usb_packet_handler)(uint8_t packet_type, uint8_t *packet, uint16_t size) = usb_dummy_handler;

void usb_bt_callback(uint8_t event_type, uint8_t *data, int size)
{
#ifdef PACKET_DUMP
        int len = size;

        switch (event_type) {
        case HCI_EVENT_PACKET:
                printf("EVT <= ");
                break;
        case HCI_ACL_DATA_PACKET:
                printf("ACL <= ");
                break;
        default:
                printf("??? <= ");
                break;
        }

        if (len > 256)
                len = 256;
        printf_hexdump(data, len);
#endif
        usb_packet_handler(event_type, data, size);
}

static void usb_init(const void *transport_config)
{

}

static int usb_open(void *transport_config)
{
        return 0;
}

static int usb_close(void *transport_config)
{
        return 0;
}

static int usb_send_packet(uint8_t packet_type, uint8_t *packet, int size)
{
        int r;
#ifdef PACKET_DUMP
        int len = size;
        if (len > 256)
                len = 256;
#endif
        switch (packet_type) {
        case HCI_COMMAND_DATA_PACKET:
#ifdef PACKET_DUMP
                printf("CMD => ");
                printf_hexdump(packet, len);
#endif
                r = bt_usb_hbth_control_write(packet, size);
                if (r < 0 || r != size) {
                        log_error("Error submitting control transfer %d", r);
                        return -1;
                }
                return 0;
        case HCI_ACL_DATA_PACKET:
#ifdef PACKET_DUMP
                printf("ACL => ");
                printf_hexdump(packet, len);
#endif
                if (size >= 1024)
                        printf("HCI_ACL_DATA_PACKET size=%d\n", size);
                r = bt_usb_hbth_bulk_write(packet, size);
                if (r < 0) {
                        log_error("Error submitting data transfer, %d", r);
                        return -1;
                }
                return 0;
        default:
                return -1;
        }
}

static void usb_register_packet_handler(void(*handler)(uint8_t packet_type, uint8_t *packet, uint16_t size))
{
        log_info("registering packet handler.");
        usb_packet_handler = handler;
}

static const char * usb_get_transport_name(void){
        return "USB";
}

static void usb_dummy_handler(uint8_t packet_type, uint8_t *packet, uint16_t size)
{
}

// single instance
static const hci_transport_t hci_transport_usb =
{
        /*.open                          =*/ usb_open,
        /*.close                         =*/ usb_close,
        /*.send_packet                   =*/ usb_send_packet,
        /*.register_packet_handler       =*/ usb_register_packet_handler,
        /*.get_transport_name            =*/ usb_get_transport_name,
        /*.set_baudrate                  =*/ NULL,
        /*.can_send_packet_now           =*/ NULL
};

// get usb singleton
const hci_transport_t *hci_transport_usb_instance()
{
        return &hci_transport_usb;
}