|
6 | 6 | * Copyright (C) 2015 Intel Corporation
|
7 | 7 | */
|
8 | 8 |
|
| 9 | +#include <linux/efi.h> |
9 | 10 | #include <linux/module.h>
|
10 | 11 | #include <linux/firmware.h>
|
11 | 12 | #include <linux/dmi.h>
|
|
34 | 35 | /* For kmalloc-ing the fw-name array instead of putting it on the stack */
|
35 | 36 | typedef char bcm_fw_name[BCM_FW_NAME_LEN];
|
36 | 37 |
|
| 38 | +#ifdef CONFIG_EFI |
| 39 | +static int btbcm_set_bdaddr_from_efi(struct hci_dev *hdev) |
| 40 | +{ |
| 41 | + efi_guid_t guid = EFI_GUID(0x74b00bd9, 0x805a, 0x4d61, 0xb5, 0x1f, |
| 42 | + 0x43, 0x26, 0x81, 0x23, 0xd1, 0x13); |
| 43 | + bdaddr_t efi_bdaddr, bdaddr; |
| 44 | + efi_status_t status; |
| 45 | + unsigned long len; |
| 46 | + int ret; |
| 47 | + |
| 48 | + if (!efi_rt_services_supported(EFI_RT_SUPPORTED_GET_VARIABLE)) |
| 49 | + return -EOPNOTSUPP; |
| 50 | + |
| 51 | + len = sizeof(efi_bdaddr); |
| 52 | + status = efi.get_variable(L"BDADDR", &guid, NULL, &len, &efi_bdaddr); |
| 53 | + if (status != EFI_SUCCESS) |
| 54 | + return -ENXIO; |
| 55 | + |
| 56 | + if (len != sizeof(efi_bdaddr)) |
| 57 | + return -EIO; |
| 58 | + |
| 59 | + baswap(&bdaddr, &efi_bdaddr); |
| 60 | + |
| 61 | + ret = btbcm_set_bdaddr(hdev, &bdaddr); |
| 62 | + if (ret) |
| 63 | + return ret; |
| 64 | + |
| 65 | + bt_dev_info(hdev, "BCM: Using EFI device address (%pMR)", &bdaddr); |
| 66 | + return 0; |
| 67 | +} |
| 68 | +#else |
| 69 | +static int btbcm_set_bdaddr_from_efi(struct hci_dev *hdev) |
| 70 | +{ |
| 71 | + return -EOPNOTSUPP; |
| 72 | +} |
| 73 | +#endif |
| 74 | + |
37 | 75 | int btbcm_check_bdaddr(struct hci_dev *hdev)
|
38 | 76 | {
|
39 | 77 | struct hci_rp_read_bd_addr *bda;
|
@@ -87,9 +125,12 @@ int btbcm_check_bdaddr(struct hci_dev *hdev)
|
87 | 125 | !bacmp(&bda->bdaddr, BDADDR_BCM4345C5) ||
|
88 | 126 | !bacmp(&bda->bdaddr, BDADDR_BCM43430A0) ||
|
89 | 127 | !bacmp(&bda->bdaddr, BDADDR_BCM43341B)) {
|
90 |
| - bt_dev_info(hdev, "BCM: Using default device address (%pMR)", |
91 |
| - &bda->bdaddr); |
92 |
| - set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks); |
| 128 | + /* Try falling back to BDADDR EFI variable */ |
| 129 | + if (btbcm_set_bdaddr_from_efi(hdev) != 0) { |
| 130 | + bt_dev_info(hdev, "BCM: Using default device address (%pMR)", |
| 131 | + &bda->bdaddr); |
| 132 | + set_bit(HCI_QUIRK_INVALID_BDADDR, &hdev->quirks); |
| 133 | + } |
93 | 134 | }
|
94 | 135 |
|
95 | 136 | kfree_skb(skb);
|
|
0 commit comments