diff --git a/diagnose_bt.sh b/diagnose_bt.sh index eb0e784..688c038 100644 --- a/diagnose_bt.sh +++ b/diagnose_bt.sh @@ -3,6 +3,10 @@ # AIC8800D80 Bluetooth Diagnostic Script # 用于诊断蓝牙问题 # +# 本分支 (bluetooth) 使用内核标准 btusb 驱动接管蓝牙， +# aic_load_fw 负责把蓝牙固件上传到芯片。 +# 不应该再安装/加载 aic_btusb。 +# echo "=== AIC8800D80 蓝牙诊断 ===" echo "" @@ -38,8 +42,8 @@ done echo "" # 3. 检查已加载的模块 -echo "3. 已加载的 AIC 模块:" -lsmod | grep -E "aic|btusb" || echo " 未找到相关模块" +echo "3. 已加载的相关模块 (期望: aic_load_fw + btusb):" +lsmod | grep -E "aic_load_fw|aicwf|btusb|bluetooth" || echo " 未找到相关模块" echo "" # 4. 检查 HCI 设备 @@ -49,7 +53,7 @@ echo "" # 5. 检查蓝牙固件加载日志 echo "5. 蓝牙固件加载日志 (最近 50 行):" -dmesg | grep -iE "fw_patch|fw_adid|aicbt|bluetooth|btusb|aic_btusb|hci" | tail -50 +dmesg | grep -iE "fw_patch|fw_adid|aicbt|bluetooth|btusb|hci" | tail -50 echo "" # 6. 检查 rfkill 状态 @@ -57,13 +61,15 @@ echo "6. RF-Kill 状态:" rfkill list bluetooth 2>/dev/null || echo " 无法获取 rfkill 信息" echo "" -# 7. 检查 modprobe 配置 -echo "7. Modprobe 配置:" +# 7. 检查残留的旧 modprobe 配置 (issue #53) +echo "7. 残留旧配置检查:" if [ -f /etc/modprobe.d/aic8800-bt.conf ]; then - echo " /etc/modprobe.d/aic8800-bt.conf 存在:" - cat /etc/modprobe.d/aic8800-bt.conf + echo " ⚠️ 发现 /etc/modprobe.d/aic8800-bt.conf —— 这是早期版本残留, 应删除" + echo " 该文件 softdep / alias 到不再存在的 aic_btusb, 会导致 btusb 接管设备" + echo " 但固件未上传, 表现为 hci0 HCI_Reset 超时 (-110)" + echo " 修复: sudo rm /etc/modprobe.d/aic8800-bt.conf && sudo update-initramfs -u (若用 initramfs)" else - echo " /etc/modprobe.d/aic8800-bt.conf 不存在!" + echo " /etc/modprobe.d/aic8800-bt.conf 不存在 (正常)" fi echo "" @@ -71,28 +77,29 @@ echo "" echo "=== 诊断建议 ===" echo "" -# 检查是否有 3 个接口 -intf_count=$(lsusb -t 2>/dev/null | grep -c "Class=Wireless" || echo "0") -if [ "$intf_count" -lt 2 ]; then - echo "⚠️ 蓝牙接口数量不足 (应该有 2 个 Wireless 接口)" - echo " 可能原因: aic_load_fw 没有加载蓝牙固件" - echo " 解决方案: 检查 dmesg 中是否有 'fw_patch_table_8800d80' 相关日志" +# 检查 aic_load_fw 是否加载 (它负责上传 WiFi + BT 固件) +if ! lsmod | grep -q "^aic_load_fw"; then + echo "⚠️ aic_load_fw 未加载" + echo " 该模块负责把蓝牙固件上传到芯片, 必须先于 btusb 工作" + echo " 解决方案: sudo modprobe aic_load_fw" echo "" fi -# 检查 btusb 是否抢占 +# 检查 HCI_Reset 超时 (典型症状: 固件未上传却让 btusb 接管) +if dmesg | grep -iE "hci0:.*command (0x|tx) timed out|hci0.*opcode.*0x0c03" | tail -5 | grep -q .; then + echo "⚠️ 检测到 HCI 命令超时 (HCI_Reset/-110)" + echo " 常见原因:" + echo " a) /etc/modprobe.d/aic8800-bt.conf 残留 (见第 7 项)" + echo " b) aic_load_fw 没有先把蓝牙固件 patch 上传到芯片" + echo " c) usb_modeswitch 没把 1111:1111 切换到真实 VID:PID" + echo " 排查: 看上面第 5 项日志, 应能看到 fw_patch_table_8800d80 / fw_adid 字样" + echo " 临时缓解: 拔插一次设备 (软件复位/飞行模式切换通常无法救活)" + echo "" +fi + +# btusb 是否已接管 BT 接口 (这是正常预期) if lsmod | grep -q "^btusb"; then - echo "⚠️ btusb 模块已加载" - echo " 如果蓝牙不工作，可能是 btusb 抢占了设备" - echo " 解决方案: sudo rmmod btusb && sudo modprobe aic_btusb" - echo "" -fi - -# 检查 aic_btusb 是否加载 -if ! lsmod | grep -q "aic_btusb"; then - echo "⚠️ aic_btusb 模块未加载" - echo " 解决方案: sudo modprobe aic_btusb" - echo "" + echo "✅ btusb 已加载 (正常, 本分支由 btusb 接管蓝牙)" fi echo "=== 诊断完成 ===" diff --git a/drivers/aic8800/aic_btusb/Kconfig b/drivers/aic8800/aic_btusb/Kconfig deleted file mode 100644 index 7416cd6..0000000 --- a/drivers/aic8800/aic_btusb/Kconfig +++ /dev/null @@ -1,8 +0,0 @@ -config AIC8800_BTUSB_SUPPORT - tristate "AIC8800 Bluetooth USB Support" - depends on BT && USB - help - This is support for AIC8800 Bluetooth USB driver. - Select this option if you have an AIC8800 USB WiFi/Bluetooth - combo adapter and want to use Bluetooth functionality. - diff --git a/drivers/aic8800/aic_btusb/Makefile b/drivers/aic8800/aic_btusb/Makefile deleted file mode 100644 index 41d3718..0000000 --- a/drivers/aic8800/aic_btusb/Makefile +++ /dev/null @@ -1,87 +0,0 @@ -MODULE_NAME = aic_btusb - -CONFIG_AIC8800_BTUSB_SUPPORT = m -CONFIG_SUPPORT_VENDOR_APCF = n -# Need to set fw path in BOARD_KERNEL_CMDLINE -CONFIG_USE_FW_REQUEST = n - -ifeq ($(CONFIG_SUPPORT_VENDOR_APCF), y) -obj-$(CONFIG_AIC8800_BTUSB_SUPPORT) := $(MODULE_NAME).o aic_btusb_external_featrue.o -else -obj-$(CONFIG_AIC8800_BTUSB_SUPPORT) := $(MODULE_NAME).o -endif - -ccflags-$(CONFIG_SUPPORT_VENDOR_APCF) += -DCONFIG_SUPPORT_VENDOR_APCF -#$(MODULE_NAME)-y := aic_btusb_ioctl.o\ -# aic_btusb.o \ - -ccflags-$(CONFIG_USE_FW_REQUEST) += -DCONFIG_USE_FW_REQUEST - - -# Platform support list -CONFIG_PLATFORM_ROCKCHIP ?= n -CONFIG_PLATFORM_ALLWINNER ?= n -CONFIG_PLATFORM_AMLOGIC ?= n -CONFIG_PLATFORM_UBUNTU ?= y - - -# MTK linux platform use bluedroid -CONFIG_PLATFORM_MTK_LINUX ?= n - - -ifeq ($(CONFIG_PLATFORM_ROCKCHIP), y) -ccflags-$(CONFIG_PLATFORM_ROCKCHIP) += -DCONFIG_PLATFORM_ROCKCHIP -KDIR := /home/yaya/E/Rockchip/3229/Android9/rk3229_android9.0_box/kernel -ARCH ?= arm -CROSS_COMPILE ?= /home/yaya/E/Rockchip/3229/Android9/rk3229_android9.0_box/prebuilts/gcc/linux-x86/arm/gcc-linaro-6.3.1-2017.05-x86_64_arm-linux-gnueabihf/bin/arm-linux-gnueabihf- -#KDIR := /home/yaya/E/Rockchip/3229/Android7/RK3229_ANDROID7.1_v1.01_20170914/rk3229_Android7.1_v1.01_xml0914/kernel -#ARCH ?= arm -#CROSS_COMPILE ?= /home/yaya/E/Rockchip/3229/Android7/RK3229_ANDROID7.1_v1.01_20170914/rk3229_Android7.1_v1.01_xml0914/prebuilts/gcc/linux-x86/arm/arm-eabi-4.6/bin/arm-eabi- - -endif - -ifeq ($(CONFIG_PLATFORM_ALLWINNER), y) -ccflags-$(CONFIG_PLATFORM_ALLWINNER) += -DCONFIG_PLATFORM_ALLWINNER -KDIR := /home/yaya/E/Allwinner/R818/R818/AndroidQ/lichee/kernel/linux-4.9 -ARCH ?= arm64 -CROSS_COMPILE ?= /home/yaya/E/Allwinner/R818/R818/AndroidQ/lichee/out/gcc-linaro-5.3.1-2016.05-x86_64_aarch64-linux-gnu/bin/aarch64-linux-gnu- -endif - -ifeq ($(CONFIG_PLATFORM_AMLOGIC), y) - ccflags-$(CONFIG_PLATFORM_AMLOGIC) += -DCONFIG_PLATFORM_AMLOGIC -endif - -ifeq ($(CONFIG_PLATFORM_UBUNTU), y) -ccflags-$(CONFIG_PLATFORM_UBUNTU) += -DCONFIG_PLATFORM_UBUNTU - -KVER ?= $(shell uname -r) -KDIR ?= /lib/modules/$(KVER)/build -PWD := $(shell pwd) -MODDESTDIR := /lib/modules/$(KVER)/kernel/drivers/net/wireless/aic8800 -SUBARCH = $(shell uname -m | sed -e s/i.86/i386/ -e s/armv.l/arm/ -e s/aarch64/arm64/) -ARCH ?= $(SUBARCH) -CROSS_COMPILE := -endif - -ifeq ($(CONFIG_PLATFORM_MTK_LINUX), y) - ccflags-$(CONFIG_PLATFORM_MTK_LINUX) += -DCONFIG_PLATFORM_MTK_LINUX -endif - -all: modules -modules: - make -C $(KDIR) M=$(PWD) ARCH=$(ARCH) CROSS_COMPILE=$(CROSS_COMPILE) modules - -install: - mkdir -p $(MODDESTDIR) - install -p -m 644 $(MODULE_NAME).ko $(MODDESTDIR)/ - /sbin/depmod -a ${KVER} - echo $(MODULE_NAME) >> /etc/modules-load.d/aic_bt.conf - -uninstall: - rm -rfv $(MODDESTDIR)/$(MODULE_NAME).ko - /sbin/depmod -a ${KVER} - rm -f /etc/modules-load.d/aic_bt.conf - -clean: - rm -rf *.o *.ko *.o.* *.mod.* modules.* Module.* .a* .o* .*.o.* *.mod .tmp* .cache.mk .Module.symvers.cmd .modules.order.cmd - diff --git a/drivers/aic8800/aic_btusb/aic_btusb.c b/drivers/aic8800/aic_btusb/aic_btusb.c deleted file mode 100644 index 185fcc6..0000000 --- a/drivers/aic8800/aic_btusb/aic_btusb.c +++ /dev/null @@ -1,5521 +0,0 @@ -/* - * - * AicSemi Bluetooth USB driver - * - * - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or - * the Free Software Foundation; either version 2 of the License, or - * (at your option) any later version. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program; if not, write to the Free Software - * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA - * - */ - -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#include -#include -#include -#include -#include -#include -#include -#include - -#include "aic_btusb.h" - -#ifdef CONFIG_USE_FW_REQUEST -#include -#endif - -#define AICBT_RELEASE_NAME "202012_ANDROID" -#define VERSION "2.1.0" - - - -static spinlock_t queue_lock; -static spinlock_t dlfw_lock; -static volatile uint16_t dlfw_dis_state = 0; - -/* USB Device ID */ -#define USB_VENDOR_ID_AIC 0xA69C -#define USB_VENDOR_ID_AIC_V2 0x368B -#define USB_PRODUCT_ID_AIC8801 0x8801 -#define USB_PRODUCT_ID_AIC8800DC 0x88dc -#define USB_PRODUCT_ID_AIC8800D80 0x8d81 -#define USB_PRODUCT_ID_AIC8800D80X2 0x8d91 -#define USB_PRODUCT_ID_AIC8800D80X2P 0x8da1 -#define USB_PRODUCT_ID_AIC8800D80N 0x8d45 -#define USB_PRODUCT_ID_AIC8800D80LN 0x8d46 -#define USB_PRODUCT_ID_AIC8800D40N 0x8d48 -#define USB_PRODUCT_ID_AIC8800D40LN 0x8d49 -#define USB_PRODUCT_ID_AIC8800DLN 0x8871 - -enum AICWF_IC{ - PRODUCT_ID_AIC8801 = 0, - PRODUCT_ID_AIC8800DC, - PRODUCT_ID_AIC8800DW, - PRODUCT_ID_AIC8800DLN, - PRODUCT_ID_AIC8800D80N, - PRODUCT_ID_AIC8800D80, - PRODUCT_ID_AIC8800D80X2, - PRODUCT_ID_MAX, -}; - -u16 g_chipid = PRODUCT_ID_AIC8801; -u8 chip_id = 0; -u8 sub_chip_id = 0; - -int btdual = 0; -int bt_support = 0; -int testmode = 0; - -module_param(testmode, int, 0660); -module_param(btdual, int, 0660); -module_param(bt_support, int, 0660); - -struct btusb_data { - struct hci_dev *hdev; - struct usb_device *udev; - struct usb_interface *intf; - struct usb_interface *isoc; - - spinlock_t lock; - - unsigned long flags; - - struct work_struct work; - struct work_struct waker; - - struct usb_anchor tx_anchor; - struct usb_anchor intr_anchor; - struct usb_anchor bulk_anchor; - struct usb_anchor isoc_anchor; - struct usb_anchor deferred; - int tx_in_flight; - spinlock_t txlock; - -#if (CONFIG_BLUEDROID == 0) -#if HCI_VERSION_CODE >= KERNEL_VERSION(3, 18, 0) - spinlock_t rxlock; - struct sk_buff *evt_skb; - struct sk_buff *acl_skb; - struct sk_buff *sco_skb; -#endif -#endif - - struct usb_endpoint_descriptor *intr_ep; - struct usb_endpoint_descriptor *bulk_tx_ep; - struct usb_endpoint_descriptor *bulk_rx_ep; - struct usb_endpoint_descriptor *isoc_tx_ep; - struct usb_endpoint_descriptor *isoc_rx_ep; - - __u8 cmdreq_type; - - unsigned int sco_num; - int isoc_altsetting; - int suspend_count; - uint16_t sco_handle; - -#if (CONFIG_BLUEDROID == 0) -#if HCI_VERSION_CODE >= KERNEL_VERSION(3, 18, 0) - int (*recv_bulk) (struct btusb_data * data, void *buffer, int count); -#endif -#endif - -//#ifdef CONFIG_HAS_EARLYSUSPEND -#if 0 - struct early_suspend early_suspend; -#else - struct notifier_block pm_notifier; - struct notifier_block reboot_notifier; -#endif - firmware_info *fw_info; -}; -#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 1) -static bool reset_on_close = 0; -#endif - - -#ifdef CONFIG_SUPPORT_VENDOR_APCF -int vendor_apcf_sent_done = 0; -#endif - -const struct aicbt_firmware *aicbt_fw; - -static int aic_load_firmware(u8 ** fw_buf, const char *name, struct device *device); -static int aicbt_patch_table_free(struct aicbt_patch_table **head); -static int download_patch(firmware_info *fw_info, int cached); -static int rwnx_send_dbg_mem_write_req(firmware_info *fw_info, u32 mem_addr, u32 mem_data); - - -static inline int check_set_dlfw_state_value(uint16_t change_value) -{ - spin_lock(&dlfw_lock); - if(!dlfw_dis_state) { - dlfw_dis_state = change_value; - } - spin_unlock(&dlfw_lock); - return dlfw_dis_state; -} - -static inline void set_dlfw_state_value(uint16_t change_value) -{ - spin_lock(&dlfw_lock); - dlfw_dis_state = change_value; - spin_unlock(&dlfw_lock); -} - - - - -static void aic_free( struct btusb_data *data) -{ -#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 7, 1) - kfree(data); -#endif - return; -} - -static struct btusb_data *aic_alloc(struct usb_interface *intf) -{ - struct btusb_data *data; -#if LINUX_VERSION_CODE < KERNEL_VERSION(3, 7, 1) - data = kzalloc(sizeof(*data), GFP_KERNEL); -#else - data = devm_kzalloc(&intf->dev, sizeof(*data), GFP_KERNEL); -#endif - return data; -} - -static void print_acl(struct sk_buff *skb, int direction) -{ -#if PRINT_ACL_DATA - //uint wlength = skb->len; - u16 *handle = (u16 *)(skb->data); - u16 len = *(handle+1); - //u8 *acl_data = (u8 *)(skb->data); - - AICBT_INFO("aic %s: direction %d, handle %04x, len %d", - __func__, direction, *handle, len); -#endif -} - -static void print_sco(struct sk_buff *skb, int direction) -{ -#if PRINT_SCO_DATA - uint wlength = skb->len; - u16 *handle = (u16 *)(skb->data); - u8 len = *(u8 *)(handle+1); - //u8 *sco_data =(u8 *)(skb->data); - - AICBT_INFO("aic %s: direction %d, handle %04x, len %d,wlength %d", - __func__, direction, *handle, len,wlength); -#endif -} - -static void print_error_command(struct sk_buff *skb) -{ - u16 *opcode = (u16*)(skb->data); - u8 *cmd_data = (u8*)(skb->data); - u8 len = *(cmd_data+2); - - printk(" 0x%04x,len:%d,", *opcode, len); -#if CONFIG_BLUEDROID - switch (*opcode) { - case HCI_OP_INQUIRY: - printk("HCI_OP_INQUIRY"); - break; - case HCI_OP_INQUIRY_CANCEL: - printk("HCI_OP_INQUIRY_CANCEL"); - break; - case HCI_OP_EXIT_PERIODIC_INQ: - printk("HCI_OP_EXIT_PERIODIC_INQ"); - break; - case HCI_OP_CREATE_CONN: - printk("HCI_OP_CREATE_CONN"); - break; - case HCI_OP_DISCONNECT: - printk("HCI_OP_DISCONNECT"); - break; - case HCI_OP_CREATE_CONN_CANCEL: - printk("HCI_OP_CREATE_CONN_CANCEL"); - break; - case HCI_OP_ACCEPT_CONN_REQ: - printk("HCI_OP_ACCEPT_CONN_REQ"); - break; - case HCI_OP_REJECT_CONN_REQ: - printk("HCI_OP_REJECT_CONN_REQ"); - break; - case HCI_OP_AUTH_REQUESTED: - printk("HCI_OP_AUTH_REQUESTED"); - break; - case HCI_OP_SET_CONN_ENCRYPT: - printk("HCI_OP_SET_CONN_ENCRYPT"); - break; - case HCI_OP_REMOTE_NAME_REQ: - printk("HCI_OP_REMOTE_NAME_REQ"); - break; - case HCI_OP_READ_REMOTE_FEATURES: - printk("HCI_OP_READ_REMOTE_FEATURES"); - break; - case HCI_OP_SNIFF_MODE: - printk("HCI_OP_SNIFF_MODE"); - break; - case HCI_OP_EXIT_SNIFF_MODE: - printk("HCI_OP_EXIT_SNIFF_MODE"); - break; - case HCI_OP_SWITCH_ROLE: - printk("HCI_OP_SWITCH_ROLE"); - break; - case HCI_OP_SNIFF_SUBRATE: - printk("HCI_OP_SNIFF_SUBRATE"); - break; - case HCI_OP_RESET: - printk("HCI_OP_RESET"); - break; - case HCI_OP_Write_Extended_Inquiry_Response: - printk("HCI_Write_Extended_Inquiry_Response"); - break; - case HCI_OP_Write_Simple_Pairing_Mode: - printk("HCI_OP_Write_Simple_Pairing_Mode"); - break; - case HCI_OP_Read_Buffer_Size: - printk("HCI_OP_Read_Buffer_Size"); - break; - case HCI_OP_Host_Buffer_Size: - printk("HCI_OP_Host_Buffer_Size"); - break; - case HCI_OP_Read_Local_Version_Information: - printk("HCI_OP_Read_Local_Version_Information"); - break; - case HCI_OP_Read_BD_ADDR: - printk("HCI_OP_Read_BD_ADDR"); - break; - case HCI_OP_Read_Local_Supported_Commands: - printk("HCI_OP_Read_Local_Supported_Commands"); - break; - case HCI_OP_Write_Scan_Enable: - printk("HCI_OP_Write_Scan_Enable"); - break; - case HCI_OP_Write_Current_IAC_LAP: - printk("HCI_OP_Write_Current_IAC_LAP"); - break; - case HCI_OP_Write_Inquiry_Scan_Activity: - printk("HCI_OP_Write_Inquiry_Scan_Activity"); - break; - case HCI_OP_Write_Class_of_Device: - printk("HCI_OP_Write_Class_of_Device"); - break; - case HCI_OP_LE_Rand: - printk("HCI_OP_LE_Rand"); - break; - case HCI_OP_LE_Set_Random_Address: - printk("HCI_OP_LE_Set_Random_Address"); - break; - case HCI_OP_LE_Set_Extended_Scan_Enable: - printk("HCI_OP_LE_Set_Extended_Scan_Enable"); - break; - case HCI_OP_LE_Set_Extended_Scan_Parameters: - printk("HCI_OP_LE_Set_Extended_Scan_Parameters"); - break; - case HCI_OP_Set_Event_Filter: - printk("HCI_OP_Set_Event_Filter"); - break; - case HCI_OP_Write_Voice_Setting: - printk("HCI_OP_Write_Voice_Setting"); - break; - case HCI_OP_Change_Local_Name: - printk("HCI_OP_Change_Local_Name"); - break; - case HCI_OP_Read_Local_Name: - printk("HCI_OP_Read_Local_Name"); - break; - case HCI_OP_Wirte_Page_Timeout: - printk("HCI_OP_Wirte_Page_Timeout"); - break; - case HCI_OP_LE_Clear_Resolving_List: - printk("HCI_OP_LE_Clear_Resolving_List"); - break; - case HCI_OP_LE_Set_Addres_Resolution_Enable_Command: - printk("HCI_OP_LE_Set_Addres_Resolution_Enable_Command"); - break; - case HCI_OP_Write_Inquiry_mode: - printk("HCI_OP_Write_Inquiry_mode"); - break; - case HCI_OP_Write_Page_Scan_Type: - printk("HCI_OP_Write_Page_Scan_Type"); - break; - case HCI_OP_Write_Inquiry_Scan_Type: - printk("HCI_OP_Write_Inquiry_Scan_Type"); - break; - case HCI_OP_Delete_Stored_Link_Key: - printk("HCI_OP_Delete_Stored_Link_Key"); - break; - case HCI_OP_LE_Read_Local_Resolvable_Address: - printk("HCI_OP_LE_Read_Local_Resolvable_Address"); - break; - case HCI_OP_LE_Extended_Create_Connection: - printk("HCI_OP_LE_Extended_Create_Connection"); - break; - case HCI_OP_Read_Remote_Version_Information: - printk("HCI_OP_Read_Remote_Version_Information"); - break; - case HCI_OP_LE_Start_Encryption: - printk("HCI_OP_LE_Start_Encryption"); - break; - case HCI_OP_LE_Add_Device_to_Resolving_List: - printk("HCI_OP_LE_Add_Device_to_Resolving_List"); - break; - case HCI_OP_LE_Set_Privacy_Mode: - printk("HCI_OP_LE_Set_Privacy_Mode"); - break; - case HCI_OP_LE_Connection_Update: - printk("HCI_OP_LE_Connection_Update"); - break; - default: - printk("UNKNOW_HCI_COMMAND"); - break; - } -#endif //CONFIG_BLUEDROID -} - -static void print_command(struct sk_buff *skb) -{ -#if PRINT_CMD_EVENT - print_error_command(skb); -#endif -} - - -enum CODEC_TYPE{ - CODEC_CVSD, - CODEC_MSBC, -}; - -static enum CODEC_TYPE codec_type = CODEC_CVSD; -static void set_select_msbc(enum CODEC_TYPE type); -static enum CODEC_TYPE check_select_msbc(void); -int send_hci_cmd(firmware_info *fw_info); - - -#if CONFIG_BLUEDROID - -/* Global parameters for bt usb char driver */ -#define BT_CHAR_DEVICE_NAME "aicbt_dev" -struct mutex btchr_mutex; -static struct sk_buff_head btchr_readq; -static wait_queue_head_t btchr_read_wait; -static wait_queue_head_t bt_dlfw_wait; -static int bt_char_dev_registered; -static dev_t bt_devid; /* bt char device number */ -static struct cdev bt_char_dev; /* bt character device structure */ -static struct class *bt_char_class; /* device class for usb char driver */ -static int bt_reset = 0; -static int aic_queue_cnt(void); -static void aic_enqueue(struct sk_buff *skb); - -/* HCI device & lock */ -DEFINE_RWLOCK(hci_dev_lock); -struct hci_dev *ghdev = NULL; -#ifdef CONFIG_BT_WAKEUP_IN_PM -static bool aic_store_acl_handle(uint16_t handle); -static bool aic_check_store_handle(uint16_t handle); -static void aic_clean_store_acl_handle(uint16_t handle); -static void aic_clean_all_store_acl_handle(void); -static int aic_handle_cmd(struct sk_buff *skb); -static uint8_t ble_scan_en[10]={0x00,0x42,0x20,0x06,0x01,0x00,0x00,0x00,0x00,0x00}; -static uint8_t bt_scan_en[5]={0x00,0x1a,0x0c,0x01,0x03}; -static uint8_t ble_create_con[62]={0x00,0x43,0x20,0x3a,0x01,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x07,\ - 0x60,0x00,0x30,0x00,0x09,0x00,0x09,0x00,0x00,0x00,0xf4,0x01,0x00,0x00,0x00,0x00,\ - 0x60,0x00,0x30,0x00,0x09,0x00,0x09,0x00,0x00,0x00,0xf4,0x01,0x00,0x00,0x00,0x00,\ - 0x60,0x00,0x30,0x00,0x09,0x00,0x09,0x00,0x00,0x00,0xf4,0x01,0x00,0x00,0x00,0x00}; - -#endif -static int bypass_event(struct sk_buff *skb) -{ - int ret = 0; - struct hci_dev *hdev = (struct hci_dev *) skb->dev; - u8 *opcode = (u8*)(skb->data); - //u8 len = *(opcode+1); - //printk("bypass_event %x,%x,%x,%x,%x\r\n",opcode[0],opcode[1],opcode[2],opcode[3],opcode[4]); - - switch(*opcode) { - case HCI_EV_CMD_COMPLETE: - { - u16 command; - command = ((u16)opcode[3]|(u16)(opcode[4])<<8); - if (command == 0xc03){ - if (SCO_NUM > 0){ - SCO_NUM = 0; - hdev->notify(hdev, 0); - set_select_msbc(CODEC_CVSD); - } - } - } -#ifdef CONFIG_SUPPORT_VENDOR_APCF - { - u16 sub_opcpde; - sub_opcpde = ((u16)opcode[3]|(u16)(opcode[4])<<8); - if(sub_opcpde == 0xfd57){ - if(vendor_apcf_sent_done){ - vendor_apcf_sent_done--; - printk("apcf bypass\r\n"); - ret = 1; - } - } - } -#endif//CONFIG_SUPPORT_VENDOR_APCF - break; - case HCI_EV_LE_Meta: - { - u8 subevent_code; - subevent_code = opcode[2]; - switch(subevent_code){ - case HCI_BLE_ADV_PKT_RPT_EVT: - case HCI_LE_EXTENDED_ADVERTISING_REPORT_EVT: - { - if(aic_queue_cnt() > (QUEUE_SIZE-100)){ - printk("more adv report bypass\r\n"); - ret = 1; - } - } - break; -#ifdef CONFIG_BT_WAKEUP_IN_PM - case HCI_BLE_CONN_COMPLETE_EVT: - { - uint8_t status = opcode[3]; - uint16_t handle; - uint8_t *ptr = &opcode[4]; - printk("%s: HCI_BLE_CONN_COMPLETE_EVT(0x%02x)", __func__, *opcode); - handle = ((uint16_t)(*(ptr)) | (((uint16_t)(*((ptr) + 1))) << 8)); - if(status == 0){ - aic_store_acl_handle(handle); - } - ble_create_con[0]=0; - } - break; - case HCI_BLE_ENHANCED_CONN_COMPLETE_EVT: - { - uint8_t status = opcode[3]; - uint16_t handle; - uint8_t *ptr = &opcode[4]; - printk("%s: HCI_BLE_ENHANCED_CONN_COMPLETE_EVT(0x%02x)", __func__, *opcode); - handle = ((uint16_t)(*(ptr)) | (((uint16_t)(*((ptr) + 1))) << 8)); - if(status == 0){ - aic_store_acl_handle(handle); - } - ble_create_con[0]=0; - } - break; -#endif//CONFIG_BT_WAKEUP_IN_PM - default: - break; - } - } - break; -#ifdef CONFIG_BT_WAKEUP_IN_PM - case HCI_EV_CONN_COMPLETE: - { - uint8_t status; - uint16_t handle; - printk("%s: HCI_EV_SYNC_CONN_COMPLETE(0x%02x)", __func__, *opcode); - status = *(opcode + 2); - handle = *(opcode + 3) | *(opcode + 4) << 8; - if(status == 0){ - aic_store_acl_handle(handle); - } - } - break; - case HCI_EV_DISCONN_COMPLETE: - { - uint8_t status; - uint16_t handle; - printk("%s: HCI_EV_DISCONN_COMPLETE(0x%02x)", __func__, *opcode); - status = *(opcode + 2); - handle = *(opcode + 3) | *(opcode + 4) << 8; - if(aic_check_store_handle(handle)){ - aic_clean_store_acl_handle(handle); - } - } - break; -#endif//CONFIG_BT_WAKEUP_IN_PM - default: - break; - } - return ret; -} -static void print_event(struct sk_buff *skb) -{ -#if PRINT_CMD_EVENT - //uint wlength = skb->len; - //uint icount = 0; - u8 *opcode = (u8*)(skb->data); - //u8 len = *(opcode+1); - - printk("aic %s ", __func__); - switch (*opcode) { - case HCI_EV_INQUIRY_COMPLETE: - printk("HCI_EV_INQUIRY_COMPLETE"); - break; - case HCI_EV_INQUIRY_RESULT: - printk("HCI_EV_INQUIRY_RESULT"); - break; - case HCI_EV_CONN_COMPLETE: - printk("HCI_EV_CONN_COMPLETE"); - break; - case HCI_EV_CONN_REQUEST: - printk("HCI_EV_CONN_REQUEST"); - break; - case HCI_EV_DISCONN_COMPLETE: - printk("HCI_EV_DISCONN_COMPLETE"); - break; - case HCI_EV_AUTH_COMPLETE: - printk("HCI_EV_AUTH_COMPLETE"); - break; - case HCI_EV_REMOTE_NAME: - printk("HCI_EV_REMOTE_NAME"); - break; - case HCI_EV_ENCRYPT_CHANGE: - printk("HCI_EV_ENCRYPT_CHANGE"); - break; - case HCI_EV_CHANGE_LINK_KEY_COMPLETE: - printk("HCI_EV_CHANGE_LINK_KEY_COMPLETE"); - break; - case HCI_EV_REMOTE_FEATURES: - printk("HCI_EV_REMOTE_FEATURES"); - break; - case HCI_EV_REMOTE_VERSION: - printk("HCI_EV_REMOTE_VERSION"); - break; - case HCI_EV_QOS_SETUP_COMPLETE: - printk("HCI_EV_QOS_SETUP_COMPLETE"); - break; - case HCI_EV_CMD_COMPLETE: - printk("HCI_EV_CMD_COMPLETE"); - break; - case HCI_EV_CMD_STATUS: - printk("HCI_EV_CMD_STATUS"); - break; - case HCI_EV_ROLE_CHANGE: - printk("HCI_EV_ROLE_CHANGE"); - break; - case HCI_EV_NUM_COMP_PKTS: - printk("HCI_EV_NUM_COMP_PKTS"); - break; - case HCI_EV_MODE_CHANGE: - printk("HCI_EV_MODE_CHANGE"); - break; - case HCI_EV_PIN_CODE_REQ: - printk("HCI_EV_PIN_CODE_REQ"); - break; - case HCI_EV_LINK_KEY_REQ: - printk("HCI_EV_LINK_KEY_REQ"); - break; - case HCI_EV_LINK_KEY_NOTIFY: - printk("HCI_EV_LINK_KEY_NOTIFY"); - break; - case HCI_EV_CLOCK_OFFSET: - printk("HCI_EV_CLOCK_OFFSET"); - break; - case HCI_EV_PKT_TYPE_CHANGE: - printk("HCI_EV_PKT_TYPE_CHANGE"); - break; - case HCI_EV_PSCAN_REP_MODE: - printk("HCI_EV_PSCAN_REP_MODE"); - break; - case HCI_EV_INQUIRY_RESULT_WITH_RSSI: - printk("HCI_EV_INQUIRY_RESULT_WITH_RSSI"); - break; - case HCI_EV_REMOTE_EXT_FEATURES: - printk("HCI_EV_REMOTE_EXT_FEATURES"); - break; - case HCI_EV_SYNC_CONN_COMPLETE: - printk("HCI_EV_SYNC_CONN_COMPLETE"); - break; - case HCI_EV_SYNC_CONN_CHANGED: - printk("HCI_EV_SYNC_CONN_CHANGED"); - break; - case HCI_EV_SNIFF_SUBRATE: - printk("HCI_EV_SNIFF_SUBRATE"); - break; - case HCI_EV_EXTENDED_INQUIRY_RESULT: - printk("HCI_EV_EXTENDED_INQUIRY_RESULT"); - break; - case HCI_EV_IO_CAPA_REQUEST: - printk("HCI_EV_IO_CAPA_REQUEST"); - break; - case HCI_EV_SIMPLE_PAIR_COMPLETE: - printk("HCI_EV_SIMPLE_PAIR_COMPLETE"); - break; - case HCI_EV_REMOTE_HOST_FEATURES: - printk("HCI_EV_REMOTE_HOST_FEATURES"); - break; - default: - printk("unknow event"); - break; - } - printk("\n"); -#if 0 - printk("%02x,len:%d,", *opcode,len); - for (icount = 2; (icount < wlength) && (icount < 24); icount++) - printk("%02x ", *(opcode+icount)); - printk("\n"); -#endif -#endif -} - -static inline ssize_t usb_put_user(struct sk_buff *skb, - char __user *buf, int count) -{ - char __user *ptr = buf; - int len = min_t(unsigned int, skb->len, count); - - if (copy_to_user(ptr, skb->data, len)) - return -EFAULT; - - return len; -} - -static struct sk_buff *aic_skb_queue[QUEUE_SIZE]; -static int aic_skb_queue_front = 0; -static int aic_skb_queue_rear = 0; - -static void aic_enqueue(struct sk_buff *skb) -{ - unsigned long flags = 0; - - spin_lock_irqsave(&queue_lock, flags); - if (aic_skb_queue_front == (aic_skb_queue_rear + 1) % QUEUE_SIZE) { - /* - * If queue is full, current solution is to drop - * the following entries. - */ - AICBT_WARN("%s: Queue is full, entry will be dropped", __func__); - } else { - aic_skb_queue[aic_skb_queue_rear] = skb; - - aic_skb_queue_rear++; - aic_skb_queue_rear %= QUEUE_SIZE; - - } - spin_unlock_irqrestore(&queue_lock, flags); -} - -static struct sk_buff *aic_dequeue_try(unsigned int deq_len) -{ - struct sk_buff *skb; - struct sk_buff *skb_copy; - unsigned long flags = 0; - - spin_lock_irqsave(&queue_lock, flags); - if (aic_skb_queue_front == aic_skb_queue_rear) { - AICBT_WARN("%s: Queue is empty", __func__); - spin_unlock_irqrestore(&queue_lock, flags); - return NULL; - } - - skb = aic_skb_queue[aic_skb_queue_front]; - if (deq_len >= skb->len) { - - aic_skb_queue_front++; - aic_skb_queue_front %= QUEUE_SIZE; - - /* - * Return skb addr to be dequeued, and the caller - * should free the skb eventually. - */ - spin_unlock_irqrestore(&queue_lock, flags); - return skb; - } else { - skb_copy = pskb_copy(skb, GFP_ATOMIC); - skb_pull(skb, deq_len); - /* Return its copy to be freed */ - spin_unlock_irqrestore(&queue_lock, flags); - return skb_copy; - } -} - -static inline int is_queue_empty(void) -{ - return (aic_skb_queue_front == aic_skb_queue_rear) ? 1 : 0; -} - -static void aic_clear_queue(void) -{ - struct sk_buff *skb; - unsigned long flags = 0; - AICBT_INFO("aic_clear_queue: %s\n", __func__); - spin_lock_irqsave(&queue_lock, flags); - while(!is_queue_empty()) { - skb = aic_skb_queue[aic_skb_queue_front]; - aic_skb_queue[aic_skb_queue_front] = NULL; - aic_skb_queue_front++; - aic_skb_queue_front %= QUEUE_SIZE; - if (skb) { - kfree_skb(skb); - } - } - spin_unlock_irqrestore(&queue_lock, flags); -} - -static int aic_queue_cnt(void) -{ - int ret_cnt = 0; - unsigned long flags = 0; - - spin_lock_irqsave(&queue_lock, flags); - if(is_queue_empty()) { - ret_cnt = 0; - }else{ - if(aic_skb_queue_rear > aic_skb_queue_front){ - ret_cnt = aic_skb_queue_rear-aic_skb_queue_front; - }else{ - ret_cnt = aic_skb_queue_rear+QUEUE_SIZE-aic_skb_queue_front; - } - } - spin_unlock_irqrestore(&queue_lock, flags); - return ret_cnt; -} -/* - * AicSemi - Integrate from hci_core.c - */ - -/* Get HCI device by index. - * Device is held on return. */ -static struct hci_dev *hci_dev_get(int index) -{ - if (index != 0) - return NULL; - - return ghdev; -} - -/* ---- HCI ioctl helpers ---- */ -static int hci_dev_open(__u16 dev) -{ - struct hci_dev *hdev; - int ret = 0; - - AICBT_DBG("%s: dev %d", __func__, dev); - - hdev = hci_dev_get(dev); - if (!hdev) { - AICBT_ERR("%s: Failed to get hci dev[Null]", __func__); - return -ENODEV; - } - - if (test_bit(HCI_UNREGISTER, &hdev->dev_flags)) { - ret = -ENODEV; - goto done; - } - - if (test_bit(HCI_UP, &hdev->flags)) { - ret = -EALREADY; - goto done; - } - -done: - return ret; -} - -static int hci_dev_do_close(struct hci_dev *hdev) -{ - if (hdev->flush) - hdev->flush(hdev); - /* After this point our queues are empty - * and no tasks are scheduled. */ - hdev->close(hdev); - /* Clear flags */ - hdev->flags = 0; - return 0; -} - -static int hci_dev_close(__u16 dev) -{ - struct hci_dev *hdev; - int err; - hdev = hci_dev_get(dev); - if (!hdev) { - AICBT_ERR("%s: failed to get hci dev[Null]", __func__); - return -ENODEV; - } - - err = hci_dev_do_close(hdev); - - return err; -} - - -#if CONFIG_BLUEDROID -static struct hci_dev *hci_alloc_dev(void) -{ - struct hci_dev *hdev; - - hdev = kzalloc(sizeof(struct hci_dev), GFP_KERNEL); - if (!hdev) - return NULL; - - return hdev; -} - -/* Free HCI device */ -static void hci_free_dev(struct hci_dev *hdev) -{ - kfree(hdev); -} - -/* Register HCI device */ -static int hci_register_dev(struct hci_dev *hdev) -{ - int i, id; - - AICBT_DBG("%s: %p name %s bus %d", __func__, hdev, hdev->name, hdev->bus); - /* Do not allow HCI_AMP devices to register at index 0, - * so the index can be used as the AMP controller ID. - */ - id = (hdev->dev_type == HCI_BREDR) ? 0 : 1; - - write_lock(&hci_dev_lock); - - sprintf(hdev->name, "hci%d", id); - hdev->id = id; - hdev->flags = 0; - hdev->dev_flags = 0; - mutex_init(&hdev->lock); - - AICBT_DBG("%s: id %d, name %s", __func__, hdev->id, hdev->name); - - - for (i = 0; i < NUM_REASSEMBLY; i++) - hdev->reassembly[i] = NULL; - - memset(&hdev->stat, 0, sizeof(struct hci_dev_stats)); - atomic_set(&hdev->promisc, 0); - - if (ghdev) { - write_unlock(&hci_dev_lock); - AICBT_ERR("%s: Hci device has been registered already", __func__); - return -1; - } else - ghdev = hdev; - - write_unlock(&hci_dev_lock); - - return id; -} - -/* Unregister HCI device */ -static void hci_unregister_dev(struct hci_dev *hdev) -{ - int i; - - AICBT_DBG("%s: hdev %p name %s bus %d", __func__, hdev, hdev->name, hdev->bus); - set_bit(HCI_UNREGISTER, &hdev->dev_flags); - - write_lock(&hci_dev_lock); - ghdev = NULL; - write_unlock(&hci_dev_lock); - - hci_dev_do_close(hdev); - for (i = 0; i < NUM_REASSEMBLY; i++) - kfree_skb(hdev->reassembly[i]); -} - -static void hci_send_to_stack(struct hci_dev *hdev, struct sk_buff *skb) -{ - struct sk_buff *aic_skb_copy = NULL; - - //AICBT_DBG("%s", __func__); - - if (!hdev) { - AICBT_ERR("%s: Frame for unknown HCI device", __func__); - return; - } - - if (!test_bit(HCI_RUNNING, &hdev->flags)) { - AICBT_ERR("%s: HCI not running", __func__); - return; - } - - aic_skb_copy = pskb_copy(skb, GFP_ATOMIC); - if (!aic_skb_copy) { - AICBT_ERR("%s: Copy skb error", __func__); - return; - } - - memcpy(skb_push(aic_skb_copy, 1), &bt_cb(skb)->pkt_type, 1); - aic_enqueue(aic_skb_copy); - - /* Make sure bt char device existing before wakeup read queue */ - hdev = hci_dev_get(0); - if (hdev) { - //AICBT_DBG("%s: Try to wakeup read queue", __func__); - AICBT_DBG("%s", __func__); - wake_up_interruptible(&btchr_read_wait); - } - - - return; -} - -/* Receive frame from HCI drivers */ -static int hci_recv_frame(struct sk_buff *skb) -{ - struct hci_dev *hdev = (struct hci_dev *) skb->dev; - - if (!hdev || - (!test_bit(HCI_UP, &hdev->flags) && !test_bit(HCI_INIT, &hdev->flags))) { - kfree_skb(skb); - return -ENXIO; - } - - /* Incomming skb */ - bt_cb(skb)->incoming = 1; - - /* Time stamp */ - __net_timestamp(skb); - - if (atomic_read(&hdev->promisc)) { - if(bt_cb(skb)->pkt_type == HCI_EVENT_PKT){ - if(bypass_event(skb)){ - kfree_skb(skb); - return 0; - } - } - /* Send copy to the sockets */ - hci_send_to_stack(hdev, skb); - } - - kfree_skb(skb); - return 0; -} - - - -static int hci_reassembly(struct hci_dev *hdev, int type, void *data, - int count, __u8 index) -{ - int len = 0; - int hlen = 0; - int remain = count; - struct sk_buff *skb; - struct bt_skb_cb *scb; - - //AICBT_DBG("%s", __func__); - - if ((type < HCI_ACLDATA_PKT || type > HCI_EVENT_PKT) || - index >= NUM_REASSEMBLY) - return -EILSEQ; - - skb = hdev->reassembly[index]; - - if (!skb) { - switch (type) { - case HCI_ACLDATA_PKT: - len = HCI_MAX_FRAME_SIZE; - hlen = HCI_ACL_HDR_SIZE; - break; - case HCI_EVENT_PKT: - len = HCI_MAX_EVENT_SIZE; - hlen = HCI_EVENT_HDR_SIZE; - break; - case HCI_SCODATA_PKT: - len = HCI_MAX_SCO_SIZE; - hlen = HCI_SCO_HDR_SIZE; - break; - } - - skb = bt_skb_alloc(len, GFP_ATOMIC); - if (!skb) - return -ENOMEM; - - scb = (void *) skb->cb; - scb->expect = hlen; - scb->pkt_type = type; - - skb->dev = (void *) hdev; - hdev->reassembly[index] = skb; - } - - while (count) { - scb = (void *) skb->cb; - len = min_t(uint, scb->expect, count); - - memcpy(skb_put(skb, len), data, len); - - count -= len; - data += len; - scb->expect -= len; - remain = count; - - switch (type) { - case HCI_EVENT_PKT: - if (skb->len == HCI_EVENT_HDR_SIZE) { - struct hci_event_hdr *h = hci_event_hdr(skb); - scb->expect = h->plen; - - if (skb_tailroom(skb) < scb->expect) { - kfree_skb(skb); - hdev->reassembly[index] = NULL; - return -ENOMEM; - } - } - break; - - case HCI_ACLDATA_PKT: - if (skb->len == HCI_ACL_HDR_SIZE) { - struct hci_acl_hdr *h = hci_acl_hdr(skb); - scb->expect = __le16_to_cpu(h->dlen); - - if (skb_tailroom(skb) < scb->expect) { - kfree_skb(skb); - hdev->reassembly[index] = NULL; - return -ENOMEM; - } - } - break; - - case HCI_SCODATA_PKT: - if (skb->len == HCI_SCO_HDR_SIZE) { - struct hci_sco_hdr *h = hci_sco_hdr(skb); - scb->expect = h->dlen; - - if (skb_tailroom(skb) < scb->expect) { - kfree_skb(skb); - hdev->reassembly[index] = NULL; - return -ENOMEM; - } - } - break; - } - - if (scb->expect == 0) { - /* Complete frame */ - if(HCI_ACLDATA_PKT == type) - print_acl(skb,0); - if(HCI_SCODATA_PKT == type) - print_sco(skb,0); - if(HCI_EVENT_PKT == type) - print_event(skb); - - bt_cb(skb)->pkt_type = type; - hci_recv_frame(skb); - - hdev->reassembly[index] = NULL; - return remain; - } - } - - return remain; -} - -static int hci_recv_fragment(struct hci_dev *hdev, int type, void *data, int count) -{ - int rem = 0; - - if (type < HCI_ACLDATA_PKT || type > HCI_EVENT_PKT) - return -EILSEQ; - - while (count) { - rem = hci_reassembly(hdev, type, data, count, type - 1); - if (rem < 0) - return rem; - - data += (count - rem); - count = rem; - } - - return rem; -} -#endif //CONFIG_BLUEDROID - -static void hci_hardware_error(void) -{ - struct sk_buff *aic_skb_copy = NULL; - int len = 4; - uint8_t hardware_err_pkt[4] = {HCI_EVENT_PKT, 0x10, 0x01, HCI_VENDOR_USB_DISC_HARDWARE_ERROR}; - - aic_skb_copy = alloc_skb(len, GFP_ATOMIC); - if (!aic_skb_copy) { - AICBT_ERR("%s: Failed to allocate mem", __func__); - return; - } - - memcpy(skb_put(aic_skb_copy, len), hardware_err_pkt, len); - aic_enqueue(aic_skb_copy); - - wake_up_interruptible(&btchr_read_wait); -} - -#if 0 -static void hci_resume_hardware_error(void) -{ - struct sk_buff *aic_skb_copy = NULL; - int len = 4; - uint8_t hardware_err_pkt[4] = {HCI_EVENT_PKT, 0x10, 0x01, HCI_VENDOR_USB_RESUME_HARDWARE_ERROR}; - - aic_skb_copy = alloc_skb(len, GFP_ATOMIC); - if (!aic_skb_copy) { - AICBT_ERR("%s: Failed to allocate mem", __func__); - return; - } - - memcpy(skb_put(aic_skb_copy, len), hardware_err_pkt, len); - aic_enqueue(aic_skb_copy); - - wake_up_interruptible(&btchr_read_wait); -} -#endif -static int btchr_open(struct inode *inode_p, struct file *file_p) -{ - struct btusb_data *data; - struct hci_dev *hdev; - - AICBT_DBG("%s: BT usb char device is opening", __func__); - /* Not open unless wanna tracing log */ - /* trace_printk("%s: open....\n", __func__); */ - - hdev = hci_dev_get(0); - if (!hdev) { - AICBT_DBG("%s: Failed to get hci dev[NULL]", __func__); - return -ENODEV; - } - data = GET_DRV_DATA(hdev); - - atomic_inc(&hdev->promisc); - /* - * As bt device is not re-opened when hotplugged out, we cannot - * trust on file's private data(may be null) when other file ops - * are invoked. - */ - file_p->private_data = data; - - mutex_lock(&btchr_mutex); - hci_dev_open(0); - mutex_unlock(&btchr_mutex); -#ifdef CONFIG_BT_WAKEUP_IN_PM - aic_clean_all_store_acl_handle(); -#endif//CONFIG_BT_WAKEUP_IN_PM - aic_clear_queue(); - return nonseekable_open(inode_p, file_p); -} - -static int btchr_close(struct inode *inode_p, struct file *file_p) -{ - struct btusb_data *data; - struct hci_dev *hdev; - - AICBT_INFO("%s: BT usb char device is closing", __func__); - /* Not open unless wanna tracing log */ - /* trace_printk("%s: close....\n", __func__); */ - - data = file_p->private_data; - file_p->private_data = NULL; - -#if CONFIG_BLUEDROID - /* - * If the upper layer closes bt char interfaces, no reset - * action required even bt device hotplugged out. - */ - bt_reset = 0; -#endif - - hdev = hci_dev_get(0); - if (hdev) { - atomic_set(&hdev->promisc, 0); - mutex_lock(&btchr_mutex); - hci_dev_close(0); - mutex_unlock(&btchr_mutex); - } - - return 0; -} - -static ssize_t btchr_read(struct file *file_p, - char __user *buf_p, - size_t count, - loff_t *pos_p) -{ - struct hci_dev *hdev; - struct sk_buff *skb; - ssize_t ret = 0; - - while (count) { - hdev = hci_dev_get(0); - if (!hdev) { - /* - * Note: Only when BT device hotplugged out, we wil get - * into such situation. In order to keep the upper layer - * stack alive (blocking the read), we should never return - * EFAULT or break the loop. - */ - AICBT_ERR("%s: Failed to get hci dev[Null]", __func__); - } - - ret = wait_event_interruptible(btchr_read_wait, !is_queue_empty()); - if (ret < 0) { - AICBT_ERR("%s: wait event is signaled %d", __func__, (int)ret); - break; - } - - skb = aic_dequeue_try(count); - if (skb) { - ret = usb_put_user(skb, buf_p, count); - if (ret < 0) - AICBT_ERR("%s: Failed to put data to user space", __func__); - kfree_skb(skb); - break; - } - } - - return ret; -} - -#ifdef CONFIG_SUPPORT_VENDOR_APCF -void btchr_external_write(char* buff, int len){ - struct hci_dev *hdev; - struct sk_buff *skb; - int i; - struct btusb_data *data; - - AICBT_INFO("%s \r\n", __func__); - for(i=0;idev = (void *)hdev; - memcpy((__u8 *)skb->data,(__u8 *)buff,len); - skb_put(skb, len); - bt_cb(skb)->pkt_type = *((__u8 *)skb->data); - skb_pull(skb, 1); - data->hdev->send(skb); -} - -EXPORT_SYMBOL(btchr_external_write); -#endif //CONFIG_SUPPORT_VENDOR_APCF - -static ssize_t btchr_write(struct file *file_p, - const char __user *buf_p, - size_t count, - loff_t *pos_p) -{ - struct btusb_data *data = file_p->private_data; - struct hci_dev *hdev; - struct sk_buff *skb; - - //AICBT_DBG("%s: BT usb char device is writing", __func__); - AICBT_DBG("%s", __func__); - - hdev = hci_dev_get(0); - if (!hdev) { - AICBT_WARN("%s: Failed to get hci dev[Null]", __func__); - /* - * Note: we bypass the data from the upper layer if bt device - * is hotplugged out. Fortunatelly, H4 or H5 HCI stack does - * NOT check btchr_write's return value. However, returning - * count instead of EFAULT is preferable. - */ - /* return -EFAULT; */ - return count; - } - - /* Never trust on btusb_data, as bt device may be hotplugged out */ - data = GET_DRV_DATA(hdev); - if (!data) { - AICBT_WARN("%s: Failed to get bt usb driver data[Null]", __func__); - return count; - } - - if (count > HCI_MAX_FRAME_SIZE) - return -EINVAL; - - skb = bt_skb_alloc(count, GFP_ATOMIC); - if (!skb) - return -ENOMEM; - skb_reserve(skb, -1); // Add this line - - if (copy_from_user(skb_put(skb, count), buf_p, count)) { - AICBT_ERR("%s: Failed to get data from user space", __func__); - kfree_skb(skb); - return -EFAULT; - } - - skb->dev = (void *)hdev; - bt_cb(skb)->pkt_type = *((__u8 *)skb->data); - skb_pull(skb, 1); -#ifdef CONFIG_BT_WAKEUP_IN_PM - aic_handle_cmd(skb); -#endif//CONFIG_BT_WAKEUP_IN_PM - data->hdev->send(skb); - - return count; -} - -static unsigned int btchr_poll(struct file *file_p, poll_table *wait) -{ - struct btusb_data *data = file_p->private_data; - struct hci_dev *hdev; - - //AICBT_DBG("%s: BT usb char device is polling", __func__); - - if(!bt_char_dev_registered) { - AICBT_ERR("%s: char device has not registered!", __func__); - return POLLERR | POLLHUP; - } - - poll_wait(file_p, &btchr_read_wait, wait); - - hdev = hci_dev_get(0); - if (!hdev) { - AICBT_ERR("%s: Failed to get hci dev[Null]", __func__); - mdelay(URB_CANCELING_DELAY_MS); - return POLLERR | POLLHUP; - return POLLOUT | POLLWRNORM; - } - - /* Never trust on btusb_data, as bt device may be hotplugged out */ - data = GET_DRV_DATA(hdev); - if (!data) { - /* - * When bt device is hotplugged out, btusb_data will - * be freed in disconnect. - */ - AICBT_ERR("%s: Failed to get bt usb driver data[Null]", __func__); - mdelay(URB_CANCELING_DELAY_MS); - return POLLOUT | POLLWRNORM; - } - - if (!is_queue_empty()) - return POLLIN | POLLRDNORM; - - return POLLOUT | POLLWRNORM; -} -static long btchr_ioctl(struct file *file_p,unsigned int cmd, unsigned long arg) -{ - int ret = 0; - struct hci_dev *hdev; - struct btusb_data *data; - firmware_info *fw_info; - - if(!bt_char_dev_registered) { - return -ENODEV; - } - - if(check_set_dlfw_state_value(1) != 1) { - AICBT_ERR("%s bt controller is disconnecting!", __func__); - return 0; - } - - hdev = hci_dev_get(0); - if(!hdev) { - AICBT_ERR("%s device is NULL!", __func__); - set_dlfw_state_value(0); - return 0; - } - data = GET_DRV_DATA(hdev); - fw_info = data->fw_info; - - AICBT_INFO(" btchr_ioctl DOWN_FW_CFG with Cmd:%d",cmd); - switch (cmd) { - case DOWN_FW_CFG: - AICBT_INFO(" btchr_ioctl DOWN_FW_CFG"); - ret = usb_autopm_get_interface(data->intf); - if (ret < 0){ - goto failed; - } - - //ret = download_patch(fw_info,1); - usb_autopm_put_interface(data->intf); - if(ret < 0){ - AICBT_ERR("%s:Failed in download_patch with ret:%d",__func__,ret); - goto failed; - } - - ret = hdev->open(hdev); - if(ret < 0){ - AICBT_ERR("%s:Failed in hdev->open(hdev):%d",__func__,ret); - goto failed; - } - set_bit(HCI_UP, &hdev->flags); - set_dlfw_state_value(0); - wake_up_interruptible(&bt_dlfw_wait); - return 1; - case DWFW_CMPLT: - AICBT_INFO(" btchr_ioctl DWFW_CMPLT"); - break; - case SET_ISO_CFG: - AICBT_INFO("btchr_ioctl SET_ISO_CFG"); - if(copy_from_user(&(hdev->voice_setting), (__u16*)arg, sizeof(__u16))){ - AICBT_INFO(" voice settings err"); - } - //hdev->voice_setting = *(uint16_t*)arg; - AICBT_INFO(" voice settings = %d", hdev->voice_setting); - //return 1; - break; - case GET_USB_INFO: - //ret = download_patch(fw_info,1); - AICBT_INFO(" btchr_ioctl GET_USB_INFO"); - ret = hdev->open(hdev); - if(ret < 0){ - AICBT_ERR("%s:Failed in hdev->open(hdev):%d",__func__,ret); - //goto done; - } - set_bit(HCI_UP, &hdev->flags); - set_dlfw_state_value(0); - wake_up_interruptible(&bt_dlfw_wait); - return 1; - case RESET_CONTROLLER: - AICBT_INFO(" btchr_ioctl RESET_CONTROLLER"); - //reset_controller(fw_info); - return 1; - default: - AICBT_ERR("%s:Failed with wrong Cmd:%d",__func__,cmd); - goto failed; - } - failed: - set_dlfw_state_value(0); - wake_up_interruptible(&bt_dlfw_wait); - return ret; - -} - -#ifdef CONFIG_PLATFORM_UBUNTU//AIDEN -#if LINUX_VERSION_CODE < KERNEL_VERSION(5, 6, 0) -typedef u32 compat_uptr_t; -static inline void __user *compat_ptr(compat_uptr_t uptr) -{ - return (void __user *)(unsigned long)uptr; -} -#endif -#endif - -#ifdef CONFIG_COMPAT -static long compat_btchr_ioctl (struct file *filp, unsigned int cmd, unsigned long arg) -{ - AICBT_DBG("%s: enter",__func__); - return btchr_ioctl(filp, cmd, (unsigned long) compat_ptr(arg)); -} -#endif -static struct file_operations bt_chrdev_ops = { - open : btchr_open, - release : btchr_close, - read : btchr_read, - write : btchr_write, - poll : btchr_poll, - unlocked_ioctl : btchr_ioctl, -#ifdef CONFIG_COMPAT - compat_ioctl : compat_btchr_ioctl, -#endif -}; - -static int btchr_init(void) -{ - int res = 0; - struct device *dev; -#ifdef CONFIG_PLATFORM_MTK_LINUX - bt_devid = MKDEV(111, 0); -#endif - AICBT_INFO("Register usb char device interface for BT driver"); - /* - * btchr mutex is used to sync between - * 1) downloading patch and opening bt char driver - * 2) the file operations of bt char driver - */ - mutex_init(&btchr_mutex); - - skb_queue_head_init(&btchr_readq); - init_waitqueue_head(&btchr_read_wait); - init_waitqueue_head(&bt_dlfw_wait); - -#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 4, 0) - bt_char_class = class_create(BT_CHAR_DEVICE_NAME); -#else - bt_char_class = class_create(THIS_MODULE, BT_CHAR_DEVICE_NAME); -#endif - if (IS_ERR(bt_char_class)) { - AICBT_ERR("Failed to create bt char class"); - return PTR_ERR(bt_char_class); - } -#ifndef CONFIG_PLATFORM_MTK_LINUX - res = alloc_chrdev_region(&bt_devid, 0, 1, BT_CHAR_DEVICE_NAME); -#else - res = register_chrdev_region(bt_devid, 1, BT_CHAR_DEVICE_NAME); -#endif - if (res < 0) { - AICBT_ERR("Failed to allocate bt char device"); - goto err_alloc; - } - - dev = device_create(bt_char_class, NULL, bt_devid, NULL, BT_CHAR_DEVICE_NAME); - if (IS_ERR(dev)) { - AICBT_ERR("Failed to create bt char device"); - res = PTR_ERR(dev); - goto err_create; - } - - cdev_init(&bt_char_dev, &bt_chrdev_ops); - res = cdev_add(&bt_char_dev, bt_devid, 1); - if (res < 0) { - AICBT_ERR("Failed to add bt char device"); - goto err_add; - } - - return 0; - -err_add: - device_destroy(bt_char_class, bt_devid); -err_create: - unregister_chrdev_region(bt_devid, 1); -err_alloc: - class_destroy(bt_char_class); - return res; -} - -static void btchr_exit(void) -{ - AICBT_INFO("Unregister usb char device interface for BT driver"); - - device_destroy(bt_char_class, bt_devid); - cdev_del(&bt_char_dev); - unregister_chrdev_region(bt_devid, 1); - class_destroy(bt_char_class); - - return; -} -#endif - -int send_hci_cmd(firmware_info *fw_info) -{ - - int ret_val = -1; - int i = 0; - - while((ret_val<0)&&(i++<3)) - { - ret_val = usb_control_msg( - fw_info->udev, fw_info->pipe_out, - 0, USB_TYPE_CLASS, 0, 0, - (void *)(fw_info->send_pkt), - fw_info->pkt_len, MSG_TO); - - if (ret_val>0) { - AICBT_DBG("Right in send hci cmd = %d,""size = %d", ret_val, fw_info->pkt_len); - }else{ - AICBT_ERR("Error in send hci cmd = %d,""size = %d", ret_val, fw_info->pkt_len); - } - } - return ret_val; - -} - -static int rcv_hci_evt(firmware_info *fw_info) -{ - int ret_len = 0, ret_val = 0; - int i; - - while (1) { - for(i = 0; i < 5; i++) { - ret_val = usb_interrupt_msg( - fw_info->udev, fw_info->pipe_in, - (void *)(fw_info->rcv_pkt), RCV_PKT_LEN, - &ret_len, MSG_TO); - if (ret_val >= 0) - break; - } - - if (ret_val < 0) - return ret_val; - - if (CMD_CMP_EVT == fw_info->evt_hdr->evt) { - if (fw_info->cmd_hdr->opcode == fw_info->cmd_cmp->opcode) - return ret_len; - } - } -} - -#ifdef CONFIG_BT_WAKEUP_IN_PM -static int rcv_hci_evt_in_pm(firmware_info *fw_info, bool is_cmp) -{ - int ret_len = 0, ret_val = 0; - int i; - - while (1) { - for(i = 0; i < 2; i++) { - ret_val = usb_interrupt_msg( - fw_info->udev, fw_info->pipe_in, - (void *)(fw_info->rcv_pkt), RCV_PKT_LEN, - &ret_len, 10); - if (ret_val >= 0) - break; - } - - if (ret_val < 0) - return ret_val; - - if (is_cmp){ - if (CMD_CMP_EVT == fw_info->evt_hdr->evt) { - if (fw_info->cmd_hdr->opcode == fw_info->cmd_cmp->opcode) - return ret_len; - } - }else{ - return ret_len; - } - } -} - -static void rcv_ble_wakeup_event(firmware_info *fw_info) -{ - int ret_val = 0; - u8 reportdata[128]; - int i; - - ret_val = rcv_hci_evt_in_pm(fw_info,0); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive ble wakeup event, errno %d", - __func__, ret_val); - return; - }else{ - for(i = 0;ircv_pkt[i]; - printk("%x ",fw_info->rcv_pkt[i]); - } - } -} -static int set_bt_ad_filetr_en_param(firmware_info *fw_info) -{ - int ret_val; - - AICBT_INFO("%s", __func__); - - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_SET_ADFILTER_EN_CMD); - fw_info->cmd_hdr->plen = 0; - fw_info->pkt_len = CMD_HDR_LEN ; - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to send bt wakeup param, errno %d", - __func__, ret_val); - return ret_val; - } - - ret_val = rcv_hci_evt_in_pm(fw_info,0); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive bt event, errno %d", - __func__, ret_val); - return ret_val; - } - - return ret_val; -} - -static int set_bt_wakeup_param(firmware_info *fw_info) -{ - int ret_val; - struct ble_wakeup_param_t* wakeup_param = NULL; - AICBT_INFO("%s", __func__); - -/* - data and ad_data_filter_mask instructions for use - ex. - data[18] = {0x46,0x00,0x00,0xff,0xff,0xff,0xff,0xff,0xff,0x30,0xff,0xff,0xff,0x43,0x52,0x45,0x4c,0x42}; - mask = 1100 0000 0111 1111 1100 0000 0000 0000 = 0xc07fc000 - - data = 0x46,0x00,0x00,0xff,0xff,0xff,0xff,0xff,0xff,0x30,0xff,0xff,0xff,0x43,0x52,0x45,0x4c,0x42 - mask = 1 1 0 0 0 0 0 0 0 1 1 1 1 1 1 1 1 1 0 0...... fill 0 - - data & mask = "0x46 0x00" 0x00 0x00 0x00 0x00 0x00 0x00 0x00 "0x30 0xff 0xff 0x43 0x52 0x45 0x4c 0x42" - using data & mask value condition to wakeup host_wake_bt gpio -*/ - wakeup_param = (struct ble_wakeup_param_t*)kmalloc(sizeof(struct ble_wakeup_param_t), GFP_KERNEL); - - printk("%s ble scan wakeup \r\n", __func__); - - memset(wakeup_param, 0, sizeof(struct ble_wakeup_param_t)); - wakeup_param->magic_num = 0x53454C42;//magic_num - wakeup_param->delay_scan_to = 1000;//delay start scan time(ms) - wakeup_param->reboot_to = 0x800003e8;//reboot time(ms): bit31: 1, ic will reboot when timer is handle; 0 , do not reboot - // bit0~30 : time(ms) - /******************************************************************/ - ///gpio_trigger_idx : 0 if wakeup_param->gpio_dft_lvl[0]=0xfe,this idx will be invalid. - wakeup_param->gpio_num[0] = 2;////default select gpiob2 for fw_wakeup_host - wakeup_param->gpio_dft_lvl[0] = 0;////0:defalut pull down, 1:default pull up - ///gpio_trigger_idx : 1 if wakeup_param->gpio_dft_lvl[1]=0xfe,this idx will be invalid. - wakeup_param->gpio_num[1] = 3;////default select gpiob2 for fw_wakeup_host - wakeup_param->gpio_dft_lvl[1] = 1;////0:defalut pull down, 1:default pull up - /********************************************************************/ - /********************************************************************/ - //MAX_AD_FILTER_NUM=5 :num 0 - { - const uint8_t data[11] = {0x59,0x4B,0x32,0x42,0x41,0x5F,0x54,0x45,0x53,0x54,0x33}; - wakeup_param->ad_filter[0].ad_len = 12; - wakeup_param->ad_filter[0].ad_type = 0x09; - memcpy(wakeup_param->ad_filter[0].ad_data, data,wakeup_param->ad_filter[0].ad_len-1);// 1111 1111 1110 0000 0000 0000 0000 0000 //0xffe00000 - wakeup_param->ad_filter[0].ad_data_mask = 0xffe00000; - wakeup_param->ad_filter[0].ad_role = ROLE_COMBO|(COMBO_0<<4); - wakeup_param->ad_filter[0].gpio_trigger_idx = TG_IDX_0;//0: match for wakeup_param->gpio_num[0] 1: match for wakeup_param->gpio_num[1] - /********************************************************************/ - /*enable white list addr for paired remote ble addr. if all 0: all addr will use ad filter - wl_addr have value xx: only remote addr in white_list_addr will use ad filter - ********************************************************************/ - wakeup_param->ad_filter[0].wl_addr.addr[0] = 0; - wakeup_param->ad_filter[0].wl_addr.addr[1] = 0; - wakeup_param->ad_filter[0].wl_addr.addr[2] = 0; - wakeup_param->ad_filter[0].wl_addr.addr[3] = 0; - wakeup_param->ad_filter[0].wl_addr.addr[4] = 0; - wakeup_param->ad_filter[0].wl_addr.addr[5] = 0; - } - /********************************************************************/ - //MAX_AD_FILTER_NUM=5 :num 1 - { - const uint8_t data[2] = {0x12,0x18}; - wakeup_param->ad_filter[1].ad_len = 3; - wakeup_param->ad_filter[1].ad_type = 0x3; - memcpy(wakeup_param->ad_filter[1].ad_data, data,wakeup_param->ad_filter[1].ad_len-1);// 1100 0000 0000 0000 0000 0000 0000 0000 //0xc0000000 - wakeup_param->ad_filter[1].ad_data_mask = 0xc0000000; - wakeup_param->ad_filter[1].ad_role = ROLE_COMBO|(COMBO_0<<4); - wakeup_param->ad_filter[1].gpio_trigger_idx = TG_IDX_0;//0: match for wakeup_param->gpio_num[0] 1: match for wakeup_param->gpio_num[1] - /********************************************************************/ - /*enable white list addr for paired remote ble addr. if all 0: all addr will use ad filter - wl_addr have value xx: only remote addr in white_list_addr will use ad filter - ********************************************************************/ - wakeup_param->ad_filter[1].wl_addr.addr[0] = 0; - wakeup_param->ad_filter[1].wl_addr.addr[1] = 0; - wakeup_param->ad_filter[1].wl_addr.addr[2] = 0; - wakeup_param->ad_filter[1].wl_addr.addr[3] = 0; - wakeup_param->ad_filter[1].wl_addr.addr[4] = 0; - wakeup_param->ad_filter[1].wl_addr.addr[5] = 0; - } - /********************************************************************/ - //MAX_AD_FILTER_NUM=5 :num 2 - { - //const uint8_t data[11] = {0x59,0x4B,0x32,0x42,0x41,0x5F,0x54,0x45,0x53,0x54,0x33}; - wakeup_param->ad_filter[2].ad_len = 0; - wakeup_param->ad_filter[2].ad_type = 0; - //memcpy(wakeup_param->ad_filter[2].ad_data, data,wakeup_param->ad_filter[2].ad_len-1);// 1100 0000 0111 1111 1100 0000 0000 0000 //0xc07fc000 - wakeup_param->ad_filter[2].ad_data_mask = 0; - wakeup_param->ad_filter[2].ad_role = ROLE_ONLY; - wakeup_param->ad_filter[2].gpio_trigger_idx = TG_IDX_0;//0: match for wakeup_param->gpio_num[0] 1: match for wakeup_param->gpio_num[1] - /********************************************************************/ - /*enable white list addr for paired remote ble addr. if all 0: all addr will use ad filter - wl_addr have value xx: only remote addr in white_list_addr will use ad filter - ********************************************************************/ - wakeup_param->ad_filter[2].wl_addr.addr[0] = 0; - wakeup_param->ad_filter[2].wl_addr.addr[1] = 0; - wakeup_param->ad_filter[2].wl_addr.addr[2] = 0; - wakeup_param->ad_filter[2].wl_addr.addr[3] = 0; - wakeup_param->ad_filter[2].wl_addr.addr[4] = 0; - wakeup_param->ad_filter[2].wl_addr.addr[5] = 0; - } - /********************************************************************/ - //MAX_AD_FILTER_NUM=5 :num 3 - { - //const uint8_t data[11] = {0x59,0x4B,0x32,0x42,0x41,0x5F,0x54,0x45,0x53,0x54,0x33}; - wakeup_param->ad_filter[3].ad_len = 0; - wakeup_param->ad_filter[3].ad_type = 0; - //memcpy(wakeup_param->ad_filter[2].ad_data, data,wakeup_param->ad_filter[2].ad_len-1);// 1100 0000 0111 1111 1100 0000 0000 0000 //0xc07fc000 - wakeup_param->ad_filter[3].ad_data_mask = 0; - wakeup_param->ad_filter[3].ad_role = ROLE_COMBO|(COMBO_1<<4); - wakeup_param->ad_filter[3].gpio_trigger_idx = TG_IDX_0;//0: match for wakeup_param->gpio_num[0] 1: match for wakeup_param->gpio_num[1] - /********************************************************************/ - /*enable white list addr for paired remote ble addr. if all 0: all addr will use ad filter - wl_addr have value xx: only remote addr in white_list_addr will use ad filter - ********************************************************************/ - wakeup_param->ad_filter[3].wl_addr.addr[0] = 0; - wakeup_param->ad_filter[3].wl_addr.addr[1] = 0; - wakeup_param->ad_filter[3].wl_addr.addr[2] = 0; - wakeup_param->ad_filter[3].wl_addr.addr[3] = 0; - wakeup_param->ad_filter[3].wl_addr.addr[4] = 0; - wakeup_param->ad_filter[3].wl_addr.addr[5] = 0; - } - #if 0 - /********************************************************************/ - //MAX_AD_FILTER_NUM=5 :num 4 - { - const uint8_t data[11] = {0x59,0x4B,0x32,0x42,0x41,0x5F,0x54,0x45,0x53,0x54,0x33}; - wakeup_param->ad_filter[4].ad_len = 0; - wakeup_param->ad_filter[4].ad_type = 0x09; - //memcpy(wakeup_param->ad_filter[4].ad_data, data,wakeup_param->ad_filter[4].ad_len-1);// 1111 1111 1110 0000 0000 0000 0000 0000 //0xffe00000 - wakeup_param->ad_filter[4].ad_data_mask = 0xffe00000; - wakeup_param->ad_filter[4].ad_role = ROLE_COMBO|(COMBO_1<<4); - wakeup_param->ad_filter[4].gpio_trigger_idx = TG_IDX_0|TG_IDX_1;//0: match for wakeup_param->gpio_num[0] 1: match for wakeup_param->gpio_num[1] - /********************************************************************/ - /*enable white list addr for paired remote ble addr. if all 0: all addr will use ad filter - wl_addr have value xx: only remote addr in white_list_addr will use ad filter - ********************************************************************/ - wakeup_param->ad_filter[4].wl_addr.addr[0] = 0; - wakeup_param->ad_filter[4].wl_addr.addr[1] = 0; - wakeup_param->ad_filter[4].wl_addr.addr[2] = 0; - wakeup_param->ad_filter[4].wl_addr.addr[3] = 0; - wakeup_param->ad_filter[4].wl_addr.addr[4] = 0; - wakeup_param->ad_filter[4].wl_addr.addr[5] = 0; - } - #endif - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_SET_ADFILTER_PT_CMD); - fw_info->cmd_hdr->plen = sizeof(struct ble_wakeup_param_t); - fw_info->pkt_len = CMD_HDR_LEN + sizeof(struct ble_wakeup_param_t); - memcpy(fw_info->req_para,wakeup_param,sizeof(struct ble_wakeup_param_t)); - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to send bt wakeup param, errno %d", - __func__, ret_val); - return ret_val; - } - - ret_val = rcv_hci_evt_in_pm(fw_info,0); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive bt event, errno %d", - __func__, ret_val); - return ret_val; - } - - return ret_val; -} - -static int reset_bt_from_wakeup_process(firmware_info *fw_info) -{ - int ret_val; - - AICBT_INFO("%s", __func__); - rcv_ble_wakeup_event(fw_info); - - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_RESET_ADFILTER_PROCESS_PT_CMD); - fw_info->cmd_hdr->plen = 0; - fw_info->pkt_len = CMD_HDR_LEN; - - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to send bt reset wakeup process, errno %d", - __func__, ret_val); - return ret_val; - } - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_OP_RESET); - - ret_val = rcv_hci_evt_in_pm(fw_info,1); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive bt event, errno %d", - __func__, ret_val); - return ret_val; - } - - return ret_val; -} - -uint16_t aic_acl_handle_list[10]; -static void hci_disconnect_complete_event(uint16_t handle,uint8_t reason) -{ - struct sk_buff *aic_skb_copy = NULL; - - int len = 7; - unsigned char p_buf[7] = {HCI_EVENT_PKT, 0x05, 0x04, 0x00, 0x00, 0x00, 0x00}; - p_buf[4] = (unsigned char)(handle & 0x00ff); - p_buf[5] = (unsigned char)((handle & 0xff00)>>8); - p_buf[6] = reason; - printk("%s\n",__func__); - - aic_skb_copy = alloc_skb(len, GFP_ATOMIC); - if (!aic_skb_copy) { - AICBT_ERR("%s: Failed to allocate mem", __func__); - return; - } - - memcpy(skb_put(aic_skb_copy, len), p_buf, len); - aic_enqueue(aic_skb_copy); - - wake_up_interruptible(&btchr_read_wait); -} - -static int hci_disconnect_complete_cmd(firmware_info *fw_info,uint16_t handle,uint8_t reason) -{ - int ret_val = 0; - int len = 3; - unsigned char p_buf[3] = {0x00, 0x00, 0x00}; - - - p_buf[0] = (unsigned char)(handle & 0x00ff); - p_buf[1] = (unsigned char)((handle & 0xff00)>>8); - p_buf[2] = reason; - printk("%s\n",__func__); - - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_OP_DISCONNECT); - fw_info->cmd_hdr->plen = len; - fw_info->pkt_len = CMD_HDR_LEN + len; - memcpy(fw_info->req_para,p_buf,len); - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to send , errno %d", - __func__, ret_val); - return ret_val; - } - - ret_val = rcv_hci_evt_in_pm(fw_info,1); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive bt event, errno %d", - __func__, ret_val); - return ret_val; - } - return ret_val; -} - -static bool aic_check_store_handle(uint16_t handle) -{ - bool ret = false; - int i = 0; - for(i = 0 ;i < 10; i++){ - if(aic_acl_handle_list[i] == handle && aic_acl_handle_list[i] != 0){ - ret = true; - break; - } - } - printk("%s,handle = 0x%x,ret = %d\n", __func__,handle,ret); - return ret; -} - -static bool aic_store_acl_handle(uint16_t handle) -{ - bool ret = false; - int i = 0; - for(i = 0 ;i < 10; i++){ - if(aic_acl_handle_list[i] != handle && aic_acl_handle_list[i] == 0){ - aic_acl_handle_list[i] = handle; - ret = true; - break; - } - } - printk("%s,handle = 0x%x,ret = %d\n", __func__,handle,ret); - return ret; -} - -static void aic_clean_store_acl_handle(uint16_t handle) -{ - int i = 0; - printk("%s,handle = 0x%x\n", __func__,handle); - for(i = 0 ;i < 10; i++){ - if(aic_acl_handle_list[i] == handle && aic_acl_handle_list[i] != 0){ - aic_acl_handle_list[i] = 0; - break; - } - } -} - -static void aic_clean_all_store_acl_handle(void) -{ - int i = 0; - for(i = 0 ;i < 10; i++){ - aic_acl_handle_list[i] = 0; - } - printk("%s\n", __func__); -} - -static int aic_event_disconnect_all_store_acl_handle(void) -{ - int i = 0; - int ret = 0; - printk("%s\n", __func__); - for(i = 0 ;i < 10; i++){ - if(aic_acl_handle_list[i] != 0){ - printk("%s,handle = 0x%x\n", __func__,aic_acl_handle_list[i]); - if(aic_acl_handle_list[i]>=0x10){ - hci_disconnect_complete_event(aic_acl_handle_list[i],0x13); - } - aic_clean_store_acl_handle(aic_acl_handle_list[i]); - ret = 1; - } - } - printk("%s ret = %d\n", __func__,ret); - return ret; -} - -static int aic_cmd_disconnect_all_store_acl_handle(firmware_info *fw_info) -{ - int i = 0; - int ret = 0; - printk("%s\n", __func__); - for(i = 0 ;i < 10; i++){ - if(aic_acl_handle_list[i] != 0){ - printk("%s,handle = 0x%x\n", __func__,aic_acl_handle_list[i]); - if(aic_acl_handle_list[i]>=0x10){ - hci_disconnect_complete_cmd(fw_info,aic_acl_handle_list[i],0x13); - } - ret = 1; - } - } - printk("%s ret = %d\n", __func__,ret); - return ret; -} - - -static int aic_cmd_cancel_le_conn(firmware_info *fw_info) -{ - int ret_val = 0; - int len = 0; - printk("%s,ble_create_con %d\n",__func__,ble_create_con[0]); - - if(ble_create_con[0] == 1 ){ - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_OP_LE_Create_Connection_Cancel); - fw_info->cmd_hdr->plen = len; - fw_info->pkt_len = CMD_HDR_LEN + len; - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to send , errno %d", - __func__, ret_val); - } - - ret_val = rcv_hci_evt_in_pm(fw_info,0); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive bt event, errno %d", - __func__, ret_val); - } - } - - return ret_val; -} - -static int aic_cmd_reconn_le_conn(firmware_info *fw_info) -{ - int ret_val = 0; - int len = 0; - u16 opcode = 0; - printk("%s,ble_create_con %d\n",__func__,ble_create_con[0]); - - if(ble_create_con[0] == 1 ){ - opcode = (u16)ble_create_con[1]|((u16)ble_create_con[2]<<8); - len = ble_create_con[3]; - AICBT_INFO("%s: opcode 0x%x,len %d",__func__, opcode,len); - fw_info->cmd_hdr->opcode = cpu_to_le16(opcode); - fw_info->cmd_hdr->plen = len; - fw_info->pkt_len = CMD_HDR_LEN + len; - memcpy(fw_info->req_para,&ble_create_con[4],len); - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to send , errno %d", - __func__, ret_val); - } - - ret_val = rcv_hci_evt_in_pm(fw_info,0); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive bt event, errno %d", - __func__, ret_val); - } - } - - return ret_val; -} - -static int aic_cmd_disable_scan(firmware_info *fw_info) -{ - int ret_val = 0; - int len = 6; - unsigned char p_buf[6] = {0x01,0x00,0x00,0x00,0x00,0x00}; - - printk("%s,ble_scan_en %d,%d\n",__func__,ble_scan_en[0],ble_scan_en[4]); - - if(ble_scan_en[0] == 1 && ble_scan_en[4] == 1){ - p_buf[0] = 0; - memcpy(&p_buf[1],&ble_scan_en[5],5); - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_OP_LE_Set_Extended_Scan_Enable); - fw_info->cmd_hdr->plen = len; - fw_info->pkt_len = CMD_HDR_LEN + len; - memcpy(fw_info->req_para,p_buf,len); - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to send , errno %d", - __func__, ret_val); - } - - ret_val = rcv_hci_evt_in_pm(fw_info,0); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive bt event, errno %d", - __func__, ret_val); - } - } - - - printk("%s,bt_scan_en %d ,%d\n",__func__,bt_scan_en[0],bt_scan_en[4]); - - if(bt_scan_en[0] == 1 && bt_scan_en[4] > 0){ - p_buf[0] = 0; - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_OP_Write_Scan_Enable); - fw_info->cmd_hdr->plen = 1; - fw_info->pkt_len = CMD_HDR_LEN + 1; - memcpy(fw_info->req_para,p_buf,len); - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to send , errno %d", - __func__, ret_val); - } - - ret_val = rcv_hci_evt_in_pm(fw_info,0); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive bt event, errno %d", - __func__, ret_val); - } - } - ret_val = aic_cmd_cancel_le_conn(fw_info); - - return ret_val; -} - -static int aic_cmd_enable_scan(firmware_info *fw_info) -{ - int ret_val = 0; - int len = 6; - unsigned char p_buf[6] = {0x01,0x00,0x00,0x00,0x00,0x00}; - - printk("%s,ble_scan_en %d,%d\n",__func__,ble_scan_en[0],ble_scan_en[4]); - - if(ble_scan_en[0] == 1 && ble_scan_en[4] == 1){ - p_buf[0] = 1; - memcpy(&p_buf[1],&ble_scan_en[5],5); - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_OP_LE_Set_Extended_Scan_Enable); - fw_info->cmd_hdr->plen = len; - fw_info->pkt_len = CMD_HDR_LEN + len; - memcpy(fw_info->req_para,p_buf,len); - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to send , errno %d", - __func__, ret_val); - } - - ret_val = rcv_hci_evt_in_pm(fw_info,0); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive bt event, errno %d", - __func__, ret_val); - } - } - - printk("%s,bt_scan_en %d,%d\n",__func__,bt_scan_en[0],bt_scan_en[4]); - - if(bt_scan_en[0] == 1 && bt_scan_en[4] > 0){ - p_buf[0] = bt_scan_en[4]; - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_OP_Write_Scan_Enable); - fw_info->cmd_hdr->plen = 1; - fw_info->pkt_len = CMD_HDR_LEN + 1; - memcpy(fw_info->req_para,p_buf,len); - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to send , errno %d", - __func__, ret_val); - } - - ret_val = rcv_hci_evt_in_pm(fw_info,0); - if (ret_val < 0) { - AICBT_ERR("%s: Failed to receive bt event, errno %d", - __func__, ret_val); - } - } - ret_val = aic_cmd_reconn_le_conn(fw_info); - - return ret_val; -} - - -static int aic_handle_cmd(struct sk_buff *skb) -{ - int ret = 0; - u8 *opcode = (u8*)(skb->data); - u16 command; - command = ((u16)opcode[0]|(u16)(opcode[1])<<8); - switch(command){ - case HCI_OP_LE_Set_Extended_Scan_Enable: - { - u8 scan_en = opcode[3]; - if(scan_en){ - ble_scan_en[0]=1; - memcpy(&ble_scan_en[1],opcode,9); - }else{ - ble_scan_en[0]=0; - } - } - break; - case HCI_OP_LE_Set_Extended_Adv_Enable: - break; - case HCI_OP_Write_Scan_Enable: - { - u8 scan_en = opcode[3]; - if(scan_en){ - bt_scan_en[0]=1; - bt_scan_en[4] = scan_en; - }else{ - bt_scan_en[0]=0; - } - } - break; - case HCI_OP_LE_Extended_Create_Connection: - case HCI_OP_LE_Create_Connection: - { - u8 len = opcode[2]; - printk("%s,0x%x,len %d\n",__func__,command,len); - ble_create_con[0]=1; - memcpy(&ble_create_con[1],opcode,len+2); - } - break; - case HCI_OP_LE_Create_Connection_Cancel: - { - printk("%s,0x%x\n",__func__,command); - ble_create_con[0]=0; - } - break; - default: - break; - } - return ret; -} - - -#endif -//for 8800DC start -u32 fwcfg_tbl[][2] = { - {0x40200028, 0x0021047e}, - {0x40200024, 0x0000011d}, -}; - -//Crystal provided by CPU (start) -static int hci_send_dbg_rd_mem_cmd(firmware_info* fw_info, u32 addr){ - struct hci_dbg_rd_mem_cmd *rd_cmd; - struct hci_dbg_rd_mem_cmd_evt *evt_para; - - int ret_val = -1; - - rd_cmd = (struct hci_dbg_rd_mem_cmd *)(fw_info->req_para); - if (!rd_cmd) - return -ENOMEM; - - rd_cmd->start_addr = addr; - rd_cmd->type = 32; - rd_cmd->length = 4; - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_DBG_RD_MEM_CMD); - fw_info->cmd_hdr->plen = sizeof(struct hci_dbg_rd_mem_cmd); - fw_info->pkt_len = CMD_HDR_LEN + sizeof(struct hci_dbg_rd_mem_cmd); - - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - printk("%s: Failed to send hci cmd 0x%04x, errno %d", - __func__, fw_info->cmd_hdr->opcode, ret_val); - return ret_val; - } - - ret_val = rcv_hci_evt(fw_info); - if (ret_val < 0) { - printk("%s: Failed to receive hci event, errno %d", - __func__, ret_val); - return ret_val; - } - - evt_para = (struct hci_dbg_rd_mem_cmd_evt *)(fw_info->rsp_para); - - printk("%s: fw status = 0x%04x, length %d, %x %x %x %x", - __func__, evt_para->status, evt_para->length, - evt_para->data[0], - evt_para->data[1], - evt_para->data[2], - evt_para->data[3]); - - return 0; -} - -static int set_bbpll_config(firmware_info* fw_info){ - int ret_val = -1; - struct fw_status *evt_status; - struct hci_dbg_rd_mem_cmd_evt *evt_para; - struct aicbt_patch_table_cmd *patch_table_cmd; - - //Read crystal provided by CPU or not. - ret_val = hci_send_dbg_rd_mem_cmd(fw_info, 0x40500148); - if(ret_val < 0){ - printk("%s error ret_val:%d\r\n", __func__, ret_val); - return ret_val; - } - evt_para = (struct hci_dbg_rd_mem_cmd_evt *)(fw_info->rsp_para); - - if(!(evt_para->data[0] & 0x01)){ - printk("%s Crystal not provided by CPU \r\n", __func__); - return 0; - }else{ - printk("%s Crystal provided by CPU \r\n", __func__); - - //Read 0x40505010 value to check bbpll set or not. - ret_val = hci_send_dbg_rd_mem_cmd(fw_info, 0x40505010); - if(ret_val < 0){ - printk("%s error ret_val:%d\r\n", __func__, ret_val); - return ret_val; - } - evt_para = (struct hci_dbg_rd_mem_cmd_evt *)(fw_info->rsp_para); - if((evt_para->data[3] >> 5) == 3){ - printk("%s Not need to set \r\n", __func__); - return 0; - }else{ - patch_table_cmd = (struct aicbt_patch_table_cmd *)(fw_info->req_para); - patch_table_cmd->patch_num = 1; - patch_table_cmd->patch_table_addr[0] = 0x40505010; - evt_para->data[3] |= ((0x1 << 5) | (0x1 << 6)); - evt_para->data[3] &= (~(0x1 << 7)); - patch_table_cmd->patch_table_data[0] = 0; - patch_table_cmd->patch_table_data[0] = evt_para->data[3] << 24; - patch_table_cmd->patch_table_data[0] |= evt_para->data[2] << 16; - patch_table_cmd->patch_table_data[0] |= evt_para->data[1] << 8; - patch_table_cmd->patch_table_data[0] |= evt_para->data[0]; - //printk("%s patch_table_cmd->patch_table_data[0]:%x \r\n", __func__, - //patch_table_cmd->patch_table_data[0]); - } -// patch_table_cmd->patch_table_data[0] = 0x7C301010; - - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_UPDATE_PT_CMD); - fw_info->cmd_hdr->plen = HCI_VSC_UPDATE_PT_SIZE; - if (g_chipid == PRODUCT_ID_AIC8800D80N) { - fw_info->cmd_hdr->plen = HCI_VSC_UPDATE_PT_V2_SIZE; - } - fw_info->pkt_len = fw_info->cmd_hdr->plen + 3; - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: rcv_hci_evt err %d", __func__, ret_val); - return ret_val; - } - ret_val = rcv_hci_evt(fw_info); - if (ret_val < 0) { - printk("%s: Failed to receive hci event, errno %d", - __func__, ret_val); - return ret_val; - } - evt_status = (struct fw_status *)fw_info->rsp_para; - ret_val = evt_status->status; - if (0 != evt_status->status) { - ret_val = -1; - } else { - ret_val = 0; - } - } - - return ret_val; -} -//Crystal provided by CPU (end) - - -static int fw_config(firmware_info* fw_info) -{ - int ret_val = -1; - struct hci_dbg_rd_mem_cmd *rd_cmd; - struct hci_dbg_rd_mem_cmd_evt *evt_para; - int len = 0, i = 0; - struct fw_status *evt_status; - - rd_cmd = (struct hci_dbg_rd_mem_cmd *)(fw_info->req_para); - if (!rd_cmd) - return -ENOMEM; - - rd_cmd->start_addr = 0x40200024; - rd_cmd->type = 32; - rd_cmd->length = 4; - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_DBG_RD_MEM_CMD); - fw_info->cmd_hdr->plen = sizeof(struct hci_dbg_rd_mem_cmd); - fw_info->pkt_len = CMD_HDR_LEN + sizeof(struct hci_dbg_rd_mem_cmd); - - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - printk("%s: Failed to send hci cmd 0x%04x, errno %d", - __func__, fw_info->cmd_hdr->opcode, ret_val); - return ret_val; - } - - ret_val = rcv_hci_evt(fw_info); - if (ret_val < 0) { - printk("%s: Failed to receive hci event, errno %d", - __func__, ret_val); - return ret_val; - } - - evt_para = (struct hci_dbg_rd_mem_cmd_evt *)(fw_info->rsp_para); - - printk("%s: fw status = 0x%04x, length %d, %x %x %x %x", - __func__, evt_para->status, evt_para->length, - evt_para->data[0], - evt_para->data[1], - evt_para->data[2], - evt_para->data[3]); - - ret_val = evt_para->status; - if (evt_para->status == 0) { - uint16_t rd_data = (evt_para->data[0] | (evt_para->data[1] << 8)); - printk("%s rd_data is %x\n", __func__, rd_data); - if (rd_data == 0x119) { - struct aicbt_patch_table_cmd *patch_table_cmd = (struct aicbt_patch_table_cmd *)(fw_info->req_para); - len = sizeof(fwcfg_tbl) / sizeof(u32) / 2; - patch_table_cmd->patch_num = len; - for (i = 0; i < len; i++) { - memcpy(&patch_table_cmd->patch_table_addr[i], &fwcfg_tbl[i][0], sizeof(uint32_t)); - memcpy(&patch_table_cmd->patch_table_data[i], &fwcfg_tbl[i][1], sizeof(uint32_t)); - //printk("%s [%d] data: %08x %08x\n", __func__, i, patch_table_cmd->patch_table_addr[i],patch_table_cmd->patch_table_data[i]); - } - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_UPDATE_PT_CMD); - fw_info->cmd_hdr->plen = HCI_VSC_UPDATE_PT_SIZE; - fw_info->pkt_len = fw_info->cmd_hdr->plen + 3; - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - AICBT_ERR("%s: rcv_hci_evt err %d", __func__, ret_val); - return ret_val; - } - ret_val = rcv_hci_evt(fw_info); - if (ret_val < 0) { - printk("%s: Failed to receive hci event, errno %d", - __func__, ret_val); - return ret_val; - } - evt_status = (struct fw_status *)fw_info->rsp_para; - ret_val = evt_status->status; - if (0 != evt_status->status) { - ret_val = -1; - } else { - ret_val = 0; - } - - } - - //Crystal provided by CPU (start) - ret_val = set_bbpll_config(fw_info); - //Crystal provided by CPU (end) - - } - return ret_val; -} - -static int system_config(firmware_info *fw_info) -{ - int ret_val = -1; - struct hci_dbg_rd_mem_cmd *rd_cmd; - struct hci_dbg_rd_mem_cmd_evt *evt_para; - //int len = 0, i = 0; - //struct fw_status *evt_status; - - rd_cmd = (struct hci_dbg_rd_mem_cmd *)(fw_info->req_para); - if (!rd_cmd) - return -ENOMEM; - - rd_cmd->start_addr = 0x40500000; - rd_cmd->type = 32; - rd_cmd->length = 4; - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_DBG_RD_MEM_CMD); - fw_info->cmd_hdr->plen = sizeof(struct hci_dbg_rd_mem_cmd); - fw_info->pkt_len = CMD_HDR_LEN + sizeof(struct hci_dbg_rd_mem_cmd); - - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) - { - printk("%s: Failed to send hci cmd 0x%04x, errno %d", - __func__, fw_info->cmd_hdr->opcode, ret_val); - return ret_val; - } - - ret_val = rcv_hci_evt(fw_info); - if (ret_val < 0) - { - printk("%s: Failed to receive hci event, errno %d", - __func__, ret_val); - return ret_val; - } - - evt_para = (struct hci_dbg_rd_mem_cmd_evt *)(fw_info->rsp_para); - - printk("%s: fw status = 0x%04x, length %d, %x %x %x %x", - __func__, evt_para->status, evt_para->length, - evt_para->data[0], - evt_para->data[1], - evt_para->data[2], - evt_para->data[3]); - - ret_val = evt_para->status; - if (evt_para->status == 0) - { - uint32_t rd_data = (evt_para->data[0] | (evt_para->data[1] << 8) | (evt_para->data[2] << 16) | (evt_para->data[3] << 24)); - //printk("%s 0x40500000 rd_data is %x\n", __func__, rd_data); - chip_id = (u8) (rd_data >> 16); - //btenable = (u8) ((rd_data >> 26) && 0x01); - btdual = (u8) ((rd_data >> 27) && 0x01); - } - - rd_cmd->start_addr = 0x20; - rd_cmd->type = 32; - rd_cmd->length = 4; - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_DBG_RD_MEM_CMD); - fw_info->cmd_hdr->plen = sizeof(struct hci_dbg_rd_mem_cmd); - fw_info->pkt_len = CMD_HDR_LEN + sizeof(struct hci_dbg_rd_mem_cmd); - - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) - { - printk("%s: Failed to send hci cmd 0x%04x, errno %d", - __func__, fw_info->cmd_hdr->opcode, ret_val); - return ret_val; - } - - ret_val = rcv_hci_evt(fw_info); - if (ret_val < 0) - { - printk("%s: Failed to receive hci event, errno %d", - __func__, ret_val); - return ret_val; - } - - evt_para = (struct hci_dbg_rd_mem_cmd_evt *)(fw_info->rsp_para); - - printk("%s: fw status = 0x%04x, length %d, %x %x %x %x", - __func__, evt_para->status, evt_para->length, - evt_para->data[0], - evt_para->data[1], - evt_para->data[2], - evt_para->data[3]); - - ret_val = evt_para->status; - if (evt_para->status == 0) - { - uint32_t rd_data = (evt_para->data[0] | (evt_para->data[1] << 8) | (evt_para->data[2] << 16) | (evt_para->data[3] << 24)); - //printk("%s 0x02 rd_data is %x\n", __func__, rd_data); - sub_chip_id = (u8) (rd_data); - } - printk("chip_id = %x, sub_chip_id = %x\n", chip_id, sub_chip_id); - return ret_val; -} - -static int check_fw_status(firmware_info* fw_info) -{ - struct fw_status *read_ver_rsp; - int ret_val = -1; - - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_FW_STATUS_GET_CMD); - fw_info->cmd_hdr->plen = 0; - fw_info->pkt_len = CMD_HDR_LEN; - - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - printk("%s: Failed to send hci cmd 0x%04x, errno %d", - __func__, fw_info->cmd_hdr->opcode, ret_val); - return ret_val; - } - - ret_val = rcv_hci_evt(fw_info); - if (ret_val < 0) { - printk("%s: Failed to receive hci event, errno %d", - __func__, ret_val); - return ret_val; - } - - read_ver_rsp = (struct fw_status *)(fw_info->rsp_para); - - printk("%s: fw status = 0x%04x", - __func__, read_ver_rsp->status); - return read_ver_rsp->status; -} - - -static int download_data(firmware_info *fw_info, u32 fw_addr, const char *filename) -{ - unsigned int i=0; - int size; - u8 *dst=NULL; - int err=0; - struct hci_dbg_wr_mem_cmd *dl_cmd; - int hdr_len = sizeof(__le32) + sizeof(__u8) + sizeof(__u8); - int data_len = HCI_VSC_MEM_WR_SIZE; - int mem_wr_size = HCI_VSC_MEM_WR_SIZE; - int frag_len = data_len + hdr_len; - int ret_val; - int ncmd = 1; - struct fw_status *evt_para; - - if (g_chipid == PRODUCT_ID_AIC8800D80N) { - mem_wr_size = HCI_VSC_MEM_WR_V2_SIZE; - } - /* load aic firmware */ - size = aic_load_firmware(&dst, filename, NULL); - if(size <= 0){ - printk("wrong size of firmware file\n"); - vfree(dst); - dst = NULL; - return -1; - } - - dl_cmd = (struct hci_dbg_wr_mem_cmd *)(fw_info->req_para); - if (!dl_cmd) - return -ENOMEM; - evt_para = (struct fw_status *)fw_info->rsp_para; - - /* Copy the file on the Embedded side */ - printk("### Upload %s firmware, @ = %x size=%d\n", filename, fw_addr, size); - - if (size > mem_wr_size) {// > 1KB data - for (i = 0; i < (size - mem_wr_size); i += mem_wr_size) {//each time write 240 bytes - data_len = mem_wr_size; - frag_len = data_len + hdr_len; - memcpy(dl_cmd->data, dst + i, data_len); - dl_cmd->length = data_len; - dl_cmd->type = 32; - dl_cmd->start_addr = fw_addr + i; - fw_info->cmd_hdr->opcode = cpu_to_le16(DOWNLOAD_OPCODE); - fw_info->cmd_hdr->plen = frag_len; - fw_info->pkt_len = frag_len + 3; - #if 0 - printk("[%d] data_len %d, src %x, dst %x\n", i, data_len, dst + i, fw_addr + i); - printk("%p , %d\n", dl_cmd, fw_info->pkt_len); - print_hex_dump(KERN_ERR,"payload:",DUMP_PREFIX_NONE,16,1,dl_cmd->data,32,false); - - /* Send download command */ - //print_hex_dump(KERN_ERR,"cmd data:",DUMP_PREFIX_NONE,16,1,fw_info->send_pkt,32,false); - #endif - ret_val = send_hci_cmd(fw_info); - - while (ncmd > 0) { - ret_val = rcv_hci_evt(fw_info); - //print_hex_dump(KERN_ERR,"evt data:",DUMP_PREFIX_NONE,16,1,fw_info->rcv_pkt,ret_val,false); - //printk("rcv_hci_evt %d\n", ret_val); - if (ret_val < 0) { - AICBT_ERR("%s: rcv_hci_evt err %d", __func__, ret_val); - goto out; - } else { - AICBT_DBG("%s: Receive acked frag num %d", __func__, evt_para->status); - ncmd--; - } - if (0 != evt_para->status) { - AICBT_ERR("%s: Receive acked frag num %d, err status %d", - __func__, ret_val, evt_para->status); - ret_val = -1; - goto out; - } - } - ncmd = 1; - } - } - - if (!err && (i < size)) {// <1KB data - data_len = size - i; - frag_len = data_len + hdr_len; - memcpy(dl_cmd->data, dst + i, data_len); - dl_cmd->length = data_len; - dl_cmd->type = 32; - dl_cmd->start_addr = fw_addr + i; - fw_info->cmd_hdr->opcode = cpu_to_le16(DOWNLOAD_OPCODE); - fw_info->cmd_hdr->plen = frag_len; - fw_info->pkt_len = frag_len + 3; - ret_val = send_hci_cmd(fw_info); - //printk("(%d) data_len %d, src %x, dst %x\n", i, data_len, (dst + i), fw_addr + i); - //printk("%p , %d\n", dl_cmd, fw_info->pkt_len); - /* Send download command */ - //print_hex_dump(KERN_ERR,"cmd data:",DUMP_PREFIX_NONE,16,1,fw_info->send_pkt,32,false); - while (ncmd > 0) { - ret_val = rcv_hci_evt(fw_info); - //print_hex_dump(KERN_ERR,"evt data:",DUMP_PREFIX_NONE,16,1,fw_info->rcv_pkt,ret_val,false); - if (ret_val < 0) { - AICBT_ERR("%s: rcv_hci_evt err %d", __func__, ret_val); - goto out; - } else { - AICBT_DBG("%s: Receive acked frag num %d", __func__, evt_para->status); - ncmd--; - } - if (0 != evt_para->status) { - AICBT_ERR("%s: Receive acked frag num %d, err status %d", - __func__, ret_val, evt_para->status); - ret_val = -1; - goto out; - } - } - ncmd = 0; - } - -out: - if (dst) { - vfree(dst); - dst = NULL; - } - - if(ret_val != -1){ - ret_val = 0; - } - - printk("fw download complete\n\n"); - return ret_val; - -} - - -struct aicbt_info_t { - uint32_t btmode; - uint32_t btport; - uint32_t uart_baud; - uint32_t uart_flowctrl; - uint32_t lpm_enable; - uint32_t txpwr_lvl; -}; - -struct aicbsp_info_t { - int hwinfo; - uint32_t cpmode; -}; - -enum aicbsp_cpmode_type { - AICBSP_CPMODE_WORK, - AICBSP_CPMODE_TEST, -}; - -/* btmode - * used for force bt mode,if not AICBSP_MODE_NULL - * efuse valid and vendor_info will be invalid, even has beed set valid -*/ -enum aicbt_btmode_type { - AICBT_BTMODE_BT_ONLY_SW = 0x0, // bt only mode with switch - AICBT_BTMODE_BT_WIFI_COMBO, // wifi/bt combo mode - AICBT_BTMODE_BT_ONLY, // bt only mode without switch - AICBT_BTMODE_BT_ONLY_TEST, // bt only test mode - AICBT_BTMODE_BT_WIFI_COMBO_TEST, // wifi/bt combo test mode - AICBT_BTMODE_BT_ONLY_COANT, - AICBT_MODE_NULL = 0xFF, // invalid value -}; - -enum aicbt_btport_type { - AICBT_BTPORT_NULL, - AICBT_BTPORT_MB, - AICBT_BTPORT_UART, -}; - -enum aicbt_uart_baud_type { - AICBT_UART_BAUD_115200 = 115200, - AICBT_UART_BAUD_921600 = 921600, - AICBT_UART_BAUD_1_5M = 1500000, - AICBT_UART_BAUD_3_25M = 3250000, -}; - -enum aicbt_uart_flowctrl_type { - AICBT_UART_FLOWCTRL_DISABLE = 0x0, // uart without flow ctrl - AICBT_UART_FLOWCTRL_ENABLE, // uart with flow ctrl -}; - -#define AICBSP_HWINFO_DEFAULT (-1) -#define AICBSP_CPMODE_DEFAULT AICBSP_CPMODE_WORK -#define AICBT_TXPWR_DFT 0x6F2F -#define AICBT_TXPWR_RF_DFT 0x7F0F - - -#define AICBT_BTMODE_DEFAULT AICBT_BTMODE_BT_WIFI_COMBO -#define AICBT_BTMODE_DEFAULT_D80N AICBT_BTMODE_BT_ONLY -#define AICBT_BTPORT_DEFAULT AICBT_BTPORT_MB -#define AICBT_UART_BAUD_DEFAULT AICBT_UART_BAUD_1_5M -#define AICBT_UART_FC_DEFAULT AICBT_UART_FLOWCTRL_ENABLE -#define AICBT_LPM_ENABLE_DEFAULT 0 -#define AICBT_TXPWR_LVL_DEFAULT AICBT_TXPWR_DFT - -struct aicbsp_info_t aicbsp_info = { - .hwinfo = AICBSP_HWINFO_DEFAULT, - .cpmode = AICBSP_CPMODE_DEFAULT, -}; - -#ifndef CONFIG_USE_FW_REQUEST -#define FW_PATH_MAX 200 - -char aic_fw_path[FW_PATH_MAX]; -#if (CONFIG_BLUEDROID == 0) || defined (CONFIG_PLATFORM_UBUNTU) -static const char* aic_default_fw_path = "/lib/firmware"; -#else -static const char* aic_default_fw_path = "/vendor/etc/firmware"; -#endif -#endif //CONFIG_USE_FW_REQUEST - -#if 0 -static struct aicbt_info_t aicbt_info = { - .btmode = AICBT_BTMODE_DEFAULT, - .btport = AICBT_BTPORT_DEFAULT, - .uart_baud = AICBT_UART_BAUD_DEFAULT, - .uart_flowctrl = AICBT_UART_FC_DEFAULT, - .lpm_enable = AICBT_LPM_ENABLE_DEFAULT, - .txpwr_lvl = AICBT_TXPWR_LVL_DEFAULT, -}; -#endif -static struct aicbt_info_t aicbt_info[] = { - { - },//PRODUCT_ID_AIC8801 - { - .btmode = AICBT_BTMODE_DEFAULT, - .btport = AICBT_BTPORT_DEFAULT, - .uart_baud = AICBT_UART_BAUD_DEFAULT, - .uart_flowctrl = AICBT_UART_FC_DEFAULT, - .lpm_enable = AICBT_LPM_ENABLE_DEFAULT, - .txpwr_lvl = AICBT_TXPWR_LVL_DEFAULT, - },//PRODUCT_ID_AIC8800DC - { - },//PRODUCT_ID_AIC8800DW - { - },//PRODUCT_ID_AIC8800DLN - { - .btmode = AICBT_BTMODE_DEFAULT_D80N, - .btport = AICBT_BTPORT_DEFAULT, - .uart_baud = AICBT_UART_BAUD_DEFAULT, - .uart_flowctrl = AICBT_UART_FC_DEFAULT, - .lpm_enable = AICBT_LPM_ENABLE_DEFAULT, - .txpwr_lvl = AICBT_TXPWR_LVL_DEFAULT, - },//PRODUCT_ID_AIC8800D80N - { - },//PRODUCT_ID_AIC8800D80 - { - },//PRODUCT_ID_AIC8800D80X2 -}; - - -static int patch_table_load(firmware_info *fw_info, struct aicbt_patch_table *_head) -{ - struct aicbt_patch_table *head, *p; - int i; - int ret = 0; - uint32_t *data = NULL; - struct aicbt_patch_table_cmd *patch_table_cmd = (struct aicbt_patch_table_cmd *)(fw_info->req_para); - struct fw_status *evt_para; - int ret_val = 0; - int ncmd = 1; - uint32_t len = 0; - uint32_t tot_len = 0; - head = _head; - for (p = head; p != NULL; p = p->next) { - data = p->data; - if(AICBT_PT_BTMODE == p->type){ - *(data + 1) = aicbsp_info.hwinfo < 0; - *(data + 3) = aicbsp_info.hwinfo; - *(data + 5) = aicbsp_info.cpmode; - if (g_chipid < PRODUCT_ID_MAX) { - if(testmode == 1) { - aicbt_info[g_chipid].txpwr_lvl = AICBT_TXPWR_RF_DFT; - } - *(data + 7) = aicbt_info[g_chipid].btmode; - *(data + 9) = aicbt_info[g_chipid].btport; - *(data + 11) = aicbt_info[g_chipid].uart_baud; - *(data + 13) = aicbt_info[g_chipid].uart_flowctrl; - *(data + 15) = aicbt_info[g_chipid].lpm_enable; - *(data + 17) = aicbt_info[g_chipid].txpwr_lvl; - - printk("%s bt btmode:%d \r\n", __func__, aicbt_info[g_chipid].btmode); - printk("%s bt uart_baud:%d \r\n", __func__, aicbt_info[g_chipid].uart_baud); - printk("%s bt uart_flowctrl:%d \r\n", __func__, aicbt_info[g_chipid].uart_flowctrl); - printk("%s bt lpm_enable:%d \r\n", __func__, aicbt_info[g_chipid].lpm_enable); - printk("%s bt tx_pwr:%d \r\n", __func__, aicbt_info[g_chipid].txpwr_lvl); - } - - } - if (p->type == AICBT_PT_INF || p->type == AICBT_PT_PWRON) { - continue; - } - if (p->type == AICBT_PT_VER) { - char *data_s = (char *)p->data; - printk("patch version %s\n", data_s); - continue; - } - if (p->len == 0) { - printk("len is 0\n"); - continue; - } - tot_len = p->len; - while (tot_len) { - if (tot_len > HCI_PT_MAX_LEN) { - len = HCI_PT_MAX_LEN; - } else { - len = tot_len; - } - for (i = 0; i < len; i++) { - patch_table_cmd->patch_num = len; - memcpy(&patch_table_cmd->patch_table_addr[i], data, sizeof(uint32_t)); - memcpy(&patch_table_cmd->patch_table_data[i], data + 1, sizeof(uint32_t)); - //printk("[%d] data: %08x %08x\n", i, patch_table_cmd->patch_table_addr[i],patch_table_cmd->patch_table_data[i]); - if (g_chipid == PRODUCT_ID_AIC8800D80N) { - ret = rwnx_send_dbg_mem_write_req(fw_info, patch_table_cmd->patch_table_addr[i],patch_table_cmd->patch_table_data[i]); - if (ret) { - printk("%s err %d\n", __func__, ret); - break; - } - } - data += 2; - } - tot_len -= len; - if (g_chipid == PRODUCT_ID_AIC8800DC) - { - evt_para = (struct fw_status *)fw_info->rsp_para; - //print_hex_dump(KERN_ERR,"data0:",DUMP_PREFIX_NONE,16,1,patch_table_cmd,sizeof(struct aicbt_patch_table_cmd),false); - - //printk("patch num %x %d\n", patch_table_cmd->patch_num, (int)sizeof(struct aicbt_patch_table_cmd)); - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_UPDATE_PT_CMD); - fw_info->cmd_hdr->plen = HCI_VSC_UPDATE_PT_SIZE; - fw_info->pkt_len = fw_info->cmd_hdr->plen + 3; - AICBT_DBG("patch num 0x%x, plen 0x%x\n", patch_table_cmd->patch_num, fw_info->cmd_hdr->plen ); - //print_hex_dump(KERN_ERR,"patch table:",DUMP_PREFIX_NONE,16,1,fw_info->send_pkt,32,false); - ret_val = send_hci_cmd(fw_info); - while (ncmd > 0) { - ret_val = rcv_hci_evt(fw_info); - //printk("%s ret_val:%d \r\n", __func__, ret_val); - if (ret_val < 0) { - AICBT_ERR("%s: rcv_hci_evt err %d", __func__, ret_val); - goto out; - } else { - AICBT_DBG("%s: Receive acked frag num %d", __func__, evt_para->status); - ncmd--; - } - if (0 != evt_para->status) { - AICBT_ERR("%s: Receive acked frag num %d, err status %d", - __func__, ret_val, evt_para->status); - ret_val = -1; - goto out; - }else{ - ret_val = 0; - } - } - } - ncmd = 1; - } - } -out: - //aicbt_patch_table_free(&head); - - return ret_val; -} - - -static int aic_load_firmware(u8 ** fw_buf, const char *name, struct device *device) -{ - -#ifdef CONFIG_USE_FW_REQUEST - const struct firmware *fw = NULL; - u32 *dst = NULL; - void *buffer=NULL; - int size = 0; - int ret = 0; - - printk("%s: request firmware = %s \n", __func__ ,name); - - - ret = request_firmware(&fw, name, NULL); - - if (ret < 0) { - printk("Load %s fail\n", name); - release_firmware(fw); - return -1; - } - - size = fw->size; - dst = (u32 *)fw->data; - - if (size <= 0) { - printk("wrong size of firmware file\n"); - release_firmware(fw); - return -1; - } - - - buffer = vmalloc(size); - memset(buffer, 0, size); - memcpy(buffer, dst, size); - - *fw_buf = buffer; - - release_firmware(fw); - - return size; - -#else - u8 *buffer=NULL; - char *path=NULL; - struct file *fp=NULL; - int size = 0, len=0; - ssize_t rdlen=0; - - /* get the firmware path */ - path = __getname(); - if (!path){ - *fw_buf=NULL; - return -1; - } - - if (strlen(aic_fw_path) > 0) { - printk("%s: use customer define fw_path\n", __func__); - len = snprintf(path, FW_PATH_MAX, "%s/%s", aic_fw_path, name); - } else { -#if (CONFIG_BLUEDROID == 0) || defined (CONFIG_PLATFORM_UBUNTU) - if (g_chipid == PRODUCT_ID_AIC8800DC) { - len = snprintf(path, FW_PATH_MAX, "%s/%s/%s",aic_default_fw_path, "aic8800DC", name); - } else if (g_chipid == PRODUCT_ID_AIC8800D80N) { - len = snprintf(path, FW_PATH_MAX, "%s/%s/%s",aic_default_fw_path, "aic8800D80N", name); - } else { - printk("%s unknown chipid %d\n", __func__, g_chipid); - } -#else - len = snprintf(path, FW_PATH_MAX, "%s/%s",aic_default_fw_path, name); -#endif - } - - if (len >= FW_PATH_MAX) { - printk("%s: %s file's path too long\n", __func__, name); - *fw_buf=NULL; - __putname(path); - return -1; - } - - printk("%s :firmware path = %s \n", __func__ ,path); - - - /* open the firmware file */ - fp=filp_open(path, O_RDONLY, 0); - if(IS_ERR(fp) || (!fp)){ - printk("%s: %s file failed to open\n", __func__, name); - if(IS_ERR(fp)) - printk("is_Err\n"); - if((!fp)) - printk("null\n"); - *fw_buf=NULL; - __putname(path); - fp=NULL; - return -1; - } - - size = i_size_read(file_inode(fp)); - if(size<=0){ - printk("%s: %s file size invalid %d\n", __func__, name, size); - *fw_buf=NULL; - __putname(path); - filp_close(fp,NULL); - fp=NULL; - return -1; -} - - /* start to read from firmware file */ - buffer = vmalloc(size); - memset(buffer, 0, size); - if(!buffer){ - *fw_buf=NULL; - __putname(path); - filp_close(fp,NULL); - fp=NULL; - return -1; - } - - - #if LINUX_VERSION_CODE > KERNEL_VERSION(4, 13, 16) - rdlen = kernel_read(fp, buffer, size, &fp->f_pos); - #else - rdlen = kernel_read(fp, fp->f_pos, buffer, size); - #endif - - if(size != rdlen){ - printk("%s: %s file rdlen invalid %d %d\n", __func__, name, (int)rdlen, size); - *fw_buf=NULL; - __putname(path); - filp_close(fp,NULL); - fp=NULL; - vfree(buffer); - buffer=NULL; - return -1; - } - if(rdlen > 0){ - fp->f_pos += rdlen; - //printk("f_pos=%d\n", (int)fp->f_pos); - } - *fw_buf = buffer; - -#if 0 - MD5Init(&md5); - MD5Update(&md5, (unsigned char *)dst, size); - MD5Final(&md5, decrypt); - - printk(MD5PINRT, MD5(decrypt)); - -#endif - return size; -#endif -} - -static int aicbt_patch_table_free(struct aicbt_patch_table **head) -{ - struct aicbt_patch_table *p = *head, *n = NULL; - while (p) { - n = p->next; - kfree(p->name); - kfree(p->data); - kfree(p); - p = n; - } - *head = NULL; - return 0; -} - -static struct aicbt_patch_table *aicbt_patch_table_alloc(const char *filename) -{ - uint8_t *rawdata = NULL, *p; - int size; - struct aicbt_patch_table *head = NULL, *new = NULL, *cur = NULL; - - /* load aic firmware */ - size = aic_load_firmware((u8 **)&rawdata, filename, NULL); - if (size <= 0) { - printk("wrong size of firmware file\n"); - goto err; - } - - p = rawdata; - if (memcmp(p, AICBT_PT_TAG, sizeof(AICBT_PT_TAG) < 16 ? sizeof(AICBT_PT_TAG) : 16)) { - printk("TAG err\n"); - goto err; - } - p += 16; - - while (p - rawdata < size) { - printk("size = %d p - rawdata = 0x%0lx \r\n", size, p - rawdata); - new = (struct aicbt_patch_table *)vmalloc(sizeof(struct aicbt_patch_table)); - memset(new, 0, sizeof(struct aicbt_patch_table)); - if (head == NULL) { - head = new; - cur = new; - } else { - cur->next = new; - cur = cur->next; - } - - cur->name = (char *)vmalloc(sizeof(char) * 16); - memset(cur->name, 0, sizeof(char) * 16); - memcpy(cur->name, p, 16); - p += 16; - - cur->type = *(uint32_t *)p; - p += 4; - - cur->len = *(uint32_t *)p; - p += 4; - - printk("cur->type %x, len %d\n", cur->type, cur->len); - - if((cur->type ) >= 1000 ) {//Temp Workaround - cur->len = 0; - }else{ - if(cur->len > 0){ - cur->data = (uint32_t *)vmalloc(sizeof(uint8_t) * cur->len * 8); - memset(cur->data, 0, sizeof(uint8_t) * cur->len * 8); - memcpy(cur->data, p, cur->len * 8); - p += cur->len * 8; - } - } - } - - if (rawdata) - vfree(rawdata); - - return head; - -err: - aicbt_patch_table_free(&head); - if (rawdata) - vfree(rawdata); - return NULL; -} - - -static int aicbt_patch_info_unpack(struct aicbt_patch_info_t *patch_info, struct aicbt_patch_table *head_t) -{ - uint8_t *patch_info_array = (uint8_t*)patch_info; - int base_len = 0; - int memcpy_len = 0; - - if (AICBT_PT_INF == head_t->type) { - base_len = ((offsetof(struct aicbt_patch_info_t, ext_patch_nb_addr) - offsetof(struct aicbt_patch_info_t, adid_addrinf) )/sizeof(uint32_t))/2; - printk("%s head_t->len:%d base_len:%d \r\n", __func__, head_t->len, base_len); - - if (head_t->len > base_len){ - patch_info->info_len = base_len; - memcpy_len = patch_info->info_len + 1;//include ext patch nb - } else{ - patch_info->info_len = head_t->len; - memcpy_len = patch_info->info_len; - } - printk("%s memcpy_len:%d \r\n", __func__, memcpy_len); - - if (patch_info->info_len == 0) - return 0; - - memcpy(((patch_info_array) + sizeof(patch_info->info_len)), - head_t->data, - memcpy_len * sizeof(uint32_t) * 2); - printk("%s adid_addrinf:%x addr_adid:%x \r\n", __func__, - ((struct aicbt_patch_info_t *)patch_info_array)->adid_addrinf, - ((struct aicbt_patch_info_t *)patch_info_array)->addr_adid); - - if (patch_info->ext_patch_nb > 0){ - int index = 0; - patch_info->ext_patch_param = (uint32_t *)(head_t->data + ((memcpy_len) * 2)); - - for(index = 0; index < patch_info->ext_patch_nb; index++){ - printk("%s id:%x addr:%x \r\n", __func__, - *(patch_info->ext_patch_param + (index * 2)), - *(patch_info->ext_patch_param + (index * 2) + 1)); - } - } - - } - return 0; -} - -static int rwnx_send_dbg_mem_write_req(firmware_info *fw_info, u32 mem_addr, u32 mem_data){ - int ret_val = -1; - struct hci_dbg_wr_mem_cmd *dl_cmd; - int data_len = 4; - int frag_len = 0; - int hdr_len = sizeof(__le32) + sizeof(__u8) + sizeof(__u8); - - frag_len = data_len + hdr_len; - dl_cmd = (struct hci_dbg_wr_mem_cmd *)(fw_info->req_para); - if (!dl_cmd) - return -ENOMEM; - - dl_cmd->start_addr = mem_addr; - dl_cmd->type = 32; - dl_cmd->length = data_len; - memcpy(dl_cmd->data, (__u8*)(&mem_data), data_len); - frag_len = data_len + hdr_len; - fw_info->cmd_hdr->opcode = cpu_to_le16(DOWNLOAD_OPCODE); - fw_info->cmd_hdr->plen = frag_len; - fw_info->pkt_len = frag_len + sizeof(struct hci_command_hdr);; - - //print_hex_dump(KERN_ERR,"data:",DUMP_PREFIX_NONE,16,1,fw_info->send_pkt,fw_info->pkt_len,false); - - ret_val = send_hci_cmd(fw_info); - if (ret_val < 0) { - printk("%s: Failed to send hci cmd 0x%04x, errno %d", - __func__, fw_info->cmd_hdr->opcode, ret_val); - return ret_val; - } - - ret_val = rcv_hci_evt(fw_info); - //print_hex_dump(KERN_ERR,"evt data:",DUMP_PREFIX_NONE,16,1,fw_info->rcv_pkt,ret_val,false); - if (ret_val < 0) { - printk("%s: Failed to receive hci event, errno %d", - __func__, ret_val); - return ret_val; - }else{ - ret_val = 0; - } - - return ret_val; -} - -static int aicbt_ext_patch_data_load(firmware_info *fw_info, struct aicbt_patch_info_t *patch_info) -{ - int ret = 0; - uint32_t ext_patch_nb = patch_info->ext_patch_nb; - char ext_patch_file_name[50]; - int index = 0; - uint32_t id = 0; - uint32_t addr = 0; - - if (ext_patch_nb > 0){ - for (index = 0; index < patch_info->ext_patch_nb; index++){ - id = *(patch_info->ext_patch_param + (index * 2)); - addr = *(patch_info->ext_patch_param + (index * 2) + 1); - memset(ext_patch_file_name, 0, sizeof(ext_patch_file_name)); - sprintf(ext_patch_file_name,"%s%d.bin", - aicbt_fw->bt_ext_patch, - id); - printk("%s ext_patch_file_name:%s ext_patch_id:%x ext_patch_addr:%x \r\n", - __func__,ext_patch_file_name, id, addr); - - if (download_data(fw_info, addr, ext_patch_file_name)) { - ret = -1; - break; - } - } - }else{ - printk("%s nothing ext patch need to load \r\n", __func__); - } - return ret; -} - - -static int aicbt_patch_trap_data_load(firmware_info *fw_info, struct aicbt_patch_table *head) -{ - int ret_val; - - struct aicbt_patch_info_t patch_info = { - .info_len = 0, - .adid_addrinf = 0, - .addr_adid = 0, - .patch_addrinf = 0, - .addr_patch = 0, - .reset_addr = 0, - .reset_val = 0, - .adid_flag_addr = 0, - .adid_flag = 0, - .ext_patch_nb_addr = 0, - .ext_patch_nb = 0, - }; - if(head == NULL){ - return -1; - } - - patch_info.addr_patch = FW_RAM_PATCH_BASE_ADDR;//set default patch base addr - aicbt_patch_info_unpack(&patch_info, head); - - if(download_data(fw_info, patch_info.addr_patch, aicbt_fw->bt_patch)){ - printk("aic load patch fail %d\n", ret_val); - return -1; - } - - if (aicbt_ext_patch_data_load(fw_info, &patch_info)){ - printk("aic load ext patch fail %d\n", ret_val); - return -1; - } - - return 0; -} - -#define ROM_FMAC_BTUSB_ADDR_8800D80N_U02 0x00132c00 -#define ROM_FMAC_CINIT_ADDR_8800D80N_U02 0x00133000 - -#define CHIP_INFO_FLAG_CINIT_BEGIN (0x01U << 12) -#define CHIP_INFO_FLAG_CINIT_DONE (0x01U << 13) - -enum { - HOST_START_APP_AUTO = 1, - HOST_START_APP_CUSTOM, - HOST_START_APP_REBOOT, - HOST_START_APP_FNCALL = 4, - HOST_START_APP_DUMMY = 5, -}; - -static int hci_send_wf_cinit_exec_cmd(firmware_info* fw_info) -{ - int ret = 0; - struct wf_start_app_param start_app_param; - start_app_param.bootaddr = ROM_FMAC_CINIT_ADDR_8800D80N_U02 + 0x0009; - start_app_param.boottype = HOST_START_APP_FNCALL; - fw_info->cmd_hdr->opcode = cpu_to_le16(HCI_VSC_WF_START_APP_CMD); - fw_info->cmd_hdr->plen = sizeof(struct wf_start_app_param); - fw_info->pkt_len = CMD_HDR_LEN + sizeof(struct wf_start_app_param); - memcpy(fw_info->req_para, &start_app_param,sizeof(struct wf_start_app_param)); - printk("%s wf start_app exec cinit\r\n", __func__); - ret = send_hci_cmd(fw_info); - if (ret < 0) { - AICBT_ERR("%s: Failed to send wf start_app_param, errno %d\r\n", __func__, ret); - return ret; - } - return ret; -} - -static int aicbt_wf_cinit_data_load(firmware_info *fw_info) -{ - int ret = 0; - uint32_t addr = 0; - addr = ROM_FMAC_CINIT_ADDR_8800D80N_U02; - printk("%s wf cinit:%s addr:%x\r\n", __func__, aicbt_fw->wf_cinit, addr); - ret = download_data(fw_info, addr, aicbt_fw->wf_cinit); - if (ret < 0) { - printk("%s download wf cinit error, ret:%d\r\n", __func__, ret); - return ret; - } - addr = ROM_FMAC_BTUSB_ADDR_8800D80N_U02; - printk("%s wf btusb:%s addr:%x\r\n", __func__, aicbt_fw->wf_btusb, addr); - ret = download_data(fw_info, addr, aicbt_fw->wf_btusb); - if (ret < 0) { - printk("%s download wf btusb error, ret:%d\r\n", __func__, ret); - return ret; - } - printk("%s patch btusb\r\n", __func__); - ret = rwnx_send_dbg_mem_write_req(fw_info, 0x00113564, ROM_FMAC_BTUSB_ADDR_8800D80N_U02 + 0x0009); - if (ret) { - printk("%s patch btusb error, ret:%d\r\n", __func__, ret); - return ret; - } - return ret; -} - -static int aicbt_wf_cinit_exec(firmware_info *fw_info) -{ - int ret_val = 0; - struct hci_dbg_rd_mem_cmd_evt *evt_para; - uint32_t chipinfo_val; - //Read chipinfo - ret_val = hci_send_dbg_rd_mem_cmd(fw_info, 0x40500184); - if(ret_val < 0){ - printk("%s error ret_val:%d\r\n", __func__, ret_val); - return ret_val; - } - evt_para = (struct hci_dbg_rd_mem_cmd_evt *)(fw_info->rsp_para); - chipinfo_val = ( (uint32_t)evt_para->data[0] | - ((uint32_t)evt_para->data[1] << 8) | - ((uint32_t)evt_para->data[2] << 16) | - ((uint32_t)evt_para->data[3] << 24)); - if (chipinfo_val & CHIP_INFO_FLAG_CINIT_BEGIN) { - while (!(chipinfo_val & CHIP_INFO_FLAG_CINIT_DONE)) { - printk("%s chipinfo_val=%d\r\n", __func__, chipinfo_val); - ret_val = hci_send_dbg_rd_mem_cmd(fw_info, 0x40500184); - if(ret_val < 0){ - printk("%s error ret_val:%d\r\n", __func__, ret_val); - return ret_val; - } - evt_para = (struct hci_dbg_rd_mem_cmd_evt *)(fw_info->rsp_para); - chipinfo_val = ( (uint32_t)evt_para->data[0] | - ((uint32_t)evt_para->data[1] << 8) | - ((uint32_t)evt_para->data[2] << 16) | - ((uint32_t)evt_para->data[3] << 24)); - } - printk("cinit executed, chipinfo=%x\r\n", chipinfo_val); - return 0; - } - ret_val = aicbt_wf_cinit_data_load(fw_info); - if (ret_val < 0){ - printk("%s wf cinit load fail, ret_val:%d\r\n", __func__, ret_val); - return ret_val; - } - ret_val = hci_send_wf_cinit_exec_cmd(fw_info); - if (ret_val < 0){ - printk("%s wf cinit exec fail, ret_val:%d\r\n", __func__, ret_val); - return ret_val; - } - return ret_val; -} - -static int download_patch(firmware_info *fw_info, int cached) -{ - int ret_val = 0; - struct aicbt_patch_table *head; - int ret = 0; - - printk("%s: Download fw patch start, cached %d", __func__, cached); - - if (!fw_info) { - printk("%s: No patch entry exists(fw_info %p)", __func__, fw_info); - ret_val = -1; - goto end; - } - - ret_val = fw_config(fw_info); - if (ret_val) { - printk("%s: fw config failed %d", __func__, ret_val); - goto free; - } - - ret_val = system_config(fw_info); - if (ret_val) - { - printk("%s: system config failed %d", __func__, ret_val); - goto free; - } - - /* - * step1: check firmware statis - * step2: download firmware if updated - */ - - - ret_val = check_fw_status(fw_info); - - - if (ret_val) { - switch (sub_chip_id){ - case DC_U01: - case DC_U02: - case DC_U02H: - if (g_chipid == PRODUCT_ID_AIC8800DC) { - aicbt_fw = &fw_8800dc[sub_chip_id]; - } else if (g_chipid == PRODUCT_ID_AIC8800D80N) { - if (testmode) { - aicbt_fw = &fw_8800d80n_rf[sub_chip_id]; - } else { - aicbt_fw = &fw_8800d80n[sub_chip_id]; - } - } else { - goto free; - } - printk("%s aicbt_fw desc:%s \r\n", __func__, aicbt_fw->desc); - break; - default: - printk("%s unsupported sub_chip_id %x\n", __func__, sub_chip_id); - goto free; - break; - } - - if (g_chipid == PRODUCT_ID_AIC8800DC) { - printk("%s [0x40506004]: 0x04318000\r\n", __func__); - ret = rwnx_send_dbg_mem_write_req(fw_info, 0x40506004, 0x04318000); - printk("%s [0x40506004]: 0x04338000\r\n", __func__); - ret = rwnx_send_dbg_mem_write_req(fw_info, 0x40506004, 0x04338000); - if(ret < 0){ - printk("%s set dc enable fail\r\n", __func__); - return ret; - } - } - - if (g_chipid == PRODUCT_ID_AIC8800D80N) { - printk("%s try to exec wf cinit\r\n", __func__); - ret_val = aicbt_wf_cinit_exec(fw_info); - if (ret_val < 0){ - printk("%s wf cinit exec fail, ret_val:%d\r\n", __func__, ret_val); - goto free; - } - printk("%s [0x40506004]: 0x04338000\r\n", __func__); - ret = rwnx_send_dbg_mem_write_req(fw_info, 0x40506004, 0x04338000); - printk("%s [0x40509000] : 0x00040000 \r\n",__func__); - ret = rwnx_send_dbg_mem_write_req(fw_info, 0x40509000, 0x00040000); - } - - //step 1 get patch table data - head = aicbt_patch_table_alloc(aicbt_fw->bt_table); - if (head == NULL){ - printk("aicbt_patch_table_alloc fail\n"); - goto free; - } - //step 2 unpack table data and download patch , ext patch - ret_val = aicbt_patch_trap_data_load(fw_info, head); - if (ret_val) { - printk("aicbt_patch_trap_data_load fail\n"); - goto free; - } - - //step 3 download patch table - ret_val = patch_table_load(fw_info, head); - if (ret_val){ - printk("aic load patch table fail\n"); - goto free; - } - printk("%s download complete\r\n", __func__); - - } - -free: - /* Free fw data after download finished */ - kfree(fw_info->fw_data); - fw_info->fw_data = NULL; - -end: - return ret_val; -} - -//for 8800dc end - -static firmware_info *firmware_info_init(struct usb_interface *intf) -{ - struct usb_device *udev = interface_to_usbdev(intf); - firmware_info *fw_info; - - AICBT_DBG("%s: start", __func__); - - fw_info = kzalloc(sizeof(*fw_info), GFP_KERNEL); - if (!fw_info) - return NULL; - - fw_info->send_pkt = kzalloc(SEND_PKT_LEN, GFP_KERNEL); - if (!fw_info->send_pkt) { - kfree(fw_info); - return NULL; - } - - fw_info->rcv_pkt = kzalloc(RCV_PKT_LEN, GFP_KERNEL); - if (!fw_info->rcv_pkt) { - kfree(fw_info->send_pkt); - kfree(fw_info); - return NULL; - } - - fw_info->intf = intf; - fw_info->udev = udev; - fw_info->pipe_in = usb_rcvintpipe(fw_info->udev, INTR_EP); - fw_info->pipe_out = usb_sndctrlpipe(fw_info->udev, CTRL_EP); - fw_info->cmd_hdr = (struct hci_command_hdr *)(fw_info->send_pkt); - fw_info->evt_hdr = (struct hci_event_hdr *)(fw_info->rcv_pkt); - fw_info->cmd_cmp = (struct hci_ev_cmd_complete *)(fw_info->rcv_pkt + EVT_HDR_LEN); - fw_info->req_para = fw_info->send_pkt + CMD_HDR_LEN; - fw_info->rsp_para = fw_info->rcv_pkt + EVT_HDR_LEN + CMD_CMP_LEN; - -#if BTUSB_RPM - AICBT_INFO("%s: Auto suspend is enabled", __func__); - usb_enable_autosuspend(udev); - pm_runtime_set_autosuspend_delay(&(udev->dev), 2000); -#else - AICBT_INFO("%s: Auto suspend is disabled", __func__); - usb_disable_autosuspend(udev); -#endif - -#if BTUSB_WAKEUP_HOST - device_wakeup_enable(&udev->dev); -#endif - - return fw_info; -} - - -static void firmware_info_destroy(struct usb_interface *intf) -{ - firmware_info *fw_info; - struct usb_device *udev; - struct btusb_data *data; - - udev = interface_to_usbdev(intf); - data = usb_get_intfdata(intf); - - fw_info = data->fw_info; - if (!fw_info) - return; - -#if BTUSB_RPM - usb_disable_autosuspend(udev); -#endif - - /* - * In order to reclaim fw data mem, we free fw_data immediately - * after download patch finished instead of here. - */ - kfree(fw_info->rcv_pkt); - kfree(fw_info->send_pkt); - kfree(fw_info); - - -} - -static struct usb_driver btusb_driver; - -static struct usb_device_id btusb_table[] = { - #if 0 - { .match_flags = USB_DEVICE_ID_MATCH_VENDOR | - USB_DEVICE_ID_MATCH_INT_INFO, - .idVendor = 0xa69d, - .bInterfaceClass = 0xe0, - .bInterfaceSubClass = 0x01, - .bInterfaceProtocol = 0x01 }, - #endif - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_AIC, USB_PRODUCT_ID_AIC8801, 0xe0, 0x01,0x01)}, - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_AIC, USB_PRODUCT_ID_AIC8800D80, 0xe0, 0x01,0x01)}, - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_AIC, USB_PRODUCT_ID_AIC8800DC, 0xe0, 0x01,0x01)}, - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_AIC_V2, USB_PRODUCT_ID_AIC8800D80X2, 0xe0, 0x01,0x01)}, - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_AIC_V2, USB_PRODUCT_ID_AIC8800D80X2P, 0xe0, 0x01,0x01)}, - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_AIC_V2, USB_PRODUCT_ID_AIC8800D80N, 0xe0, 0x01,0x01)}, - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_AIC_V2, USB_PRODUCT_ID_AIC8800D80LN, 0xe0, 0x01,0x01)}, - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_AIC_V2, USB_PRODUCT_ID_AIC8800D40N, 0xe0, 0x01,0x01)}, - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_AIC_V2, USB_PRODUCT_ID_AIC8800D40LN, 0xe0, 0x01,0x01)}, - {USB_DEVICE_AND_INTERFACE_INFO(USB_VENDOR_ID_AIC_V2, USB_PRODUCT_ID_AIC8800DLN, 0xe0, 0x01,0x01)}, - {} -}; - -MODULE_DEVICE_TABLE(usb, btusb_table); - -static int inc_tx(struct btusb_data *data) -{ - unsigned long flags; - int rv; - - spin_lock_irqsave(&data->txlock, flags); - rv = test_bit(BTUSB_SUSPENDING, &data->flags); - if (!rv) - data->tx_in_flight++; - spin_unlock_irqrestore(&data->txlock, flags); - - return rv; -} - -static void check_sco_event(struct urb *urb) -{ - u8* opcode = (u8*)(urb->transfer_buffer); - u8 status; - static uint16_t sco_handle = 0; - uint16_t handle; - u8 air_mode = 0; - struct hci_dev *hdev = urb->context; - - switch (*opcode) { - case HCI_EV_SYNC_CONN_COMPLETE: - AICBT_INFO("%s: HCI_EV_SYNC_CONN_COMPLETE(0x%02x)", __func__, *opcode); - status = *(opcode + 2); - sco_handle = *(opcode + 3) | *(opcode + 4) << 8; - air_mode = *(opcode + 18); - printk("%s status:%d,air_mode:%d \r\n", __func__, status,air_mode); - if (status == 0) { - SCO_NUM++; - if (air_mode == 0x03) { - set_select_msbc(CODEC_MSBC); - hdev->voice_setting = 0x43; - }else{ - hdev->voice_setting = 0x60; - } - hdev->notify(hdev, 0); - //schedule_work(&data->work); - } - break; - case HCI_EV_DISCONN_COMPLETE: - AICBT_INFO("%s: HCI_EV_DISCONN_COMPLETE(0x%02x)", __func__, *opcode); - status = *(opcode + 2); - handle = *(opcode + 3) | *(opcode + 4) << 8; - if (status == 0 && sco_handle == handle) { - SCO_NUM--; - hdev->notify(hdev, 0); - set_select_msbc(CODEC_CVSD); - //schedule_work(&data->work); - } - break; - default: - AICBT_DBG("%s: event 0x%02x", __func__, *opcode); - break; - } -} - -#if (CONFIG_BLUEDROID == 0) -#if HCI_VERSION_CODE >= KERNEL_VERSION(3, 18, 0) -static inline void btusb_free_frags(struct btusb_data *data) -{ - unsigned long flags; - - spin_lock_irqsave(&data->rxlock, flags); - - kfree_skb(data->evt_skb); - data->evt_skb = NULL; - - kfree_skb(data->acl_skb); - data->acl_skb = NULL; - - kfree_skb(data->sco_skb); - data->sco_skb = NULL; - - spin_unlock_irqrestore(&data->rxlock, flags); -} - -static int btusb_recv_intr(struct btusb_data *data, void *buffer, int count) -{ - struct sk_buff *skb; - int err = 0; - - spin_lock(&data->rxlock); - skb = data->evt_skb; - //printk("%s count %d\n", __func__, count); - -#if 1 - while (count) { - int len; - - if (!skb) { - skb = bt_skb_alloc(HCI_MAX_EVENT_SIZE, GFP_ATOMIC); - if (!skb) { - err = -ENOMEM; - break; - } - - bt_cb(skb)->pkt_type = HCI_EVENT_PKT; - bt_cb(skb)->expect = HCI_EVENT_HDR_SIZE; - } - - len = min_t(uint, bt_cb(skb)->expect, count); - memcpy(skb_put(skb, len), buffer, len); - - count -= len; - buffer += len; - bt_cb(skb)->expect -= len; - - if (skb->len == HCI_EVENT_HDR_SIZE) { - /* Complete event header */ - bt_cb(skb)->expect = hci_event_hdr(skb)->plen; - - if (skb_tailroom(skb) < bt_cb(skb)->expect) { - kfree_skb(skb); - skb = NULL; - - err = -EILSEQ; - break; - } - } - - if (bt_cb(skb)->expect == 0) { - /* Complete frame */ - hci_recv_frame(data->hdev, skb); - skb = NULL; - } - } -#endif - - data->evt_skb = skb; - spin_unlock(&data->rxlock); - - return err; -} - -static int btusb_recv_bulk(struct btusb_data *data, void *buffer, int count) -{ - struct sk_buff *skb; - int err = 0; - - spin_lock(&data->rxlock); - skb = data->acl_skb; - - while (count) { - int len; - - if (!skb) { - skb = bt_skb_alloc(HCI_MAX_FRAME_SIZE, GFP_ATOMIC); - if (!skb) { - err = -ENOMEM; - break; - } - - bt_cb(skb)->pkt_type = HCI_ACLDATA_PKT; - bt_cb(skb)->expect = HCI_ACL_HDR_SIZE; - } - - len = min_t(uint, bt_cb(skb)->expect, count); - memcpy(skb_put(skb, len), buffer, len); - - count -= len; - buffer += len; - bt_cb(skb)->expect -= len; - - if (skb->len == HCI_ACL_HDR_SIZE) { - __le16 dlen = hci_acl_hdr(skb)->dlen; - - /* Complete ACL header */ - bt_cb(skb)->expect = __le16_to_cpu(dlen); - - if (skb_tailroom(skb) < bt_cb(skb)->expect) { - kfree_skb(skb); - skb = NULL; - - err = -EILSEQ; - break; - } - } - - if (bt_cb(skb)->expect == 0) { - /* Complete frame */ - hci_recv_frame(data->hdev, skb); - skb = NULL; - } - } - - data->acl_skb = skb; - spin_unlock(&data->rxlock); - - return err; -} - -static int btusb_recv_isoc(struct btusb_data *data, void *buffer, int count) -{ - struct sk_buff *skb; - int err = 0; - - spin_lock(&data->rxlock); - skb = data->sco_skb; - - while (count) { - int len; - - if (!skb) { - skb = bt_skb_alloc(HCI_MAX_SCO_SIZE, GFP_ATOMIC); - if (!skb) { - err = -ENOMEM; - break; - } - - bt_cb(skb)->pkt_type = HCI_SCODATA_PKT; - bt_cb(skb)->expect = HCI_SCO_HDR_SIZE; - } - - len = min_t(uint, bt_cb(skb)->expect, count); - memcpy(skb_put(skb, len), buffer, len); - - count -= len; - buffer += len; - bt_cb(skb)->expect -= len; - - if (skb->len == HCI_SCO_HDR_SIZE) { - /* Complete SCO header */ - bt_cb(skb)->expect = hci_sco_hdr(skb)->dlen; - - if (skb_tailroom(skb) < bt_cb(skb)->expect) { - kfree_skb(skb); - skb = NULL; - - err = -EILSEQ; - break; - } - } - - if (bt_cb(skb)->expect == 0) { - /* Complete frame */ - hci_recv_frame(data->hdev, skb); - skb = NULL; - } - } - - data->sco_skb = skb; - spin_unlock(&data->rxlock); - - return err; -} -#endif -#endif // (CONFIG_BLUEDROID == 0) - - -static void btusb_intr_complete(struct urb *urb) -{ - struct hci_dev *hdev = urb->context; - struct btusb_data *data = GET_DRV_DATA(hdev); - int err; - - AICBT_DBG("%s: urb %p status %d count %d ", __func__, - urb, urb->status, urb->actual_length); - - if (!test_bit(HCI_RUNNING, &hdev->flags)) { - printk("%s return \n", __func__); - return; - } - if (urb->status == 0) { - hdev->stat.byte_rx += urb->actual_length; - -#if (CONFIG_BLUEDROID) || (HCI_VERSION_CODE < KERNEL_VERSION(3, 18, 0)) - if (hci_recv_fragment(hdev, HCI_EVENT_PKT, - urb->transfer_buffer, - urb->actual_length) < 0) { - AICBT_ERR("%s: Corrupted event packet", __func__); - hdev->stat.err_rx++; - } -#else - if (btusb_recv_intr(data, urb->transfer_buffer, - urb->actual_length) < 0) { - AICBT_ERR("%s corrupted event packet", hdev->name); - hdev->stat.err_rx++; - } -#endif - check_sco_event(urb); - } - /* Avoid suspend failed when usb_kill_urb */ - else if(urb->status == -ENOENT) { - return; - } - - - if (!test_bit(BTUSB_INTR_RUNNING, &data->flags)) - return; - - usb_mark_last_busy(data->udev); - usb_anchor_urb(urb, &data->intr_anchor); - - err = usb_submit_urb(urb, GFP_ATOMIC); - if (err < 0) { - if (err != -EPERM && err != -ENODEV) - AICBT_ERR("%s: Failed to re-submit urb %p, err %d", - __func__, urb, err); - usb_unanchor_urb(urb); - } -} - -static int btusb_submit_intr_urb(struct hci_dev *hdev, gfp_t mem_flags) -{ - struct btusb_data *data = GET_DRV_DATA(hdev); - struct urb *urb; - unsigned char *buf; - unsigned int pipe; - int err, size; - - if (!data->intr_ep) - return -ENODEV; - - urb = usb_alloc_urb(0, mem_flags); - if (!urb) - return -ENOMEM; - - size = le16_to_cpu(data->intr_ep->wMaxPacketSize); - - buf = kmalloc(size, mem_flags); - if (!buf) { - usb_free_urb(urb); - return -ENOMEM; - } - - AICBT_DBG("%s: mMaxPacketSize %d, bEndpointAddress 0x%02x", - __func__, size, data->intr_ep->bEndpointAddress); - - pipe = usb_rcvintpipe(data->udev, data->intr_ep->bEndpointAddress); - - usb_fill_int_urb(urb, data->udev, pipe, buf, size, - btusb_intr_complete, hdev, - data->intr_ep->bInterval); - - urb->transfer_flags |= URB_FREE_BUFFER; - - usb_anchor_urb(urb, &data->intr_anchor); - - err = usb_submit_urb(urb, mem_flags); - if (err < 0) { - AICBT_ERR("%s: Failed to submit urb %p, err %d", - __func__, urb, err); - usb_unanchor_urb(urb); - } - - usb_free_urb(urb); - - return err; -} - -static void btusb_bulk_complete(struct urb *urb) -{ - struct hci_dev *hdev = urb->context; - struct btusb_data *data = GET_DRV_DATA(hdev); - int err; - - AICBT_DBG("%s: urb %p status %d count %d", - __func__, urb, urb->status, urb->actual_length); - - if (!test_bit(HCI_RUNNING, &hdev->flags)) { - printk("%s HCI_RUNNING\n", __func__); - return; - } - if (urb->status == 0) { - hdev->stat.byte_rx += urb->actual_length; - -#if (CONFIG_BLUEDROID) || (HCI_VERSION_CODE < KERNEL_VERSION(3, 18, 0)) - if (hci_recv_fragment(hdev, HCI_ACLDATA_PKT, - urb->transfer_buffer, - urb->actual_length) < 0) { - AICBT_ERR("%s: Corrupted ACL packet", __func__); - hdev->stat.err_rx++; - } -#else - if (data->recv_bulk(data, urb->transfer_buffer, - urb->actual_length) < 0) { - AICBT_ERR("%s Corrupted ACL packet", hdev->name); - hdev->stat.err_rx++; - } -#endif - - } - /* Avoid suspend failed when usb_kill_urb */ - else if(urb->status == -ENOENT) { - printk("%s ENOENT\n", __func__); - return; - } - AICBT_DBG("%s: OUT", __func__); - - if (!test_bit(BTUSB_BULK_RUNNING, &data->flags)) { - printk("%s BTUSB_BULK_RUNNING\n", __func__); - return; - } - usb_anchor_urb(urb, &data->bulk_anchor); - usb_mark_last_busy(data->udev); - - //printk("LIULI bulk submit\n"); - err = usb_submit_urb(urb, GFP_ATOMIC); - if (err < 0) { - /* -EPERM: urb is being killed; - * -ENODEV: device got disconnected */ - if (err != -EPERM && err != -ENODEV) - AICBT_ERR("btusb_bulk_complete %s urb %p failed to resubmit (%d)", - hdev->name, urb, -err); - usb_unanchor_urb(urb); - } -} - -static int btusb_submit_bulk_urb(struct hci_dev *hdev, gfp_t mem_flags) -{ - struct btusb_data *data = GET_DRV_DATA(hdev); - struct urb *urb; - unsigned char *buf; - unsigned int pipe; - int err, size = HCI_MAX_FRAME_SIZE; - - AICBT_DBG("%s: hdev name %s", __func__, hdev->name); - AICBT_DBG("%s: mMaxPacketSize %d, bEndpointAddress 0x%02x", - __func__, size, data->bulk_rx_ep->bEndpointAddress); - - if (!data->bulk_rx_ep) - return -ENODEV; - - urb = usb_alloc_urb(0, mem_flags); - if (!urb) - return -ENOMEM; - - buf = kmalloc(size, mem_flags); - if (!buf) { - usb_free_urb(urb); - return -ENOMEM; - } - - pipe = usb_rcvbulkpipe(data->udev, data->bulk_rx_ep->bEndpointAddress); - - usb_fill_bulk_urb(urb, data->udev, pipe, - buf, size, btusb_bulk_complete, hdev); - - urb->transfer_flags |= URB_FREE_BUFFER; - - usb_mark_last_busy(data->udev); - usb_anchor_urb(urb, &data->bulk_anchor); - - err = usb_submit_urb(urb, mem_flags); - if (err < 0) { - AICBT_ERR("%s: Failed to submit urb %p, err %d", __func__, urb, err); - usb_unanchor_urb(urb); - } - - usb_free_urb(urb); - - return err; -} - -static void btusb_isoc_complete(struct urb *urb) -{ - struct hci_dev *hdev = urb->context; - struct btusb_data *data = GET_DRV_DATA(hdev); - int i, err; - unsigned int total_length = 0; - - AICBT_DBG("%s: urb %p status %d count %d", - __func__, urb, urb->status, urb->actual_length); - - if (!test_bit(HCI_RUNNING, &hdev->flags)) - return; - - if (urb->status == 0) { - for (i = 0; i < urb->number_of_packets; i++) { - unsigned int offset = urb->iso_frame_desc[i].offset; - unsigned int length = urb->iso_frame_desc[i].actual_length; - //u8 *data = (u8 *)(urb->transfer_buffer + offset); - //AICBT_DBG("%d,%d ,%x,%x,%x s %d.", - //offset, length, data[0], data[1],data[2],urb->iso_frame_desc[i].status); - - if(total_length >= urb->actual_length){ - AICBT_ERR("total_len >= actual_length ,return"); - break; - } - total_length += length; - - if (urb->iso_frame_desc[i].status) - continue; - - hdev->stat.byte_rx += length; - if(length){ -#if (CONFIG_BLUEDROID) || (HCI_VERSION_CODE < KERNEL_VERSION(3, 18, 0)) - if (hci_recv_fragment(hdev, HCI_SCODATA_PKT, - urb->transfer_buffer + offset, - length) < 0) { - AICBT_ERR("%s: Corrupted SCO packet", __func__); - hdev->stat.err_rx++; - } -#else - if (btusb_recv_isoc(data, urb->transfer_buffer + offset, - length) < 0) { - AICBT_ERR("%s corrupted SCO packet", - hdev->name); - hdev->stat.err_rx++; - } -#endif - - } - } - } - /* Avoid suspend failed when usb_kill_urb */ - else if(urb->status == -ENOENT) { - return; - } - - - if (!test_bit(BTUSB_ISOC_RUNNING, &data->flags)) - return; - - usb_anchor_urb(urb, &data->isoc_anchor); - i = 0; -retry: - err = usb_submit_urb(urb, GFP_ATOMIC); - if (err < 0) { - /* -EPERM: urb is being killed; - * -ENODEV: device got disconnected */ - if (err != -EPERM && err != -ENODEV) - AICBT_ERR("%s: Failed to re-sumbit urb %p, retry %d, err %d", - __func__, urb, i, err); - if (i < 10) { - i++; - mdelay(1); - goto retry; - } - - usb_unanchor_urb(urb); - } -} - -static inline void fill_isoc_descriptor(struct urb *urb, int len, int mtu) -{ - int i, offset = 0; - - AICBT_DBG("%s: len %d mtu %d", __func__, len, mtu); - - for (i = 0; i < BTUSB_MAX_ISOC_FRAMES && len >= mtu; - i++, offset += mtu, len -= mtu) { - urb->iso_frame_desc[i].offset = offset; - urb->iso_frame_desc[i].length = mtu; - } - - if (len && i < BTUSB_MAX_ISOC_FRAMES) { - urb->iso_frame_desc[i].offset = offset; - urb->iso_frame_desc[i].length = len; - i++; - } - - urb->number_of_packets = i; -} - -static int btusb_submit_isoc_urb(struct hci_dev *hdev, gfp_t mem_flags) -{ - struct btusb_data *data = GET_DRV_DATA(hdev); - struct urb *urb; - unsigned char *buf; - unsigned int pipe; - int err, size; - int interval; - - if (!data->isoc_rx_ep) - return -ENODEV; - AICBT_DBG("%s: mMaxPacketSize %d, bEndpointAddress 0x%02x", - __func__, size, data->isoc_rx_ep->bEndpointAddress); - - urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, mem_flags); - if (!urb) - return -ENOMEM; - - size = le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize) * - BTUSB_MAX_ISOC_FRAMES; - - buf = kmalloc(size, mem_flags); - if (!buf) { - usb_free_urb(urb); - return -ENOMEM; - } - - pipe = usb_rcvisocpipe(data->udev, data->isoc_rx_ep->bEndpointAddress); - - urb->dev = data->udev; - urb->pipe = pipe; - urb->context = hdev; - urb->complete = btusb_isoc_complete; - if (urb->dev->speed == USB_SPEED_HIGH || urb->dev->speed >= USB_SPEED_SUPER) { - /* make sure interval is within allowed range */ - interval = clamp((int)data->isoc_rx_ep->bInterval, 1, 16); - urb->interval = 1 << (interval - 1); - } else { - urb->interval = data->isoc_rx_ep->bInterval; - } - - AICBT_INFO("urb->interval %d \r\n", urb->interval); - - urb->transfer_flags = URB_FREE_BUFFER | URB_ISO_ASAP; - urb->transfer_buffer = buf; - urb->transfer_buffer_length = size; - - fill_isoc_descriptor(urb, size, - le16_to_cpu(data->isoc_rx_ep->wMaxPacketSize)); - - usb_anchor_urb(urb, &data->isoc_anchor); - - err = usb_submit_urb(urb, mem_flags); - if (err < 0) { - AICBT_ERR("%s: Failed to submit urb %p, err %d", __func__, urb, err); - usb_unanchor_urb(urb); - } - - usb_free_urb(urb); - - return err; -} - -static void btusb_tx_complete(struct urb *urb) -{ - struct sk_buff *skb = urb->context; - struct hci_dev *hdev = (struct hci_dev *) skb->dev; - struct btusb_data *data = GET_DRV_DATA(hdev); - - if (!test_bit(HCI_RUNNING, &hdev->flags)) - goto done; - - if (!urb->status) - hdev->stat.byte_tx += urb->transfer_buffer_length; - else - hdev->stat.err_tx++; - -done: - spin_lock(&data->txlock); - data->tx_in_flight--; - spin_unlock(&data->txlock); - - kfree(urb->setup_packet); - - kfree_skb(skb); -} - -static void btusb_isoc_tx_complete(struct urb *urb) -{ - struct sk_buff *skb = urb->context; - struct hci_dev *hdev = (struct hci_dev *) skb->dev; - - AICBT_DBG("%s: urb %p status %d count %d", - __func__, urb, urb->status, urb->actual_length); - - if (skb && hdev) { - if (!test_bit(HCI_RUNNING, &hdev->flags)) - goto done; - - if (!urb->status) - hdev->stat.byte_tx += urb->transfer_buffer_length; - else - hdev->stat.err_tx++; - } else - AICBT_ERR("%s: skb 0x%p hdev 0x%p", __func__, skb, hdev); - -done: - kfree(urb->setup_packet); - - kfree_skb(skb); -} - -#if (CONFIG_BLUEDROID == 0) -#if LINUX_VERSION_CODE > KERNEL_VERSION(4, 0, 9) -static int btusb_shutdown(struct hci_dev *hdev) -{ - struct sk_buff *skb; - printk("aic %s\n", __func__); - - skb = __hci_cmd_sync(hdev, HCI_OP_RESET, 0, NULL, HCI_INIT_TIMEOUT); - if (IS_ERR(skb)) { - printk("HCI reset during shutdown failed\n"); - return PTR_ERR(skb); - } - kfree_skb(skb); - - return 0; -} -#endif -#endif //(CONFIG_BLUEDROID == 0) - -static int btusb_open(struct hci_dev *hdev) -{ - struct btusb_data *data = GET_DRV_DATA(hdev); - int err = 0; - - AICBT_INFO("%s: Start", __func__); - - err = usb_autopm_get_interface(data->intf); - if (err < 0) - return err; - - data->intf->needs_remote_wakeup = 1; - -#if (CONFIG_BLUEDROID == 0) - //err = download_patch(data->fw_info,1); - printk(" download_patch %d", err); - if (err < 0) { - goto failed; - } -#endif - - - if (test_and_set_bit(HCI_RUNNING, &hdev->flags)){ - goto done; - } - - if (test_and_set_bit(BTUSB_INTR_RUNNING, &data->flags)){ - goto done; - } - - err = btusb_submit_intr_urb(hdev, GFP_KERNEL); - if (err < 0) - goto failed; - - err = btusb_submit_bulk_urb(hdev, GFP_KERNEL); - if (err < 0) { - mdelay(URB_CANCELING_DELAY_MS); - usb_kill_anchored_urbs(&data->intr_anchor); - goto failed; - } - - set_bit(BTUSB_BULK_RUNNING, &data->flags); - btusb_submit_bulk_urb(hdev, GFP_KERNEL); - -done: - usb_autopm_put_interface(data->intf); - AICBT_INFO("%s: End", __func__); - return 0; - -failed: - clear_bit(BTUSB_INTR_RUNNING, &data->flags); - clear_bit(HCI_RUNNING, &hdev->flags); - usb_autopm_put_interface(data->intf); - AICBT_ERR("%s: Failed", __func__); - return err; -} - -static void btusb_stop_traffic(struct btusb_data *data) -{ - mdelay(URB_CANCELING_DELAY_MS); - usb_kill_anchored_urbs(&data->intr_anchor); - usb_kill_anchored_urbs(&data->bulk_anchor); - usb_kill_anchored_urbs(&data->isoc_anchor); -} - -static int btusb_close(struct hci_dev *hdev) -{ - struct btusb_data *data = GET_DRV_DATA(hdev); -#if (CONFIG_BLUEDROID) || (HCI_VERSION_CODE < KERNEL_VERSION(4, 1, 0)) - int i; -#endif - int err; -#ifdef CONFIG_BT_WAKEUP_IN_PM - firmware_info *fw_info; - fw_info = data->fw_info; -#endif - AICBT_INFO("%s: hci running %lu", __func__, hdev->flags & HCI_RUNNING); - - if (!test_and_clear_bit(HCI_RUNNING, &hdev->flags)){ - return 0; - } - - if (!test_and_clear_bit(BTUSB_INTR_RUNNING, &data->flags)){ - return 0; - } - -#if (CONFIG_BLUEDROID) || (HCI_VERSION_CODE < KERNEL_VERSION(4, 1, 0)) - for (i = 0; i < NUM_REASSEMBLY; i++) { - if (hdev->reassembly[i]) { - AICBT_DBG("%s: free ressembly[%d]", __func__, i); - kfree_skb(hdev->reassembly[i]); - hdev->reassembly[i] = NULL; - } - } -#endif - - cancel_work_sync(&data->work); - cancel_work_sync(&data->waker); - - clear_bit(BTUSB_ISOC_RUNNING, &data->flags); - clear_bit(BTUSB_BULK_RUNNING, &data->flags); - clear_bit(BTUSB_INTR_RUNNING, &data->flags); - - btusb_stop_traffic(data); - err = usb_autopm_get_interface(data->intf); - if (err < 0) - goto failed; - - data->intf->needs_remote_wakeup = 0; - usb_autopm_put_interface(data->intf); - -failed: - mdelay(URB_CANCELING_DELAY_MS); - usb_scuttle_anchored_urbs(&data->deferred); - #ifdef CONFIG_BT_WAKEUP_IN_PM - { - set_bt_ad_filetr_en_param(fw_info); - } - #endif - return 0; -} - -static int btusb_flush(struct hci_dev *hdev) -{ - struct btusb_data *data = GET_DRV_DATA(hdev); - - AICBT_DBG("%s", __func__); - - mdelay(URB_CANCELING_DELAY_MS); - usb_kill_anchored_urbs(&data->tx_anchor); - - return 0; -} - - -#if (CONFIG_BLUEDROID) || (HCI_VERSION_CODE < KERNEL_VERSION(3, 13, 0)) -static int btusb_send_frame(struct sk_buff *skb) -{ - struct hci_dev *hdev = (struct hci_dev *) skb->dev; -#else -static int btusb_send_frame(struct hci_dev *hdev, struct sk_buff *skb) -{ -#endif - //struct hci_dev *hdev = (struct hci_dev *) skb->dev; - - struct btusb_data *data = GET_DRV_DATA(hdev); - struct usb_ctrlrequest *dr; - struct urb *urb; - unsigned int pipe; - int err = 0; - int retries = 0; - u16 *opcode = NULL; - - AICBT_DBG("%s: hdev %p, btusb data %p, pkt type %d", - __func__, hdev, data, bt_cb(skb)->pkt_type); - - //printk("aic %d %d\r\n", bt_cb(skb)->pkt_type, skb->len); - if (!test_bit(HCI_RUNNING, &hdev->flags)) - return -EBUSY; - -#if (CONFIG_BLUEDROID == 0) -#if HCI_VERSION_CODE >= KERNEL_VERSION(3, 13, 0) - skb->dev = (void *)hdev; -#endif -#endif - - switch (bt_cb(skb)->pkt_type) { - case HCI_COMMAND_PKT: - print_command(skb); - urb = usb_alloc_urb(0, GFP_ATOMIC); - if (!urb) - return -ENOMEM; - - dr = kmalloc(sizeof(*dr), GFP_ATOMIC); - if (!dr) { - usb_free_urb(urb); - return -ENOMEM; - } - - dr->bRequestType = data->cmdreq_type; - dr->bRequest = 0; - dr->wIndex = 0; - dr->wValue = 0; - dr->wLength = __cpu_to_le16(skb->len); - - pipe = usb_sndctrlpipe(data->udev, 0x00); - - usb_fill_control_urb(urb, data->udev, pipe, (void *) dr, - skb->data, skb->len, btusb_tx_complete, skb); - - hdev->stat.cmd_tx++; - break; - - case HCI_ACLDATA_PKT: - if (bt_cb(skb)->pkt_type == HCI_COMMAND_PKT) { - print_command(skb); - opcode = (u16*)(skb->data); - printk("aic cmd:0x%04x", *opcode); - } else { - print_acl(skb, 1); - } - if (!data->bulk_tx_ep) - return -ENODEV; - - urb = usb_alloc_urb(0, GFP_ATOMIC); - if (!urb) - return -ENOMEM; - - pipe = usb_sndbulkpipe(data->udev, - data->bulk_tx_ep->bEndpointAddress); - - usb_fill_bulk_urb(urb, data->udev, pipe, - skb->data, skb->len, btusb_tx_complete, skb); - urb->transfer_flags |= URB_ZERO_PACKET; - - hdev->stat.acl_tx++; - break; - - case HCI_SCODATA_PKT: - print_sco(skb, 1); - if (!data->isoc_tx_ep || !SCO_NUM) { - kfree(skb); - return -ENODEV; - } - - urb = usb_alloc_urb(BTUSB_MAX_ISOC_FRAMES, GFP_ATOMIC); - if (!urb) { - AICBT_ERR("%s: Failed to allocate mem for sco pkts", __func__); - kfree(skb); - return -ENOMEM; - } - - pipe = usb_sndisocpipe(data->udev, data->isoc_tx_ep->bEndpointAddress); - - usb_fill_int_urb(urb, data->udev, pipe, - skb->data, skb->len, btusb_isoc_tx_complete, - skb, data->isoc_tx_ep->bInterval); - - urb->transfer_flags = URB_ISO_ASAP; - - fill_isoc_descriptor(urb, skb->len, - le16_to_cpu(data->isoc_tx_ep->wMaxPacketSize)); - - hdev->stat.sco_tx++; - goto skip_waking; - - default: - return -EILSEQ; - } - - err = inc_tx(data); - if (err) { - usb_anchor_urb(urb, &data->deferred); - schedule_work(&data->waker); - err = 0; - goto done; - } - -skip_waking: - usb_anchor_urb(urb, &data->tx_anchor); -retry: - err = usb_submit_urb(urb, GFP_ATOMIC); - if (err < 0) { - AICBT_ERR("%s: Failed to submit urb %p, pkt type %d, err %d, retries %d", - __func__, urb, bt_cb(skb)->pkt_type, err, retries); - if ((bt_cb(skb)->pkt_type != HCI_SCODATA_PKT) && (retries < 10)) { - mdelay(1); - - if (bt_cb(skb)->pkt_type == HCI_COMMAND_PKT) - print_error_command(skb); - retries++; - goto retry; - } - kfree(urb->setup_packet); - usb_unanchor_urb(urb); - } else{ - - usb_mark_last_busy(data->udev); - } - usb_free_urb(urb); - -done: - return err; -} - -#if LINUX_VERSION_CODE <= KERNEL_VERSION(3, 4, 0) -static void btusb_destruct(struct hci_dev *hdev) -{ - struct btusb_data *data = GET_DRV_DATA(hdev); - - AICBT_DBG("%s: name %s", __func__, hdev->name); - - kfree(data); -} -#endif - -static void btusb_notify(struct hci_dev *hdev, unsigned int evt) -{ - struct btusb_data *data = GET_DRV_DATA(hdev); - - AICBT_DBG("%s: name %s, evt %d", __func__, hdev->name, evt); - - if (SCO_NUM != data->sco_num) { - data->sco_num = SCO_NUM; - schedule_work(&data->work); - } -} - -static inline int set_isoc_interface(struct hci_dev *hdev, int altsetting) -{ - struct btusb_data *data = GET_DRV_DATA(hdev); - struct usb_interface *intf = data->isoc; - struct usb_endpoint_descriptor *ep_desc; - int i, err; - - if (!data->isoc) - return -ENODEV; - - err = usb_set_interface(data->udev, 1, altsetting); - if (err < 0) { - AICBT_ERR("%s: Failed to set interface, altsetting %d, err %d", - __func__, altsetting, err); - return err; - } - - data->isoc_altsetting = altsetting; - - data->isoc_tx_ep = NULL; - data->isoc_rx_ep = NULL; - - for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) { - ep_desc = &intf->cur_altsetting->endpoint[i].desc; - - if (!data->isoc_tx_ep && usb_endpoint_is_isoc_out(ep_desc)) { - data->isoc_tx_ep = ep_desc; - continue; - } - - if (!data->isoc_rx_ep && usb_endpoint_is_isoc_in(ep_desc)) { - data->isoc_rx_ep = ep_desc; - continue; - } - } - - if (!data->isoc_tx_ep || !data->isoc_rx_ep) { - AICBT_ERR("%s: Invalid SCO descriptors", __func__); - return -ENODEV; - } - - AICBT_ERR("%s: hdev->reassembly implemant\r\n", - __func__); - -#if CONFIG_BLUEDROID - if(hdev->reassembly[HCI_SCODATA_PKT - 1]) { - kfree_skb(hdev->reassembly[HCI_SCODATA_PKT - 1]); - hdev->reassembly[HCI_SCODATA_PKT - 1] = NULL; - } -#endif - return 0; -} - -static void set_select_msbc(enum CODEC_TYPE type) -{ - printk("%s codec type = %d", __func__, (int)type); - codec_type = type; -} - -static enum CODEC_TYPE check_select_msbc(void) -{ - return codec_type; -} - -static void btusb_work(struct work_struct *work) -{ - struct btusb_data *data = container_of(work, struct btusb_data, work); - struct hci_dev *hdev = data->hdev; - int err; - int new_alts; - printk("%s data->sco_num:%d \r\n", __func__, data->sco_num); - - if (data->sco_num > 0) { - if (!test_bit(BTUSB_DID_ISO_RESUME, &data->flags)) { - err = usb_autopm_get_interface(data->isoc ? data->isoc : data->intf); - if (err < 0) { - clear_bit(BTUSB_ISOC_RUNNING, &data->flags); - mdelay(URB_CANCELING_DELAY_MS); - usb_kill_anchored_urbs(&data->isoc_anchor); - printk("%s usb_kill_anchored_urbs after \r\n", __func__); - return; - } - - set_bit(BTUSB_DID_ISO_RESUME, &data->flags); - } - - AICBT_INFO("%s voice settings = 0x%04x", __func__, hdev->voice_setting); - if (!(hdev->voice_setting & 0x0003)) { - if(data->sco_num == 1) - if(check_select_msbc()) { - new_alts = 1; - } else { - new_alts = 2; - } - else { - AICBT_INFO("%s: we don't support mutiple sco link for cvsd", __func__); - return; - } - } else{ - if(check_select_msbc()) { - if(data->sco_num == 1) - new_alts = 1; - else { - AICBT_INFO("%s: we don't support mutiple sco link for msbc", __func__); - return; - } - } else { - new_alts = 2; - } - } - if (data->isoc_altsetting != new_alts) { - - clear_bit(BTUSB_ISOC_RUNNING, &data->flags); - mdelay(URB_CANCELING_DELAY_MS); - usb_kill_anchored_urbs(&data->isoc_anchor); - - printk("%s set_isoc_interface in \r\n", __func__); - if (set_isoc_interface(hdev, new_alts) < 0) - return; - - } - - printk("%s set_isoc_interface out \r\n", __func__); - - if (!test_and_set_bit(BTUSB_ISOC_RUNNING, &data->flags)) { - printk("%s btusb_submit_isoc_urb\r\n", __func__); - if (btusb_submit_isoc_urb(hdev, GFP_KERNEL) < 0) - clear_bit(BTUSB_ISOC_RUNNING, &data->flags); - else - btusb_submit_isoc_urb(hdev, GFP_KERNEL); - } - } else { - AICBT_INFO("%s: data->sco_num :%d", __func__, data->sco_num); - clear_bit(BTUSB_ISOC_RUNNING, &data->flags); - mdelay(URB_CANCELING_DELAY_MS); - usb_kill_anchored_urbs(&data->isoc_anchor); - - set_isoc_interface(hdev, 0); - if (test_and_clear_bit(BTUSB_DID_ISO_RESUME, &data->flags)) - usb_autopm_put_interface(data->isoc ? data->isoc : data->intf); - } -} - -static void btusb_waker(struct work_struct *work) -{ - struct btusb_data *data = container_of(work, struct btusb_data, waker); - int err; - - AICBT_DBG("%s", __func__); - - err = usb_autopm_get_interface(data->intf); - if (err < 0) - return; - - usb_autopm_put_interface(data->intf); -} - -static int bt_pm_notify(struct notifier_block *notifier, ulong pm_event, void *unused) -{ - struct btusb_data *data; - firmware_info *fw_info; - struct usb_device *udev; - - AICBT_INFO("%s: pm event %ld", __func__, pm_event); - - data = container_of(notifier, struct btusb_data, pm_notifier); - fw_info = data->fw_info; - udev = fw_info->udev; - - switch (pm_event) { - case PM_SUSPEND_PREPARE: - case PM_HIBERNATION_PREPARE: -#if 0 - patch_entry->fw_len = load_firmware(fw_info, &patch_entry->fw_cache); - if (patch_entry->fw_len <= 0) { - /* We may encount failure in loading firmware, just give a warning */ - AICBT_WARN("%s: Failed to load firmware", __func__); - } -#endif - if (!device_may_wakeup(&udev->dev)) { -#if (CONFIG_RESET_RESUME || CONFIG_BLUEDROID) -#ifdef CONFIG_BT_WAKEUP_IN_PM - set_bt_ad_filetr_en_param(fw_info); -#endif//CONFIG_BT_WAKEUP_IN_PM - AICBT_INFO("%s:remote wakeup not supported, reset resume supported", __func__); -#else - fw_info->intf->needs_binding = 1; - AICBT_INFO("%s:remote wakeup not supported, binding needed", __func__); -#endif - } - break; - - case PM_POST_SUSPEND: - case PM_POST_HIBERNATION: - case PM_POST_RESTORE: -#if 0 - /* Reclaim fw buffer when bt usb resumed */ - if (patch_entry->fw_len > 0) { - kfree(patch_entry->fw_cache); - patch_entry->fw_cache = NULL; - patch_entry->fw_len = 0; - } -#endif - -#if BTUSB_RPM - usb_disable_autosuspend(udev); - usb_enable_autosuspend(udev); - pm_runtime_set_autosuspend_delay(&(udev->dev), 2000); -#endif - break; - - default: - break; - } - - return NOTIFY_DONE; -} - -static int bt_reboot_notify(struct notifier_block *notifier, ulong pm_event, void *unused) -{ - struct btusb_data *data; - firmware_info *fw_info; - struct usb_device *udev; - int ret = 0; - AICBT_INFO("%s: pm event %ld", __func__, pm_event); - - data = container_of(notifier, struct btusb_data, reboot_notifier); - fw_info = data->fw_info; - udev = fw_info->udev; - - - switch (pm_event) { - case SYS_DOWN: - AICBT_DBG("%s:system down or restart", __func__); - break; - - case SYS_HALT: - case SYS_POWER_OFF: - { -#ifdef CONFIG_BT_WAKEUP_IN_PM - cancel_work_sync(&data->work); - - btusb_stop_traffic(data); - mdelay(URB_CANCELING_DELAY_MS); - usb_kill_anchored_urbs(&data->tx_anchor); - - set_bt_ad_filetr_en_param(fw_info); - ret = aic_cmd_disable_scan(fw_info); - AICBT_ERR("%s disable scan err %x\n", __func__, ret); - aic_cmd_disconnect_all_store_acl_handle(fw_info); - set_bt_wakeup_param(fw_info); - aic_clear_queue(); -#endif - AICBT_DBG("%s:system halt or power off", __func__); - } - break; - - default: - break; - } - - return NOTIFY_DONE; -} - - -static int aicwf_usb_chipmatch(u16 vid, u16 pid){ - - if(pid == USB_PRODUCT_ID_AIC8801){ - g_chipid = PRODUCT_ID_AIC8801; - printk("%s USE AIC8801\r\n", __func__); - return 0; - }else if(pid == USB_PRODUCT_ID_AIC8800DC){ - g_chipid = PRODUCT_ID_AIC8800DC; - printk("%s USE AIC8800DC\r\n", __func__); - return 0; - }else if(pid == USB_PRODUCT_ID_AIC8800D80){ - g_chipid = PRODUCT_ID_AIC8800D80; - printk("%s USE AIC8800D80\r\n", __func__); - return 0; - }else if((pid == USB_PRODUCT_ID_AIC8800D80X2) || (pid == USB_PRODUCT_ID_AIC8800D80X2P)){ - g_chipid = PRODUCT_ID_AIC8800D80X2; - printk("%s USE AIC8800D80X2\r\n", __func__); - return 0; - }else if((pid == USB_PRODUCT_ID_AIC8800D80N) || - (pid == USB_PRODUCT_ID_AIC8800D80LN) || - (pid == USB_PRODUCT_ID_AIC8800D40N) || - (pid == USB_PRODUCT_ID_AIC8800D40LN)){ - g_chipid = PRODUCT_ID_AIC8800D80N; - printk("%s USE AIC8800D80N\r\n", __func__); - return 0; - }else if(pid == USB_PRODUCT_ID_AIC8800DLN){ - g_chipid = PRODUCT_ID_AIC8800DLN; - printk("%s USE AIC8800DLN\r\n", __func__); - return 0; - }else{ - return -1; - } -} - - -static int btusb_probe(struct usb_interface *intf, const struct usb_device_id *id) -{ - struct usb_device *udev = interface_to_usbdev(intf); - struct usb_endpoint_descriptor *ep_desc; - u8 endpoint_num; - struct btusb_data *data; - struct hci_dev *hdev; - firmware_info *fw_info; - int i, err=0; - - bt_support = 1; - - AICBT_INFO("%s: usb_interface %p, bInterfaceNumber %d, idVendor 0x%04x, " - "idProduct 0x%04x", __func__, intf, - intf->cur_altsetting->desc.bInterfaceNumber, - id->idVendor, id->idProduct); - - aicwf_usb_chipmatch(id->idVendor, id->idProduct); - - /* interface numbers are hardcoded in the spec */ - if (intf->cur_altsetting->desc.bInterfaceNumber != 0) - return -ENODEV; - - AICBT_DBG("%s: can wakeup = %x, may wakeup = %x", __func__, - device_can_wakeup(&udev->dev), device_may_wakeup(&udev->dev)); - - data = aic_alloc(intf); - if (!data) - return -ENOMEM; - - for (i = 0; i < intf->cur_altsetting->desc.bNumEndpoints; i++) { - ep_desc = &intf->cur_altsetting->endpoint[i].desc; - - endpoint_num = usb_endpoint_num(ep_desc); - printk("endpoint num %d\n", endpoint_num); - - if (!data->intr_ep && usb_endpoint_is_int_in(ep_desc)) { - data->intr_ep = ep_desc; - continue; - } - - if (!data->bulk_tx_ep && usb_endpoint_is_bulk_out(ep_desc)) { - data->bulk_tx_ep = ep_desc; - continue; - } - - if (!data->bulk_rx_ep && usb_endpoint_is_bulk_in(ep_desc)) { - data->bulk_rx_ep = ep_desc; - continue; - } - } - - if (!data->intr_ep || !data->bulk_tx_ep || !data->bulk_rx_ep) { - aic_free(data); - return -ENODEV; - } - - data->cmdreq_type = USB_TYPE_CLASS; - - data->udev = udev; - data->intf = intf; - - dlfw_dis_state = 0; - spin_lock_init(&queue_lock); - spin_lock_init(&dlfw_lock); - spin_lock_init(&data->lock); - - INIT_WORK(&data->work, btusb_work); - INIT_WORK(&data->waker, btusb_waker); - spin_lock_init(&data->txlock); - - init_usb_anchor(&data->tx_anchor); - init_usb_anchor(&data->intr_anchor); - init_usb_anchor(&data->bulk_anchor); - init_usb_anchor(&data->isoc_anchor); - init_usb_anchor(&data->deferred); - -#if (CONFIG_BLUEDROID == 0) -#if HCI_VERSION_CODE >= KERNEL_VERSION(3, 18, 0) - spin_lock_init(&data->rxlock); - data->recv_bulk = btusb_recv_bulk; -#endif -#endif - - - fw_info = firmware_info_init(intf); - if (fw_info) - data->fw_info = fw_info; - else { - AICBT_WARN("%s: Failed to initialize fw info", __func__); - /* Skip download patch */ - goto end; - } - - AICBT_INFO("%s: download begining...", __func__); - -#if CONFIG_BLUEDROID - mutex_lock(&btchr_mutex); -#endif - if(g_chipid == PRODUCT_ID_AIC8800DC || g_chipid == PRODUCT_ID_AIC8800D80N){ - err = download_patch(data->fw_info,1); - } - -#if CONFIG_BLUEDROID - mutex_unlock(&btchr_mutex); -#endif - - AICBT_INFO("%s: download ending...", __func__); - if (err < 0) { - return err; - } - - - hdev = hci_alloc_dev(); - if (!hdev) { - aic_free(data); - data = NULL; - return -ENOMEM; - } - - HDEV_BUS = HCI_USB; - - data->hdev = hdev; - - SET_HCIDEV_DEV(hdev, &intf->dev); - - hdev->open = btusb_open; - hdev->close = btusb_close; - hdev->flush = btusb_flush; - hdev->send = btusb_send_frame; - hdev->notify = btusb_notify; -#if (CONFIG_BLUEDROID == 0) -#if LINUX_VERSION_CODE > KERNEL_VERSION(4, 0, 9) - hdev->shutdown = btusb_shutdown; -#endif -#endif //(CONFIG_BLUEDROIF == 0) - -#if LINUX_VERSION_CODE > KERNEL_VERSION(3, 4, 0) - hci_set_drvdata(hdev, data); -#else - hdev->driver_data = data; - hdev->destruct = btusb_destruct; - hdev->owner = THIS_MODULE; -#endif - -#if LINUX_VERSION_CODE >= KERNEL_VERSION(3, 7, 1) - if (!reset_on_close){ - /* set_bit(HCI_QUIRK_RESET_ON_CLOSE, &hdev->quirks); */ - AICBT_DBG("%s: Set HCI_QUIRK_RESET_ON_CLOSE", __func__); - } -#endif - - /* Interface numbers are hardcoded in the specification */ - data->isoc = usb_ifnum_to_if(data->udev, 1); - if (data->isoc) { - err = usb_driver_claim_interface(&btusb_driver, - data->isoc, data); - if (err < 0) { - hci_free_dev(hdev); - hdev = NULL; - aic_free(data); - data = NULL; - return err; - } - } - - err = hci_register_dev(hdev); - if (err < 0) { - hci_free_dev(hdev); - hdev = NULL; - aic_free(data); - data = NULL; - return err; - } - - usb_set_intfdata(intf, data); - -//#ifdef CONFIG_HAS_EARLYSUSPEND -#if 0 - data->early_suspend.level = EARLY_SUSPEND_LEVEL_BLANK_SCREEN; - data->early_suspend.suspend = btusb_early_suspend; - data->early_suspend.resume = btusb_late_resume; - register_early_suspend(&data->early_suspend); -#else - data->pm_notifier.notifier_call = bt_pm_notify; - data->reboot_notifier.notifier_call = bt_reboot_notify; - register_pm_notifier(&data->pm_notifier); - register_reboot_notifier(&data->reboot_notifier); -#endif - -#if CONFIG_BLUEDROID - AICBT_INFO("%s: Check bt reset flag %d", __func__, bt_reset); - /* Report hci hardware error after everthing is ready, - * especially hci register is completed. Or, btchr_poll - * will get null hci dev when hotplug in. - */ - if (bt_reset == 1) { - hci_hardware_error(); - bt_reset = 0; - } else - bt_reset = 0; /* Clear and reset it anyway */ -#endif - -end: - return 0; -} - -static void btusb_disconnect(struct usb_interface *intf) -{ - struct btusb_data *data; - struct hci_dev *hdev = NULL; -#if CONFIG_BLUEDROID - wait_event_interruptible(bt_dlfw_wait, (check_set_dlfw_state_value(2) == 2)); -#endif - - bt_support = 0; - - AICBT_INFO("%s: usb_interface %p, bInterfaceNumber %d", - __func__, intf, intf->cur_altsetting->desc.bInterfaceNumber); - - data = usb_get_intfdata(intf); - - if (intf->cur_altsetting->desc.bInterfaceNumber != 0) - return; - - if (data) - hdev = data->hdev; - else { - AICBT_WARN("%s: Failed to get bt usb data[Null]", __func__); - return; - } - -//#ifdef CONFIG_HAS_EARLYSUSPEND -#if 0 - unregister_early_suspend(&data->early_suspend); -#else - unregister_pm_notifier(&data->pm_notifier); - unregister_reboot_notifier(&data->reboot_notifier); -#endif - - firmware_info_destroy(intf); - -#if CONFIG_BLUEDROID - if (test_bit(HCI_RUNNING, &hdev->flags)) { - AICBT_INFO("%s: Set BT reset flag", __func__); - bt_reset = 1; - } -#endif - - usb_set_intfdata(data->intf, NULL); - - if (data->isoc) - usb_set_intfdata(data->isoc, NULL); - - hci_unregister_dev(hdev); - - if (intf == data->isoc) - usb_driver_release_interface(&btusb_driver, data->intf); - else if (data->isoc) - usb_driver_release_interface(&btusb_driver, data->isoc); - -#if !CONFIG_BLUEDROID -#if LINUX_VERSION_CODE <= KERNEL_VERSION(3, 4, 0) - __hci_dev_put(hdev); -#endif -#endif - - hci_free_dev(hdev); - aic_free(data); - data = NULL; - set_dlfw_state_value(0); -} - -#ifdef CONFIG_PM -static int btusb_suspend(struct usb_interface *intf, pm_message_t message) -{ - struct btusb_data *data = usb_get_intfdata(intf); -#ifdef CONFIG_BT_WAKEUP_IN_PM - firmware_info *fw_info = data->fw_info; - int ret = 0; -#endif - AICBT_INFO("%s: event 0x%x, suspend count %d", __func__, - message.event, data->suspend_count); - - if (intf->cur_altsetting->desc.bInterfaceNumber != 0) - return 0; - - if (data->suspend_count++) - return 0; - - spin_lock_irq(&data->txlock); - if (!((message.event & PM_EVENT_AUTO) && data->tx_in_flight)) { - set_bit(BTUSB_SUSPENDING, &data->flags); - spin_unlock_irq(&data->txlock); - } else { - spin_unlock_irq(&data->txlock); - data->suspend_count--; - AICBT_ERR("%s: Failed to enter suspend", __func__); - return -EBUSY; - } - - cancel_work_sync(&data->work); - - btusb_stop_traffic(data); - mdelay(URB_CANCELING_DELAY_MS); - usb_kill_anchored_urbs(&data->tx_anchor); - -#ifdef CONFIG_BT_WAKEUP_IN_PM - ret = aic_cmd_disable_scan(fw_info); - AICBT_ERR("%s disable scan err %x\n", __func__, ret); - aic_cmd_disconnect_all_store_acl_handle(fw_info); - set_bt_wakeup_param(fw_info); - aic_clear_queue(); -#endif - - return 0; -} - -static void play_deferred(struct btusb_data *data) -{ - struct urb *urb; - int err; - - while ((urb = usb_get_from_anchor(&data->deferred))) { - usb_anchor_urb(urb, &data->tx_anchor); - err = usb_submit_urb(urb, GFP_ATOMIC); - if (err < 0) { - AICBT_ERR("%s: Failed to submit urb %p, err %d", - __func__, urb, err); - kfree(urb->setup_packet); - usb_unanchor_urb(urb); - } else { - usb_mark_last_busy(data->udev); - } - usb_free_urb(urb); - - data->tx_in_flight++; - } - mdelay(URB_CANCELING_DELAY_MS); - usb_scuttle_anchored_urbs(&data->deferred); -} - -static int btusb_resume(struct usb_interface *intf) -{ - struct btusb_data *data = usb_get_intfdata(intf); - struct hci_dev *hdev = data->hdev; - int err = 0; - - AICBT_INFO("%s: Suspend count %d", __func__, data->suspend_count); - - if (intf->cur_altsetting->desc.bInterfaceNumber != 0) - return 0; - - if (--data->suspend_count) - return 0; - - #if 0 - /*check_fw_version to check the status of the BT Controller after USB Resume*/ - err = check_fw_version(fw_info); - if (err !=0) - { - AICBT_INFO("%s: BT Controller Power OFF And Return hci_hardware_error:%d", __func__, err); - hci_hardware_error(); - } - #endif - - AICBT_INFO("%s g_chipid %x\n", __func__, g_chipid); - if(g_chipid == PRODUCT_ID_AIC8800DC){ - if(data->fw_info){ - err = download_patch(data->fw_info,1); - }else{ - AICBT_WARN("%s: Failed to initialize fw info", __func__); - } - } - #ifdef CONFIG_BT_WAKEUP_IN_PM - reset_bt_from_wakeup_process(data->fw_info); - //hci_resume_hardware_error(); - err = aic_cmd_enable_scan(data->fw_info); - AICBT_ERR("%s en scan err %x\n", __func__, err); - aic_event_disconnect_all_store_acl_handle(); - #endif - - #if 1 - if (test_bit(BTUSB_INTR_RUNNING, &data->flags)) { - err = btusb_submit_intr_urb(hdev, GFP_NOIO); - if (err < 0) { - clear_bit(BTUSB_INTR_RUNNING, &data->flags); - goto failed; - } - } - #endif - - if (test_bit(BTUSB_BULK_RUNNING, &data->flags)) { - err = btusb_submit_bulk_urb(hdev, GFP_NOIO); - if (err < 0) { - clear_bit(BTUSB_BULK_RUNNING, &data->flags); - goto failed; - } - - btusb_submit_bulk_urb(hdev, GFP_NOIO); - } - - if (test_bit(BTUSB_ISOC_RUNNING, &data->flags)) { - if (btusb_submit_isoc_urb(hdev, GFP_NOIO) < 0) - clear_bit(BTUSB_ISOC_RUNNING, &data->flags); - else - btusb_submit_isoc_urb(hdev, GFP_NOIO); - } - - spin_lock_irq(&data->txlock); - play_deferred(data); - clear_bit(BTUSB_SUSPENDING, &data->flags); - spin_unlock_irq(&data->txlock); - schedule_work(&data->work); - - return 0; - -failed: - mdelay(URB_CANCELING_DELAY_MS); - usb_scuttle_anchored_urbs(&data->deferred); - spin_lock_irq(&data->txlock); - clear_bit(BTUSB_SUSPENDING, &data->flags); - spin_unlock_irq(&data->txlock); - - return err; -} -#endif - -static struct usb_driver btusb_driver = { - .name = "aic_btusb", - .probe = btusb_probe, - .disconnect = btusb_disconnect, -#ifdef CONFIG_PM - .suspend = btusb_suspend, - .resume = btusb_resume, -#if CONFIG_RESET_RESUME - .reset_resume = btusb_resume, -#endif -#endif - .id_table = btusb_table, - .supports_autosuspend = 1, -#if LINUX_VERSION_CODE > KERNEL_VERSION(3, 7, 1) - .disable_hub_initiated_lpm = 1, -#endif -}; - -static int __init btusb_init(void) -{ - int err; - - AICBT_INFO("AICBT_RELEASE_NAME: %s",AICBT_RELEASE_NAME); - AICBT_INFO("AicSemi Bluetooth USB driver module init, version %s", VERSION); - AICBT_INFO("RELEASE DATE: 2023_1211_1958 \r\n"); -#if CONFIG_BLUEDROID - err = btchr_init(); - if (err < 0) { - /* usb register will go on, even bt char register failed */ - AICBT_ERR("Failed to register usb char device interfaces"); - } else - bt_char_dev_registered = 1; -#endif - err = usb_register(&btusb_driver); - if (err < 0) - AICBT_ERR("Failed to register aic bluetooth USB driver"); - return err; -} - -static void __exit btusb_exit(void) -{ - AICBT_INFO("AicSemi Bluetooth USB driver module exit"); -#if CONFIG_BLUEDROID - if (bt_char_dev_registered > 0) - btchr_exit(); -#endif - usb_deregister(&btusb_driver); -#if CONFIG_BLUEDROID - aic_clear_queue(); -#endif -} - -module_init(btusb_init); -module_exit(btusb_exit); - - -module_param(mp_drv_mode, int, 0644); -MODULE_PARM_DESC(mp_drv_mode, "0: NORMAL; 1: MP MODE"); - -#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 13, 0) -MODULE_IMPORT_NS("VFS_internal_I_am_really_a_filesystem_and_am_NOT_a_driver"); -#elif LINUX_VERSION_CODE >= KERNEL_VERSION(5, 4, 0) -MODULE_IMPORT_NS(VFS_internal_I_am_really_a_filesystem_and_am_NOT_a_driver); -#endif - -MODULE_AUTHOR("AicSemi Corporation"); -MODULE_DESCRIPTION("AicSemi Bluetooth USB driver version"); -MODULE_VERSION(VERSION); -MODULE_LICENSE("GPL"); diff --git a/drivers/aic8800/aic_btusb/aic_btusb.h b/drivers/aic8800/aic_btusb/aic_btusb.h deleted file mode 100644 index 5171a65..0000000 --- a/drivers/aic8800/aic_btusb/aic_btusb.h +++ /dev/null @@ -1,905 +0,0 @@ -/* - * - * Aic Bluetooth USB driver - * - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or - * (at your option) any later version. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program; if not, write to the Free Software - * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA - * - */ -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - -#include -#include -#include -#include - - -#ifdef CONFIG_PLATFORM_UBUNTU -#define CONFIG_BLUEDROID 1 /* bleuz 0, bluedroid 1, lbh 2 */ -#else -#define CONFIG_BLUEDROID 1 /* bleuz 0, bluedroid 1, lbh 2 */ -#endif - -#if CONFIG_BLUEDROID == 1 -/* -If you need to use the feature of waking up with BLE during STR Suspend sleep, please enable this macro. -*/ - -//#define CONFIG_BT_WAKEUP_IN_PM -#endif -/* Some Android system may use standard Linux kernel, while - * standard Linux may also implement early suspend feature. - * So exclude earysuspend.h from CONFIG_BLUEDROID. - */ -#ifdef CONFIG_HAS_EARLYSUSPEND -#include -#endif - -#if CONFIG_BLUEDROID -#else -#include -#include -#include -#endif - - -/*********************************** -** AicSemi - For aic_btusb driver ** -***********************************/ -#define URB_CANCELING_DELAY_MS 10 -/* when OS suspended, module is still powered,usb is not powered, - * this may set to 1, and must comply with special patch code. - */ -#define CONFIG_RESET_RESUME 1 -#define PRINT_CMD_EVENT 0 -#define PRINT_ACL_DATA 0 -#define PRINT_SCO_DATA 0 - -#define AICBT_DBG_FLAG 0 - -#if AICBT_DBG_FLAG -#define AICBT_DBG(fmt, arg...) printk( "aic_btusb: " fmt "\n" , ## arg) -#else -#define AICBT_DBG(fmt, arg...) -#endif - -#define AICBT_INFO(fmt, arg...) printk("aic_btusb: " fmt "\n" , ## arg) -#define AICBT_WARN(fmt, arg...) printk("aic_btusb: " fmt "\n" , ## arg) -#define AICBT_ERR(fmt, arg...) printk("aic_btusb: " fmt "\n" , ## arg) - - -#if LINUX_VERSION_CODE > KERNEL_VERSION(2, 6, 33) -#define HDEV_BUS hdev->bus -#define USB_RPM 1 -#else -#define HDEV_BUS hdev->type -#define USB_RPM 0 -#endif - -#if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 38) -#define NUM_REASSEMBLY 3 -#endif - -#if LINUX_VERSION_CODE > KERNEL_VERSION(3, 4, 0) -#define GET_DRV_DATA(x) hci_get_drvdata(x) -#else -#define GET_DRV_DATA(x) x->driver_data -#endif - -#define SCO_NUM hdev->conn_hash.sco_num - - -#define BTUSB_RPM (0 * USB_RPM) /* 1 SS enable; 0 SS disable */ -#define BTUSB_WAKEUP_HOST 0 /* 1 enable; 0 disable */ -#define BTUSB_MAX_ISOC_FRAMES 48 -#define BTUSB_INTR_RUNNING 0 -#define BTUSB_BULK_RUNNING 1 -#define BTUSB_ISOC_RUNNING 2 -#define BTUSB_SUSPENDING 3 -#define BTUSB_DID_ISO_RESUME 4 - -#define HCI_VENDOR_USB_DISC_HARDWARE_ERROR 0xFF -#define HCI_VENDOR_USB_RESUME_HARDWARE_ERROR 0xFE - -#define HCI_CMD_READ_BD_ADDR 0x1009 -#define HCI_VENDOR_READ_LMP_VERISION 0x1001 -#define HCI_VENDOR_RESET 0x0C03 - -#define DRV_NORMAL_MODE 0 -#define DRV_MP_MODE 1 -int mp_drv_mode = 0; /* 1 Mptool Fw; 0 Normal Fw */ - -#if CONFIG_BLUEDROID -/* ----- HCI Commands ---- */ -#define HCI_OP_INQUIRY 0x0401 -#define HCI_OP_INQUIRY_CANCEL 0x0402 -#define HCI_OP_EXIT_PERIODIC_INQ 0x0404 -#define HCI_OP_CREATE_CONN 0x0405 -#define HCI_OP_DISCONNECT 0x0406 -#define HCI_OP_ADD_SCO 0x0407 -#define HCI_OP_CREATE_CONN_CANCEL 0x0408 -#define HCI_OP_ACCEPT_CONN_REQ 0x0409 -#define HCI_OP_REJECT_CONN_REQ 0x040a -#define HCI_OP_LINK_KEY_REPLY 0x040b -#define HCI_OP_LINK_KEY_NEG_REPLY 0x040c -#define HCI_OP_PIN_CODE_REPLY 0x040d -#define HCI_OP_PIN_CODE_NEG_REPLY 0x040e -#define HCI_OP_CHANGE_CONN_PTYPE 0x040f -#define HCI_OP_AUTH_REQUESTED 0x0411 -#define HCI_OP_SET_CONN_ENCRYPT 0x0413 -#define HCI_OP_CHANGE_CONN_LINK_KEY 0x0415 -#define HCI_OP_REMOTE_NAME_REQ 0x0419 -#define HCI_OP_REMOTE_NAME_REQ_CANCEL 0x041a -#define HCI_OP_READ_REMOTE_FEATURES 0x041b -#define HCI_OP_READ_REMOTE_EXT_FEATURES 0x041c -#define HCI_OP_READ_REMOTE_VERSION 0x041d -#define HCI_OP_SETUP_SYNC_CONN 0x0428 -#define HCI_OP_ACCEPT_SYNC_CONN_REQ 0x0429 -#define HCI_OP_REJECT_SYNC_CONN_REQ 0x042a -#define HCI_OP_SNIFF_MODE 0x0803 -#define HCI_OP_EXIT_SNIFF_MODE 0x0804 -#define HCI_OP_ROLE_DISCOVERY 0x0809 -#define HCI_OP_SWITCH_ROLE 0x080b -#define HCI_OP_READ_LINK_POLICY 0x080c -#define HCI_OP_WRITE_LINK_POLICY 0x080d -#define HCI_OP_READ_DEF_LINK_POLICY 0x080e -#define HCI_OP_WRITE_DEF_LINK_POLICY 0x080f -#define HCI_OP_SNIFF_SUBRATE 0x0811 -#define HCI_OP_Write_Link_Policy_Settings 0x080d -#define HCI_OP_SET_EVENT_MASK 0x0c01 -#define HCI_OP_RESET 0x0c03 -#define HCI_OP_SET_EVENT_FLT 0x0c05 -#endif - -#define HCI_OP_Write_Extended_Inquiry_Response 0x0c52 -#define HCI_OP_Write_Simple_Pairing_Mode 0x0c56 -#define HCI_OP_Read_Buffer_Size 0x1005 -#define HCI_OP_Host_Buffer_Size 0x0c33 -#define HCI_OP_Read_Local_Version_Information 0x1001 -#define HCI_OP_Read_BD_ADDR 0x1009 -#define HCI_OP_Read_Local_Supported_Commands 0x1002 -#define HCI_OP_Write_Scan_Enable 0x0c1a -#define HCI_OP_Write_Current_IAC_LAP 0x0c3a -#define HCI_OP_Write_Inquiry_Scan_Activity 0x0c1e -#define HCI_OP_Write_Class_of_Device 0x0c24 -#define HCI_OP_LE_Rand 0x2018 -#define HCI_OP_LE_Set_Random_Address 0x2005 -#define HCI_OP_LE_Set_Extended_Adv_Enable 0x2039 -#define HCI_OP_LE_Set_Extended_Scan_Enable 0x2042 -#define HCI_OP_LE_Set_Extended_Scan_Parameters 0x2041 -#define HCI_OP_Set_Event_Filter 0x0c05 -#define HCI_OP_Write_Voice_Setting 0x0c26 -#define HCI_OP_Change_Local_Name 0x0c13 -#define HCI_OP_Read_Local_Name 0x0c14 -#define HCI_OP_Wirte_Page_Timeout 0x0c18 -#define HCI_OP_LE_Clear_Resolving_List 0x0c29 -#define HCI_OP_LE_Set_Addres_Resolution_Enable_Command 0x0c2e -#define HCI_OP_Write_Inquiry_mode 0x0c45 -#define HCI_OP_Write_Page_Scan_Type 0x0c47 -#define HCI_OP_Write_Inquiry_Scan_Type 0x0c43 - - - -#define HCI_OP_Delete_Stored_Link_Key 0x0c12 -#define HCI_OP_LE_Read_Local_Resolvable_Address 0x202d -#define HCI_OP_LE_Extended_Create_Connection 0x2043 -#define HCI_OP_Read_Remote_Version_Information 0x041d -#define HCI_OP_LE_Start_Encryption 0x2019 -#define HCI_OP_LE_Add_Device_to_Resolving_List 0x2027 -#define HCI_OP_LE_Set_Privacy_Mode 0x204e -#define HCI_OP_LE_Connection_Update 0x2013 - -#define HCI_OP_LE_Read_Local_Support_Featrues 0x2003 -#define HCI_OP_LE_Get_Vendor_Capabilities_Command 0xfd53 -#define HCI_OP_LE_Set_Le_Scan_Enable 0x200C -#define HCI_OP_LE_Create_Connection 0x200d -#define HCI_OP_LE_Create_Connection_Cancel 0x200e - -#if CONFIG_BLUEDROID -/* ----- HCI events---- */ -#define HCI_OP_DISCONNECT 0x0406 -#define HCI_EV_INQUIRY_COMPLETE 0x01 -#define HCI_EV_INQUIRY_RESULT 0x02 -#define HCI_EV_CONN_COMPLETE 0x03 -#define HCI_EV_CONN_REQUEST 0x04 -#define HCI_EV_DISCONN_COMPLETE 0x05 -#define HCI_EV_AUTH_COMPLETE 0x06 -#define HCI_EV_REMOTE_NAME 0x07 -#define HCI_EV_ENCRYPT_CHANGE 0x08 -#define HCI_EV_CHANGE_LINK_KEY_COMPLETE 0x09 - -#define HCI_EV_REMOTE_FEATURES 0x0b -#define HCI_EV_REMOTE_VERSION 0x0c -#define HCI_EV_QOS_SETUP_COMPLETE 0x0d -#define HCI_EV_CMD_COMPLETE 0x0e -#define HCI_EV_CMD_STATUS 0x0f - -#define HCI_EV_ROLE_CHANGE 0x12 -#define HCI_EV_NUM_COMP_PKTS 0x13 -#define HCI_EV_MODE_CHANGE 0x14 -#define HCI_EV_PIN_CODE_REQ 0x16 -#define HCI_EV_LINK_KEY_REQ 0x17 -#define HCI_EV_LINK_KEY_NOTIFY 0x18 -#define HCI_EV_CLOCK_OFFSET 0x1c -#define HCI_EV_PKT_TYPE_CHANGE 0x1d -#define HCI_EV_PSCAN_REP_MODE 0x20 - -#define HCI_EV_INQUIRY_RESULT_WITH_RSSI 0x22 -#define HCI_EV_REMOTE_EXT_FEATURES 0x23 -#define HCI_EV_SYNC_CONN_COMPLETE 0x2c -#define HCI_EV_SYNC_CONN_CHANGED 0x2d -#define HCI_EV_SNIFF_SUBRATE 0x2e -#define HCI_EV_EXTENDED_INQUIRY_RESULT 0x2f -#define HCI_EV_IO_CAPA_REQUEST 0x31 -#define HCI_EV_SIMPLE_PAIR_COMPLETE 0x36 -#define HCI_EV_REMOTE_HOST_FEATURES 0x3d -#define HCI_EV_LE_Meta 0x3e - -/* ULP Event sub code */ -#define HCI_BLE_CONN_COMPLETE_EVT 0x01 -#define HCI_BLE_ADV_PKT_RPT_EVT 0x02 -#define HCI_BLE_LL_CONN_PARAM_UPD_EVT 0x03 -#define HCI_BLE_READ_REMOTE_FEAT_CMPL_EVT 0x04 -#define HCI_BLE_LTK_REQ_EVT 0x05 -#define HCI_BLE_RC_PARAM_REQ_EVT 0x06 -#define HCI_BLE_DATA_LENGTH_CHANGE_EVT 0x07 -#define HCI_BLE_ENHANCED_CONN_COMPLETE_EVT 0x0a -#define HCI_BLE_DIRECT_ADV_EVT 0x0b -#define HCI_BLE_PHY_UPDATE_COMPLETE_EVT 0x0c -#define HCI_LE_EXTENDED_ADVERTISING_REPORT_EVT 0x0D -#define HCI_BLE_PERIODIC_ADV_SYNC_EST_EVT 0x0E -#define HCI_BLE_PERIODIC_ADV_REPORT_EVT 0x0F -#define HCI_BLE_PERIODIC_ADV_SYNC_LOST_EVT 0x10 -#define HCI_BLE_SCAN_TIMEOUT_EVT 0x11 -#define HCI_LE_ADVERTISING_SET_TERMINATED_EVT 0x12 -#define HCI_BLE_SCAN_REQ_RX_EVT 0x13 -#define HCI_BLE_CIS_EST_EVT 0x19 -#define HCI_BLE_CIS_REQ_EVT 0x1a -#define HCI_BLE_CREATE_BIG_CPL_EVT 0x1b -#define HCI_BLE_TERM_BIG_CPL_EVT 0x1c -#define HCI_BLE_BIG_SYNC_EST_EVT 0x1d -#define HCI_BLE_BIG_SYNC_LOST_EVT 0x1e -#define HCI_BLE_REQ_PEER_SCA_CPL_EVT 0x1f - -#define HCI_VENDOR_SPECIFIC_EVT 0xFF /* Vendor specific events */ -#endif - -#if CONFIG_BLUEDROID -#define QUEUE_SIZE 500 - -/*************************************** -** AicSemi - Integrate from bluetooth.h ** -*****************************************/ -/* Reserv for core and drivers use */ -#define BT_SKB_RESERVE 8 - - -typedef struct { - uint8_t addr[6]; -}bdaddr_t; - -/* Skb helpers */ -struct bt_skb_cb { - __u8 pkt_type; - __u8 incoming; - __u16 expect; - __u16 tx_seq; - __u8 retries; - __u8 sar; - __u8 force_active; -}; - -#define bt_cb(skb) ((struct bt_skb_cb *)((skb)->cb)) - -static inline struct sk_buff *bt_skb_alloc(unsigned int len, gfp_t how) -{ - struct sk_buff *skb; - - if ((skb = alloc_skb(len + BT_SKB_RESERVE, how))) { - skb_reserve(skb, BT_SKB_RESERVE); - bt_cb(skb)->incoming = 0; - } - return skb; -} -/* AicSemi - Integrate from bluetooth.h end */ - -/*********************************** -** AicSemi - Integrate from hci.h ** -***********************************/ -#define HCI_MAX_ACL_SIZE 1024 -#define HCI_MAX_SCO_SIZE 255 -#define HCI_MAX_EVENT_SIZE 260 -#define HCI_MAX_FRAME_SIZE (HCI_MAX_ACL_SIZE + 4) - -/* HCI bus types */ -#define HCI_VIRTUAL 0 -#define HCI_USB 1 -#define HCI_PCCARD 2 -#define HCI_UART 3 -#define HCI_RS232 4 -#define HCI_PCI 5 -#define HCI_SDIO 6 - -/* HCI controller types */ -#define HCI_BREDR 0x00 -#define HCI_AMP 0x01 - -/* HCI device flags */ -enum { - HCI_UP, - HCI_INIT, - HCI_RUNNING, - - HCI_PSCAN, - HCI_ISCAN, - HCI_AUTH, - HCI_ENCRYPT, - HCI_INQUIRY, - - HCI_RAW, - - HCI_RESET, -}; - -/* - * BR/EDR and/or LE controller flags: the flags defined here should represent - * states from the controller. - */ -enum { - HCI_SETUP, - HCI_AUTO_OFF, - HCI_MGMT, - HCI_PAIRABLE, - HCI_SERVICE_CACHE, - HCI_LINK_KEYS, - HCI_DEBUG_KEYS, - HCI_UNREGISTER, - - HCI_LE_SCAN, - HCI_SSP_ENABLED, - HCI_HS_ENABLED, - HCI_LE_ENABLED, - HCI_CONNECTABLE, - HCI_DISCOVERABLE, - HCI_LINK_SECURITY, - HCI_PENDING_CLASS, -}; - -/* HCI data types */ -#define HCI_COMMAND_PKT 0x01 -#define HCI_ACLDATA_PKT 0x02 -#define HCI_SCODATA_PKT 0x03 -#define HCI_EVENT_PKT 0x04 -#define HCI_VENDOR_PKT 0xff - -#define HCI_MAX_NAME_LENGTH 248 -#define HCI_MAX_EIR_LENGTH 240 - -#define HCI_OP_READ_LOCAL_VERSION 0x1001 -struct hci_rp_read_local_version { - __u8 status; - __u8 hci_ver; - __le16 hci_rev; - __u8 lmp_ver; - __le16 manufacturer; - __le16 lmp_subver; -} __packed; - -#define HCI_EV_CMD_COMPLETE 0x0e -struct hci_ev_cmd_complete { - __u8 ncmd; - __le16 opcode; -} __packed; - -/* ---- HCI Packet structures ---- */ -#define HCI_COMMAND_HDR_SIZE 3 -#define HCI_EVENT_HDR_SIZE 2 -#define HCI_ACL_HDR_SIZE 4 -#define HCI_SCO_HDR_SIZE 3 - -struct hci_command_hdr { - __le16 opcode; /* OCF & OGF */ - __u8 plen; -} __packed; - -struct hci_event_hdr { - __u8 evt; - __u8 plen; -} __packed; - -struct hci_acl_hdr { - __le16 handle; /* Handle & Flags(PB, BC) */ - __le16 dlen; -} __packed; - -struct hci_sco_hdr { - __le16 handle; - __u8 dlen; -} __packed; - -static inline struct hci_event_hdr *hci_event_hdr(const struct sk_buff *skb) -{ - return (struct hci_event_hdr *) skb->data; -} - -static inline struct hci_acl_hdr *hci_acl_hdr(const struct sk_buff *skb) -{ - return (struct hci_acl_hdr *) skb->data; -} - -static inline struct hci_sco_hdr *hci_sco_hdr(const struct sk_buff *skb) -{ - return (struct hci_sco_hdr *) skb->data; -} - -/* ---- HCI Ioctl requests structures ---- */ -struct hci_dev_stats { - __u32 err_rx; - __u32 err_tx; - __u32 cmd_tx; - __u32 evt_rx; - __u32 acl_tx; - __u32 acl_rx; - __u32 sco_tx; - __u32 sco_rx; - __u32 byte_rx; - __u32 byte_tx; -}; -/* AicSemi - Integrate from hci.h end */ - -/***************************************** -** AicSemi - Integrate from hci_core.h ** -*****************************************/ -struct hci_conn_hash { - struct list_head list; - unsigned int acl_num; - unsigned int sco_num; - unsigned int le_num; -}; - -#define HCI_MAX_SHORT_NAME_LENGTH 10 - -#define NUM_REASSEMBLY 4 -struct hci_dev { - struct mutex lock; - - char name[8]; - unsigned long flags; - __u16 id; - __u8 bus; - __u8 dev_type; - - struct sk_buff *reassembly[NUM_REASSEMBLY]; - - struct hci_conn_hash conn_hash; - - struct hci_dev_stats stat; - -#if LINUX_VERSION_CODE <= KERNEL_VERSION(3, 4, 0) - atomic_t refcnt; - struct module *owner; - void *driver_data; -#endif - - atomic_t promisc; - - struct device *parent; - struct device dev; - - unsigned long dev_flags; - - int (*open)(struct hci_dev *hdev); - int (*close)(struct hci_dev *hdev); - int (*flush)(struct hci_dev *hdev); - int (*send)(struct sk_buff *skb); -#if LINUX_VERSION_CODE <= KERNEL_VERSION(3, 4, 0) - void (*destruct)(struct hci_dev *hdev); -#endif -#if LINUX_VERSION_CODE > KERNEL_VERSION(3, 7, 1) - __u16 voice_setting; -#endif - void (*notify)(struct hci_dev *hdev, unsigned int evt); - int (*ioctl)(struct hci_dev *hdev, unsigned int cmd, unsigned long arg); - u8 *align_data; -}; - -#if LINUX_VERSION_CODE <= KERNEL_VERSION(3, 4, 0) -static inline struct hci_dev *__hci_dev_hold(struct hci_dev *d) -{ - atomic_inc(&d->refcnt); - return d; -} - -static inline void __hci_dev_put(struct hci_dev *d) -{ - if (atomic_dec_and_test(&d->refcnt)) - d->destruct(d); -} -#endif - -static inline void *hci_get_drvdata(struct hci_dev *hdev) -{ - return dev_get_drvdata(&hdev->dev); -} - -static inline void hci_set_drvdata(struct hci_dev *hdev, void *data) -{ - dev_set_drvdata(&hdev->dev, data); -} - -#define SET_HCIDEV_DEV(hdev, pdev) ((hdev)->parent = (pdev)) -/* AicSemi - Integrate from hci_core.h end */ - - -#define CONFIG_MAC_OFFSET_GEN_1_2 (0x3C) //MAC's OFFSET in config/efuse for aic generation 1~2 bluetooth chip -#define CONFIG_MAC_OFFSET_GEN_3PLUS (0x44) //MAC's OFFSET in config/efuse for aic generation 3+ bluetooth chip - - -typedef struct { - uint16_t vid; - uint16_t pid; - uint16_t lmp_sub_default; - uint16_t lmp_sub; - uint16_t eversion; - char *mp_patch_name; - char *patch_name; - char *config_name; - uint8_t *fw_cache; - int fw_len; - uint16_t mac_offset; - uint32_t max_patch_size; -} patch_info; - -//Define ioctl cmd the same as HCIDEVUP in the kernel -#define DOWN_FW_CFG _IOW('E', 176, int) -#define SET_ISO_CFG _IOW('E', 177, int) -#define RESET_CONTROLLER _IOW('E', 178, int) -#define DWFW_CMPLT _IOW('E', 179, int) - -#define GET_USB_INFO _IOR('E', 180, int) - -/* for altsettings*/ -#include -#define BDADDR_FILE "/data/misc/bluetooth/bdaddr" -#define FACTORY_BT_BDADDR_STORAGE_LEN 17 -#if 0 -static inline int getmacaddr(uint8_t * vnd_local_bd_addr) -{ - struct file *bdaddr_file; - mm_segment_t oldfs; - char buf[FACTORY_BT_BDADDR_STORAGE_LEN]; - int32_t i = 0; - memset(buf, 0, FACTORY_BT_BDADDR_STORAGE_LEN); - bdaddr_file = filp_open(BDADDR_FILE, O_RDONLY, 0); - if (IS_ERR(bdaddr_file)){ - AICBT_INFO("No Mac Config for BT\n"); - return -1; - } - oldfs = get_fs(); - set_fs(KERNEL_DS); - bdaddr_file->f_op->llseek(bdaddr_file, 0, 0); - bdaddr_file->f_op->read(bdaddr_file, buf, FACTORY_BT_BDADDR_STORAGE_LEN, &bdaddr_file->f_pos); - for (i = 0; i < 6; i++) { - if(buf[3*i]>'9') - { - if(buf[3*i]>'Z') - buf[3*i] -=('a'-'A'); //change a to A - buf[3*i] -= ('A'-'9'-1); - } - if(buf[3*i+1]>'9') - { - if(buf[3*i+1]>'Z') - buf[3*i+1] -=('a'-'A'); //change a to A - buf[3*i+1] -= ('A'-'9'-1); - } - vnd_local_bd_addr[5-i] = ((uint8_t)buf[3*i]-'0')*16 + ((uint8_t)buf[3*i+1]-'0'); - } - set_fs(oldfs); - filp_close(bdaddr_file, NULL); - return 0; -} -#endif - -#endif /* CONFIG_BLUEDROID */ - - -typedef struct { - struct usb_interface *intf; - struct usb_device *udev; - int pipe_in, pipe_out; - uint8_t *send_pkt; - uint8_t *rcv_pkt; - struct hci_command_hdr *cmd_hdr; - struct hci_event_hdr *evt_hdr; - struct hci_ev_cmd_complete *cmd_cmp; - uint8_t *req_para, *rsp_para; - uint8_t *fw_data; - int pkt_len; - int fw_len; -} firmware_info; - -/******************************* -** Reasil patch code -********************************/ -#define CMD_CMP_EVT 0x0e -#define RCV_PKT_LEN 64 -#define SEND_PKT_LEN 300 -#define MSG_TO 1000 -#define PATCH_SEG_MAX 252 -#define DATA_END 0x80 -#define DOWNLOAD_OPCODE 0xfc02 -#define HCI_VSC_UPDATE_PT_CMD 0xFC75 -#define HCI_VSC_SET_ADFILTER_EN_CMD 0xFDAA -#define HCI_VSC_SET_ADFILTER_PT_CMD 0xFDAB -#define HCI_VSC_RESET_ADFILTER_PROCESS_PT_CMD 0xFDAC -#define HCI_VSC_WF_START_APP_CMD 0xFDAD -#define TRUE 1 -#define FALSE 0 -#define CMD_HDR_LEN sizeof(struct hci_command_hdr) -#define EVT_HDR_LEN sizeof(struct hci_event_hdr) -#define CMD_CMP_LEN sizeof(struct hci_ev_cmd_complete) -#define MAX_PATCH_SIZE_24K (1024*24) -#define MAX_PATCH_SIZE_40K (1024*40) - - -#define FW_RAM_ADID_BASE_ADDR 0x101788 -#define FW_RAM_PATCH_BASE_ADDR 0x184000 -#define AICBT_PT_TAG "AICBT_PT_TAG" - -enum aicbt_patch_table_type { - AICBT_PT_INF = 0x00, - AICBT_PT_TRAP = 0x1, - AICBT_PT_B4, - AICBT_PT_BTMODE, - AICBT_PT_PWRON, - AICBT_PT_AF, - AICBT_PT_VER, - AICBT_PT_MAX, -}; - -enum AIC_DC_SUBID{ - DC_U01 = 0, - DC_U02, - DC_U02H, -}; - -enum AIC_D80N_SUBID{ - D80N_U01 = 0, - D80N_U02, -}; - -struct aicbt_firmware { - const char *desc; - const char *bt_adid; - const char *bt_patch; - const char *bt_table; - const char *bt_ext_patch; - const char *wf_cinit; - const char *wf_btusb; -}; - -const struct aicbt_firmware fw_8800dc[] = { - [DC_U01] = { - .desc = "aic8800dc u01 bt patch", - .bt_adid = "fw_adid_8800dc.bin", - .bt_patch = "fw_patch_8800dc.bin", - .bt_table = "fw_patch_table_8800dc.bin", - .bt_ext_patch = "fw_patch_8800dc_ext" - }, - [DC_U02] = { - .desc = "aic8800dc u02 bt patch", - .bt_adid = "fw_adid_8800dc_u02.bin", - .bt_patch = "fw_patch_8800dc_u02.bin", - .bt_table = "fw_patch_table_8800dc_u02.bin", - .bt_ext_patch = "fw_patch_8800dc_u02_ext" - }, - [DC_U02H] = { - .desc = "aic8800dch u02 bt patch", - .bt_adid = "fw_adid_8800dc_u02h.bin", - .bt_patch = "fw_patch_8800dc_u02h.bin", - .bt_table = "fw_patch_table_8800dc_u02h.bin", - .bt_ext_patch = "fw_patch_8800dc_u02h_ext" - }, -}; - -const struct aicbt_firmware fw_8800d80n[] = { - [D80N_U01] = { - .desc = "aic8800d80n u01 bt patch", - .bt_adid = "fw_adid_8800d80n.bin", - .bt_patch = "fw_patch_8800d80n.bin", - .bt_table = "fw_patch_table_8800d80n.bin", - .bt_ext_patch = "fw_patch_8800d80n_ext" - }, - [D80N_U02] = { - .desc = "aic8800d80n u02 bt patch", - .bt_adid = "fw_adid_8800d80n_u02.bin", - .bt_patch = "fw_patch_8800d80n_u02.bin", - .bt_table = "fw_patch_table_8800d80n_u02.bin", - .bt_ext_patch = "fw_patch_8800d80n_u02_ext", - .wf_cinit = "fmacfw_cinit_8800d80n_u02.bin", - .wf_btusb = "fmacfw_btusb_8800d80n_u02.bin", - }, -}; - -const struct aicbt_firmware fw_8800d80n_rf[] = { - [D80N_U01] = { - .desc = "aic8800d80n u01 bt test patch", - .bt_adid = "fw_adid_8800d80n.bin", - .bt_patch = "fw_patch_8800d80n.bin", - .bt_table = "fw_patch_table_8800d80n.bin", - .bt_ext_patch = "fw_patch_8800d80n_ext" - }, - [D80N_U02] = { - .desc = "aic8800d80n u02 bt patch", - .bt_adid = "fw_adid_8800d80n_rf_u02.bin", - .bt_patch = "fw_patch_8800d80n_rf_u02.bin", - .bt_table = "fw_patch_table_8800d80n_rf_u02.bin", - .bt_ext_patch = "fw_patch_8800d80n_rf_u02_ext", - .wf_cinit = "fmacfw_cinit_8800d80n_u02.bin", - .wf_btusb = "fmacfw_btusb_8800d80n_u02.bin", - }, -}; - - -#define HCI_VSC_FW_STATUS_GET_CMD 0xFC78 - -struct fw_status { - u8 status; -} __packed; - -#define HCI_PATCH_DATA_MAX_LEN 240 -#define HCI_VSC_MEM_WR_SIZE 240 -#define HCI_VSC_MEM_RD_SIZE 128 -#define HCI_VSC_UPDATE_PT_SIZE 249 -#define HCI_PT_MAX_LEN 31 - -#define HCI_VSC_MEM_WR_V2_SIZE 128 -#define HCI_VSC_UPDATE_PT_V2_SIZE 128 - -#define HCI_VSC_DBG_RD_MEM_CMD 0xFC01 - -#define MAX_AD_FILTER_NUM 4// Max AD Filter num -#define MAX_GPIO_TRIGGER_NUM 2// Max user config num of gpio -#define MAX_ROLE_COMNO_IDX_NUM 2// Max num of ad role type combo,form( enum gpio_combo_idx) - -#define AD_ROLE_FLAG 0x0f -#define ROLE_COMBO_IDX_FLAG 0xf0 - -enum ad_role_type { - ROLE_ONLY,// ROLE_ONLY will trigger wake up immediately. - ROLE_COMBO,//ROLE_COMBO will trigger When all the conditions (ad_role == ROLE_COMBO,and ad_filter is matching)are met. -}; - -enum gpio_combo_idx { - COMBO_0, - COMBO_1, -}; - -enum gpio_trigger_bit { - TG_IDX_0 = (1<<0), - TG_IDX_1 = (1<<1), -}; - -struct wakeup_ad_data_filter { - uint32_t ad_data_mask; - uint8_t gpio_trigger_idx; - uint8_t ad_role;//from enum ad_role_type - uint8_t ad_len; - uint8_t ad_type; - uint8_t ad_data[31]; - bdaddr_t wl_addr; -}; - -struct ble_wakeup_param_t { - uint32_t magic_num;// "BLES" = 0x53454C42 - uint32_t delay_scan_to;// timeout for start scan in ms - uint32_t reboot_to;// timeout for reboot in ms - uint32_t gpio_num[MAX_GPIO_TRIGGER_NUM]; - uint32_t gpio_dft_lvl[MAX_GPIO_TRIGGER_NUM]; - struct wakeup_ad_data_filter ad_filter[MAX_AD_FILTER_NUM]; -}; - -/// Structure containing the parameters of the @ref DBG_START_APP_REQ message. -struct wf_start_app_param -{ - uint32_t bootaddr; - uint32_t boottype; -}; - -struct hci_dbg_rd_mem_cmd { - __le32 start_addr; - __u8 type; - __u8 length; -}__attribute__ ((packed)); - -struct hci_dbg_rd_mem_cmd_evt { - __u8 status; - __u8 length; - __u8 data[HCI_VSC_MEM_RD_SIZE]; -}__attribute__ ((packed)); - -struct long_buffer_tag { - __u8 length; - __u8 data[HCI_VSC_MEM_WR_SIZE]; -}; - -struct hci_dbg_wr_mem_cmd { - __le32 start_addr; - __u8 type; - __u8 length; - __u8 data[HCI_VSC_MEM_WR_SIZE]; -}; - -struct aicbt_patch_table { - char *name; - uint32_t type; - uint32_t *data; - uint32_t len; - struct aicbt_patch_table *next; -}; - -struct aicbt_patch_info_t { - uint32_t info_len; -//base len start - uint32_t adid_addrinf; - uint32_t addr_adid; - uint32_t patch_addrinf; - uint32_t addr_patch; - uint32_t reset_addr; - uint32_t reset_val; - uint32_t adid_flag_addr; - uint32_t adid_flag; -//base len end -//ext patch nb - uint32_t ext_patch_nb_addr; - uint32_t ext_patch_nb; - uint32_t *ext_patch_param; -}; - - -struct aicbt_patch_table_cmd { - uint8_t patch_num; - uint32_t patch_table_addr[31]; - uint32_t patch_table_data[31]; -}__attribute__ ((packed)); - - -enum aic_endpoit { - CTRL_EP = 0, - INTR_EP = 3, - BULK_EP = 1, - ISOC_EP = 4 -}; - -/* #define HCI_VERSION_CODE KERNEL_VERSION(3, 14, 41) */ -#define HCI_VERSION_CODE LINUX_VERSION_CODE - - -#if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 38) -#define NUM_REASSEMBLY 3 -#else -#define NUM_REASSEMBLY 4 -#endif - diff --git a/drivers/aic8800/aic_btusb/aic_btusb_external_featrue.c b/drivers/aic8800/aic_btusb/aic_btusb_external_featrue.c deleted file mode 100644 index 368997e..0000000 --- a/drivers/aic8800/aic_btusb/aic_btusb_external_featrue.c +++ /dev/null @@ -1,130 +0,0 @@ -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include -#include - - - -#define IOCTL_CHAR_DEVICE_NAME "aic_btusb_ex_dev" - -#define SET_APCF_PARAMETER _IOR('E', 181, int) - -static dev_t ioctl_devid; /* bt char device number */ -static struct cdev ioctl_char_dev; /* bt character device structure */ -static struct class *ioctl_char_class; /* device class for usb char driver */ - -extern struct file_operations ioctl_chrdev_ops; - -extern void btchr_external_write(char* data, int len); - -static long ioctl_ioctl(struct file *file_p,unsigned int cmd, unsigned long arg) -{ - char data[1024]; - int ret = 0; - - printk("%s enter\r\n", __func__); - memset(data, 0, 1024); - switch(cmd) - { - case SET_APCF_PARAMETER: - printk("set apcf parameter\r\n"); - ret = copy_from_user(data, (int __user *)arg, 1024); - btchr_external_write(&data[1], (int)data[0]); - break; - - default: - printk("unknow cmdr\r\n"); - break; - } - return 0; -} - - -#ifdef CONFIG_COMPAT -static long compat_ioctlchr_ioctl (struct file *filp, unsigned int cmd, unsigned long arg) -{ - return ioctl_ioctl(filp, cmd, (unsigned long) compat_ptr(arg)); -} -#endif - - -struct file_operations ioctl_chrdev_ops = { - unlocked_ioctl : ioctl_ioctl, -#ifdef CONFIG_COMPAT - compat_ioctl : compat_ioctlchr_ioctl, -#endif - -}; - -static int __init init_extenal_ioctl(void){ - int res = 0; - struct device *dev; - - printk("%s enter\r\n", __func__); - -#if LINUX_VERSION_CODE >= KERNEL_VERSION(6, 4, 0) - ioctl_char_class = class_create(IOCTL_CHAR_DEVICE_NAME); -#else - ioctl_char_class = class_create(THIS_MODULE, IOCTL_CHAR_DEVICE_NAME); -#endif - if (IS_ERR(ioctl_char_class)) { - printk("Failed to create ioctl char class"); - } - - res = alloc_chrdev_region(&ioctl_devid, 0, 1, IOCTL_CHAR_DEVICE_NAME); - if (res < 0) { - printk("Failed to allocate ioctl char device"); - goto err_alloc; - } - - dev = device_create(ioctl_char_class, NULL, ioctl_devid, NULL, IOCTL_CHAR_DEVICE_NAME); - if (IS_ERR(dev)) { - printk("Failed to create ioctl char device"); - res = PTR_ERR(dev); - goto err_create; - } - - cdev_init(&ioctl_char_dev, &ioctl_chrdev_ops); - res = cdev_add(&ioctl_char_dev, ioctl_devid, 1); - if (res < 0) { - printk("Failed to add ioctl char device"); - goto err_add; - } - - return res; - -err_add: - device_destroy(ioctl_char_class, ioctl_devid); -err_create: - unregister_chrdev_region(ioctl_devid, 1); -err_alloc: - class_destroy(ioctl_char_class); - - return res; - -} -static void __exit deinit_extenal_ioctl(void){ - printk("%s enter\r\n", __func__); - device_destroy(ioctl_char_class, ioctl_devid); - cdev_del(&ioctl_char_dev); - unregister_chrdev_region(ioctl_devid, 1); - class_destroy(ioctl_char_class); - -} - -module_init(init_extenal_ioctl); -module_exit(deinit_extenal_ioctl); - - -MODULE_AUTHOR("AicSemi Corporation"); -MODULE_DESCRIPTION("AicSemi Bluetooth USB driver version"); -MODULE_LICENSE("GPL"); - diff --git a/drivers/aic8800/aic_btusb/aic_btusb_external_featrue.h b/drivers/aic8800/aic_btusb/aic_btusb_external_featrue.h deleted file mode 100644 index 3b7b81c..0000000 --- a/drivers/aic8800/aic_btusb/aic_btusb_external_featrue.h +++ /dev/null @@ -1,3 +0,0 @@ - -void btchr_external_write(char* data, int len); - diff --git a/install.sh b/install.sh index 6ad08ff..bdb2b0f 100755 --- a/install.sh +++ b/install.sh @@ -289,18 +289,6 @@ install_firmware() { print_warning "Udev rules file not found: $rules_source" fi - # Install modprobe configuration for Bluetooth - local modprobe_source="${SCRIPT_DIR}/modprobe/aic8800-bt.conf" - local modprobe_dest="/etc/modprobe.d/aic8800-bt.conf" - - if [ -f "$modprobe_source" ]; then - print_info "Installing modprobe configuration to $modprobe_dest..." - cp "$modprobe_source" "$modprobe_dest" >> "$LOG_FILE" 2>&1 - print_success "Modprobe configuration installed successfully." - else - print_warning "Modprobe configuration file not found: $modprobe_source" - fi - # Install usb_modeswitch configuration local modeswitch_source="${SCRIPT_DIR}/usb_modeswitch/1111_1111" local modeswitch_dest="/etc/usb_modeswitch.d/1111:1111" diff --git a/modprobe/aic8800-bt.conf b/modprobe/aic8800-bt.conf deleted file mode 100644 index 2e380c9..0000000 --- a/modprobe/aic8800-bt.conf +++ /dev/null @@ -1,15 +0,0 @@ -# AIC8800D80 Bluetooth - prevent generic btusb from claiming the device -# -# The kernel's built-in btusb driver matches any USB device with Bluetooth -# interface class (0xe0/0x01/0x01), but it doesn't know how to initialize -# the AIC8800 BT controller, resulting in HCI_Reset timeout errors. -# -# The AIC-specific aic_btusb module must handle these devices instead. - -# Ensure aic_btusb loads before btusb can claim AIC devices -softdep btusb pre: aic_btusb - -# Auto-load aic_btusb when the AIC8800 device is present -alias usb:v0A69Cp8D83d*dc*dsc*dp*icE0isc01ip01in* aic_btusb -alias usb:v0A69Cp8D81d*dc*dsc*dp*icE0isc01ip01in* aic_btusb -alias usb:v368Bp8D81d*dc*dsc*dp*icE0isc01ip01in* aic_btusb