Message ID | 20230124174714.2775680-1-neeraj.sanjaykale@nxp.com |
---|---|
Headers | show |
Series | Add support for NXP bluetooth chipsets | expand |
correct the indentation len = serdev_device_write_buf(serdev, skb->data, skb->len); remove extra tab serdev_device_break_ctl(nxpdev->serdev, 0); /* break OFF */ else serdev_device_break_ctl(nxpdev->serdev, -1); /* break ON */ extra space b/w else if else if (data->ps_cmd == PS_CMD_EXIT_PS) can we use strncmp in case strcmp (!strcmp(chip_id_name_table[i].chip_name, name_str)) when config flag using CONFIG_BT_NXPUART -> why not give driver name btnxpuart.o Thanks, Alok On 1/24/2023 11:17 PM, Neeraj Sanjay Kale wrote: > This adds a driver based on serdev driver for the NXP BT serial > protocol based on running H:4, which can enable the built-in > Bluetooth device inside a generic NXP BT chip. > > This driver has Power Save feature that will put the chip into > sleep state whenever there is no activity for 2000ms, and will > be woken up when any activity is to be initiated. > > This driver enables the power save feature by default by sending > the vendor specific commands to the chip during setup. > > During setup, the driver is capable of reading the bootloader > signature unique to every chip, and downloading corresponding > FW file defined in a user-space config file. The firmware file > name can be defined in DTS file as well, in which case the > user-space config file will be ignored. > > Signed-off-by: Neeraj Sanjay Kale <neeraj.sanjaykale@nxp.com> > --- > MAINTAINERS | 7 + > drivers/bluetooth/Kconfig | 11 + > drivers/bluetooth/Makefile | 1 + > drivers/bluetooth/btnxp.c | 1337 ++++++++++++++++++++++++++++++++++++ > drivers/bluetooth/btnxp.h | 230 +++++++ > 5 files changed, 1586 insertions(+) > create mode 100644 drivers/bluetooth/btnxp.c > create mode 100644 drivers/bluetooth/btnxp.h > > diff --git a/MAINTAINERS b/MAINTAINERS > index 32dd41574930..20bb9e6b44b5 100644 > --- a/MAINTAINERS > +++ b/MAINTAINERS > @@ -22835,6 +22835,13 @@ L: linux-mm@kvack.org > S: Maintained > F: mm/zswap.c > > +NXP BLUETOOTH WIRELESS DRIVERS > +M: Amitkumar Karwar <amitkumar.karwar@nxp.com> > +M: Neeraj Kale <neeraj.sanjaykale@nxp.com> > +S: Maintained > +F: Documentation/devicetree/bindings/net/bluetooth/nxp-bluetooth.yaml > +F: drivers/bluetooth/btnxp* > + > THE REST > M: Linus Torvalds <torvalds@linux-foundation.org> > L: linux-kernel@vger.kernel.org > diff --git a/drivers/bluetooth/Kconfig b/drivers/bluetooth/Kconfig > index 5a1a7bec3c42..773b40d34b7b 100644 > --- a/drivers/bluetooth/Kconfig > +++ b/drivers/bluetooth/Kconfig > @@ -465,4 +465,15 @@ config BT_VIRTIO > Say Y here to compile support for HCI over Virtio into the > kernel or say M to compile as a module. > > +config BT_NXPUART > + tristate "NXP protocol support" > + depends on SERIAL_DEV_BUS > + help > + NXP is serial driver required for NXP Bluetooth > + devices with UART interface. > + > + Say Y here to compile support for NXP Bluetooth UART device into > + the kernel, or say M here to compile as a module. > + > + > endmenu > diff --git a/drivers/bluetooth/Makefile b/drivers/bluetooth/Makefile > index e0b261f24fc9..6c0e7fbe2297 100644 > --- a/drivers/bluetooth/Makefile > +++ b/drivers/bluetooth/Makefile > @@ -29,6 +29,7 @@ obj-$(CONFIG_BT_QCA) += btqca.o > obj-$(CONFIG_BT_MTK) += btmtk.o > > obj-$(CONFIG_BT_VIRTIO) += virtio_bt.o > +obj-$(CONFIG_BT_NXPUART) += btnxp.o > > obj-$(CONFIG_BT_HCIUART_NOKIA) += hci_nokia.o > > diff --git a/drivers/bluetooth/btnxp.c b/drivers/bluetooth/btnxp.c > new file mode 100644 > index 000000000000..0066f778593a > --- /dev/null > +++ b/drivers/bluetooth/btnxp.c > @@ -0,0 +1,1337 @@ > +// SPDX-License-Identifier: GPL-2.0-or-later > +/* > + * > + * NXP Bluetooth driver > + * Copyright 2018-2023 NXP > + * > + * > + * 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. > + * > + */ > + > +#include <linux/module.h> > +#include <linux/kernel.h> > + > +#include <linux/serdev.h> > +#include <linux/of.h> > +#include <linux/skbuff.h> > +#include <asm/unaligned.h> > +#include <linux/firmware.h> > +#include <linux/string.h> > +#include <linux/crc8.h> > + > +#include <net/bluetooth/bluetooth.h> > +#include <net/bluetooth/hci_core.h> > + > +#include "btnxp.h" > +#include "h4_recv.h" > + > +#define BTNXPUART_TX_STATE_ACTIVE 1 > +#define BTNXPUART_TX_STATE_WAKEUP 2 > +#define BTNXPUART_FW_DOWNLOADING 3 > + > +static const struct chip_id_map_table chip_id_name_table[] = { > + {0xffff, "legacy_chip"}, /* for legacy bootloader chipsets w8987 and w8997 */ > + {0x7201, "iw416"}, > + {0x7601, "iw612"}, > + {0x5c03, "w9098"}, > +}; > + > +static u8 crc8_table[CRC8_TABLE_SIZE]; > +static unsigned long crc32_table[256]; > +static struct fw_params fw_mod_params[MAX_NO_OF_CHIPS_SUPPORT]; > + > +/* NXP Power Save Feature */ > +int wakeupmode = WAKEUP_METHOD_BREAK; > +int ps_mode = PS_MODE_ENABLE; > + > +static void ps_start_timer(struct btnxpuart_dev *nxpdev) > +{ > + struct ps_data *psdata = nxpdev->psdata; > + > + if (!psdata) > + return; > + > + if (psdata->cur_psmode == PS_MODE_ENABLE) { > + psdata->timer_on = 1; > + mod_timer(&psdata->ps_timer, jiffies + (psdata->interval * HZ) / 1000); > + } > +} > + > +static void ps_cancel_timer(struct btnxpuart_dev *nxpdev) > +{ > + struct ps_data *psdata = nxpdev->psdata; > + > + if (!psdata) > + return; > + > + flush_scheduled_work(); > + if (psdata->timer_on) > + del_timer(&psdata->ps_timer); > + kfree(psdata); > +} > + > +static void ps_control(struct hci_dev *hdev, u8 ps_state) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + struct ps_data *psdata = nxpdev->psdata; > + > + if (psdata->ps_state == ps_state) > + return; > + > + switch (psdata->cur_wakeupmode) { > + case WAKEUP_METHOD_DTR: > + if (ps_state == PS_STATE_AWAKE) > + serdev_device_set_tiocm(nxpdev->serdev, TIOCM_DTR, 0); /* DTR ON */ > + else > + serdev_device_set_tiocm(nxpdev->serdev, 0, TIOCM_DTR); /* DTR OFF */ > + break; > + case WAKEUP_METHOD_BREAK: > + default: > + BT_INFO("Set UART break: %s", ps_state == PS_STATE_AWAKE ? "off" : "on"); > + if (ps_state == PS_STATE_AWAKE) > + serdev_device_break_ctl(nxpdev->serdev, 0); /* break OFF */ > + else > + serdev_device_break_ctl(nxpdev->serdev, -1); /* break ON */ > + break; > + } > + psdata->ps_state = ps_state; > + > + if (ps_state == PS_STATE_AWAKE) > + btnxpuart_tx_wakeup(nxpdev); > +} > + > +static void ps_work_func(struct work_struct *work) > +{ > + struct ps_data *data = container_of(work, struct ps_data, work); > + > + if (data->ps_cmd == PS_CMD_ENTER_PS && data->cur_psmode == PS_MODE_ENABLE) > + ps_control(data->hdev, PS_STATE_SLEEP); > + else if (data->ps_cmd == PS_CMD_EXIT_PS) > + ps_control(data->hdev, PS_STATE_AWAKE); > +} > + > +static void ps_timeout_func(struct timer_list *t) > +{ > + struct ps_data *data = from_timer(data, t, ps_timer); > + struct hci_dev *hdev = data->hdev; > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + > + data->timer_on = 0; > + if (test_bit(BTNXPUART_TX_STATE_ACTIVE, &nxpdev->tx_state)) { > + ps_start_timer(nxpdev); > + } else { > + data->ps_cmd = PS_CMD_ENTER_PS; > + schedule_work(&data->work); > + } > +} > + > +static int ps_init_work(struct hci_dev *hdev) > +{ > + struct ps_data *psdata = kzalloc(sizeof(*psdata), GFP_KERNEL); > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + > + if (!psdata) { > + BT_ERR("Can't allocate control structure for Power Save feature"); > + return -ENOMEM; > + } > + nxpdev->psdata = psdata; > + > + memset(psdata, 0, sizeof(*psdata)); > + psdata->interval = PS_DEFAULT_TIMEOUT_PERIOD; > + psdata->ps_state = PS_STATE_AWAKE; > + psdata->ps_mode = ps_mode; > + psdata->hdev = hdev; > + > + switch (wakeupmode) { > + case WAKEUP_METHOD_DTR: > + psdata->wakeupmode = WAKEUP_METHOD_DTR; > + break; > + case WAKEUP_METHOD_BREAK: > + default: > + psdata->wakeupmode = WAKEUP_METHOD_BREAK; > + break; > + } > + > + psdata->cur_psmode = PS_MODE_DISABLE; > + psdata->cur_wakeupmode = WAKEUP_METHOD_INVALID; > + INIT_WORK(&psdata->work, ps_work_func); > + > + return 0; > +} > + > +static void ps_init_timer(struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + struct ps_data *psdata = nxpdev->psdata; > + > + psdata->timer_on = 0; > + timer_setup(&psdata->ps_timer, ps_timeout_func, 0); > +} > + > +static int ps_wakeup(struct btnxpuart_dev *nxpdev) > +{ > + struct ps_data *psdata = nxpdev->psdata; > + int ret = 1; > + > + if (psdata->ps_state == PS_STATE_AWAKE) > + ret = 0; > + psdata->ps_cmd = PS_CMD_EXIT_PS; > + schedule_work(&psdata->work); > + > + return ret; > +} > + > +static int send_ps_cmd(struct hci_dev *hdev, void *data) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + struct ps_data *psdata = nxpdev->psdata; > + u8 pcmd; > + struct sk_buff *skb; > + u8 *status; > + > + if (psdata->ps_mode == PS_MODE_ENABLE) > + pcmd = BT_PS_ENABLE; > + else > + pcmd = BT_PS_DISABLE; > + > + psdata->driver_sent_cmd = true; /* set flag to prevent re-sending command in nxp_enqueue */ > + skb = __hci_cmd_sync(hdev, HCI_NXP_AUTO_SLEEP_MODE, 1, &pcmd, HCI_CMD_TIMEOUT); > + psdata->driver_sent_cmd = false; > + > + if (IS_ERR(skb)) { > + bt_dev_err(hdev, "Setting Power Save mode failed (%ld)", > + PTR_ERR(skb)); > + return PTR_ERR(skb); > + } > + > + status = skb_pull_data(skb, 1); > + > + if (status) { > + if (!*status) > + psdata->cur_psmode = psdata->ps_mode; > + else > + psdata->ps_mode = psdata->cur_psmode; > + if (psdata->cur_psmode == PS_MODE_ENABLE) > + ps_start_timer(nxpdev); > + else > + ps_wakeup(nxpdev); > + BT_INFO("Power Save mode response: status=%d, ps_mode=%d", > + *status, psdata->cur_psmode); > + } > + return 0; > +} > + > +static int send_wakeup_method_cmd(struct hci_dev *hdev, void *data) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + struct ps_data *psdata = nxpdev->psdata; > + u8 pcmd[4]; > + struct sk_buff *skb; > + u8 *status; > + > + pcmd[0] = BT_HOST_WAKEUP_METHOD_NONE; > + pcmd[1] = BT_HOST_WAKEUP_DEFAULT_GPIO; > + switch (psdata->wakeupmode) { > + case WAKEUP_METHOD_DTR: > + pcmd[2] = BT_CTRL_WAKEUP_METHOD_DSR; > + break; > + case WAKEUP_METHOD_BREAK: > + default: > + pcmd[2] = BT_CTRL_WAKEUP_METHOD_BREAK; > + break; > + } > + pcmd[3] = 0xFF; > + > + psdata->driver_sent_cmd = true; /* set flag to prevent re-sending command in nxp_enqueue */ > + skb = __hci_cmd_sync(hdev, HCI_NXP_WAKEUP_METHOD, 4, pcmd, HCI_CMD_TIMEOUT); > + psdata->driver_sent_cmd = false; > + > + if (IS_ERR(skb)) { > + bt_dev_err(hdev, "Setting wake-up method failed (%ld)", > + PTR_ERR(skb)); > + return PTR_ERR(skb); > + } > + > + status = skb_pull_data(skb, 1); > + if (status) { > + if (*status == 0) > + psdata->cur_wakeupmode = psdata->wakeupmode; > + else > + psdata->wakeupmode = psdata->cur_wakeupmode; > + BT_INFO("Set Wakeup Method response: status=%d, wakeupmode=%d", > + *status, psdata->cur_wakeupmode); > + } > + > + return 0; > +} > + > +static int ps_init(struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + struct ps_data *psdata = nxpdev->psdata; > + > + serdev_device_set_tiocm(nxpdev->serdev, TIOCM_RTS, 0); /* RTS ON */ > + > + switch (psdata->wakeupmode) { > + case WAKEUP_METHOD_DTR: > + serdev_device_set_tiocm(nxpdev->serdev, 0, TIOCM_DTR); /* DTR OFF */ > + serdev_device_set_tiocm(nxpdev->serdev, TIOCM_DTR, 0); /* DTR ON */ > + break; > + case WAKEUP_METHOD_BREAK: > + default: > + serdev_device_break_ctl(nxpdev->serdev, -1); /* break ON */ > + serdev_device_break_ctl(nxpdev->serdev, 0); /* break OFF */ > + break; > + } > + if (!test_bit(HCI_RUNNING, &hdev->flags)) { > + BT_ERR("HCI_RUNNING is not set"); > + return -EBUSY; > + } > + if (psdata->cur_wakeupmode != psdata->wakeupmode) > + hci_cmd_sync_queue(hdev, send_wakeup_method_cmd, NULL, NULL); > + if (psdata->cur_psmode != psdata->ps_mode) > + hci_cmd_sync_queue(hdev, send_ps_cmd, NULL, NULL); > + > + return 0; > +} > + > +/* NXP Firmware Download Feature */ > +static u16 nxp_get_chip_id_from_name(u8 *name_str) > +{ > + int map_table_size = sizeof(chip_id_name_table) / sizeof(struct chip_id_map_table); > + int i; > + > + for (i = 0; i < map_table_size; i++) { > + if (!strcmp(chip_id_name_table[i].chip_name, name_str)) > + return chip_id_name_table[i].chip_id; > + } > + > + return 0; /* invalid name_str */ > +} > + > +static int nxp_parse_conf_file(struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + const char *sptr; > + char *dptr, *label, *value; > + char line[100]; > + int i = 0; > + int param_index = 0; > + int line_num = 1; > + int ret = 0; > + bool skipline = false; > + bool valid_param = false; > + > + memset(fw_mod_params, 0, sizeof(fw_mod_params)); > + sptr = nxpdev->fw_config->data; > + dptr = line; > + for (i = 0; i < nxpdev->fw_config->size; i++) { > + /* if current line is a comment, ignore */ > + if (sptr[i] == '#') { > + skipline = true; > + continue; > + } > + if (sptr[i] != '\n' && skipline) > + continue; > + /* ignore space <CR> and comma*/ > + if (sptr[i] == ' ' || sptr[i] == '\r' || sptr[i] == ',') > + continue; > + /* select next fw_mod_params index */ > + if (sptr[i] == '}') { > + if (!valid_param) { > + BT_ERR("Unexpected '}' on line %d", line_num); > + ret = -1; > + goto err; > + } > + param_index++; > + valid_param = false; > + continue; > + } > + if (sptr[i] == '\n') { > + line_num++; > + if (skipline) { > + skipline = false; > + continue; > + } > + *dptr = '\0'; > + /* ignore empty lines */ > + if (strlen(line) == 0) > + continue; > + dptr = line; > + label = strsep(&dptr, "="); > + value = strsep(&dptr, "="); > + if (label && value) { > + if (!strcmp(value, "{")) { > + valid_param = true; > + strncpy(fw_mod_params[param_index].chip_name, > + label, MAX_CHIP_NAME_LEN); > + fw_mod_params[param_index].chip_id = > + nxp_get_chip_id_from_name(label); > + if (fw_mod_params[param_index].chip_id == 0) { > + BT_ERR("Invalid label %s in %s", label, > + BT_FW_CONF_FILE); > + ret = -1; > + goto err; > + } > + } else { > + if (!valid_param) { > + BT_ERR("Expecting a '{' on line %d", line_num - 1); > + ret = -1; > + goto err; > + } > + if (!strcmp(label, FW_NAME_TAG)) { > + strncpy(fw_mod_params[param_index].fw_name, > + value, MAX_FW_FILE_NAME_LEN); > + } else if (!strcmp(label, OPER_SPEED_TAG)) { > + ret = kstrtouint(value, 10, > + &fw_mod_params[param_index].oper_speed); > + } else if (!strcmp(label, FW_DL_PRI_BAUDRATE_TAG)) { > + ret = kstrtouint(value, 10, > + &fw_mod_params[param_index].fw_dnld_pri_baudrate); > + } else if (!strcmp(label, FW_DL_SEC_BAUDRATE_TAG)) { > + ret = kstrtouint(value, 10, > + &fw_mod_params[param_index].fw_dnld_sec_baudrate); > + } else if (!strcmp(label, FW_INIT_BAUDRATE)) { > + ret = kstrtouint(value, 10, > + &fw_mod_params[param_index].fw_init_baudrate); > + } else { > + BT_ERR("Unknown tag: %s", label); > + ret = -1; > + goto err; > + } > + } > + } else { > + BT_ERR("Invalid \"key\" = \"value\" pair at line: %d", > + line_num - 1); > + } > + dptr = line; > + } else { > + *dptr = sptr[i]; > + dptr++; > + } > + } > + /* '}' not found till the end of the file */ > + if (valid_param) { > + BT_ERR("Expecting a '}' before the end of the file"); > + ret = -1; > + goto err; > + } > +err: > + return ret; > +} > + > +static int nxp_load_fw_params_for_chip_id(u16 chip_id, struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + int i; > + > + for (i = 0; i < MAX_NO_OF_CHIPS_SUPPORT; i++) { > + if (chip_id == fw_mod_params[i].chip_id) { > + strncpy(nxpdev->fw_name, fw_mod_params[i].fw_name, MAX_FW_FILE_NAME_LEN); > + nxpdev->oper_speed = fw_mod_params[i].oper_speed; > + nxpdev->fw_dnld_pri_baudrate = fw_mod_params[i].fw_dnld_pri_baudrate; > + nxpdev->fw_dnld_sec_baudrate = fw_mod_params[i].fw_dnld_sec_baudrate; > + nxpdev->fw_init_baudrate = fw_mod_params[i].fw_init_baudrate; > + break; > + } > + } > + if (i == MAX_NO_OF_CHIPS_SUPPORT) { > + if (chip_id == 0xffff) > + BT_ERR("%s does not contain entry for 'legacy_chip'", BT_FW_CONF_FILE); > + else > + BT_ERR("Unsupported chip signature: %04X", chip_id); > + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); > + return -ENOENT; > + } > + return 0; > +} > + > +static int nxp_download_firmware(struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + const struct btnxpuart_data *nxp_data = nxpdev->nxp_data; > + int err = 0; > + > + nxpdev->fw_dnld_offset = 0; > + nxpdev->fw_sent_bytes = 0; > + > + crc8_populate_msb(crc8_table, POLYNOMIAL8); > + > + serdev_device_set_baudrate(nxpdev->serdev, nxp_data->fw_dnld_pri_baudrate); > + serdev_device_set_flow_control(nxpdev->serdev, 0); > + set_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); > + nxpdev->current_baudrate = nxp_data->fw_dnld_pri_baudrate; > + nxpdev->fw_v3_offset_correction = 0; > + > + /* Wait till FW is downloaded and CTS becomes low */ > + init_waitqueue_head(&nxpdev->suspend_wait_q); > + err = wait_event_interruptible_timeout(nxpdev->suspend_wait_q, > + !test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state), > + msecs_to_jiffies(60000)); > + if (err == 0) { > + BT_ERR("FW Download Timeout."); > + return -ETIMEDOUT; > + } > + > + err = serdev_device_wait_for_cts(nxpdev->serdev, 1, 60000); > + if (err < 0) { > + BT_ERR("CTS is still high. FW Download failed."); > + return err; > + } > + BT_INFO("CTS is low"); > + release_firmware(nxpdev->fw); > + > + /* Allow the downloaded FW to initialize */ > + usleep_range(20000, 22000); > + > + return 0; > +} > + > +static int nxp_send_ack(u8 ack, struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + u8 ack_nak[2]; > + > + if (ack == NXP_ACK_V1 || ack == NXP_NAK_V1) { > + ack_nak[0] = ack; > + serdev_device_write_buf(nxpdev->serdev, ack_nak, 1); > + } else if (ack == NXP_ACK_V3) { > + ack_nak[0] = ack; > + ack_nak[1] = crc8(crc8_table, ack_nak, 1, 0xFF); > + serdev_device_write_buf(nxpdev->serdev, ack_nak, 2); > + } > + return 0; > +} > + > +static void nxp_fw_dnld_gen_crc_table(void) > +{ > + int i, j; > + unsigned long crc_accum; > + > + for (i = 0; i < 256; i++) { > + crc_accum = ((unsigned long)i << 24); > + for (j = 0; j < 8; j++) { > + if (crc_accum & 0x80000000L) > + crc_accum = (crc_accum << 1) ^ POLYNOMIAL32; > + else > + crc_accum = (crc_accum << 1); > + } > + crc32_table[i] = crc_accum; > + } > +} > + > +static unsigned long nxp_fw_dnld_update_crc(unsigned long crc_accum, > + char *data_blk_ptr, > + int data_blk_size) > +{ > + unsigned long i, j; > + > + for (j = 0; j < data_blk_size; j++) { > + i = ((unsigned long)(crc_accum >> 24) ^ *data_blk_ptr++) & 0xff; > + crc_accum = (crc_accum << 8) ^ crc32_table[i]; > + } > + return crc_accum; > +} > + > +static bool nxp_fw_change_baudrate(struct hci_dev *hdev, u16 req_len) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + static u8 nxp_cmd5_header[HDR_LEN] = { > + 0x05, 0x00, 0x00, 0x00, > + 0x00, 0x00, 0x00, 0x00, > + 0x2c, 0x00, 0x00, 0x00, > + 0x77, 0xdb, 0xfd, 0xe0}; > + static u8 uart_config[60] = {0}; > + u32 header_len = 0; > + u32 uart_config_len = 0; > + u32 mcr = MCR; > + u32 init = INIT; > + u32 icr = ICR; > + u32 fcr = FCR; > + u32 br_addr = CLKDIVADDR; > + u32 div_addr = UARTDIVADDR; > + u32 mcr_addr = UARTMCRADDR; > + u32 re_init_addr = UARTREINITADDR; > + u32 icr_addr = UARTICRADDR; > + u32 fcr_addr = UARTFCRADDR; > + u32 uart_div = 1; > + u32 uart_clk = 0x00C00000; > + u32 crc = 0; > + bool ret = false; > + > + nxpdev->fw_v3_offset_correction += req_len; > + > + if (req_len == HDR_LEN) { > + /* Create CMD5 payload */ > + memcpy(uart_config + uart_config_len, &br_addr, sizeof(br_addr)); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &uart_clk, sizeof(uart_clk)); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &div_addr, 4); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &uart_div, 4); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &mcr_addr, 4); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &mcr, 4); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &re_init_addr, 4); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &init, 4); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &icr_addr, 4); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &icr, 4); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &fcr_addr, 4); > + uart_config_len += 4; > + memcpy(uart_config + uart_config_len, &fcr, 4); > + uart_config_len += 4; > + header_len = uart_config_len + 4; > + > + nxp_fw_dnld_gen_crc_table(); > + > + /* Calculate CRC for CMD5 Header */ > + memcpy(nxp_cmd5_header + 8, &header_len, sizeof(header_len)); > + crc = (u32)nxp_fw_dnld_update_crc(0UL, nxp_cmd5_header, 12); > + crc = (u32)SWAPL(crc); > + memcpy(nxp_cmd5_header + 12, &crc, 4); > + > + /* Calculate CRC for CMD5 Payload */ > + crc = (u32)nxp_fw_dnld_update_crc(0UL, uart_config, uart_config_len); > + crc = (u32)SWAPL(crc); > + memcpy(uart_config + uart_config_len, &crc, 4); > + uart_config_len += 4; > + > + serdev_device_write_buf(nxpdev->serdev, nxp_cmd5_header, req_len); > + } else { > + serdev_device_write_buf(nxpdev->serdev, uart_config, req_len); > + serdev_device_wait_until_sent(nxpdev->serdev, 0); > + ret = true; > + } > + return ret; > +} > + > +static bool nxp_fw_change_timeout(struct hci_dev *hdev, u16 req_len) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + bool ret = false; > + u8 nxp_cmd7_header[HDR_LEN] = {0x07, 0x00, 0x00, 0x00, > + 0x70, 0x00, 0x00, 0x00, > + 0x00, 0x00, 0x00, 0x00, > + 0x5b, 0x88, 0xf8, 0xba}; > + > + nxpdev->fw_v3_offset_correction += req_len; > + > + if (req_len == HDR_LEN) { > + serdev_device_write_buf(nxpdev->serdev, nxp_cmd7_header, req_len); > + serdev_device_wait_until_sent(nxpdev->serdev, 0); > + ret = true; > + } > + return ret; > +} > + > +static u32 nxp_get_data_len(const u8 *buf) > +{ > + return (buf[8] | (buf[9] << 8)); > +} > + > +/* for legacy chipsets with V1 bootloader */ > +static int nxp_recv_fw_req_v1(struct hci_dev *hdev, struct sk_buff *skb) > +{ > + struct V1_DATA_REQ *req = skb_pull_data(skb, sizeof(struct V1_DATA_REQ)); > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + const struct btnxpuart_data *nxp_data = nxpdev->nxp_data; > + static bool timeout_changed; > + static bool baudrate_changed; > + u32 requested_len; > + static u32 expected_len = HDR_LEN; > + int err; > + > + if (!test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state)) > + return 0; > + > + if (strlen(nxpdev->fw_name) == 0) { > + err = nxp_load_fw_params_for_chip_id(0xffff, hdev); > + if (err < 0) > + return err; > + timeout_changed = false; > + baudrate_changed = false; > + /* If secondary baudrate is not read from > + * the conf file set default value from nxp_data > + */ > + if (nxpdev->fw_dnld_sec_baudrate == 0) > + nxpdev->fw_dnld_sec_baudrate = nxp_data->fw_dnld_sec_baudrate; > + } > + > + if (nxpdev->fw_dnld_sec_baudrate != nxpdev->current_baudrate) { > + if (!timeout_changed) { > + nxp_send_ack(NXP_ACK_V1, hdev); > + timeout_changed = nxp_fw_change_timeout(hdev, req->len); > + return 0; > + } > + if (!baudrate_changed) { > + nxp_send_ack(NXP_ACK_V1, hdev); > + baudrate_changed = nxp_fw_change_baudrate(hdev, req->len); > + if (baudrate_changed) { > + serdev_device_set_baudrate(nxpdev->serdev, > + nxpdev->fw_dnld_sec_baudrate); > + nxpdev->current_baudrate = nxpdev->fw_dnld_sec_baudrate; > + } > + return 0; > + } > + } > + > + if (!nxpdev->fw) { > + BT_INFO("Request Firmware: %s", nxpdev->fw_name); > + err = request_firmware(&nxpdev->fw, nxpdev->fw_name, &hdev->dev); > + if (err < 0) { > + BT_ERR("Firmware file %s not found", nxpdev->fw_name); > + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); > + return err; > + } > + } > + > + if (req && (req->len ^ req->len_comp) == 0xffff) { > + nxp_send_ack(NXP_ACK_V1, hdev); > + if (req->len == 0) { > + BT_INFO("FW_Downloaded Successfully: %ld bytes", nxpdev->fw->size); > + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); > + wake_up_interruptible(&nxpdev->suspend_wait_q); > + return 0; > + } > + if (req->len & 0x01) { > + /* The CRC did not match at the other end. > + * That's why the request to re-send. > + * Simply send the same bytes again. > + */ > + requested_len = nxpdev->fw_sent_bytes; > + BT_ERR("CRC error. Resend %d bytes of FW.", requested_len); > + } else { > + /* Increment offset by number of previous successfully sent bytes */ > + nxpdev->fw_dnld_offset += nxpdev->fw_sent_bytes; > + requested_len = req->len; > + } > + > + /* The FW bin file is made up of many blocks of > + * 16 byte header and payload data chunks. If the > + * FW has requested a header, read the payload length > + * info from the header, and then send the header. > + * In the next iteration, the FW should request the > + * payload data chunk, which should be equal to the > + * payload length read from header. If there is a > + * mismatch, clearly the driver and FW are out of sync, > + * and we need to re-send the previous header again. > + */ > + if (requested_len == expected_len) { > + if (requested_len == HDR_LEN) > + expected_len = nxp_get_data_len(nxpdev->fw->data + > + nxpdev->fw_dnld_offset); > + else > + expected_len = HDR_LEN; > + } else { > + if (requested_len == HDR_LEN) { > + /* FW download out of sync. Send previous chunk again */ > + nxpdev->fw_dnld_offset -= nxpdev->fw_sent_bytes; > + expected_len = HDR_LEN; > + } > + } > + > + if (nxpdev->fw_dnld_offset + requested_len <= nxpdev->fw->size) > + serdev_device_write_buf(nxpdev->serdev, > + nxpdev->fw->data + nxpdev->fw_dnld_offset, > + requested_len); > + nxpdev->fw_sent_bytes = requested_len; > + } else { > + BT_INFO("ERR: Send NAK"); > + nxp_send_ack(NXP_NAK_V1, hdev); > + } > + return 0; > +} > + > +static int nxp_recv_chip_ver_v3(struct hci_dev *hdev, struct sk_buff *skb) > +{ > + struct V3_START_IND *req = skb_pull_data(skb, sizeof(struct V3_START_IND)); > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + const struct btnxpuart_data *nxp_data = nxpdev->nxp_data; > + int err = 0; > + > + if (!test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state)) > + return 0; > + > + if (req) { > + if (strlen(nxpdev->fw_name) == 0) { > + nxp_load_fw_params_for_chip_id(req->chip_id, hdev); > + } else if (!nxpdev->fw) { > + BT_INFO("Request Firmware: %s", nxpdev->fw_name); > + err = request_firmware(&nxpdev->fw, nxpdev->fw_name, &hdev->dev); > + if (err < 0) { > + BT_ERR("Firmware file %s not found", nxpdev->fw_name); > + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); > + } > + } else { > + /* If secondary baudrate is not read from > + * the conf file set default value from nxp_data > + */ > + if (nxpdev->fw_dnld_sec_baudrate == 0) > + nxpdev->fw_dnld_sec_baudrate = nxp_data->fw_dnld_sec_baudrate; > + nxp_send_ack(NXP_ACK_V3, hdev); > + } > + } > + return err; > +} > + > +static int nxp_recv_fw_req_v3(struct hci_dev *hdev, struct sk_buff *skb) > +{ > + struct V3_DATA_REQ *req = skb_pull_data(skb, sizeof(struct V3_DATA_REQ)); > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + static bool timeout_changed; > + static bool baudrate_changed; > + > + if (!req || !nxpdev || !strlen(nxpdev->fw_name) || !nxpdev->fw->data) > + return 0; > + > + if (!test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state)) > + return 0; > + > + nxp_send_ack(NXP_ACK_V3, hdev); > + > + if (nxpdev->fw_dnld_sec_baudrate != nxpdev->current_baudrate) { > + if (!timeout_changed) { > + timeout_changed = nxp_fw_change_timeout(hdev, req->len); > + return 0; > + } > + > + if (!baudrate_changed) { > + baudrate_changed = nxp_fw_change_baudrate(hdev, req->len); > + if (baudrate_changed) { > + serdev_device_set_baudrate(nxpdev->serdev, > + nxpdev->fw_dnld_sec_baudrate); > + nxpdev->current_baudrate = nxpdev->fw_dnld_sec_baudrate; > + } > + return 0; > + } > + } > + > + if (req->len == 0) { > + BT_INFO("FW_Downloaded Successfully: %ld bytes", nxpdev->fw->size); > + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); > + wake_up_interruptible(&nxpdev->suspend_wait_q); > + return 0; > + } > + if (req->error) > + BT_ERR("FW Download received err 0x%02X from chip. Resending FW chunk.", > + req->error); > + > + if (req->offset < nxpdev->fw_v3_offset_correction) { > + /* This scenario should ideally never occur. > + * But if it ever does, FW is out of sync and > + * needs a power cycle. > + */ > + BT_ERR("Something went wrong during FW download. Please power cycle and try again"); > + return 0; > + } > + > + serdev_device_write_buf(nxpdev->serdev, > + nxpdev->fw->data + req->offset - nxpdev->fw_v3_offset_correction, > + req->len); > + > + return 0; > +} > + > +static int nxp_set_baudrate_cmd(struct hci_dev *hdev, void *data) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + struct ps_data *psdata = nxpdev->psdata; > + u8 *pcmd = (u8 *)&nxpdev->new_baudrate; > + struct sk_buff *skb; > + u8 *status; > + int ret = 0; > + > + if (!psdata) > + return -EFAULT; > + > + psdata->driver_sent_cmd = true; /* set flag to prevent re-sending command in nxp_enqueue */ > + skb = __hci_cmd_sync(hdev, HCI_NXP_SET_OPER_SPEED, 4, pcmd, HCI_CMD_TIMEOUT); > + psdata->driver_sent_cmd = false; > + > + if (IS_ERR(skb)) { > + bt_dev_err(hdev, "Setting baudrate failed (%ld)", > + PTR_ERR(skb)); > + return PTR_ERR(skb); > + } > + > + status = skb_pull_data(skb, 1); > + if (status) { > + if (*status == 0) { > + serdev_device_set_baudrate(nxpdev->serdev, nxpdev->new_baudrate); > + nxpdev->current_baudrate = nxpdev->new_baudrate; > + } > + ret = *status; > + BT_INFO("Set baudrate response: status=%d, baudrate=%d", > + *status, nxpdev->new_baudrate); > + } > + > + return ret; > +} > + > +/* NXP protocol */ > +static int nxp_setup(struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + const struct btnxpuart_data *nxp_data = nxpdev->nxp_data; > + const char *fw_name_dt; > + const char *fw_path = "nxp/"; > + int ret = 0; > + > + if (!serdev_device_get_cts(nxpdev->serdev)) { > + BT_INFO("CTS high. Need FW Download"); > + > + /* Try reading FW name from DT */ > + if (!device_property_read_string(&nxpdev->serdev->dev, "firmware-name", > + &fw_name_dt)) { > + strncpy(nxpdev->fw_name, fw_path, MAX_FW_FILE_NAME_LEN); > + strncpy(nxpdev->fw_name + strlen(fw_path), fw_name_dt, > + MAX_FW_FILE_NAME_LEN); > + } else { > + /* If no input from DT, parse conf file from user-space. > + * FW name will be selected based on the chip bootloader > + * signature read, and corresponding entry in conf file. > + */ > + ret = request_firmware(&nxpdev->fw_config, BT_FW_CONF_FILE, &hdev->dev); > + if (ret < 0) { > + BT_INFO("Firmware conf file not found: %s", BT_FW_CONF_FILE); > + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); > + goto err; > + } > + ret = nxp_parse_conf_file(hdev); > + release_firmware(nxpdev->fw_config); > + if (ret < 0) { > + BT_ERR("Error parsing config file: %s", BT_FW_CONF_FILE); > + goto err; > + } > + } > + > + ret = nxp_download_firmware(hdev); > + if (ret < 0) > + goto err; > + } else { > + BT_INFO("CTS low. FW already running."); > + } > + > + serdev_device_set_flow_control(nxpdev->serdev, 1); > + > + /* If fw_init_baudrate is not read from > + * the conf file set default value from nxp_data > + */ > + if (nxpdev->fw_init_baudrate == 0) > + nxpdev->fw_init_baudrate = nxp_data->fw_init_baudrate; > + serdev_device_set_baudrate(nxpdev->serdev, nxpdev->fw_init_baudrate); > + nxpdev->current_baudrate = nxpdev->fw_init_baudrate; > + > + /* If oper_speed is not read from > + * the conf file set default value from nxp_data > + */ > + if (nxpdev->oper_speed == 0) > + nxpdev->oper_speed = nxp_data->oper_speed; > + > + if (nxpdev->current_baudrate != nxpdev->oper_speed) { > + /* Queue cmd to set baudrate to oper-speed */ > + nxpdev->new_baudrate = nxpdev->oper_speed; > + hci_cmd_sync_queue(hdev, nxp_set_baudrate_cmd, NULL, NULL); > + } > + > + if (ps_init_work(hdev) == 0) > + ps_init_timer(hdev); > + ps_init(hdev); > +err: > + return ret; > +} > + > +static int nxp_enqueue(struct hci_dev *hdev, struct sk_buff *skb) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + struct ps_data *psdata = nxpdev->psdata; > + struct hci_command_hdr *hdr; > + u8 *param; > + > + /* if commands are received from user space (e.g. hcitool), update > + * driver flags accordingly and ask driver to re-send the command > + */ > + if (bt_cb(skb)->pkt_type == HCI_COMMAND_PKT && !psdata->driver_sent_cmd) { > + hdr = (struct hci_command_hdr *)skb->data; > + param = skb->data + HCI_COMMAND_HDR_SIZE; > + switch (__le16_to_cpu(hdr->opcode)) { > + case HCI_NXP_AUTO_SLEEP_MODE: > + if (hdr->plen >= 1) { > + if (param[0] == BT_PS_ENABLE) > + psdata->ps_mode = PS_MODE_ENABLE; > + else if (param[0] == BT_PS_DISABLE) > + psdata->ps_mode = PS_MODE_DISABLE; > + hci_cmd_sync_queue(hdev, send_ps_cmd, NULL, NULL); > + kfree_skb(skb); > + goto ret; > + } > + break; > + case HCI_NXP_WAKEUP_METHOD: > + if (hdr->plen >= 4) { > + switch (param[2]) { > + case BT_CTRL_WAKEUP_METHOD_DSR: > + psdata->wakeupmode = WAKEUP_METHOD_DTR; > + break; > + case BT_CTRL_WAKEUP_METHOD_BREAK: > + default: > + psdata->wakeupmode = WAKEUP_METHOD_BREAK; > + break; > + } > + hci_cmd_sync_queue(hdev, send_wakeup_method_cmd, NULL, NULL); > + kfree_skb(skb); > + goto ret; > + } > + break; > + case HCI_NXP_SET_OPER_SPEED: > + if (hdr->plen == 4) { > + nxpdev->new_baudrate = *((u32 *)param); > + hci_cmd_sync_queue(hdev, nxp_set_baudrate_cmd, NULL, NULL); > + kfree_skb(skb); > + goto ret; > + } > + } > + } > + > + /* Prepend skb with frame type */ > + memcpy(skb_push(skb, 1), &hci_skb_pkt_type(skb), 1); > + skb_queue_tail(&nxpdev->txq, skb); > + > + btnxpuart_tx_wakeup(nxpdev); > +ret: > + return 0; > +} > + > +static struct sk_buff *nxp_dequeue(void *data) > +{ > + struct btnxpuart_dev *nxpdev = (struct btnxpuart_dev *)data; > + > + ps_wakeup(nxpdev); > + ps_start_timer(nxpdev); > + return skb_dequeue(&nxpdev->txq); > +} > + > +/* btnxpuart based on serdev */ > +static void btnxpuart_tx_work(struct work_struct *work) > +{ > + struct btnxpuart_dev *nxpdev = container_of(work, struct btnxpuart_dev, > + tx_work); > + struct serdev_device *serdev = nxpdev->serdev; > + struct hci_dev *hdev = nxpdev->hdev; > + > + if (!nxpdev->nxp_data->dequeue) > + return; > + > + while (1) { > + clear_bit(BTNXPUART_TX_STATE_WAKEUP, &nxpdev->tx_state); > + > + while (1) { > + struct sk_buff *skb = nxpdev->nxp_data->dequeue(nxpdev); > + int len; > + > + if (!skb) > + break; > + > + len = serdev_device_write_buf(serdev, skb->data, > + skb->len); > + hdev->stat.byte_tx += len; > + > + skb_pull(skb, len); > + if (skb->len > 0) { > + skb_queue_head(&nxpdev->txq, skb); > + break; > + } > + > + switch (hci_skb_pkt_type(skb)) { > + case HCI_COMMAND_PKT: > + hdev->stat.cmd_tx++; > + break; > + case HCI_ACLDATA_PKT: > + hdev->stat.acl_tx++; > + break; > + case HCI_SCODATA_PKT: > + hdev->stat.sco_tx++; > + break; > + } > + > + kfree_skb(skb); > + } > + > + if (!test_bit(BTNXPUART_TX_STATE_WAKEUP, &nxpdev->tx_state)) > + break; > + } > + clear_bit(BTNXPUART_TX_STATE_ACTIVE, &nxpdev->tx_state); > +} > + > +static void btnxpuart_tx_wakeup(struct btnxpuart_dev *nxpdev) > +{ > + if (test_and_set_bit(BTNXPUART_TX_STATE_ACTIVE, &nxpdev->tx_state)) { > + set_bit(BTNXPUART_TX_STATE_WAKEUP, &nxpdev->tx_state); > + return; > + } > + schedule_work(&nxpdev->tx_work); > +} > + > +static int btnxpuart_open(struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + int err; > + > + err = serdev_device_open(nxpdev->serdev); > + if (err) { > + bt_dev_err(hdev, "Unable to open UART device %s", > + dev_name(&nxpdev->serdev->dev)); > + return err; > + } > + > + if (nxpdev->nxp_data->open) { > + err = nxpdev->nxp_data->open(hdev); > + if (err) { > + serdev_device_close(nxpdev->serdev); > + return err; > + } > + } > + > + return 0; > +} > + > +static int btnxpuart_close(struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + int err; > + > + if (nxpdev->nxp_data->close) { > + err = nxpdev->nxp_data->close(hdev); > + if (err) > + return err; > + } > + > + serdev_device_close(nxpdev->serdev); > + > + return 0; > +} > + > +static int btnxpuart_flush(struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + > + /* Flush any pending characters */ > + serdev_device_write_flush(nxpdev->serdev); > + skb_queue_purge(&nxpdev->txq); > + > + cancel_work_sync(&nxpdev->tx_work); > + > + kfree_skb(nxpdev->rx_skb); > + nxpdev->rx_skb = NULL; > + > + return 0; > +} > + > +static int btnxpuart_setup(struct hci_dev *hdev) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + > + if (nxpdev->nxp_data->setup) > + return nxpdev->nxp_data->setup(hdev); > + > + return 0; > +} > + > +static int btnxpuart_send_frame(struct hci_dev *hdev, struct sk_buff *skb) > +{ > + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); > + > + if (nxpdev->nxp_data->enqueue) > + nxpdev->nxp_data->enqueue(hdev, skb); > + > + return 0; > +} > + > +static int btnxpuart_receive_buf(struct serdev_device *serdev, const u8 *data, > + size_t count) > +{ > + struct btnxpuart_dev *nxpdev = serdev_device_get_drvdata(serdev); > + const struct btnxpuart_data *nxp_data = nxpdev->nxp_data; > + > + if (test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state)) { > + if (*data != NXP_V1_FW_REQ_PKT && *data != NXP_V1_CHIP_VER_PKT && > + *data != NXP_V3_FW_REQ_PKT && *data != NXP_V3_CHIP_VER_PKT) { > + /* Unknown bootloader signature, skip without returning error */ > + return count; > + } > + } > + > + ps_start_timer(nxpdev); > + > + nxpdev->rx_skb = h4_recv_buf(nxpdev->hdev, nxpdev->rx_skb, data, count, > + nxp_data->recv_pkts, nxp_data->recv_pkts_cnt); > + if (IS_ERR(nxpdev->rx_skb)) { > + int err = PTR_ERR(nxpdev->rx_skb); > + > + bt_dev_err(nxpdev->hdev, "Frame reassembly failed (%d)", err); > + nxpdev->rx_skb = NULL; > + return err; > + } > + nxpdev->hdev->stat.byte_rx += count; > + return count; > +} > + > +static void btnxpuart_write_wakeup(struct serdev_device *serdev) > +{ > + serdev_device_write_wakeup(serdev); > +} > + > +static const struct serdev_device_ops btnxpuart_client_ops = { > + .receive_buf = btnxpuart_receive_buf, > + .write_wakeup = btnxpuart_write_wakeup, > +}; > + > +static int nxp_serdev_probe(struct serdev_device *serdev) > +{ > + struct hci_dev *hdev; > + struct btnxpuart_dev *nxpdev; > + > + nxpdev = devm_kzalloc(&serdev->dev, sizeof(*nxpdev), GFP_KERNEL); > + if (!nxpdev) > + return -ENOMEM; > + > + memset(nxpdev, 0, sizeof(*nxpdev)); > + > + nxpdev->nxp_data = device_get_match_data(&serdev->dev); > + > + nxpdev->serdev = serdev; > + serdev_device_set_drvdata(serdev, nxpdev); > + > + serdev_device_set_client_ops(serdev, &btnxpuart_client_ops); > + > + INIT_WORK(&nxpdev->tx_work, btnxpuart_tx_work); > + skb_queue_head_init(&nxpdev->txq); > + > + /* Initialize and register HCI device */ > + hdev = hci_alloc_dev(); > + if (!hdev) { > + dev_err(&serdev->dev, "Can't allocate HCI device\n"); > + return -ENOMEM; > + } > + > + nxpdev->hdev = hdev; > + > + hdev->bus = HCI_UART; > + hci_set_drvdata(hdev, nxpdev); > + > + /* Only when vendor specific setup callback is provided, consider > + * the manufacturer information valid. This avoids filling in the > + * value for NXP when nothing is specified. > + */ > + if (nxpdev->nxp_data->setup) > + hdev->manufacturer = nxpdev->nxp_data->manufacturer; > + > + hdev->open = btnxpuart_open; > + hdev->close = btnxpuart_close; > + hdev->flush = btnxpuart_flush; > + hdev->setup = btnxpuart_setup; > + hdev->send = btnxpuart_send_frame; > + SET_HCIDEV_DEV(hdev, &serdev->dev); > + > + if (hci_register_dev(hdev) < 0) { > + dev_err(&serdev->dev, "Can't register HCI device\n"); > + hci_free_dev(hdev); > + return -ENODEV; > + } > + > + return 0; > +} > + > +static void nxp_serdev_remove(struct serdev_device *serdev) > +{ > + struct btnxpuart_dev *nxpdev = serdev_device_get_drvdata(serdev); > + struct hci_dev *hdev = nxpdev->hdev; > + > + /* Restore FW baudrate to fw_init_baudrate if changed. > + * This will ensure FW baudrate is in sync with > + * driver baudrate in case this driver is re-inserted. > + */ > + if (nxpdev->fw_init_baudrate != nxpdev->current_baudrate) { > + nxpdev->new_baudrate = nxpdev->fw_init_baudrate; > + nxp_set_baudrate_cmd(hdev, NULL); > + } > + > + ps_cancel_timer(nxpdev); > + hci_unregister_dev(hdev); > + hci_free_dev(hdev); > +} > + > +static const struct h4_recv_pkt nxp_recv_pkts[] = { > + { H4_RECV_ACL, .recv = hci_recv_frame }, > + { H4_RECV_SCO, .recv = hci_recv_frame }, > + { H4_RECV_EVENT, .recv = hci_recv_frame }, > + { NXP_RECV_FW_REQ_V1, .recv = nxp_recv_fw_req_v1 }, > + { NXP_RECV_CHIP_VER_V3, .recv = nxp_recv_chip_ver_v3 }, > + { NXP_RECV_FW_REQ_V3, .recv = nxp_recv_fw_req_v3 }, > +}; > + > +static const struct btnxpuart_data nxp_generic_data = { > + .recv_pkts = nxp_recv_pkts, > + .recv_pkts_cnt = ARRAY_SIZE(nxp_recv_pkts), > + .manufacturer = 18, > + .fw_dnld_pri_baudrate = 115200, > + .fw_dnld_sec_baudrate = 3000000, > + .fw_init_baudrate = 3000000, > + .oper_speed = 3000000, > + .setup = nxp_setup, > + .enqueue = nxp_enqueue, > + .dequeue = nxp_dequeue, > +}; > + > +static const struct btnxpuart_data nxp_legacy_data = { > + .recv_pkts = nxp_recv_pkts, > + .recv_pkts_cnt = ARRAY_SIZE(nxp_recv_pkts), > + .manufacturer = 18, > + .fw_dnld_pri_baudrate = 115200, > + .fw_dnld_sec_baudrate = 3000000, > + .fw_init_baudrate = 115200, > + .oper_speed = 3000000, > + .setup = nxp_setup, > + .enqueue = nxp_enqueue, > + .dequeue = nxp_dequeue, > +}; > + > +#ifdef CONFIG_OF > +static const struct of_device_id nxpuart_of_match_table[] = { > + { .compatible = "nxp,nxp-generic-bt-chip", .data = &nxp_generic_data }, > + { .compatible = "nxp,nxp-legacy-bt-chip", .data = &nxp_legacy_data }, > + { } > +}; > +MODULE_DEVICE_TABLE(of, nxpuart_of_match_table); > +#endif > + > +static struct serdev_device_driver nxp_serdev_driver = { > + .probe = nxp_serdev_probe, > + .remove = nxp_serdev_remove, > + .driver = { > + .name = "btnxpuart", > + .of_match_table = of_match_ptr(nxpuart_of_match_table), > + }, > +}; > + > +module_serdev_device_driver(nxp_serdev_driver); > + > +MODULE_AUTHOR("Neeraj Sanjay Kale <neeraj.sanjaykale@nxp.com>"); > +MODULE_DESCRIPTION("NXP Bluetooth Serial driver v1.0 "); > +MODULE_VERSION("v1.0"); > +MODULE_LICENSE("GPL"); > diff --git a/drivers/bluetooth/btnxp.h b/drivers/bluetooth/btnxp.h > new file mode 100644 > index 000000000000..23ab11c1ce8d > --- /dev/null > +++ b/drivers/bluetooth/btnxp.h > @@ -0,0 +1,230 @@ > +/* SPDX-License-Identifier: GPL-2.0-or-later */ > +/* > + * > + * NXP Bluetooth driver > + * Copyright 2018-2023 NXP > + * > + * > + * 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. > + * > + */ > + > +#ifndef BT_NXP_H_ > +#define BT_NXP_H_ > + > +#define BT_FW_CONF_FILE "nxp/bt_mod_para.conf" > +#define FW_NAME_TAG "fw_name" > +#define OPER_SPEED_TAG "oper_speed" > +#define FW_DL_PRI_BAUDRATE_TAG "fw_dl_pri_speed" > +#define FW_DL_SEC_BAUDRATE_TAG "fw_dl_sec_speed" > +#define FW_INIT_BAUDRATE "fw_init_speed" > + > +#define MAX_CHIP_NAME_LEN 20 > +#define MAX_FW_FILE_NAME_LEN 50 > +#define MAX_NO_OF_CHIPS_SUPPORT 20 > + > +/* Default ps timeout period in milli-second */ > +#define PS_DEFAULT_TIMEOUT_PERIOD 2000 > + > +/* wakeup methods */ > +#define WAKEUP_METHOD_DTR 0 > +#define WAKEUP_METHOD_BREAK 1 > +#define WAKEUP_METHOD_EXT_BREAK 2 > +#define WAKEUP_METHOD_RTS 3 > +#define WAKEUP_METHOD_INVALID 0xff > + > +/* power save mode status */ > +#define PS_MODE_DISABLE 0 > +#define PS_MODE_ENABLE 1 > + > +/* Power Save Commands to ps_work_func */ > +#define PS_CMD_EXIT_PS 1 > +#define PS_CMD_ENTER_PS 2 > + > +/* power save state */ > +#define PS_STATE_AWAKE 0 > +#define PS_STATE_SLEEP 1 > + > +/* Bluetooth vendor command : Sleep mode */ > +#define HCI_NXP_AUTO_SLEEP_MODE 0xFC23 > +/* Bluetooth vendor command : Wakeup method */ > +#define HCI_NXP_WAKEUP_METHOD 0xFC53 > +/* Bluetooth vendor command : Set operational baudrate */ > +#define HCI_NXP_SET_OPER_SPEED 0xFC09 > + > +/* Bluetooth Power State : Vendor cmd params */ > +#define BT_PS_ENABLE 0x02 > +#define BT_PS_DISABLE 0x03 > + > +/* Bluetooth Host Wakeup Methods */ > +#define BT_HOST_WAKEUP_METHOD_NONE 0x00 > +#define BT_HOST_WAKEUP_METHOD_DTR 0x01 > +#define BT_HOST_WAKEUP_METHOD_BREAK 0x02 > +#define BT_HOST_WAKEUP_METHOD_GPIO 0x03 > +#define BT_HOST_WAKEUP_DEFAULT_GPIO 5 > + > +/* Bluetooth Chip Wakeup Methods */ > +#define BT_CTRL_WAKEUP_METHOD_DSR 0x00 > +#define BT_CTRL_WAKEUP_METHOD_BREAK 0x01 > +#define BT_CTRL_WAKEUP_METHOD_GPIO 0x02 > +#define BT_CTRL_WAKEUP_METHOD_EXT_BREAK 0x04 > +#define BT_CTRL_WAKEUP_METHOD_RTS 0x05 > +#define BT_CTRL_WAKEUP_DEFAULT_GPIO 4 > + > +struct ps_data { > + u8 ps_mode; > + u8 cur_psmode; > + u8 ps_state; > + u8 ps_cmd; > + u8 wakeupmode; > + u8 cur_wakeupmode; > + u8 driver_sent_cmd; > + u8 timer_on; > + u32 interval; > + struct hci_dev *hdev; > + struct work_struct work; > + struct timer_list ps_timer; > +}; > + > +struct btnxpuart_data { > + const struct h4_recv_pkt *recv_pkts; > + int recv_pkts_cnt; > + unsigned int manufacturer; > + int (*open)(struct hci_dev *hdev); > + int (*close)(struct hci_dev *hdev); > + int (*setup)(struct hci_dev *hdev); > + int (*enqueue)(struct hci_dev *hdev, struct sk_buff *skb); > + struct sk_buff *(*dequeue)(void *data); > + u32 fw_dnld_pri_baudrate; > + u32 fw_dnld_sec_baudrate; > + u32 fw_init_baudrate; > + u32 oper_speed; > +}; > + > +struct btnxpuart_dev { > + struct hci_dev *hdev; > + struct serdev_device *serdev; > + > + struct work_struct tx_work; > + unsigned long tx_state; > + struct sk_buff_head txq; > + struct sk_buff *rx_skb; > + > + const struct firmware *fw; > + const struct firmware *fw_config; > + u8 fw_name[MAX_FW_FILE_NAME_LEN]; > + u32 fw_dnld_offset; > + u32 fw_sent_bytes; > + u32 fw_v3_offset_correction; > + wait_queue_head_t suspend_wait_q; > + > + u32 fw_dnld_pri_baudrate; > + u32 fw_dnld_sec_baudrate; > + u32 fw_init_baudrate; > + u32 oper_speed; > + u32 new_baudrate; > + u32 current_baudrate; > + > + struct ps_data *psdata; > + const struct btnxpuart_data *nxp_data; > +}; > + > +struct chip_id_map_table { > + u16 chip_id; > + const u8 *chip_name; > +}; > + > +struct fw_params { > + u16 chip_id; > + u8 chip_name[MAX_CHIP_NAME_LEN]; > + u8 fw_name[MAX_FW_FILE_NAME_LEN]; > + u32 fw_dnld_pri_baudrate; > + u32 fw_dnld_sec_baudrate; > + u32 fw_init_baudrate; > + u32 oper_speed; > +}; > + > +#define NXP_V1_FW_REQ_PKT 0xA5 > +#define NXP_V1_CHIP_VER_PKT 0xAA > +#define NXP_V3_FW_REQ_PKT 0xA7 > +#define NXP_V3_CHIP_VER_PKT 0xAB > + > +#define NXP_ACK_V1 0x5A > +#define NXP_NAK_V1 0xBF > +#define NXP_ACK_V3 0x7A > +#define NXP_NAK_V3 0x7B > +#define NXP_CRC_ERROR_V3 0x7C > + > +#define HDR_LEN 16 > + > +#define NXP_RECV_FW_REQ_V1 \ > + .type = NXP_V1_FW_REQ_PKT, \ > + .hlen = 4, \ > + .loff = 0, \ > + .lsize = 0, \ > + .maxlen = 4 > + > +#define NXP_RECV_CHIP_VER_V3 \ > + .type = NXP_V3_CHIP_VER_PKT, \ > + .hlen = 4, \ > + .loff = 0, \ > + .lsize = 0, \ > + .maxlen = 4 > + > +#define NXP_RECV_FW_REQ_V3 \ > + .type = NXP_V3_FW_REQ_PKT, \ > + .hlen = 9, \ > + .loff = 0, \ > + .lsize = 0, \ > + .maxlen = 9 > + > +struct V1_DATA_REQ { > + u16 len; > + u16 len_comp; > +} __packed; > + > +struct V3_DATA_REQ { > + u16 len; > + u32 offset; > + u16 error; > + u8 crc; > +} __packed; > + > +struct V3_START_IND { > + u16 chip_id; > + u8 loader_ver; > + u8 crc; > +} __packed; > + > +/* UART register addresses of BT chip */ > +#define CLKDIVADDR 0x7f00008f > +#define UARTDIVADDR 0x7f000090 > +#define UARTMCRADDR 0x7f000091 > +#define UARTREINITADDR 0x7f000092 > +#define UARTICRADDR 0x7f000093 > +#define UARTFCRADDR 0x7f000094 > + > +#define MCR 0x00000022 > +#define INIT 0x00000001 > +#define ICR 0x000000c7 > +#define FCR 0x000000c7 > + > +#define SWAPL(x) ((((x) >> 24) & 0xff) \ > + | (((x) >> 8) & 0xff00) \ > + | (((x) << 8) & 0xff0000L) \ > + | (((x) << 24) & 0xff000000L)) > + > +#define POLYNOMIAL8 0x07 > +#define POLYNOMIAL32 0x04c11db7L > + > +static void btnxpuart_tx_wakeup(struct btnxpuart_dev *nxpdev); > + > +#endif
Hi Neeraj, On Tue, Jan 24, 2023 at 9:48 AM Neeraj Sanjay Kale <neeraj.sanjaykale@nxp.com> wrote: > > Adds serdev_device_break_ctl() and an implementation for ttyport. > > Signed-off-by: Neeraj Sanjay Kale <neeraj.sanjaykale@nxp.com> > --- > drivers/tty/serdev/core.c | 11 +++++++++++ > drivers/tty/serdev/serdev-ttyport.c | 12 ++++++++++++ > include/linux/serdev.h | 6 ++++++ > 3 files changed, 29 insertions(+) > > diff --git a/drivers/tty/serdev/core.c b/drivers/tty/serdev/core.c > index 0180e1e4e75d..26321ad7e71d 100644 > --- a/drivers/tty/serdev/core.c > +++ b/drivers/tty/serdev/core.c > @@ -405,6 +405,17 @@ int serdev_device_set_tiocm(struct serdev_device *serdev, int set, int clear) > } > EXPORT_SYMBOL_GPL(serdev_device_set_tiocm); > > +int serdev_device_break_ctl(struct serdev_device *serdev, int break_state) > +{ > + struct serdev_controller *ctrl = serdev->ctrl; > + > + if (!ctrl || !ctrl->ops->break_ctl) > + return -ENOTSUPP; > + > + return ctrl->ops->break_ctl(ctrl, break_state); > +} > +EXPORT_SYMBOL_GPL(serdev_device_break_ctl); > + > static int serdev_drv_probe(struct device *dev) > { > const struct serdev_device_driver *sdrv = to_serdev_device_driver(dev->driver); > diff --git a/drivers/tty/serdev/serdev-ttyport.c b/drivers/tty/serdev/serdev-ttyport.c > index d367803e2044..847b1f71ab73 100644 > --- a/drivers/tty/serdev/serdev-ttyport.c > +++ b/drivers/tty/serdev/serdev-ttyport.c > @@ -247,6 +247,17 @@ static int ttyport_set_tiocm(struct serdev_controller *ctrl, unsigned int set, u > return tty->ops->tiocmset(tty, set, clear); > } > > +static int ttyport_break_ctl(struct serdev_controller *ctrl, unsigned int break_state) > +{ > + struct serport *serport = serdev_controller_get_drvdata(ctrl); > + struct tty_struct *tty = serport->tty; > + > + if (!tty->ops->break_ctl) > + return -ENOTSUPP; > + > + return tty->ops->break_ctl(tty, break_state); > +} > + > static const struct serdev_controller_ops ctrl_ops = { > .write_buf = ttyport_write_buf, > .write_flush = ttyport_write_flush, > @@ -259,6 +270,7 @@ static const struct serdev_controller_ops ctrl_ops = { > .wait_until_sent = ttyport_wait_until_sent, > .get_tiocm = ttyport_get_tiocm, > .set_tiocm = ttyport_set_tiocm, > + .break_ctl = ttyport_break_ctl, > }; > > struct device *serdev_tty_port_register(struct tty_port *port, > diff --git a/include/linux/serdev.h b/include/linux/serdev.h > index 66f624fc618c..01b5b8f308cb 100644 > --- a/include/linux/serdev.h > +++ b/include/linux/serdev.h > @@ -92,6 +92,7 @@ struct serdev_controller_ops { > void (*wait_until_sent)(struct serdev_controller *, long); > int (*get_tiocm)(struct serdev_controller *); > int (*set_tiocm)(struct serdev_controller *, unsigned int, unsigned int); > + int (*break_ctl)(struct serdev_controller *, unsigned int); Looks like these callbacks don't have any documentation, not sure if that is because the operation itself is self explanatory, anyway I hope someone can review this from serdev before it can be merged into bluetooth-next. > }; > > /** > @@ -202,6 +203,7 @@ int serdev_device_write_buf(struct serdev_device *, const unsigned char *, size_ > void serdev_device_wait_until_sent(struct serdev_device *, long); > int serdev_device_get_tiocm(struct serdev_device *); > int serdev_device_set_tiocm(struct serdev_device *, int, int); > +int serdev_device_break_ctl(struct serdev_device *, int); > void serdev_device_write_wakeup(struct serdev_device *); > int serdev_device_write(struct serdev_device *, const unsigned char *, size_t, long); > void serdev_device_write_flush(struct serdev_device *); > @@ -255,6 +257,10 @@ static inline int serdev_device_set_tiocm(struct serdev_device *serdev, int set, > { > return -ENOTSUPP; > } > +static inline int serdev_device_break_ctl(struct serdev_device *serdev, int break_state) > +{ > + return -ENOTSUPP; > +} > static inline int serdev_device_write(struct serdev_device *sdev, const unsigned char *buf, > size_t count, unsigned long timeout) > { > -- > 2.34.1 >
Hi Neeraj, > we can remove double space after == and = 63 if (psdata->cur_psmode == PS_MODE_ENABLE) { 156 psdata->wakeupmode = WAKEUP_METHOD_DTR; 157 break; 158 case WAKEUP_METHOD_BREAK: 159 default: 160 psdata->wakeupmode = WAKEUP_METHOD_BREAK; >can remove extra space for /* break OFF */ default: serdev_device_break_ctl(nxpdev->serdev, -1); /* break ON */ serdev_device_break_ctl(nxpdev->serdev, 0); /* break OFF */ >when we are using (kzalloc) nxpdev = devm_kzalloc(&serdev->dev, sizeof(*nxpdev), GFP_KERNEL); and struct ps_data *psdata = kzalloc(sizeof(*psdata), GFP_KERNEL) is it require to use memset(nxpdev, 0, sizeof(*nxpdev)); ? Thanks, Alok On 1/25/2023 1:07 AM, ALOK TIWARI wrote: > correct the indentation > len = serdev_device_write_buf(serdev, skb->data, > skb->len); > > remove extra tab > serdev_device_break_ctl(nxpdev->serdev, 0); /* break OFF */ > else > serdev_device_break_ctl(nxpdev->serdev, -1); /* break ON */ > > extra space b/w else if > else if (data->ps_cmd == PS_CMD_EXIT_PS) > > can we use strncmp in case strcmp > (!strcmp(chip_id_name_table[i].chip_name, name_str)) > > > when config flag using CONFIG_BT_NXPUART -> why not give driver name > btnxpuart.o > > > Thanks, > > Alok > > On 1/24/2023 11:17 PM, Neeraj Sanjay Kale wrote: >> This adds a driver based on serdev driver for the NXP BT serial >> protocol based on running H:4, which can enable the built-in >> Bluetooth device inside a generic NXP BT chip. >> >> This driver has Power Save feature that will put the chip into >> sleep state whenever there is no activity for 2000ms, and will >> be woken up when any activity is to be initiated. >> >> This driver enables the power save feature by default by sending >> the vendor specific commands to the chip during setup. >> >> During setup, the driver is capable of reading the bootloader >> signature unique to every chip, and downloading corresponding >> FW file defined in a user-space config file. The firmware file >> name can be defined in DTS file as well, in which case the >> user-space config file will be ignored. >> >> Signed-off-by: Neeraj Sanjay Kale <neeraj.sanjaykale@nxp.com> >> --- >> MAINTAINERS | 7 + >> drivers/bluetooth/Kconfig | 11 + >> drivers/bluetooth/Makefile | 1 + >> drivers/bluetooth/btnxp.c | 1337 ++++++++++++++++++++++++++++++++++++ >> drivers/bluetooth/btnxp.h | 230 +++++++ >> 5 files changed, 1586 insertions(+) >> create mode 100644 drivers/bluetooth/btnxp.c >> create mode 100644 drivers/bluetooth/btnxp.h >> >> diff --git a/MAINTAINERS b/MAINTAINERS >> index 32dd41574930..20bb9e6b44b5 100644 >> --- a/MAINTAINERS >> +++ b/MAINTAINERS >> @@ -22835,6 +22835,13 @@ L: linux-mm@kvack.org >> S: Maintained >> F: mm/zswap.c >> +NXP BLUETOOTH WIRELESS DRIVERS >> +M: Amitkumar Karwar <amitkumar.karwar@nxp.com> >> +M: Neeraj Kale <neeraj.sanjaykale@nxp.com> >> +S: Maintained >> +F: Documentation/devicetree/bindings/net/bluetooth/nxp-bluetooth.yaml >> +F: drivers/bluetooth/btnxp* >> + >> THE REST >> M: Linus Torvalds <torvalds@linux-foundation.org> >> L: linux-kernel@vger.kernel.org >> diff --git a/drivers/bluetooth/Kconfig b/drivers/bluetooth/Kconfig >> index 5a1a7bec3c42..773b40d34b7b 100644 >> --- a/drivers/bluetooth/Kconfig >> +++ b/drivers/bluetooth/Kconfig >> @@ -465,4 +465,15 @@ config BT_VIRTIO >> Say Y here to compile support for HCI over Virtio into the >> kernel or say M to compile as a module. >> +config BT_NXPUART >> + tristate "NXP protocol support" >> + depends on SERIAL_DEV_BUS >> + help >> + NXP is serial driver required for NXP Bluetooth >> + devices with UART interface. >> + >> + Say Y here to compile support for NXP Bluetooth UART device into >> + the kernel, or say M here to compile as a module. >> + >> + >> endmenu >> diff --git a/drivers/bluetooth/Makefile b/drivers/bluetooth/Makefile >> index e0b261f24fc9..6c0e7fbe2297 100644 >> --- a/drivers/bluetooth/Makefile >> +++ b/drivers/bluetooth/Makefile >> @@ -29,6 +29,7 @@ obj-$(CONFIG_BT_QCA) += btqca.o >> obj-$(CONFIG_BT_MTK) += btmtk.o >> obj-$(CONFIG_BT_VIRTIO) += virtio_bt.o >> +obj-$(CONFIG_BT_NXPUART) += btnxp.o >> obj-$(CONFIG_BT_HCIUART_NOKIA) += hci_nokia.o >> diff --git a/drivers/bluetooth/btnxp.c b/drivers/bluetooth/btnxp.c >> new file mode 100644 >> index 000000000000..0066f778593a >> --- /dev/null >> +++ b/drivers/bluetooth/btnxp.c >> @@ -0,0 +1,1337 @@ >> +// SPDX-License-Identifier: GPL-2.0-or-later >> +/* >> + * >> + * NXP Bluetooth driver >> + * Copyright 2018-2023 NXP >> + * >> + * >> + * 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. >> + * >> + */ >> + >> +#include <linux/module.h> >> +#include <linux/kernel.h> >> + >> +#include <linux/serdev.h> >> +#include <linux/of.h> >> +#include <linux/skbuff.h> >> +#include <asm/unaligned.h> >> +#include <linux/firmware.h> >> +#include <linux/string.h> >> +#include <linux/crc8.h> >> + >> +#include <net/bluetooth/bluetooth.h> >> +#include <net/bluetooth/hci_core.h> >> + >> +#include "btnxp.h" >> +#include "h4_recv.h" >> + >> +#define BTNXPUART_TX_STATE_ACTIVE 1 >> +#define BTNXPUART_TX_STATE_WAKEUP 2 >> +#define BTNXPUART_FW_DOWNLOADING 3 >> + >> +static const struct chip_id_map_table chip_id_name_table[] = { >> + {0xffff, "legacy_chip"}, /* for legacy bootloader chipsets >> w8987 and w8997 */ >> + {0x7201, "iw416"}, >> + {0x7601, "iw612"}, >> + {0x5c03, "w9098"}, >> +}; >> + >> +static u8 crc8_table[CRC8_TABLE_SIZE]; >> +static unsigned long crc32_table[256]; >> +static struct fw_params fw_mod_params[MAX_NO_OF_CHIPS_SUPPORT]; >> + >> +/* NXP Power Save Feature */ >> +int wakeupmode = WAKEUP_METHOD_BREAK; >> +int ps_mode = PS_MODE_ENABLE; >> + >> +static void ps_start_timer(struct btnxpuart_dev *nxpdev) >> +{ >> + struct ps_data *psdata = nxpdev->psdata; >> + >> + if (!psdata) >> + return; >> + >> + if (psdata->cur_psmode == PS_MODE_ENABLE) { >> + psdata->timer_on = 1; >> + mod_timer(&psdata->ps_timer, jiffies + (psdata->interval * >> HZ) / 1000); >> + } >> +} >> + >> +static void ps_cancel_timer(struct btnxpuart_dev *nxpdev) >> +{ >> + struct ps_data *psdata = nxpdev->psdata; >> + >> + if (!psdata) >> + return; >> + >> + flush_scheduled_work(); >> + if (psdata->timer_on) >> + del_timer(&psdata->ps_timer); >> + kfree(psdata); >> +} >> + >> +static void ps_control(struct hci_dev *hdev, u8 ps_state) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + struct ps_data *psdata = nxpdev->psdata; >> + >> + if (psdata->ps_state == ps_state) >> + return; >> + >> + switch (psdata->cur_wakeupmode) { >> + case WAKEUP_METHOD_DTR: >> + if (ps_state == PS_STATE_AWAKE) >> + serdev_device_set_tiocm(nxpdev->serdev, TIOCM_DTR, 0); >> /* DTR ON */ >> + else >> + serdev_device_set_tiocm(nxpdev->serdev, 0, TIOCM_DTR); >> /* DTR OFF */ >> + break; >> + case WAKEUP_METHOD_BREAK: >> + default: >> + BT_INFO("Set UART break: %s", ps_state == PS_STATE_AWAKE ? >> "off" : "on"); >> + if (ps_state == PS_STATE_AWAKE) >> + serdev_device_break_ctl(nxpdev->serdev, 0); /* break OFF */ >> + else >> + serdev_device_break_ctl(nxpdev->serdev, -1); /* break ON */ >> + break; >> + } >> + psdata->ps_state = ps_state; >> + >> + if (ps_state == PS_STATE_AWAKE) >> + btnxpuart_tx_wakeup(nxpdev); >> +} >> + >> +static void ps_work_func(struct work_struct *work) >> +{ >> + struct ps_data *data = container_of(work, struct ps_data, work); >> + >> + if (data->ps_cmd == PS_CMD_ENTER_PS && data->cur_psmode == >> PS_MODE_ENABLE) >> + ps_control(data->hdev, PS_STATE_SLEEP); >> + else if (data->ps_cmd == PS_CMD_EXIT_PS) >> + ps_control(data->hdev, PS_STATE_AWAKE); >> +} >> + >> +static void ps_timeout_func(struct timer_list *t) >> +{ >> + struct ps_data *data = from_timer(data, t, ps_timer); >> + struct hci_dev *hdev = data->hdev; >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + >> + data->timer_on = 0; >> + if (test_bit(BTNXPUART_TX_STATE_ACTIVE, &nxpdev->tx_state)) { >> + ps_start_timer(nxpdev); >> + } else { >> + data->ps_cmd = PS_CMD_ENTER_PS; >> + schedule_work(&data->work); >> + } >> +} >> + >> +static int ps_init_work(struct hci_dev *hdev) >> +{ >> + struct ps_data *psdata = kzalloc(sizeof(*psdata), GFP_KERNEL); >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + >> + if (!psdata) { >> + BT_ERR("Can't allocate control structure for Power Save >> feature"); >> + return -ENOMEM; >> + } >> + nxpdev->psdata = psdata; >> + >> + memset(psdata, 0, sizeof(*psdata)); >> + psdata->interval = PS_DEFAULT_TIMEOUT_PERIOD; >> + psdata->ps_state = PS_STATE_AWAKE; >> + psdata->ps_mode = ps_mode; >> + psdata->hdev = hdev; >> + >> + switch (wakeupmode) { >> + case WAKEUP_METHOD_DTR: >> + psdata->wakeupmode = WAKEUP_METHOD_DTR; >> + break; >> + case WAKEUP_METHOD_BREAK: >> + default: >> + psdata->wakeupmode = WAKEUP_METHOD_BREAK; >> + break; >> + } >> + >> + psdata->cur_psmode = PS_MODE_DISABLE; >> + psdata->cur_wakeupmode = WAKEUP_METHOD_INVALID; >> + INIT_WORK(&psdata->work, ps_work_func); >> + >> + return 0; >> +} >> + >> +static void ps_init_timer(struct hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + struct ps_data *psdata = nxpdev->psdata; >> + >> + psdata->timer_on = 0; >> + timer_setup(&psdata->ps_timer, ps_timeout_func, 0); >> +} >> + >> +static int ps_wakeup(struct btnxpuart_dev *nxpdev) >> +{ >> + struct ps_data *psdata = nxpdev->psdata; >> + int ret = 1; >> + >> + if (psdata->ps_state == PS_STATE_AWAKE) >> + ret = 0; >> + psdata->ps_cmd = PS_CMD_EXIT_PS; >> + schedule_work(&psdata->work); >> + >> + return ret; >> +} >> + >> +static int send_ps_cmd(struct hci_dev *hdev, void *data) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + struct ps_data *psdata = nxpdev->psdata; >> + u8 pcmd; >> + struct sk_buff *skb; >> + u8 *status; >> + >> + if (psdata->ps_mode == PS_MODE_ENABLE) >> + pcmd = BT_PS_ENABLE; >> + else >> + pcmd = BT_PS_DISABLE; >> + >> + psdata->driver_sent_cmd = true; /* set flag to prevent >> re-sending command in nxp_enqueue */ >> + skb = __hci_cmd_sync(hdev, HCI_NXP_AUTO_SLEEP_MODE, 1, &pcmd, >> HCI_CMD_TIMEOUT); >> + psdata->driver_sent_cmd = false; >> + >> + if (IS_ERR(skb)) { >> + bt_dev_err(hdev, "Setting Power Save mode failed (%ld)", >> + PTR_ERR(skb)); >> + return PTR_ERR(skb); >> + } >> + >> + status = skb_pull_data(skb, 1); >> + >> + if (status) { >> + if (!*status) >> + psdata->cur_psmode = psdata->ps_mode; >> + else >> + psdata->ps_mode = psdata->cur_psmode; >> + if (psdata->cur_psmode == PS_MODE_ENABLE) >> + ps_start_timer(nxpdev); >> + else >> + ps_wakeup(nxpdev); >> + BT_INFO("Power Save mode response: status=%d, ps_mode=%d", >> + *status, psdata->cur_psmode); >> + } >> + return 0; >> +} >> + >> +static int send_wakeup_method_cmd(struct hci_dev *hdev, void *data) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + struct ps_data *psdata = nxpdev->psdata; >> + u8 pcmd[4]; >> + struct sk_buff *skb; >> + u8 *status; >> + >> + pcmd[0] = BT_HOST_WAKEUP_METHOD_NONE; >> + pcmd[1] = BT_HOST_WAKEUP_DEFAULT_GPIO; >> + switch (psdata->wakeupmode) { >> + case WAKEUP_METHOD_DTR: >> + pcmd[2] = BT_CTRL_WAKEUP_METHOD_DSR; >> + break; >> + case WAKEUP_METHOD_BREAK: >> + default: >> + pcmd[2] = BT_CTRL_WAKEUP_METHOD_BREAK; >> + break; >> + } >> + pcmd[3] = 0xFF; >> + >> + psdata->driver_sent_cmd = true; /* set flag to prevent >> re-sending command in nxp_enqueue */ >> + skb = __hci_cmd_sync(hdev, HCI_NXP_WAKEUP_METHOD, 4, pcmd, >> HCI_CMD_TIMEOUT); >> + psdata->driver_sent_cmd = false; >> + >> + if (IS_ERR(skb)) { >> + bt_dev_err(hdev, "Setting wake-up method failed (%ld)", >> + PTR_ERR(skb)); >> + return PTR_ERR(skb); >> + } >> + >> + status = skb_pull_data(skb, 1); >> + if (status) { >> + if (*status == 0) >> + psdata->cur_wakeupmode = psdata->wakeupmode; >> + else >> + psdata->wakeupmode = psdata->cur_wakeupmode; >> + BT_INFO("Set Wakeup Method response: status=%d, wakeupmode=%d", >> + *status, psdata->cur_wakeupmode); >> + } >> + >> + return 0; >> +} >> + >> +static int ps_init(struct hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + struct ps_data *psdata = nxpdev->psdata; >> + >> + serdev_device_set_tiocm(nxpdev->serdev, TIOCM_RTS, 0); /* RTS ON */ >> + >> + switch (psdata->wakeupmode) { >> + case WAKEUP_METHOD_DTR: >> + serdev_device_set_tiocm(nxpdev->serdev, 0, TIOCM_DTR); /* >> DTR OFF */ >> + serdev_device_set_tiocm(nxpdev->serdev, TIOCM_DTR, 0); /* >> DTR ON */ >> + break; >> + case WAKEUP_METHOD_BREAK: >> + default: >> + serdev_device_break_ctl(nxpdev->serdev, -1); /* break ON */ >> + serdev_device_break_ctl(nxpdev->serdev, 0); /* break OFF */ >> + break; >> + } >> + if (!test_bit(HCI_RUNNING, &hdev->flags)) { >> + BT_ERR("HCI_RUNNING is not set"); >> + return -EBUSY; >> + } >> + if (psdata->cur_wakeupmode != psdata->wakeupmode) >> + hci_cmd_sync_queue(hdev, send_wakeup_method_cmd, NULL, NULL); >> + if (psdata->cur_psmode != psdata->ps_mode) >> + hci_cmd_sync_queue(hdev, send_ps_cmd, NULL, NULL); >> + >> + return 0; >> +} >> + >> +/* NXP Firmware Download Feature */ >> +static u16 nxp_get_chip_id_from_name(u8 *name_str) >> +{ >> + int map_table_size = sizeof(chip_id_name_table) / sizeof(struct >> chip_id_map_table); >> + int i; >> + >> + for (i = 0; i < map_table_size; i++) { >> + if (!strcmp(chip_id_name_table[i].chip_name, name_str)) >> + return chip_id_name_table[i].chip_id; >> + } >> + >> + return 0; /* invalid name_str */ >> +} >> + >> +static int nxp_parse_conf_file(struct hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + const char *sptr; >> + char *dptr, *label, *value; >> + char line[100]; >> + int i = 0; >> + int param_index = 0; >> + int line_num = 1; >> + int ret = 0; >> + bool skipline = false; >> + bool valid_param = false; >> + >> + memset(fw_mod_params, 0, sizeof(fw_mod_params)); >> + sptr = nxpdev->fw_config->data; >> + dptr = line; >> + for (i = 0; i < nxpdev->fw_config->size; i++) { >> + /* if current line is a comment, ignore */ >> + if (sptr[i] == '#') { >> + skipline = true; >> + continue; >> + } >> + if (sptr[i] != '\n' && skipline) >> + continue; >> + /* ignore space <CR> and comma*/ >> + if (sptr[i] == ' ' || sptr[i] == '\r' || sptr[i] == ',') >> + continue; >> + /* select next fw_mod_params index */ >> + if (sptr[i] == '}') { >> + if (!valid_param) { >> + BT_ERR("Unexpected '}' on line %d", line_num); >> + ret = -1; >> + goto err; >> + } >> + param_index++; >> + valid_param = false; >> + continue; >> + } >> + if (sptr[i] == '\n') { >> + line_num++; >> + if (skipline) { >> + skipline = false; >> + continue; >> + } >> + *dptr = '\0'; >> + /* ignore empty lines */ >> + if (strlen(line) == 0) >> + continue; >> + dptr = line; >> + label = strsep(&dptr, "="); >> + value = strsep(&dptr, "="); >> + if (label && value) { >> + if (!strcmp(value, "{")) { >> + valid_param = true; >> + strncpy(fw_mod_params[param_index].chip_name, >> + label, MAX_CHIP_NAME_LEN); >> + fw_mod_params[param_index].chip_id = >> + nxp_get_chip_id_from_name(label); >> + if (fw_mod_params[param_index].chip_id == 0) { >> + BT_ERR("Invalid label %s in %s", label, >> + BT_FW_CONF_FILE); >> + ret = -1; >> + goto err; >> + } >> + } else { >> + if (!valid_param) { >> + BT_ERR("Expecting a '{' on line %d", >> line_num - 1); >> + ret = -1; >> + goto err; >> + } >> + if (!strcmp(label, FW_NAME_TAG)) { >> + strncpy(fw_mod_params[param_index].fw_name, >> + value, MAX_FW_FILE_NAME_LEN); >> + } else if (!strcmp(label, OPER_SPEED_TAG)) { >> + ret = kstrtouint(value, 10, >> + &fw_mod_params[param_index].oper_speed); >> + } else if (!strcmp(label, >> FW_DL_PRI_BAUDRATE_TAG)) { >> + ret = kstrtouint(value, 10, >> + &fw_mod_params[param_index].fw_dnld_pri_baudrate); >> + } else if (!strcmp(label, >> FW_DL_SEC_BAUDRATE_TAG)) { >> + ret = kstrtouint(value, 10, >> + &fw_mod_params[param_index].fw_dnld_sec_baudrate); >> + } else if (!strcmp(label, FW_INIT_BAUDRATE)) { >> + ret = kstrtouint(value, 10, >> + &fw_mod_params[param_index].fw_init_baudrate); >> + } else { >> + BT_ERR("Unknown tag: %s", label); >> + ret = -1; >> + goto err; >> + } >> + } >> + } else { >> + BT_ERR("Invalid \"key\" = \"value\" pair at line: %d", >> + line_num - 1); >> + } >> + dptr = line; >> + } else { >> + *dptr = sptr[i]; >> + dptr++; >> + } >> + } >> + /* '}' not found till the end of the file */ >> + if (valid_param) { >> + BT_ERR("Expecting a '}' before the end of the file"); >> + ret = -1; >> + goto err; >> + } >> +err: >> + return ret; >> +} >> + >> +static int nxp_load_fw_params_for_chip_id(u16 chip_id, struct >> hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + int i; >> + >> + for (i = 0; i < MAX_NO_OF_CHIPS_SUPPORT; i++) { >> + if (chip_id == fw_mod_params[i].chip_id) { >> + strncpy(nxpdev->fw_name, fw_mod_params[i].fw_name, >> MAX_FW_FILE_NAME_LEN); >> + nxpdev->oper_speed = fw_mod_params[i].oper_speed; >> + nxpdev->fw_dnld_pri_baudrate = >> fw_mod_params[i].fw_dnld_pri_baudrate; >> + nxpdev->fw_dnld_sec_baudrate = >> fw_mod_params[i].fw_dnld_sec_baudrate; >> + nxpdev->fw_init_baudrate = >> fw_mod_params[i].fw_init_baudrate; >> + break; >> + } >> + } >> + if (i == MAX_NO_OF_CHIPS_SUPPORT) { >> + if (chip_id == 0xffff) >> + BT_ERR("%s does not contain entry for 'legacy_chip'", >> BT_FW_CONF_FILE); >> + else >> + BT_ERR("Unsupported chip signature: %04X", chip_id); >> + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); >> + return -ENOENT; >> + } >> + return 0; >> +} >> + >> +static int nxp_download_firmware(struct hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + const struct btnxpuart_data *nxp_data = nxpdev->nxp_data; >> + int err = 0; >> + >> + nxpdev->fw_dnld_offset = 0; >> + nxpdev->fw_sent_bytes = 0; >> + >> + crc8_populate_msb(crc8_table, POLYNOMIAL8); >> + >> + serdev_device_set_baudrate(nxpdev->serdev, >> nxp_data->fw_dnld_pri_baudrate); >> + serdev_device_set_flow_control(nxpdev->serdev, 0); >> + set_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); >> + nxpdev->current_baudrate = nxp_data->fw_dnld_pri_baudrate; >> + nxpdev->fw_v3_offset_correction = 0; >> + >> + /* Wait till FW is downloaded and CTS becomes low */ >> + init_waitqueue_head(&nxpdev->suspend_wait_q); >> + err = wait_event_interruptible_timeout(nxpdev->suspend_wait_q, >> + !test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state), >> + msecs_to_jiffies(60000)); >> + if (err == 0) { >> + BT_ERR("FW Download Timeout."); >> + return -ETIMEDOUT; >> + } >> + >> + err = serdev_device_wait_for_cts(nxpdev->serdev, 1, 60000); >> + if (err < 0) { >> + BT_ERR("CTS is still high. FW Download failed."); >> + return err; >> + } >> + BT_INFO("CTS is low"); >> + release_firmware(nxpdev->fw); >> + >> + /* Allow the downloaded FW to initialize */ >> + usleep_range(20000, 22000); >> + >> + return 0; >> +} >> + >> +static int nxp_send_ack(u8 ack, struct hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + u8 ack_nak[2]; >> + >> + if (ack == NXP_ACK_V1 || ack == NXP_NAK_V1) { >> + ack_nak[0] = ack; >> + serdev_device_write_buf(nxpdev->serdev, ack_nak, 1); >> + } else if (ack == NXP_ACK_V3) { >> + ack_nak[0] = ack; >> + ack_nak[1] = crc8(crc8_table, ack_nak, 1, 0xFF); >> + serdev_device_write_buf(nxpdev->serdev, ack_nak, 2); >> + } >> + return 0; >> +} >> + >> +static void nxp_fw_dnld_gen_crc_table(void) >> +{ >> + int i, j; >> + unsigned long crc_accum; >> + >> + for (i = 0; i < 256; i++) { >> + crc_accum = ((unsigned long)i << 24); >> + for (j = 0; j < 8; j++) { >> + if (crc_accum & 0x80000000L) >> + crc_accum = (crc_accum << 1) ^ POLYNOMIAL32; >> + else >> + crc_accum = (crc_accum << 1); >> + } >> + crc32_table[i] = crc_accum; >> + } >> +} >> + >> +static unsigned long nxp_fw_dnld_update_crc(unsigned long crc_accum, >> + char *data_blk_ptr, >> + int data_blk_size) >> +{ >> + unsigned long i, j; >> + >> + for (j = 0; j < data_blk_size; j++) { >> + i = ((unsigned long)(crc_accum >> 24) ^ *data_blk_ptr++) & >> 0xff; >> + crc_accum = (crc_accum << 8) ^ crc32_table[i]; >> + } >> + return crc_accum; >> +} >> + >> +static bool nxp_fw_change_baudrate(struct hci_dev *hdev, u16 req_len) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + static u8 nxp_cmd5_header[HDR_LEN] = { >> + 0x05, 0x00, 0x00, 0x00, >> + 0x00, 0x00, 0x00, 0x00, >> + 0x2c, 0x00, 0x00, 0x00, >> + 0x77, 0xdb, 0xfd, 0xe0}; >> + static u8 uart_config[60] = {0}; >> + u32 header_len = 0; >> + u32 uart_config_len = 0; >> + u32 mcr = MCR; >> + u32 init = INIT; >> + u32 icr = ICR; >> + u32 fcr = FCR; >> + u32 br_addr = CLKDIVADDR; >> + u32 div_addr = UARTDIVADDR; >> + u32 mcr_addr = UARTMCRADDR; >> + u32 re_init_addr = UARTREINITADDR; >> + u32 icr_addr = UARTICRADDR; >> + u32 fcr_addr = UARTFCRADDR; >> + u32 uart_div = 1; >> + u32 uart_clk = 0x00C00000; >> + u32 crc = 0; >> + bool ret = false; >> + >> + nxpdev->fw_v3_offset_correction += req_len; >> + >> + if (req_len == HDR_LEN) { >> + /* Create CMD5 payload */ >> + memcpy(uart_config + uart_config_len, &br_addr, >> sizeof(br_addr)); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &uart_clk, >> sizeof(uart_clk)); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &div_addr, 4); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &uart_div, 4); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &mcr_addr, 4); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &mcr, 4); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &re_init_addr, 4); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &init, 4); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &icr_addr, 4); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &icr, 4); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &fcr_addr, 4); >> + uart_config_len += 4; >> + memcpy(uart_config + uart_config_len, &fcr, 4); >> + uart_config_len += 4; >> + header_len = uart_config_len + 4; >> + >> + nxp_fw_dnld_gen_crc_table(); >> + >> + /* Calculate CRC for CMD5 Header */ >> + memcpy(nxp_cmd5_header + 8, &header_len, sizeof(header_len)); >> + crc = (u32)nxp_fw_dnld_update_crc(0UL, nxp_cmd5_header, 12); >> + crc = (u32)SWAPL(crc); >> + memcpy(nxp_cmd5_header + 12, &crc, 4); >> + >> + /* Calculate CRC for CMD5 Payload */ >> + crc = (u32)nxp_fw_dnld_update_crc(0UL, uart_config, >> uart_config_len); >> + crc = (u32)SWAPL(crc); >> + memcpy(uart_config + uart_config_len, &crc, 4); >> + uart_config_len += 4; >> + >> + serdev_device_write_buf(nxpdev->serdev, nxp_cmd5_header, >> req_len); >> + } else { >> + serdev_device_write_buf(nxpdev->serdev, uart_config, req_len); >> + serdev_device_wait_until_sent(nxpdev->serdev, 0); >> + ret = true; >> + } >> + return ret; >> +} >> + >> +static bool nxp_fw_change_timeout(struct hci_dev *hdev, u16 req_len) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + bool ret = false; >> + u8 nxp_cmd7_header[HDR_LEN] = {0x07, 0x00, 0x00, 0x00, >> + 0x70, 0x00, 0x00, 0x00, >> + 0x00, 0x00, 0x00, 0x00, >> + 0x5b, 0x88, 0xf8, 0xba}; >> + >> + nxpdev->fw_v3_offset_correction += req_len; >> + >> + if (req_len == HDR_LEN) { >> + serdev_device_write_buf(nxpdev->serdev, nxp_cmd7_header, >> req_len); >> + serdev_device_wait_until_sent(nxpdev->serdev, 0); >> + ret = true; >> + } >> + return ret; >> +} >> + >> +static u32 nxp_get_data_len(const u8 *buf) >> +{ >> + return (buf[8] | (buf[9] << 8)); >> +} >> + >> +/* for legacy chipsets with V1 bootloader */ >> +static int nxp_recv_fw_req_v1(struct hci_dev *hdev, struct sk_buff >> *skb) >> +{ >> + struct V1_DATA_REQ *req = skb_pull_data(skb, sizeof(struct >> V1_DATA_REQ)); >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + const struct btnxpuart_data *nxp_data = nxpdev->nxp_data; >> + static bool timeout_changed; >> + static bool baudrate_changed; >> + u32 requested_len; >> + static u32 expected_len = HDR_LEN; >> + int err; >> + >> + if (!test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state)) >> + return 0; >> + >> + if (strlen(nxpdev->fw_name) == 0) { >> + err = nxp_load_fw_params_for_chip_id(0xffff, hdev); >> + if (err < 0) >> + return err; >> + timeout_changed = false; >> + baudrate_changed = false; >> + /* If secondary baudrate is not read from >> + * the conf file set default value from nxp_data >> + */ >> + if (nxpdev->fw_dnld_sec_baudrate == 0) >> + nxpdev->fw_dnld_sec_baudrate = >> nxp_data->fw_dnld_sec_baudrate; >> + } >> + >> + if (nxpdev->fw_dnld_sec_baudrate != nxpdev->current_baudrate) { >> + if (!timeout_changed) { >> + nxp_send_ack(NXP_ACK_V1, hdev); >> + timeout_changed = nxp_fw_change_timeout(hdev, req->len); >> + return 0; >> + } >> + if (!baudrate_changed) { >> + nxp_send_ack(NXP_ACK_V1, hdev); >> + baudrate_changed = nxp_fw_change_baudrate(hdev, req->len); >> + if (baudrate_changed) { >> + serdev_device_set_baudrate(nxpdev->serdev, >> + nxpdev->fw_dnld_sec_baudrate); >> + nxpdev->current_baudrate = >> nxpdev->fw_dnld_sec_baudrate; >> + } >> + return 0; >> + } >> + } >> + >> + if (!nxpdev->fw) { >> + BT_INFO("Request Firmware: %s", nxpdev->fw_name); >> + err = request_firmware(&nxpdev->fw, nxpdev->fw_name, >> &hdev->dev); >> + if (err < 0) { >> + BT_ERR("Firmware file %s not found", nxpdev->fw_name); >> + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); >> + return err; >> + } >> + } >> + >> + if (req && (req->len ^ req->len_comp) == 0xffff) { >> + nxp_send_ack(NXP_ACK_V1, hdev); >> + if (req->len == 0) { >> + BT_INFO("FW_Downloaded Successfully: %ld bytes", >> nxpdev->fw->size); >> + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); >> + wake_up_interruptible(&nxpdev->suspend_wait_q); >> + return 0; >> + } >> + if (req->len & 0x01) { >> + /* The CRC did not match at the other end. >> + * That's why the request to re-send. >> + * Simply send the same bytes again. >> + */ >> + requested_len = nxpdev->fw_sent_bytes; >> + BT_ERR("CRC error. Resend %d bytes of FW.", requested_len); >> + } else { >> + /* Increment offset by number of previous successfully >> sent bytes */ >> + nxpdev->fw_dnld_offset += nxpdev->fw_sent_bytes; >> + requested_len = req->len; >> + } >> + >> + /* The FW bin file is made up of many blocks of >> + * 16 byte header and payload data chunks. If the >> + * FW has requested a header, read the payload length >> + * info from the header, and then send the header. >> + * In the next iteration, the FW should request the >> + * payload data chunk, which should be equal to the >> + * payload length read from header. If there is a >> + * mismatch, clearly the driver and FW are out of sync, >> + * and we need to re-send the previous header again. >> + */ >> + if (requested_len == expected_len) { >> + if (requested_len == HDR_LEN) >> + expected_len = nxp_get_data_len(nxpdev->fw->data + >> + nxpdev->fw_dnld_offset); >> + else >> + expected_len = HDR_LEN; >> + } else { >> + if (requested_len == HDR_LEN) { >> + /* FW download out of sync. Send previous chunk >> again */ >> + nxpdev->fw_dnld_offset -= nxpdev->fw_sent_bytes; >> + expected_len = HDR_LEN; >> + } >> + } >> + >> + if (nxpdev->fw_dnld_offset + requested_len <= nxpdev->fw->size) >> + serdev_device_write_buf(nxpdev->serdev, >> + nxpdev->fw->data + nxpdev->fw_dnld_offset, >> + requested_len); >> + nxpdev->fw_sent_bytes = requested_len; >> + } else { >> + BT_INFO("ERR: Send NAK"); >> + nxp_send_ack(NXP_NAK_V1, hdev); >> + } >> + return 0; >> +} >> + >> +static int nxp_recv_chip_ver_v3(struct hci_dev *hdev, struct sk_buff >> *skb) >> +{ >> + struct V3_START_IND *req = skb_pull_data(skb, sizeof(struct >> V3_START_IND)); >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + const struct btnxpuart_data *nxp_data = nxpdev->nxp_data; >> + int err = 0; >> + >> + if (!test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state)) >> + return 0; >> + >> + if (req) { >> + if (strlen(nxpdev->fw_name) == 0) { >> + nxp_load_fw_params_for_chip_id(req->chip_id, hdev); >> + } else if (!nxpdev->fw) { >> + BT_INFO("Request Firmware: %s", nxpdev->fw_name); >> + err = request_firmware(&nxpdev->fw, nxpdev->fw_name, >> &hdev->dev); >> + if (err < 0) { >> + BT_ERR("Firmware file %s not found", nxpdev->fw_name); >> + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); >> + } >> + } else { >> + /* If secondary baudrate is not read from >> + * the conf file set default value from nxp_data >> + */ >> + if (nxpdev->fw_dnld_sec_baudrate == 0) >> + nxpdev->fw_dnld_sec_baudrate = >> nxp_data->fw_dnld_sec_baudrate; >> + nxp_send_ack(NXP_ACK_V3, hdev); >> + } >> + } >> + return err; >> +} >> + >> +static int nxp_recv_fw_req_v3(struct hci_dev *hdev, struct sk_buff >> *skb) >> +{ >> + struct V3_DATA_REQ *req = skb_pull_data(skb, sizeof(struct >> V3_DATA_REQ)); >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + static bool timeout_changed; >> + static bool baudrate_changed; >> + >> + if (!req || !nxpdev || !strlen(nxpdev->fw_name) || >> !nxpdev->fw->data) >> + return 0; >> + >> + if (!test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state)) >> + return 0; >> + >> + nxp_send_ack(NXP_ACK_V3, hdev); >> + >> + if (nxpdev->fw_dnld_sec_baudrate != nxpdev->current_baudrate) { >> + if (!timeout_changed) { >> + timeout_changed = nxp_fw_change_timeout(hdev, req->len); >> + return 0; >> + } >> + >> + if (!baudrate_changed) { >> + baudrate_changed = nxp_fw_change_baudrate(hdev, req->len); >> + if (baudrate_changed) { >> + serdev_device_set_baudrate(nxpdev->serdev, >> + nxpdev->fw_dnld_sec_baudrate); >> + nxpdev->current_baudrate = >> nxpdev->fw_dnld_sec_baudrate; >> + } >> + return 0; >> + } >> + } >> + >> + if (req->len == 0) { >> + BT_INFO("FW_Downloaded Successfully: %ld bytes", >> nxpdev->fw->size); >> + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); >> + wake_up_interruptible(&nxpdev->suspend_wait_q); >> + return 0; >> + } >> + if (req->error) >> + BT_ERR("FW Download received err 0x%02X from chip. Resending >> FW chunk.", >> + req->error); >> + >> + if (req->offset < nxpdev->fw_v3_offset_correction) { >> + /* This scenario should ideally never occur. >> + * But if it ever does, FW is out of sync and >> + * needs a power cycle. >> + */ >> + BT_ERR("Something went wrong during FW download. Please >> power cycle and try again"); >> + return 0; >> + } >> + >> + serdev_device_write_buf(nxpdev->serdev, >> + nxpdev->fw->data + req->offset - >> nxpdev->fw_v3_offset_correction, >> + req->len); >> + >> + return 0; >> +} >> + >> +static int nxp_set_baudrate_cmd(struct hci_dev *hdev, void *data) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + struct ps_data *psdata = nxpdev->psdata; >> + u8 *pcmd = (u8 *)&nxpdev->new_baudrate; >> + struct sk_buff *skb; >> + u8 *status; >> + int ret = 0; >> + >> + if (!psdata) >> + return -EFAULT; >> + >> + psdata->driver_sent_cmd = true; /* set flag to prevent >> re-sending command in nxp_enqueue */ >> + skb = __hci_cmd_sync(hdev, HCI_NXP_SET_OPER_SPEED, 4, pcmd, >> HCI_CMD_TIMEOUT); >> + psdata->driver_sent_cmd = false; >> + >> + if (IS_ERR(skb)) { >> + bt_dev_err(hdev, "Setting baudrate failed (%ld)", >> + PTR_ERR(skb)); >> + return PTR_ERR(skb); >> + } >> + >> + status = skb_pull_data(skb, 1); >> + if (status) { >> + if (*status == 0) { >> + serdev_device_set_baudrate(nxpdev->serdev, >> nxpdev->new_baudrate); >> + nxpdev->current_baudrate = nxpdev->new_baudrate; >> + } >> + ret = *status; >> + BT_INFO("Set baudrate response: status=%d, baudrate=%d", >> + *status, nxpdev->new_baudrate); >> + } >> + >> + return ret; >> +} >> + >> +/* NXP protocol */ >> +static int nxp_setup(struct hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + const struct btnxpuart_data *nxp_data = nxpdev->nxp_data; >> + const char *fw_name_dt; >> + const char *fw_path = "nxp/"; >> + int ret = 0; >> + >> + if (!serdev_device_get_cts(nxpdev->serdev)) { >> + BT_INFO("CTS high. Need FW Download"); >> + >> + /* Try reading FW name from DT */ >> + if (!device_property_read_string(&nxpdev->serdev->dev, >> "firmware-name", >> + &fw_name_dt)) { >> + strncpy(nxpdev->fw_name, fw_path, MAX_FW_FILE_NAME_LEN); >> + strncpy(nxpdev->fw_name + strlen(fw_path), fw_name_dt, >> + MAX_FW_FILE_NAME_LEN); >> + } else { >> + /* If no input from DT, parse conf file from user-space. >> + * FW name will be selected based on the chip bootloader >> + * signature read, and corresponding entry in conf file. >> + */ >> + ret = request_firmware(&nxpdev->fw_config, >> BT_FW_CONF_FILE, &hdev->dev); >> + if (ret < 0) { >> + BT_INFO("Firmware conf file not found: %s", >> BT_FW_CONF_FILE); >> + clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); >> + goto err; >> + } >> + ret = nxp_parse_conf_file(hdev); >> + release_firmware(nxpdev->fw_config); >> + if (ret < 0) { >> + BT_ERR("Error parsing config file: %s", >> BT_FW_CONF_FILE); >> + goto err; >> + } >> + } >> + >> + ret = nxp_download_firmware(hdev); >> + if (ret < 0) >> + goto err; >> + } else { >> + BT_INFO("CTS low. FW already running."); >> + } >> + >> + serdev_device_set_flow_control(nxpdev->serdev, 1); >> + >> + /* If fw_init_baudrate is not read from >> + * the conf file set default value from nxp_data >> + */ >> + if (nxpdev->fw_init_baudrate == 0) >> + nxpdev->fw_init_baudrate = nxp_data->fw_init_baudrate; >> + serdev_device_set_baudrate(nxpdev->serdev, >> nxpdev->fw_init_baudrate); >> + nxpdev->current_baudrate = nxpdev->fw_init_baudrate; >> + >> + /* If oper_speed is not read from >> + * the conf file set default value from nxp_data >> + */ >> + if (nxpdev->oper_speed == 0) >> + nxpdev->oper_speed = nxp_data->oper_speed; >> + >> + if (nxpdev->current_baudrate != nxpdev->oper_speed) { >> + /* Queue cmd to set baudrate to oper-speed */ >> + nxpdev->new_baudrate = nxpdev->oper_speed; >> + hci_cmd_sync_queue(hdev, nxp_set_baudrate_cmd, NULL, NULL); >> + } >> + >> + if (ps_init_work(hdev) == 0) >> + ps_init_timer(hdev); >> + ps_init(hdev); >> +err: >> + return ret; >> +} >> + >> +static int nxp_enqueue(struct hci_dev *hdev, struct sk_buff *skb) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + struct ps_data *psdata = nxpdev->psdata; >> + struct hci_command_hdr *hdr; >> + u8 *param; >> + >> + /* if commands are received from user space (e.g. hcitool), update >> + * driver flags accordingly and ask driver to re-send the command >> + */ >> + if (bt_cb(skb)->pkt_type == HCI_COMMAND_PKT && >> !psdata->driver_sent_cmd) { >> + hdr = (struct hci_command_hdr *)skb->data; >> + param = skb->data + HCI_COMMAND_HDR_SIZE; >> + switch (__le16_to_cpu(hdr->opcode)) { >> + case HCI_NXP_AUTO_SLEEP_MODE: >> + if (hdr->plen >= 1) { >> + if (param[0] == BT_PS_ENABLE) >> + psdata->ps_mode = PS_MODE_ENABLE; >> + else if (param[0] == BT_PS_DISABLE) >> + psdata->ps_mode = PS_MODE_DISABLE; >> + hci_cmd_sync_queue(hdev, send_ps_cmd, NULL, NULL); >> + kfree_skb(skb); >> + goto ret; >> + } >> + break; >> + case HCI_NXP_WAKEUP_METHOD: >> + if (hdr->plen >= 4) { >> + switch (param[2]) { >> + case BT_CTRL_WAKEUP_METHOD_DSR: >> + psdata->wakeupmode = WAKEUP_METHOD_DTR; >> + break; >> + case BT_CTRL_WAKEUP_METHOD_BREAK: >> + default: >> + psdata->wakeupmode = WAKEUP_METHOD_BREAK; >> + break; >> + } >> + hci_cmd_sync_queue(hdev, send_wakeup_method_cmd, >> NULL, NULL); >> + kfree_skb(skb); >> + goto ret; >> + } >> + break; >> + case HCI_NXP_SET_OPER_SPEED: >> + if (hdr->plen == 4) { >> + nxpdev->new_baudrate = *((u32 *)param); >> + hci_cmd_sync_queue(hdev, nxp_set_baudrate_cmd, NULL, >> NULL); >> + kfree_skb(skb); >> + goto ret; >> + } >> + } >> + } >> + >> + /* Prepend skb with frame type */ >> + memcpy(skb_push(skb, 1), &hci_skb_pkt_type(skb), 1); >> + skb_queue_tail(&nxpdev->txq, skb); >> + >> + btnxpuart_tx_wakeup(nxpdev); >> +ret: >> + return 0; >> +} >> + >> +static struct sk_buff *nxp_dequeue(void *data) >> +{ >> + struct btnxpuart_dev *nxpdev = (struct btnxpuart_dev *)data; >> + >> + ps_wakeup(nxpdev); >> + ps_start_timer(nxpdev); >> + return skb_dequeue(&nxpdev->txq); >> +} >> + >> +/* btnxpuart based on serdev */ >> +static void btnxpuart_tx_work(struct work_struct *work) >> +{ >> + struct btnxpuart_dev *nxpdev = container_of(work, struct >> btnxpuart_dev, >> + tx_work); >> + struct serdev_device *serdev = nxpdev->serdev; >> + struct hci_dev *hdev = nxpdev->hdev; >> + >> + if (!nxpdev->nxp_data->dequeue) >> + return; >> + >> + while (1) { >> + clear_bit(BTNXPUART_TX_STATE_WAKEUP, &nxpdev->tx_state); >> + >> + while (1) { >> + struct sk_buff *skb = nxpdev->nxp_data->dequeue(nxpdev); >> + int len; >> + >> + if (!skb) >> + break; >> + >> + len = serdev_device_write_buf(serdev, skb->data, >> + skb->len); >> + hdev->stat.byte_tx += len; >> + >> + skb_pull(skb, len); >> + if (skb->len > 0) { >> + skb_queue_head(&nxpdev->txq, skb); >> + break; >> + } >> + >> + switch (hci_skb_pkt_type(skb)) { >> + case HCI_COMMAND_PKT: >> + hdev->stat.cmd_tx++; >> + break; >> + case HCI_ACLDATA_PKT: >> + hdev->stat.acl_tx++; >> + break; >> + case HCI_SCODATA_PKT: >> + hdev->stat.sco_tx++; >> + break; >> + } >> + >> + kfree_skb(skb); >> + } >> + >> + if (!test_bit(BTNXPUART_TX_STATE_WAKEUP, &nxpdev->tx_state)) >> + break; >> + } >> + clear_bit(BTNXPUART_TX_STATE_ACTIVE, &nxpdev->tx_state); >> +} >> + >> +static void btnxpuart_tx_wakeup(struct btnxpuart_dev *nxpdev) >> +{ >> + if (test_and_set_bit(BTNXPUART_TX_STATE_ACTIVE, >> &nxpdev->tx_state)) { >> + set_bit(BTNXPUART_TX_STATE_WAKEUP, &nxpdev->tx_state); >> + return; >> + } >> + schedule_work(&nxpdev->tx_work); >> +} >> + >> +static int btnxpuart_open(struct hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + int err; >> + >> + err = serdev_device_open(nxpdev->serdev); >> + if (err) { >> + bt_dev_err(hdev, "Unable to open UART device %s", >> + dev_name(&nxpdev->serdev->dev)); >> + return err; >> + } >> + >> + if (nxpdev->nxp_data->open) { >> + err = nxpdev->nxp_data->open(hdev); >> + if (err) { >> + serdev_device_close(nxpdev->serdev); >> + return err; >> + } >> + } >> + >> + return 0; >> +} >> + >> +static int btnxpuart_close(struct hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + int err; >> + >> + if (nxpdev->nxp_data->close) { >> + err = nxpdev->nxp_data->close(hdev); >> + if (err) >> + return err; >> + } >> + >> + serdev_device_close(nxpdev->serdev); >> + >> + return 0; >> +} >> + >> +static int btnxpuart_flush(struct hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + >> + /* Flush any pending characters */ >> + serdev_device_write_flush(nxpdev->serdev); >> + skb_queue_purge(&nxpdev->txq); >> + >> + cancel_work_sync(&nxpdev->tx_work); >> + >> + kfree_skb(nxpdev->rx_skb); >> + nxpdev->rx_skb = NULL; >> + >> + return 0; >> +} >> + >> +static int btnxpuart_setup(struct hci_dev *hdev) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + >> + if (nxpdev->nxp_data->setup) >> + return nxpdev->nxp_data->setup(hdev); >> + >> + return 0; >> +} >> + >> +static int btnxpuart_send_frame(struct hci_dev *hdev, struct sk_buff >> *skb) >> +{ >> + struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); >> + >> + if (nxpdev->nxp_data->enqueue) >> + nxpdev->nxp_data->enqueue(hdev, skb); >> + >> + return 0; >> +} >> + >> +static int btnxpuart_receive_buf(struct serdev_device *serdev, const >> u8 *data, >> + size_t count) >> +{ >> + struct btnxpuart_dev *nxpdev = serdev_device_get_drvdata(serdev); >> + const struct btnxpuart_data *nxp_data = nxpdev->nxp_data; >> + >> + if (test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state)) { >> + if (*data != NXP_V1_FW_REQ_PKT && *data != >> NXP_V1_CHIP_VER_PKT && >> + *data != NXP_V3_FW_REQ_PKT && *data != >> NXP_V3_CHIP_VER_PKT) { >> + /* Unknown bootloader signature, skip without returning >> error */ >> + return count; >> + } >> + } >> + >> + ps_start_timer(nxpdev); >> + >> + nxpdev->rx_skb = h4_recv_buf(nxpdev->hdev, nxpdev->rx_skb, data, >> count, >> + nxp_data->recv_pkts, nxp_data->recv_pkts_cnt); >> + if (IS_ERR(nxpdev->rx_skb)) { >> + int err = PTR_ERR(nxpdev->rx_skb); >> + >> + bt_dev_err(nxpdev->hdev, "Frame reassembly failed (%d)", err); >> + nxpdev->rx_skb = NULL; >> + return err; >> + } >> + nxpdev->hdev->stat.byte_rx += count; >> + return count; >> +} >> + >> +static void btnxpuart_write_wakeup(struct serdev_device *serdev) >> +{ >> + serdev_device_write_wakeup(serdev); >> +} >> + >> +static const struct serdev_device_ops btnxpuart_client_ops = { >> + .receive_buf = btnxpuart_receive_buf, >> + .write_wakeup = btnxpuart_write_wakeup, >> +}; >> + >> +static int nxp_serdev_probe(struct serdev_device *serdev) >> +{ >> + struct hci_dev *hdev; >> + struct btnxpuart_dev *nxpdev; >> + >> + nxpdev = devm_kzalloc(&serdev->dev, sizeof(*nxpdev), GFP_KERNEL); >> + if (!nxpdev) >> + return -ENOMEM; >> + >> + memset(nxpdev, 0, sizeof(*nxpdev)); >> + >> + nxpdev->nxp_data = device_get_match_data(&serdev->dev); >> + >> + nxpdev->serdev = serdev; >> + serdev_device_set_drvdata(serdev, nxpdev); >> + >> + serdev_device_set_client_ops(serdev, &btnxpuart_client_ops); >> + >> + INIT_WORK(&nxpdev->tx_work, btnxpuart_tx_work); >> + skb_queue_head_init(&nxpdev->txq); >> + >> + /* Initialize and register HCI device */ >> + hdev = hci_alloc_dev(); >> + if (!hdev) { >> + dev_err(&serdev->dev, "Can't allocate HCI device\n"); >> + return -ENOMEM; >> + } >> + >> + nxpdev->hdev = hdev; >> + >> + hdev->bus = HCI_UART; >> + hci_set_drvdata(hdev, nxpdev); >> + >> + /* Only when vendor specific setup callback is provided, consider >> + * the manufacturer information valid. This avoids filling in the >> + * value for NXP when nothing is specified. >> + */ >> + if (nxpdev->nxp_data->setup) >> + hdev->manufacturer = nxpdev->nxp_data->manufacturer; >> + >> + hdev->open = btnxpuart_open; >> + hdev->close = btnxpuart_close; >> + hdev->flush = btnxpuart_flush; >> + hdev->setup = btnxpuart_setup; >> + hdev->send = btnxpuart_send_frame; >> + SET_HCIDEV_DEV(hdev, &serdev->dev); >> + >> + if (hci_register_dev(hdev) < 0) { >> + dev_err(&serdev->dev, "Can't register HCI device\n"); >> + hci_free_dev(hdev); >> + return -ENODEV; >> + } >> + >> + return 0; >> +} >> + >> +static void nxp_serdev_remove(struct serdev_device *serdev) >> +{ >> + struct btnxpuart_dev *nxpdev = serdev_device_get_drvdata(serdev); >> + struct hci_dev *hdev = nxpdev->hdev; >> + >> + /* Restore FW baudrate to fw_init_baudrate if changed. >> + * This will ensure FW baudrate is in sync with >> + * driver baudrate in case this driver is re-inserted. >> + */ >> + if (nxpdev->fw_init_baudrate != nxpdev->current_baudrate) { >> + nxpdev->new_baudrate = nxpdev->fw_init_baudrate; >> + nxp_set_baudrate_cmd(hdev, NULL); >> + } >> + >> + ps_cancel_timer(nxpdev); >> + hci_unregister_dev(hdev); >> + hci_free_dev(hdev); >> +} >> + >> +static const struct h4_recv_pkt nxp_recv_pkts[] = { >> + { H4_RECV_ACL, .recv = hci_recv_frame }, >> + { H4_RECV_SCO, .recv = hci_recv_frame }, >> + { H4_RECV_EVENT, .recv = hci_recv_frame }, >> + { NXP_RECV_FW_REQ_V1, .recv = nxp_recv_fw_req_v1 }, >> + { NXP_RECV_CHIP_VER_V3, .recv = nxp_recv_chip_ver_v3 }, >> + { NXP_RECV_FW_REQ_V3, .recv = nxp_recv_fw_req_v3 }, >> +}; >> + >> +static const struct btnxpuart_data nxp_generic_data = { >> + .recv_pkts = nxp_recv_pkts, >> + .recv_pkts_cnt = ARRAY_SIZE(nxp_recv_pkts), >> + .manufacturer = 18, >> + .fw_dnld_pri_baudrate = 115200, >> + .fw_dnld_sec_baudrate = 3000000, >> + .fw_init_baudrate = 3000000, >> + .oper_speed = 3000000, >> + .setup = nxp_setup, >> + .enqueue = nxp_enqueue, >> + .dequeue = nxp_dequeue, >> +}; >> + >> +static const struct btnxpuart_data nxp_legacy_data = { >> + .recv_pkts = nxp_recv_pkts, >> + .recv_pkts_cnt = ARRAY_SIZE(nxp_recv_pkts), >> + .manufacturer = 18, >> + .fw_dnld_pri_baudrate = 115200, >> + .fw_dnld_sec_baudrate = 3000000, >> + .fw_init_baudrate = 115200, >> + .oper_speed = 3000000, >> + .setup = nxp_setup, >> + .enqueue = nxp_enqueue, >> + .dequeue = nxp_dequeue, >> +}; >> + >> +#ifdef CONFIG_OF >> +static const struct of_device_id nxpuart_of_match_table[] = { >> + { .compatible = "nxp,nxp-generic-bt-chip", .data = >> &nxp_generic_data }, >> + { .compatible = "nxp,nxp-legacy-bt-chip", .data = >> &nxp_legacy_data }, >> + { } >> +}; >> +MODULE_DEVICE_TABLE(of, nxpuart_of_match_table); >> +#endif >> + >> +static struct serdev_device_driver nxp_serdev_driver = { >> + .probe = nxp_serdev_probe, >> + .remove = nxp_serdev_remove, >> + .driver = { >> + .name = "btnxpuart", >> + .of_match_table = of_match_ptr(nxpuart_of_match_table), >> + }, >> +}; >> + >> +module_serdev_device_driver(nxp_serdev_driver); >> + >> +MODULE_AUTHOR("Neeraj Sanjay Kale <neeraj.sanjaykale@nxp.com>"); >> +MODULE_DESCRIPTION("NXP Bluetooth Serial driver v1.0 "); >> +MODULE_VERSION("v1.0"); >> +MODULE_LICENSE("GPL"); >> diff --git a/drivers/bluetooth/btnxp.h b/drivers/bluetooth/btnxp.h >> new file mode 100644 >> index 000000000000..23ab11c1ce8d >> --- /dev/null >> +++ b/drivers/bluetooth/btnxp.h >> @@ -0,0 +1,230 @@ >> +/* SPDX-License-Identifier: GPL-2.0-or-later */ >> +/* >> + * >> + * NXP Bluetooth driver >> + * Copyright 2018-2023 NXP >> + * >> + * >> + * 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. >> + * >> + */ >> + >> +#ifndef BT_NXP_H_ >> +#define BT_NXP_H_ >> + >> +#define BT_FW_CONF_FILE "nxp/bt_mod_para.conf" >> +#define FW_NAME_TAG "fw_name" >> +#define OPER_SPEED_TAG "oper_speed" >> +#define FW_DL_PRI_BAUDRATE_TAG "fw_dl_pri_speed" >> +#define FW_DL_SEC_BAUDRATE_TAG "fw_dl_sec_speed" >> +#define FW_INIT_BAUDRATE "fw_init_speed" >> + >> +#define MAX_CHIP_NAME_LEN 20 >> +#define MAX_FW_FILE_NAME_LEN 50 >> +#define MAX_NO_OF_CHIPS_SUPPORT 20 >> + >> +/* Default ps timeout period in milli-second */ >> +#define PS_DEFAULT_TIMEOUT_PERIOD 2000 >> + >> +/* wakeup methods */ >> +#define WAKEUP_METHOD_DTR 0 >> +#define WAKEUP_METHOD_BREAK 1 >> +#define WAKEUP_METHOD_EXT_BREAK 2 >> +#define WAKEUP_METHOD_RTS 3 >> +#define WAKEUP_METHOD_INVALID 0xff >> + >> +/* power save mode status */ >> +#define PS_MODE_DISABLE 0 >> +#define PS_MODE_ENABLE 1 >> + >> +/* Power Save Commands to ps_work_func */ >> +#define PS_CMD_EXIT_PS 1 >> +#define PS_CMD_ENTER_PS 2 >> + >> +/* power save state */ >> +#define PS_STATE_AWAKE 0 >> +#define PS_STATE_SLEEP 1 >> + >> +/* Bluetooth vendor command : Sleep mode */ >> +#define HCI_NXP_AUTO_SLEEP_MODE 0xFC23 >> +/* Bluetooth vendor command : Wakeup method */ >> +#define HCI_NXP_WAKEUP_METHOD 0xFC53 >> +/* Bluetooth vendor command : Set operational baudrate */ >> +#define HCI_NXP_SET_OPER_SPEED 0xFC09 >> + >> +/* Bluetooth Power State : Vendor cmd params */ >> +#define BT_PS_ENABLE 0x02 >> +#define BT_PS_DISABLE 0x03 >> + >> +/* Bluetooth Host Wakeup Methods */ >> +#define BT_HOST_WAKEUP_METHOD_NONE 0x00 >> +#define BT_HOST_WAKEUP_METHOD_DTR 0x01 >> +#define BT_HOST_WAKEUP_METHOD_BREAK 0x02 >> +#define BT_HOST_WAKEUP_METHOD_GPIO 0x03 >> +#define BT_HOST_WAKEUP_DEFAULT_GPIO 5 >> + >> +/* Bluetooth Chip Wakeup Methods */ >> +#define BT_CTRL_WAKEUP_METHOD_DSR 0x00 >> +#define BT_CTRL_WAKEUP_METHOD_BREAK 0x01 >> +#define BT_CTRL_WAKEUP_METHOD_GPIO 0x02 >> +#define BT_CTRL_WAKEUP_METHOD_EXT_BREAK 0x04 >> +#define BT_CTRL_WAKEUP_METHOD_RTS 0x05 >> +#define BT_CTRL_WAKEUP_DEFAULT_GPIO 4 >> + >> +struct ps_data { >> + u8 ps_mode; >> + u8 cur_psmode; >> + u8 ps_state; >> + u8 ps_cmd; >> + u8 wakeupmode; >> + u8 cur_wakeupmode; >> + u8 driver_sent_cmd; >> + u8 timer_on; >> + u32 interval; >> + struct hci_dev *hdev; >> + struct work_struct work; >> + struct timer_list ps_timer; >> +}; >> + >> +struct btnxpuart_data { >> + const struct h4_recv_pkt *recv_pkts; >> + int recv_pkts_cnt; >> + unsigned int manufacturer; >> + int (*open)(struct hci_dev *hdev); >> + int (*close)(struct hci_dev *hdev); >> + int (*setup)(struct hci_dev *hdev); >> + int (*enqueue)(struct hci_dev *hdev, struct sk_buff *skb); >> + struct sk_buff *(*dequeue)(void *data); >> + u32 fw_dnld_pri_baudrate; >> + u32 fw_dnld_sec_baudrate; >> + u32 fw_init_baudrate; >> + u32 oper_speed; >> +}; >> + >> +struct btnxpuart_dev { >> + struct hci_dev *hdev; >> + struct serdev_device *serdev; >> + >> + struct work_struct tx_work; >> + unsigned long tx_state; >> + struct sk_buff_head txq; >> + struct sk_buff *rx_skb; >> + >> + const struct firmware *fw; >> + const struct firmware *fw_config; >> + u8 fw_name[MAX_FW_FILE_NAME_LEN]; >> + u32 fw_dnld_offset; >> + u32 fw_sent_bytes; >> + u32 fw_v3_offset_correction; >> + wait_queue_head_t suspend_wait_q; >> + >> + u32 fw_dnld_pri_baudrate; >> + u32 fw_dnld_sec_baudrate; >> + u32 fw_init_baudrate; >> + u32 oper_speed; >> + u32 new_baudrate; >> + u32 current_baudrate; >> + >> + struct ps_data *psdata; >> + const struct btnxpuart_data *nxp_data; >> +}; >> + >> +struct chip_id_map_table { >> + u16 chip_id; >> + const u8 *chip_name; >> +}; >> + >> +struct fw_params { >> + u16 chip_id; >> + u8 chip_name[MAX_CHIP_NAME_LEN]; >> + u8 fw_name[MAX_FW_FILE_NAME_LEN]; >> + u32 fw_dnld_pri_baudrate; >> + u32 fw_dnld_sec_baudrate; >> + u32 fw_init_baudrate; >> + u32 oper_speed; >> +}; >> + >> +#define NXP_V1_FW_REQ_PKT 0xA5 >> +#define NXP_V1_CHIP_VER_PKT 0xAA >> +#define NXP_V3_FW_REQ_PKT 0xA7 >> +#define NXP_V3_CHIP_VER_PKT 0xAB >> + >> +#define NXP_ACK_V1 0x5A >> +#define NXP_NAK_V1 0xBF >> +#define NXP_ACK_V3 0x7A >> +#define NXP_NAK_V3 0x7B >> +#define NXP_CRC_ERROR_V3 0x7C >> + >> +#define HDR_LEN 16 >> + >> +#define NXP_RECV_FW_REQ_V1 \ >> + .type = NXP_V1_FW_REQ_PKT, \ >> + .hlen = 4, \ >> + .loff = 0, \ >> + .lsize = 0, \ >> + .maxlen = 4 >> + >> +#define NXP_RECV_CHIP_VER_V3 \ >> + .type = NXP_V3_CHIP_VER_PKT, \ >> + .hlen = 4, \ >> + .loff = 0, \ >> + .lsize = 0, \ >> + .maxlen = 4 >> + >> +#define NXP_RECV_FW_REQ_V3 \ >> + .type = NXP_V3_FW_REQ_PKT, \ >> + .hlen = 9, \ >> + .loff = 0, \ >> + .lsize = 0, \ >> + .maxlen = 9 >> + >> +struct V1_DATA_REQ { >> + u16 len; >> + u16 len_comp; >> +} __packed; >> + >> +struct V3_DATA_REQ { >> + u16 len; >> + u32 offset; >> + u16 error; >> + u8 crc; >> +} __packed; >> + >> +struct V3_START_IND { >> + u16 chip_id; >> + u8 loader_ver; >> + u8 crc; >> +} __packed; >> + >> +/* UART register addresses of BT chip */ >> +#define CLKDIVADDR 0x7f00008f >> +#define UARTDIVADDR 0x7f000090 >> +#define UARTMCRADDR 0x7f000091 >> +#define UARTREINITADDR 0x7f000092 >> +#define UARTICRADDR 0x7f000093 >> +#define UARTFCRADDR 0x7f000094 >> + >> +#define MCR 0x00000022 >> +#define INIT 0x00000001 >> +#define ICR 0x000000c7 >> +#define FCR 0x000000c7 >> + >> +#define SWAPL(x) ((((x) >> 24) & 0xff) \ >> + | (((x) >> 8) & 0xff00) \ >> + | (((x) << 8) & 0xff0000L) \ >> + | (((x) << 24) & 0xff000000L)) >> + >> +#define POLYNOMIAL8 0x07 >> +#define POLYNOMIAL32 0x04c11db7L >> + >> +static void btnxpuart_tx_wakeup(struct btnxpuart_dev *nxpdev); >> + >> +#endif