hollalinux
/
linux-sg2042
mirror of https://github.com/sophgo/linux-riscv.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

Bluetooth: hci_ath: Add ath_vendor_cmd helper 

Introduce ath_vendor_cmd function which can be used to
configure 'tags' and patch the firmware.

ATH vendor command has the following format:
| OPCODE (u8) | INDEX (LE16) | DLEN (U8) | DATA (U8 * DLEN) |

BD address configuration tag is at index 0x0001.

Signed-off-by: Loic Poulain <loic.poulain@linaro.org>
Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
This commit is contained in:
Loic Poulain 2017-10-19 14:29:10 +02:00 committed by Marcel Holtmann
parent f17d858ed0
commit 13df5000d3
1 changed files with 30 additions and 15 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

45
drivers/bluetooth/hci_ath.c
View File

@ -50,6 +50,17 @@ struct ath_struct {
struct work_struct ctxtsw; struct work_struct ctxtsw;
}; };
#define OP_WRITE_TAG 0x01
#define INDEX_BDADDR 0x01
struct ath_vendor_cmd {
__u8 opcode;
__le16 index;
__u8 len;
__u8 data[251];
} __packed;
static int ath_wakeup_ar3k(struct tty_struct *tty) static int ath_wakeup_ar3k(struct tty_struct *tty)
{ {
int status = tty->driver->ops->tiocmget(tty); int status = tty->driver->ops->tiocmget(tty);
@ -144,30 +155,34 @@ static int ath_flush(struct hci_uart *hu)
return 0; return 0;
} }
static int ath_set_bdaddr(struct hci_dev *hdev, const bdaddr_t *bdaddr) static int ath_vendor_cmd(struct hci_dev *hdev, uint8_t opcode, uint16_t index,
const void *data, size_t dlen)
{ {
struct sk_buff *skb; struct sk_buff *skb;
u8 buf[10]; struct ath_vendor_cmd cmd;
int err;
buf[0] = 0x01; if (dlen > sizeof(cmd.data))
buf[1] = 0x01; return -EINVAL;
buf[2] = 0x00;
buf[3] = sizeof(bdaddr_t);
memcpy(buf + 4, bdaddr, sizeof(bdaddr_t));
skb = __hci_cmd_sync(hdev, 0xfc0b, sizeof(buf), buf, HCI_INIT_TIMEOUT); cmd.opcode = opcode;
if (IS_ERR(skb)) { cmd.index = cpu_to_le16(index);
err = PTR_ERR(skb); cmd.len = dlen;
BT_ERR("%s: Change address command failed (%d)", memcpy(cmd.data, data, dlen);
hdev->name, err);
return err; skb = __hci_cmd_sync(hdev, 0xfc0b, dlen + 4, &cmd, HCI_INIT_TIMEOUT);
} if (IS_ERR(skb))
return PTR_ERR(skb);
kfree_skb(skb); kfree_skb(skb);
return 0; return 0;
} }
static int ath_set_bdaddr(struct hci_dev *hdev, const bdaddr_t *bdaddr)
{
return ath_vendor_cmd(hdev, OP_WRITE_TAG, INDEX_BDADDR, bdaddr,
sizeof(*bdaddr));
}
static int ath_setup(struct hci_uart *hu) static int ath_setup(struct hci_uart *hu)
{ {
BT_DBG("hu %p", hu); BT_DBG("hu %p", hu);