Bluetooth: btrtl: Add firmware version print
This patch is used to print fw version for debug convenience Signed-off-by: Alex Lu <alex_lu@realsil.com.cn> Signed-off-by: Marcel Holtmann <marcel@holtmann.org>
This commit is contained in:
parent
65251e2e0a
commit
240b64a831
|
@ -178,6 +178,27 @@ static const struct id_table *btrtl_match_ic(u16 lmp_subver, u16 hci_rev,
|
||||||
return &ic_id_table[i];
|
return &ic_id_table[i];
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static struct sk_buff *btrtl_read_local_version(struct hci_dev *hdev)
|
||||||
|
{
|
||||||
|
struct sk_buff *skb;
|
||||||
|
|
||||||
|
skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
|
||||||
|
HCI_INIT_TIMEOUT);
|
||||||
|
if (IS_ERR(skb)) {
|
||||||
|
rtl_dev_err(hdev, "HCI_OP_READ_LOCAL_VERSION failed (%ld)",
|
||||||
|
PTR_ERR(skb));
|
||||||
|
return skb;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (skb->len != sizeof(struct hci_rp_read_local_version)) {
|
||||||
|
rtl_dev_err(hdev, "HCI_OP_READ_LOCAL_VERSION event length mismatch");
|
||||||
|
kfree_skb(skb);
|
||||||
|
return ERR_PTR(-EIO);
|
||||||
|
}
|
||||||
|
|
||||||
|
return skb;
|
||||||
|
}
|
||||||
|
|
||||||
static int rtl_read_rom_version(struct hci_dev *hdev, u8 *version)
|
static int rtl_read_rom_version(struct hci_dev *hdev, u8 *version)
|
||||||
{
|
{
|
||||||
struct rtl_rom_version_evt *rom_version;
|
struct rtl_rom_version_evt *rom_version;
|
||||||
|
@ -368,6 +389,8 @@ static int rtl_download_firmware(struct hci_dev *hdev,
|
||||||
int frag_len = RTL_FRAG_LEN;
|
int frag_len = RTL_FRAG_LEN;
|
||||||
int ret = 0;
|
int ret = 0;
|
||||||
int i;
|
int i;
|
||||||
|
struct sk_buff *skb;
|
||||||
|
struct hci_rp_read_local_version *rp;
|
||||||
|
|
||||||
dl_cmd = kmalloc(sizeof(struct rtl_download_cmd), GFP_KERNEL);
|
dl_cmd = kmalloc(sizeof(struct rtl_download_cmd), GFP_KERNEL);
|
||||||
if (!dl_cmd)
|
if (!dl_cmd)
|
||||||
|
@ -406,6 +429,18 @@ static int rtl_download_firmware(struct hci_dev *hdev,
|
||||||
data += RTL_FRAG_LEN;
|
data += RTL_FRAG_LEN;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
skb = btrtl_read_local_version(hdev);
|
||||||
|
if (IS_ERR(skb)) {
|
||||||
|
ret = PTR_ERR(skb);
|
||||||
|
rtl_dev_err(hdev, "read local version failed");
|
||||||
|
goto out;
|
||||||
|
}
|
||||||
|
|
||||||
|
rp = (struct hci_rp_read_local_version *)skb->data;
|
||||||
|
rtl_dev_info(hdev, "fw version 0x%04x%04x",
|
||||||
|
__le16_to_cpu(rp->hci_rev), __le16_to_cpu(rp->lmp_subver));
|
||||||
|
kfree_skb(skb);
|
||||||
|
|
||||||
out:
|
out:
|
||||||
kfree(dl_cmd);
|
kfree(dl_cmd);
|
||||||
return ret;
|
return ret;
|
||||||
|
@ -484,27 +519,6 @@ out:
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static struct sk_buff *btrtl_read_local_version(struct hci_dev *hdev)
|
|
||||||
{
|
|
||||||
struct sk_buff *skb;
|
|
||||||
|
|
||||||
skb = __hci_cmd_sync(hdev, HCI_OP_READ_LOCAL_VERSION, 0, NULL,
|
|
||||||
HCI_INIT_TIMEOUT);
|
|
||||||
if (IS_ERR(skb)) {
|
|
||||||
rtl_dev_err(hdev, "HCI_OP_READ_LOCAL_VERSION failed (%ld)\n",
|
|
||||||
PTR_ERR(skb));
|
|
||||||
return skb;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (skb->len != sizeof(struct hci_rp_read_local_version)) {
|
|
||||||
rtl_dev_err(hdev, "HCI_OP_READ_LOCAL_VERSION event length mismatch\n");
|
|
||||||
kfree_skb(skb);
|
|
||||||
return ERR_PTR(-EIO);
|
|
||||||
}
|
|
||||||
|
|
||||||
return skb;
|
|
||||||
}
|
|
||||||
|
|
||||||
void btrtl_free(struct btrtl_device_info *btrtl_dev)
|
void btrtl_free(struct btrtl_device_info *btrtl_dev)
|
||||||
{
|
{
|
||||||
kfree(btrtl_dev->fw_data);
|
kfree(btrtl_dev->fw_data);
|
||||||
|
|
Loading…
Reference in New Issue