| // SPDX-License-Identifier: GPL-2.0-or-later |
| /* |
| * NXP Bluetooth driver |
| * Copyright 2023 NXP |
| */ |
| |
| #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 <linux/crc32.h> |
| #include <linux/string_helpers.h> |
| |
| #include <net/bluetooth/bluetooth.h> |
| #include <net/bluetooth/hci_core.h> |
| |
| #include "h4_recv.h" |
| |
| #define MANUFACTURER_NXP 37 |
| |
| #define BTNXPUART_TX_STATE_ACTIVE 1 |
| #define BTNXPUART_FW_DOWNLOADING 2 |
| #define BTNXPUART_CHECK_BOOT_SIGNATURE 3 |
| #define BTNXPUART_SERDEV_OPEN 4 |
| |
| #define FIRMWARE_W8987 "nxp/uartuart8987_bt.bin" |
| #define FIRMWARE_W8997 "nxp/uartuart8997_bt_v4.bin" |
| #define FIRMWARE_W9098 "nxp/uartuart9098_bt_v1.bin" |
| #define FIRMWARE_IW416 "nxp/uartiw416_bt_v0.bin" |
| #define FIRMWARE_IW612 "nxp/uartspi_n61x_v1.bin.se" |
| #define FIRMWARE_HELPER "nxp/helper_uart_3000000.bin" |
| |
| #define CHIP_ID_W9098 0x5c03 |
| #define CHIP_ID_IW416 0x7201 |
| #define CHIP_ID_IW612 0x7601 |
| |
| #define HCI_NXP_PRI_BAUDRATE 115200 |
| #define HCI_NXP_SEC_BAUDRATE 3000000 |
| |
| #define MAX_FW_FILE_NAME_LEN 50 |
| |
| /* Default ps timeout period in milliseconds */ |
| #define PS_DEFAULT_TIMEOUT_PERIOD_MS 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 vendor command: Independent Reset */ |
| #define HCI_NXP_IND_RESET 0xfcfc |
| |
| /* 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 |
| |
| /* 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 |
| |
| struct ps_data { |
| u8 target_ps_mode; /* ps mode to be set */ |
| u8 cur_psmode; /* current ps_mode */ |
| u8 ps_state; /* controller's power save state */ |
| u8 ps_cmd; |
| u8 h2c_wakeupmode; |
| u8 cur_h2c_wakeupmode; |
| u8 c2h_wakeupmode; |
| u8 c2h_wakeup_gpio; |
| u8 h2c_wakeup_gpio; |
| bool driver_sent_cmd; |
| u16 h2c_ps_interval; |
| u16 c2h_ps_interval; |
| struct hci_dev *hdev; |
| struct work_struct work; |
| struct timer_list ps_timer; |
| }; |
| |
| struct wakeup_cmd_payload { |
| u8 c2h_wakeupmode; |
| u8 c2h_wakeup_gpio; |
| u8 h2c_wakeupmode; |
| u8 h2c_wakeup_gpio; |
| } __packed; |
| |
| struct psmode_cmd_payload { |
| u8 ps_cmd; |
| __le16 c2h_ps_interval; |
| } __packed; |
| |
| struct btnxpuart_data { |
| const char *helper_fw_name; |
| const char *fw_name; |
| }; |
| |
| 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; |
| u8 fw_name[MAX_FW_FILE_NAME_LEN]; |
| u32 fw_dnld_v1_offset; |
| u32 fw_v1_sent_bytes; |
| u32 fw_v3_offset_correction; |
| u32 fw_v1_expected_len; |
| wait_queue_head_t fw_dnld_done_wait_q; |
| wait_queue_head_t check_boot_sign_wait_q; |
| |
| u32 new_baudrate; |
| u32 current_baudrate; |
| u32 fw_init_baudrate; |
| bool timeout_changed; |
| bool baudrate_changed; |
| bool helper_downloaded; |
| |
| struct ps_data psdata; |
| struct btnxpuart_data *nxp_data; |
| }; |
| |
| #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_CHIP_VER_V1 \ |
| .type = NXP_V1_CHIP_VER_PKT, \ |
| .hlen = 4, \ |
| .loff = 0, \ |
| .lsize = 0, \ |
| .maxlen = 4 |
| |
| #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 { |
| __le16 len; |
| __le16 len_comp; |
| } __packed; |
| |
| struct v1_start_ind { |
| __le16 chip_id; |
| __le16 chip_id_comp; |
| } __packed; |
| |
| struct v3_data_req { |
| __le16 len; |
| __le32 offset; |
| __le16 error; |
| u8 crc; |
| } __packed; |
| |
| struct v3_start_ind { |
| __le16 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 POLYNOMIAL8 0x07 |
| |
| struct uart_reg { |
| __le32 address; |
| __le32 value; |
| } __packed; |
| |
| struct uart_config { |
| struct uart_reg clkdiv; |
| struct uart_reg uartdiv; |
| struct uart_reg mcr; |
| struct uart_reg re_init; |
| struct uart_reg icr; |
| struct uart_reg fcr; |
| __be32 crc; |
| } __packed; |
| |
| struct nxp_bootloader_cmd { |
| __le32 header; |
| __le32 arg; |
| __le32 payload_len; |
| __be32 crc; |
| } __packed; |
| |
| static u8 crc8_table[CRC8_TABLE_SIZE]; |
| |
| /* Default configurations */ |
| #define DEFAULT_H2C_WAKEUP_MODE WAKEUP_METHOD_BREAK |
| #define DEFAULT_PS_MODE PS_MODE_DISABLE |
| #define FW_INIT_BAUDRATE HCI_NXP_PRI_BAUDRATE |
| |
| static struct sk_buff *nxp_drv_send_cmd(struct hci_dev *hdev, u16 opcode, |
| u32 plen, |
| void *param) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| struct ps_data *psdata = &nxpdev->psdata; |
| struct sk_buff *skb; |
| |
| /* set flag to prevent nxp_enqueue from parsing values from this command and |
| * calling hci_cmd_sync_queue() again. |
| */ |
| psdata->driver_sent_cmd = true; |
| skb = __hci_cmd_sync(hdev, opcode, plen, param, HCI_CMD_TIMEOUT); |
| psdata->driver_sent_cmd = false; |
| |
| return skb; |
| } |
| |
| static void btnxpuart_tx_wakeup(struct btnxpuart_dev *nxpdev) |
| { |
| if (schedule_work(&nxpdev->tx_work)) |
| set_bit(BTNXPUART_TX_STATE_ACTIVE, &nxpdev->tx_state); |
| } |
| |
| /* NXP Power Save Feature */ |
| 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) |
| mod_timer(&psdata->ps_timer, jiffies + msecs_to_jiffies(psdata->h2c_ps_interval)); |
| } |
| |
| static void ps_cancel_timer(struct btnxpuart_dev *nxpdev) |
| { |
| struct ps_data *psdata = &nxpdev->psdata; |
| |
| flush_work(&psdata->work); |
| del_timer_sync(&psdata->ps_timer); |
| } |
| |
| 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; |
| int status; |
| |
| if (psdata->ps_state == ps_state || |
| !test_bit(BTNXPUART_SERDEV_OPEN, &nxpdev->tx_state)) |
| return; |
| |
| switch (psdata->cur_h2c_wakeupmode) { |
| case WAKEUP_METHOD_DTR: |
| if (ps_state == PS_STATE_AWAKE) |
| status = serdev_device_set_tiocm(nxpdev->serdev, TIOCM_DTR, 0); |
| else |
| status = serdev_device_set_tiocm(nxpdev->serdev, 0, TIOCM_DTR); |
| break; |
| case WAKEUP_METHOD_BREAK: |
| default: |
| if (ps_state == PS_STATE_AWAKE) |
| status = serdev_device_break_ctl(nxpdev->serdev, 0); |
| else |
| status = serdev_device_break_ctl(nxpdev->serdev, -1); |
| bt_dev_dbg(hdev, "Set UART break: %s, status=%d", |
| str_on_off(ps_state == PS_STATE_SLEEP), status); |
| break; |
| } |
| if (!status) |
| 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); |
| |
| 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 btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| struct ps_data *psdata = &nxpdev->psdata; |
| |
| psdata->h2c_ps_interval = PS_DEFAULT_TIMEOUT_PERIOD_MS; |
| psdata->ps_state = PS_STATE_AWAKE; |
| psdata->target_ps_mode = DEFAULT_PS_MODE; |
| psdata->hdev = hdev; |
| psdata->c2h_wakeupmode = BT_HOST_WAKEUP_METHOD_NONE; |
| psdata->c2h_wakeup_gpio = 0xff; |
| |
| switch (DEFAULT_H2C_WAKEUP_MODE) { |
| case WAKEUP_METHOD_DTR: |
| psdata->h2c_wakeupmode = WAKEUP_METHOD_DTR; |
| break; |
| case WAKEUP_METHOD_BREAK: |
| default: |
| psdata->h2c_wakeupmode = WAKEUP_METHOD_BREAK; |
| break; |
| } |
| psdata->cur_psmode = PS_MODE_DISABLE; |
| psdata->cur_h2c_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; |
| |
| timer_setup(&psdata->ps_timer, ps_timeout_func, 0); |
| } |
| |
| static void ps_wakeup(struct btnxpuart_dev *nxpdev) |
| { |
| struct ps_data *psdata = &nxpdev->psdata; |
| |
| if (psdata->ps_state != PS_STATE_AWAKE) { |
| psdata->ps_cmd = PS_CMD_EXIT_PS; |
| schedule_work(&psdata->work); |
| } |
| } |
| |
| 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; |
| struct psmode_cmd_payload pcmd; |
| struct sk_buff *skb; |
| u8 *status; |
| |
| if (psdata->target_ps_mode == PS_MODE_ENABLE) |
| pcmd.ps_cmd = BT_PS_ENABLE; |
| else |
| pcmd.ps_cmd = BT_PS_DISABLE; |
| pcmd.c2h_ps_interval = __cpu_to_le16(psdata->c2h_ps_interval); |
| |
| skb = nxp_drv_send_cmd(hdev, HCI_NXP_AUTO_SLEEP_MODE, sizeof(pcmd), &pcmd); |
| 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->target_ps_mode; |
| else |
| psdata->target_ps_mode = psdata->cur_psmode; |
| if (psdata->cur_psmode == PS_MODE_ENABLE) |
| ps_start_timer(nxpdev); |
| else |
| ps_wakeup(nxpdev); |
| bt_dev_dbg(hdev, "Power Save mode response: status=%d, ps_mode=%d", |
| *status, psdata->cur_psmode); |
| } |
| kfree_skb(skb); |
| |
| 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; |
| struct wakeup_cmd_payload pcmd; |
| struct sk_buff *skb; |
| u8 *status; |
| |
| pcmd.c2h_wakeupmode = psdata->c2h_wakeupmode; |
| pcmd.c2h_wakeup_gpio = psdata->c2h_wakeup_gpio; |
| switch (psdata->h2c_wakeupmode) { |
| case WAKEUP_METHOD_DTR: |
| pcmd.h2c_wakeupmode = BT_CTRL_WAKEUP_METHOD_DSR; |
| break; |
| case WAKEUP_METHOD_BREAK: |
| default: |
| pcmd.h2c_wakeupmode = BT_CTRL_WAKEUP_METHOD_BREAK; |
| break; |
| } |
| pcmd.h2c_wakeup_gpio = 0xff; |
| |
| skb = nxp_drv_send_cmd(hdev, HCI_NXP_WAKEUP_METHOD, sizeof(pcmd), &pcmd); |
| 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_h2c_wakeupmode = psdata->h2c_wakeupmode; |
| else |
| psdata->h2c_wakeupmode = psdata->cur_h2c_wakeupmode; |
| bt_dev_dbg(hdev, "Set Wakeup Method response: status=%d, h2c_wakeupmode=%d", |
| *status, psdata->cur_h2c_wakeupmode); |
| } |
| kfree_skb(skb); |
| |
| return 0; |
| } |
| |
| static void 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, 0, TIOCM_RTS); |
| usleep_range(5000, 10000); |
| serdev_device_set_tiocm(nxpdev->serdev, TIOCM_RTS, 0); |
| usleep_range(5000, 10000); |
| |
| switch (psdata->h2c_wakeupmode) { |
| case WAKEUP_METHOD_DTR: |
| serdev_device_set_tiocm(nxpdev->serdev, 0, TIOCM_DTR); |
| serdev_device_set_tiocm(nxpdev->serdev, TIOCM_DTR, 0); |
| break; |
| case WAKEUP_METHOD_BREAK: |
| default: |
| serdev_device_break_ctl(nxpdev->serdev, -1); |
| usleep_range(5000, 10000); |
| serdev_device_break_ctl(nxpdev->serdev, 0); |
| usleep_range(5000, 10000); |
| break; |
| } |
| if (psdata->cur_h2c_wakeupmode != psdata->h2c_wakeupmode) |
| hci_cmd_sync_queue(hdev, send_wakeup_method_cmd, NULL, NULL); |
| if (psdata->cur_psmode != psdata->target_ps_mode) |
| hci_cmd_sync_queue(hdev, send_ps_cmd, NULL, NULL); |
| } |
| |
| /* NXP Firmware Download Feature */ |
| static int nxp_download_firmware(struct hci_dev *hdev) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| int err = 0; |
| |
| nxpdev->fw_dnld_v1_offset = 0; |
| nxpdev->fw_v1_sent_bytes = 0; |
| nxpdev->fw_v1_expected_len = HDR_LEN; |
| nxpdev->fw_v3_offset_correction = 0; |
| nxpdev->baudrate_changed = false; |
| nxpdev->timeout_changed = false; |
| nxpdev->helper_downloaded = false; |
| |
| serdev_device_set_baudrate(nxpdev->serdev, HCI_NXP_PRI_BAUDRATE); |
| serdev_device_set_flow_control(nxpdev->serdev, false); |
| nxpdev->current_baudrate = HCI_NXP_PRI_BAUDRATE; |
| |
| /* Wait till FW is downloaded and CTS becomes low */ |
| err = wait_event_interruptible_timeout(nxpdev->fw_dnld_done_wait_q, |
| !test_bit(BTNXPUART_FW_DOWNLOADING, |
| &nxpdev->tx_state), |
| msecs_to_jiffies(60000)); |
| if (err == 0) { |
| bt_dev_err(hdev, "FW Download Timeout."); |
| return -ETIMEDOUT; |
| } |
| |
| serdev_device_set_flow_control(nxpdev->serdev, true); |
| err = serdev_device_wait_for_cts(nxpdev->serdev, 1, 60000); |
| if (err < 0) { |
| bt_dev_err(hdev, "CTS is still high. FW Download failed."); |
| return err; |
| } |
| release_firmware(nxpdev->fw); |
| memset(nxpdev->fw_name, 0, sizeof(nxpdev->fw_name)); |
| |
| /* Allow the downloaded FW to initialize */ |
| usleep_range(800 * USEC_PER_MSEC, 1 * USEC_PER_SEC); |
| |
| return 0; |
| } |
| |
| static void nxp_send_ack(u8 ack, struct hci_dev *hdev) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| u8 ack_nak[2]; |
| int len = 1; |
| |
| ack_nak[0] = ack; |
| if (ack == NXP_ACK_V3) { |
| ack_nak[1] = crc8(crc8_table, ack_nak, 1, 0xff); |
| len = 2; |
| } |
| serdev_device_write_buf(nxpdev->serdev, ack_nak, len); |
| } |
| |
| static bool nxp_fw_change_baudrate(struct hci_dev *hdev, u16 req_len) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| struct nxp_bootloader_cmd nxp_cmd5; |
| struct uart_config uart_config; |
| |
| if (req_len == sizeof(nxp_cmd5)) { |
| nxp_cmd5.header = __cpu_to_le32(5); |
| nxp_cmd5.arg = 0; |
| nxp_cmd5.payload_len = __cpu_to_le32(sizeof(uart_config)); |
| /* FW expects swapped CRC bytes */ |
| nxp_cmd5.crc = __cpu_to_be32(crc32_be(0UL, (char *)&nxp_cmd5, |
| sizeof(nxp_cmd5) - 4)); |
| |
| serdev_device_write_buf(nxpdev->serdev, (u8 *)&nxp_cmd5, sizeof(nxp_cmd5)); |
| nxpdev->fw_v3_offset_correction += req_len; |
| } else if (req_len == sizeof(uart_config)) { |
| uart_config.clkdiv.address = __cpu_to_le32(CLKDIVADDR); |
| uart_config.clkdiv.value = __cpu_to_le32(0x00c00000); |
| uart_config.uartdiv.address = __cpu_to_le32(UARTDIVADDR); |
| uart_config.uartdiv.value = __cpu_to_le32(1); |
| uart_config.mcr.address = __cpu_to_le32(UARTMCRADDR); |
| uart_config.mcr.value = __cpu_to_le32(MCR); |
| uart_config.re_init.address = __cpu_to_le32(UARTREINITADDR); |
| uart_config.re_init.value = __cpu_to_le32(INIT); |
| uart_config.icr.address = __cpu_to_le32(UARTICRADDR); |
| uart_config.icr.value = __cpu_to_le32(ICR); |
| uart_config.fcr.address = __cpu_to_le32(UARTFCRADDR); |
| uart_config.fcr.value = __cpu_to_le32(FCR); |
| /* FW expects swapped CRC bytes */ |
| uart_config.crc = __cpu_to_be32(crc32_be(0UL, (char *)&uart_config, |
| sizeof(uart_config) - 4)); |
| |
| serdev_device_write_buf(nxpdev->serdev, (u8 *)&uart_config, sizeof(uart_config)); |
| serdev_device_wait_until_sent(nxpdev->serdev, 0); |
| nxpdev->fw_v3_offset_correction += req_len; |
| return true; |
| } |
| return false; |
| } |
| |
| static bool nxp_fw_change_timeout(struct hci_dev *hdev, u16 req_len) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| struct nxp_bootloader_cmd nxp_cmd7; |
| |
| if (req_len != sizeof(nxp_cmd7)) |
| return false; |
| |
| nxp_cmd7.header = __cpu_to_le32(7); |
| nxp_cmd7.arg = __cpu_to_le32(0x70); |
| nxp_cmd7.payload_len = 0; |
| /* FW expects swapped CRC bytes */ |
| nxp_cmd7.crc = __cpu_to_be32(crc32_be(0UL, (char *)&nxp_cmd7, |
| sizeof(nxp_cmd7) - 4)); |
| serdev_device_write_buf(nxpdev->serdev, (u8 *)&nxp_cmd7, sizeof(nxp_cmd7)); |
| serdev_device_wait_until_sent(nxpdev->serdev, 0); |
| nxpdev->fw_v3_offset_correction += req_len; |
| return true; |
| } |
| |
| static u32 nxp_get_data_len(const u8 *buf) |
| { |
| struct nxp_bootloader_cmd *hdr = (struct nxp_bootloader_cmd *)buf; |
| |
| return __le32_to_cpu(hdr->payload_len); |
| } |
| |
| static bool is_fw_downloading(struct btnxpuart_dev *nxpdev) |
| { |
| return test_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); |
| } |
| |
| static bool process_boot_signature(struct btnxpuart_dev *nxpdev) |
| { |
| if (test_bit(BTNXPUART_CHECK_BOOT_SIGNATURE, &nxpdev->tx_state)) { |
| clear_bit(BTNXPUART_CHECK_BOOT_SIGNATURE, &nxpdev->tx_state); |
| wake_up_interruptible(&nxpdev->check_boot_sign_wait_q); |
| return false; |
| } |
| return is_fw_downloading(nxpdev); |
| } |
| |
| static int nxp_request_firmware(struct hci_dev *hdev, const char *fw_name) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| int err = 0; |
| |
| if (!strlen(nxpdev->fw_name)) { |
| snprintf(nxpdev->fw_name, MAX_FW_FILE_NAME_LEN, "%s", fw_name); |
| |
| bt_dev_dbg(hdev, "Request Firmware: %s", nxpdev->fw_name); |
| err = request_firmware(&nxpdev->fw, nxpdev->fw_name, &hdev->dev); |
| if (err < 0) { |
| bt_dev_err(hdev, "Firmware file %s not found", nxpdev->fw_name); |
| clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); |
| } |
| } |
| return err; |
| } |
| |
| /* for legacy chipsets with V1 bootloader */ |
| static int nxp_recv_chip_ver_v1(struct hci_dev *hdev, struct sk_buff *skb) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| struct v1_start_ind *req; |
| __u16 chip_id; |
| |
| req = skb_pull_data(skb, sizeof(*req)); |
| if (!req) |
| goto free_skb; |
| |
| chip_id = le16_to_cpu(req->chip_id ^ req->chip_id_comp); |
| if (chip_id == 0xffff) { |
| nxpdev->fw_dnld_v1_offset = 0; |
| nxpdev->fw_v1_sent_bytes = 0; |
| nxpdev->fw_v1_expected_len = HDR_LEN; |
| release_firmware(nxpdev->fw); |
| memset(nxpdev->fw_name, 0, sizeof(nxpdev->fw_name)); |
| nxp_send_ack(NXP_ACK_V1, hdev); |
| } |
| |
| free_skb: |
| kfree_skb(skb); |
| return 0; |
| } |
| |
| static int nxp_recv_fw_req_v1(struct hci_dev *hdev, struct sk_buff *skb) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| struct btnxpuart_data *nxp_data = nxpdev->nxp_data; |
| struct v1_data_req *req; |
| __u16 len; |
| |
| if (!process_boot_signature(nxpdev)) |
| goto free_skb; |
| |
| req = skb_pull_data(skb, sizeof(*req)); |
| if (!req) |
| goto free_skb; |
| |
| len = __le16_to_cpu(req->len ^ req->len_comp); |
| if (len != 0xffff) { |
| bt_dev_dbg(hdev, "ERR: Send NAK"); |
| nxp_send_ack(NXP_NAK_V1, hdev); |
| goto free_skb; |
| } |
| nxp_send_ack(NXP_ACK_V1, hdev); |
| |
| len = __le16_to_cpu(req->len); |
| |
| if (!nxp_data->helper_fw_name) { |
| if (!nxpdev->timeout_changed) { |
| nxpdev->timeout_changed = nxp_fw_change_timeout(hdev, |
| len); |
| goto free_skb; |
| } |
| if (!nxpdev->baudrate_changed) { |
| nxpdev->baudrate_changed = nxp_fw_change_baudrate(hdev, |
| len); |
| if (nxpdev->baudrate_changed) { |
| serdev_device_set_baudrate(nxpdev->serdev, |
| HCI_NXP_SEC_BAUDRATE); |
| serdev_device_set_flow_control(nxpdev->serdev, true); |
| nxpdev->current_baudrate = HCI_NXP_SEC_BAUDRATE; |
| } |
| goto free_skb; |
| } |
| } |
| |
| if (!nxp_data->helper_fw_name || nxpdev->helper_downloaded) { |
| if (nxp_request_firmware(hdev, nxp_data->fw_name)) |
| goto free_skb; |
| } else if (nxp_data->helper_fw_name && !nxpdev->helper_downloaded) { |
| if (nxp_request_firmware(hdev, nxp_data->helper_fw_name)) |
| goto free_skb; |
| } |
| |
| if (!len) { |
| bt_dev_dbg(hdev, "FW Downloaded Successfully: %zu bytes", |
| nxpdev->fw->size); |
| if (nxp_data->helper_fw_name && !nxpdev->helper_downloaded) { |
| nxpdev->helper_downloaded = true; |
| serdev_device_wait_until_sent(nxpdev->serdev, 0); |
| serdev_device_set_baudrate(nxpdev->serdev, |
| HCI_NXP_SEC_BAUDRATE); |
| serdev_device_set_flow_control(nxpdev->serdev, true); |
| } else { |
| clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); |
| wake_up_interruptible(&nxpdev->fw_dnld_done_wait_q); |
| } |
| goto free_skb; |
| } |
| if (len & 0x01) { |
| /* The CRC did not match at the other end. |
| * Simply send the same bytes again. |
| */ |
| len = nxpdev->fw_v1_sent_bytes; |
| bt_dev_dbg(hdev, "CRC error. Resend %d bytes of FW.", len); |
| } else { |
| nxpdev->fw_dnld_v1_offset += nxpdev->fw_v1_sent_bytes; |
| |
| /* 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, before sending 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 (len == nxpdev->fw_v1_expected_len) { |
| if (len == HDR_LEN) |
| nxpdev->fw_v1_expected_len = nxp_get_data_len(nxpdev->fw->data + |
| nxpdev->fw_dnld_v1_offset); |
| else |
| nxpdev->fw_v1_expected_len = HDR_LEN; |
| } else if (len == HDR_LEN) { |
| /* FW download out of sync. Send previous chunk again */ |
| nxpdev->fw_dnld_v1_offset -= nxpdev->fw_v1_sent_bytes; |
| nxpdev->fw_v1_expected_len = HDR_LEN; |
| } |
| } |
| |
| if (nxpdev->fw_dnld_v1_offset + len <= nxpdev->fw->size) |
| serdev_device_write_buf(nxpdev->serdev, nxpdev->fw->data + |
| nxpdev->fw_dnld_v1_offset, len); |
| nxpdev->fw_v1_sent_bytes = len; |
| |
| free_skb: |
| kfree_skb(skb); |
| return 0; |
| } |
| |
| static char *nxp_get_fw_name_from_chipid(struct hci_dev *hdev, u16 chipid) |
| { |
| char *fw_name = NULL; |
| |
| switch (chipid) { |
| case CHIP_ID_W9098: |
| fw_name = FIRMWARE_W9098; |
| break; |
| case CHIP_ID_IW416: |
| fw_name = FIRMWARE_IW416; |
| break; |
| case CHIP_ID_IW612: |
| fw_name = FIRMWARE_IW612; |
| break; |
| default: |
| bt_dev_err(hdev, "Unknown chip signature %04x", chipid); |
| break; |
| } |
| return fw_name; |
| } |
| |
| 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(*req)); |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| u16 chip_id; |
| |
| if (!process_boot_signature(nxpdev)) |
| goto free_skb; |
| |
| chip_id = le16_to_cpu(req->chip_id); |
| if (!nxp_request_firmware(hdev, nxp_get_fw_name_from_chipid(hdev, |
| chip_id))) |
| nxp_send_ack(NXP_ACK_V3, hdev); |
| |
| free_skb: |
| kfree_skb(skb); |
| return 0; |
| } |
| |
| static int nxp_recv_fw_req_v3(struct hci_dev *hdev, struct sk_buff *skb) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| struct v3_data_req *req; |
| __u16 len; |
| __u32 offset; |
| |
| if (!process_boot_signature(nxpdev)) |
| goto free_skb; |
| |
| req = skb_pull_data(skb, sizeof(*req)); |
| if (!req || !nxpdev->fw) |
| goto free_skb; |
| |
| nxp_send_ack(NXP_ACK_V3, hdev); |
| |
| len = __le16_to_cpu(req->len); |
| |
| if (!nxpdev->timeout_changed) { |
| nxpdev->timeout_changed = nxp_fw_change_timeout(hdev, len); |
| goto free_skb; |
| } |
| |
| if (!nxpdev->baudrate_changed) { |
| nxpdev->baudrate_changed = nxp_fw_change_baudrate(hdev, len); |
| if (nxpdev->baudrate_changed) { |
| serdev_device_set_baudrate(nxpdev->serdev, |
| HCI_NXP_SEC_BAUDRATE); |
| serdev_device_set_flow_control(nxpdev->serdev, true); |
| nxpdev->current_baudrate = HCI_NXP_SEC_BAUDRATE; |
| } |
| goto free_skb; |
| } |
| |
| if (req->len == 0) { |
| bt_dev_dbg(hdev, "FW Downloaded Successfully: %zu bytes", |
| nxpdev->fw->size); |
| clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); |
| wake_up_interruptible(&nxpdev->fw_dnld_done_wait_q); |
| goto free_skb; |
| } |
| if (req->error) |
| bt_dev_dbg(hdev, "FW Download received err 0x%02x from chip", |
| req->error); |
| |
| offset = __le32_to_cpu(req->offset); |
| if (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_dev_err(hdev, "Something went wrong during FW download"); |
| bt_dev_err(hdev, "Please power cycle and try again"); |
| goto free_skb; |
| } |
| |
| serdev_device_write_buf(nxpdev->serdev, nxpdev->fw->data + offset - |
| nxpdev->fw_v3_offset_correction, len); |
| |
| free_skb: |
| kfree_skb(skb); |
| return 0; |
| } |
| |
| static int nxp_set_baudrate_cmd(struct hci_dev *hdev, void *data) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| __le32 new_baudrate = __cpu_to_le32(nxpdev->new_baudrate); |
| struct ps_data *psdata = &nxpdev->psdata; |
| struct sk_buff *skb; |
| u8 *status; |
| |
| if (!psdata) |
| return 0; |
| |
| skb = nxp_drv_send_cmd(hdev, HCI_NXP_SET_OPER_SPEED, 4, (u8 *)&new_baudrate); |
| if (IS_ERR(skb)) { |
| bt_dev_err(hdev, "Setting baudrate failed (%ld)", PTR_ERR(skb)); |
| return PTR_ERR(skb); |
| } |
| |
| status = (u8 *)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; |
| } |
| bt_dev_dbg(hdev, "Set baudrate response: status=%d, baudrate=%d", |
| *status, nxpdev->new_baudrate); |
| } |
| kfree_skb(skb); |
| |
| return 0; |
| } |
| |
| static int nxp_set_ind_reset(struct hci_dev *hdev, void *data) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| struct sk_buff *skb; |
| u8 *status; |
| u8 pcmd = 0; |
| int err = 0; |
| |
| skb = nxp_drv_send_cmd(hdev, HCI_NXP_IND_RESET, 1, &pcmd); |
| if (IS_ERR(skb)) |
| return PTR_ERR(skb); |
| |
| status = skb_pull_data(skb, 1); |
| if (!status || *status) |
| goto free_skb; |
| |
| set_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); |
| err = nxp_download_firmware(hdev); |
| if (err < 0) |
| goto free_skb; |
| serdev_device_set_baudrate(nxpdev->serdev, nxpdev->fw_init_baudrate); |
| nxpdev->current_baudrate = nxpdev->fw_init_baudrate; |
| if (nxpdev->current_baudrate != HCI_NXP_SEC_BAUDRATE) { |
| nxpdev->new_baudrate = HCI_NXP_SEC_BAUDRATE; |
| nxp_set_baudrate_cmd(hdev, NULL); |
| } |
| hci_cmd_sync_queue(hdev, send_wakeup_method_cmd, NULL, NULL); |
| hci_cmd_sync_queue(hdev, send_ps_cmd, NULL, NULL); |
| |
| free_skb: |
| kfree_skb(skb); |
| return err; |
| } |
| |
| /* NXP protocol */ |
| static int nxp_check_boot_sign(struct btnxpuart_dev *nxpdev) |
| { |
| serdev_device_set_baudrate(nxpdev->serdev, HCI_NXP_PRI_BAUDRATE); |
| serdev_device_set_flow_control(nxpdev->serdev, true); |
| set_bit(BTNXPUART_CHECK_BOOT_SIGNATURE, &nxpdev->tx_state); |
| |
| return wait_event_interruptible_timeout(nxpdev->check_boot_sign_wait_q, |
| !test_bit(BTNXPUART_CHECK_BOOT_SIGNATURE, |
| &nxpdev->tx_state), |
| msecs_to_jiffies(1000)); |
| } |
| |
| static int nxp_setup(struct hci_dev *hdev) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| int err = 0; |
| |
| set_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); |
| init_waitqueue_head(&nxpdev->fw_dnld_done_wait_q); |
| init_waitqueue_head(&nxpdev->check_boot_sign_wait_q); |
| |
| if (nxp_check_boot_sign(nxpdev)) { |
| bt_dev_dbg(hdev, "Need FW Download."); |
| err = nxp_download_firmware(hdev); |
| if (err < 0) |
| return err; |
| } else { |
| bt_dev_dbg(hdev, "FW already running."); |
| clear_bit(BTNXPUART_FW_DOWNLOADING, &nxpdev->tx_state); |
| } |
| |
| device_property_read_u32(&nxpdev->serdev->dev, "fw-init-baudrate", |
| &nxpdev->fw_init_baudrate); |
| if (!nxpdev->fw_init_baudrate) |
| nxpdev->fw_init_baudrate = FW_INIT_BAUDRATE; |
| serdev_device_set_baudrate(nxpdev->serdev, nxpdev->fw_init_baudrate); |
| nxpdev->current_baudrate = nxpdev->fw_init_baudrate; |
| |
| if (nxpdev->current_baudrate != HCI_NXP_SEC_BAUDRATE) { |
| nxpdev->new_baudrate = HCI_NXP_SEC_BAUDRATE; |
| hci_cmd_sync_queue(hdev, nxp_set_baudrate_cmd, NULL, NULL); |
| } |
| |
| ps_init(hdev); |
| |
| return 0; |
| } |
| |
| static int btnxpuart_queue_skb(struct hci_dev *hdev, struct sk_buff *skb) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| |
| /* 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); |
| return 0; |
| } |
| |
| 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; |
| struct psmode_cmd_payload ps_parm; |
| struct wakeup_cmd_payload wakeup_parm; |
| __le32 baudrate_parm; |
| |
| /* if vendor commands are received from user space (e.g. hcitool), update |
| * driver flags accordingly and ask driver to re-send the command to FW. |
| * In case the payload for any command does not match expected payload |
| * length, let the firmware and user space program handle it, or throw |
| * an error. |
| */ |
| if (bt_cb(skb)->pkt_type == HCI_COMMAND_PKT && !psdata->driver_sent_cmd) { |
| hdr = (struct hci_command_hdr *)skb->data; |
| if (hdr->plen != (skb->len - HCI_COMMAND_HDR_SIZE)) |
| return btnxpuart_queue_skb(hdev, skb); |
| |
| switch (__le16_to_cpu(hdr->opcode)) { |
| case HCI_NXP_AUTO_SLEEP_MODE: |
| if (hdr->plen == sizeof(ps_parm)) { |
| memcpy(&ps_parm, skb->data + HCI_COMMAND_HDR_SIZE, hdr->plen); |
| if (ps_parm.ps_cmd == BT_PS_ENABLE) |
| psdata->target_ps_mode = PS_MODE_ENABLE; |
| else if (ps_parm.ps_cmd == BT_PS_DISABLE) |
| psdata->target_ps_mode = PS_MODE_DISABLE; |
| psdata->c2h_ps_interval = __le16_to_cpu(ps_parm.c2h_ps_interval); |
| hci_cmd_sync_queue(hdev, send_ps_cmd, NULL, NULL); |
| goto free_skb; |
| } |
| break; |
| case HCI_NXP_WAKEUP_METHOD: |
| if (hdr->plen == sizeof(wakeup_parm)) { |
| memcpy(&wakeup_parm, skb->data + HCI_COMMAND_HDR_SIZE, hdr->plen); |
| psdata->c2h_wakeupmode = wakeup_parm.c2h_wakeupmode; |
| psdata->c2h_wakeup_gpio = wakeup_parm.c2h_wakeup_gpio; |
| psdata->h2c_wakeup_gpio = wakeup_parm.h2c_wakeup_gpio; |
| switch (wakeup_parm.h2c_wakeupmode) { |
| case BT_CTRL_WAKEUP_METHOD_DSR: |
| psdata->h2c_wakeupmode = WAKEUP_METHOD_DTR; |
| break; |
| case BT_CTRL_WAKEUP_METHOD_BREAK: |
| default: |
| psdata->h2c_wakeupmode = WAKEUP_METHOD_BREAK; |
| break; |
| } |
| hci_cmd_sync_queue(hdev, send_wakeup_method_cmd, NULL, NULL); |
| goto free_skb; |
| } |
| break; |
| case HCI_NXP_SET_OPER_SPEED: |
| if (hdr->plen == sizeof(baudrate_parm)) { |
| memcpy(&baudrate_parm, skb->data + HCI_COMMAND_HDR_SIZE, hdr->plen); |
| nxpdev->new_baudrate = __le32_to_cpu(baudrate_parm); |
| hci_cmd_sync_queue(hdev, nxp_set_baudrate_cmd, NULL, NULL); |
| goto free_skb; |
| } |
| break; |
| case HCI_NXP_IND_RESET: |
| if (hdr->plen == 1) { |
| hci_cmd_sync_queue(hdev, nxp_set_ind_reset, NULL, NULL); |
| goto free_skb; |
| } |
| break; |
| default: |
| break; |
| } |
| } |
| |
| return btnxpuart_queue_skb(hdev, skb); |
| |
| free_skb: |
| kfree_skb(skb); |
| 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; |
| struct sk_buff *skb; |
| int len; |
| |
| while ((skb = nxp_dequeue(nxpdev))) { |
| 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); |
| } |
| clear_bit(BTNXPUART_TX_STATE_ACTIVE, &nxpdev->tx_state); |
| } |
| |
| static int btnxpuart_open(struct hci_dev *hdev) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| int err = 0; |
| |
| err = serdev_device_open(nxpdev->serdev); |
| if (err) { |
| bt_dev_err(hdev, "Unable to open UART device %s", |
| dev_name(&nxpdev->serdev->dev)); |
| } else { |
| set_bit(BTNXPUART_SERDEV_OPEN, &nxpdev->tx_state); |
| } |
| return err; |
| } |
| |
| static int btnxpuart_close(struct hci_dev *hdev) |
| { |
| struct btnxpuart_dev *nxpdev = hci_get_drvdata(hdev); |
| |
| ps_wakeup(nxpdev); |
| serdev_device_close(nxpdev->serdev); |
| clear_bit(BTNXPUART_SERDEV_OPEN, &nxpdev->tx_state); |
| 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 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_CHIP_VER_V1, .recv = nxp_recv_chip_ver_v1 }, |
| { 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 int btnxpuart_receive_buf(struct serdev_device *serdev, const u8 *data, |
| size_t count) |
| { |
| struct btnxpuart_dev *nxpdev = serdev_device_get_drvdata(serdev); |
| |
| ps_start_timer(nxpdev); |
| |
| nxpdev->rx_skb = h4_recv_buf(nxpdev->hdev, nxpdev->rx_skb, data, count, |
| nxp_recv_pkts, ARRAY_SIZE(nxp_recv_pkts)); |
| if (IS_ERR(nxpdev->rx_skb)) { |
| int err = PTR_ERR(nxpdev->rx_skb); |
| /* Safe to ignore out-of-sync bootloader signatures */ |
| if (is_fw_downloading(nxpdev)) |
| return count; |
| 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; |
| |
| nxpdev->nxp_data = (struct btnxpuart_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); |
| |
| crc8_populate_msb(crc8_table, POLYNOMIAL8); |
| |
| /* 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); |
| |
| hdev->manufacturer = MANUFACTURER_NXP; |
| hdev->open = btnxpuart_open; |
| hdev->close = btnxpuart_close; |
| hdev->flush = btnxpuart_flush; |
| hdev->setup = nxp_setup; |
| hdev->send = nxp_enqueue; |
| 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; |
| } |
| |
| ps_init_work(hdev); |
| ps_init_timer(hdev); |
| |
| 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->current_baudrate != nxpdev->fw_init_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 struct btnxpuart_data w8987_data = { |
| .helper_fw_name = NULL, |
| .fw_name = FIRMWARE_W8987, |
| }; |
| |
| static struct btnxpuart_data w8997_data = { |
| .helper_fw_name = FIRMWARE_HELPER, |
| .fw_name = FIRMWARE_W8997, |
| }; |
| |
| static const struct of_device_id nxpuart_of_match_table[] = { |
| { .compatible = "nxp,88w8987-bt", .data = &w8987_data }, |
| { .compatible = "nxp,88w8997-bt", .data = &w8997_data }, |
| { } |
| }; |
| MODULE_DEVICE_TABLE(of, nxpuart_of_match_table); |
| |
| 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"); |
| MODULE_LICENSE("GPL"); |