]> www.infradead.org Git - users/hch/misc.git/commitdiff
Bluetooth: btintel_pcie: Read hardware exception data
authorKiran K <kiran.k@intel.com>
Tue, 25 Feb 2025 11:43:11 +0000 (17:13 +0530)
committerLuiz Augusto von Dentz <luiz.von.dentz@intel.com>
Tue, 25 Mar 2025 16:43:08 +0000 (12:43 -0400)
On hardware error, controller writes hardware error event and optional
vendor specific hci events in device memory in TLV format and raises
MSIX interrupt. Driver reads the device memory and passes the events to
the stack for further processing.

Co-developed-by: Vijay Satija <vijay.satija@intel.com>
Signed-off-by: Vijay Satija <vijay.satija@intel.com>
Signed-off-by: Kiran K <kiran.k@intel.com>
Signed-off-by: Luiz Augusto von Dentz <luiz.von.dentz@intel.com>
drivers/bluetooth/btintel.h
drivers/bluetooth/btintel_pcie.c
drivers/bluetooth/btintel_pcie.h

index 19530ea14905d8fd2750790804c2bcdb49f61d88..4c21e69887a376e17faabb3f66954f69d61d45ba 100644 (file)
@@ -190,6 +190,7 @@ enum {
 struct btintel_data {
        DECLARE_BITMAP(flags, __INTEL_NUM_FLAGS);
        int (*acpi_reset_method)(struct hci_dev *hdev);
+       u32     cnvi_top;
 };
 
 #define btintel_set_flag(hdev, nr)                                     \
index 0c8e4e2dd94513e1a1cdbdd5bba989cabf40814b..e8307eeb971f9a77551d4456c4d067e3b3a5b137 100644 (file)
@@ -51,6 +51,14 @@ MODULE_DEVICE_TABLE(pci, btintel_pcie_table);
 
  #define BTINTEL_PCIE_MAGIC_NUM    0xA5A5A5A5
 
+#define BTINTEL_PCIE_BLZR_HWEXP_SIZE           1024
+#define BTINTEL_PCIE_BLZR_HWEXP_DMP_ADDR       0xB00A7C00
+
+#define BTINTEL_PCIE_SCP_HWEXP_SIZE            4096
+#define BTINTEL_PCIE_SCP_HWEXP_DMP_ADDR                0xB030F800
+
+#define BTINTEL_PCIE_MAGIC_NUM 0xA5A5A5A5
+
 /* Alive interrupt context */
 enum {
        BTINTEL_PCIE_ROM,
@@ -353,6 +361,64 @@ static int btintel_pcie_reset_bt(struct btintel_pcie_data *data)
        return reg == 0 ? 0 : -ENODEV;
 }
 
+static void btintel_pcie_mac_init(struct btintel_pcie_data *data)
+{
+       u32 reg;
+
+       /* Set MAC_INIT bit to start primary bootloader */
+       reg = btintel_pcie_rd_reg32(data, BTINTEL_PCIE_CSR_FUNC_CTRL_REG);
+       reg &= ~(BTINTEL_PCIE_CSR_FUNC_CTRL_FUNC_INIT |
+                       BTINTEL_PCIE_CSR_FUNC_CTRL_BUS_MASTER_DISCON |
+                       BTINTEL_PCIE_CSR_FUNC_CTRL_SW_RESET);
+       reg |= (BTINTEL_PCIE_CSR_FUNC_CTRL_FUNC_ENA |
+                       BTINTEL_PCIE_CSR_FUNC_CTRL_MAC_INIT);
+       btintel_pcie_wr_reg32(data, BTINTEL_PCIE_CSR_FUNC_CTRL_REG, reg);
+}
+
+static int btintel_pcie_get_mac_access(struct btintel_pcie_data *data)
+{
+       u32 reg;
+       int retry = 15;
+
+       reg = btintel_pcie_rd_reg32(data, BTINTEL_PCIE_CSR_FUNC_CTRL_REG);
+
+       reg |= BTINTEL_PCIE_CSR_FUNC_CTRL_STOP_MAC_ACCESS_DIS;
+       reg |= BTINTEL_PCIE_CSR_FUNC_CTRL_XTAL_CLK_REQ;
+       if ((reg & BTINTEL_PCIE_CSR_FUNC_CTRL_MAC_ACCESS_STS) == 0)
+               reg |= BTINTEL_PCIE_CSR_FUNC_CTRL_MAC_ACCESS_REQ;
+
+       btintel_pcie_wr_reg32(data, BTINTEL_PCIE_CSR_FUNC_CTRL_REG, reg);
+
+       do {
+               reg = btintel_pcie_rd_reg32(data, BTINTEL_PCIE_CSR_FUNC_CTRL_REG);
+               if (reg & BTINTEL_PCIE_CSR_FUNC_CTRL_MAC_ACCESS_STS)
+                       return 0;
+               /* Need delay here for Target Access harwdware to settle down*/
+               usleep_range(1000, 1200);
+
+       } while (--retry > 0);
+
+       return -ETIME;
+}
+
+static void btintel_pcie_release_mac_access(struct btintel_pcie_data *data)
+{
+       u32 reg;
+
+       reg = btintel_pcie_rd_reg32(data, BTINTEL_PCIE_CSR_FUNC_CTRL_REG);
+
+       if (reg & BTINTEL_PCIE_CSR_FUNC_CTRL_MAC_ACCESS_REQ)
+               reg &= ~BTINTEL_PCIE_CSR_FUNC_CTRL_MAC_ACCESS_REQ;
+
+       if (reg & BTINTEL_PCIE_CSR_FUNC_CTRL_STOP_MAC_ACCESS_DIS)
+               reg &= ~BTINTEL_PCIE_CSR_FUNC_CTRL_STOP_MAC_ACCESS_DIS;
+
+       if (reg & BTINTEL_PCIE_CSR_FUNC_CTRL_XTAL_CLK_REQ)
+               reg &= ~BTINTEL_PCIE_CSR_FUNC_CTRL_XTAL_CLK_REQ;
+
+       btintel_pcie_wr_reg32(data, BTINTEL_PCIE_CSR_FUNC_CTRL_REG, reg);
+}
+
 /* This function enables BT function by setting BTINTEL_PCIE_CSR_FUNC_CTRL_MAC_INIT bit in
  * BTINTEL_PCIE_CSR_FUNC_CTRL_REG register and wait for MSI-X with
  * BTINTEL_PCIE_MSIX_HW_INT_CAUSES_GP0.
@@ -473,6 +539,27 @@ static inline char *btintel_pcie_alivectxt_state2str(u32 alive_intr_ctxt)
        }
 }
 
+static int btintel_pcie_read_device_mem(struct btintel_pcie_data *data,
+                                       void *buf, u32 dev_addr, int len)
+{
+       int err;
+       u32 *val = buf;
+
+       /* Get device mac access */
+       err = btintel_pcie_get_mac_access(data);
+       if (err) {
+               bt_dev_err(data->hdev, "Failed to get mac access %d", err);
+               return err;
+       }
+
+       for (; len > 0; len -= 4, dev_addr += 4, val++)
+               *val = btintel_pcie_rd_dev_mem(data, dev_addr);
+
+       btintel_pcie_release_mac_access(data);
+
+       return 0;
+}
+
 /* This function handles the MSI-X interrupt for gp0 cause (bit 0 in
  * BTINTEL_PCIE_CSR_MSIX_HW_INT_CAUSES) which is sent for boot stage and image response.
  */
@@ -794,6 +881,122 @@ exit_error:
        return ret;
 }
 
+static void btintel_pcie_read_hwexp(struct btintel_pcie_data *data)
+{
+       struct btintel_data *intel_data = hci_get_priv(data->hdev);
+       int len, err, offset, pending;
+       struct sk_buff *skb;
+       u8 *buf, prefix[64];
+       u32 addr, val;
+       u16 pkt_len;
+
+       struct tlv {
+               u8      type;
+               __le16  len;
+               u8      val[];
+       } __packed;
+
+       struct tlv *tlv;
+
+       switch (intel_data->cnvi_top & 0xfff) {
+       case BTINTEL_CNVI_BLAZARI:
+       case BTINTEL_CNVI_BLAZARIW:
+               /* only from step B0 onwards */
+               if (INTEL_CNVX_TOP_STEP(intel_data->cnvi_top) != 0x01)
+                       return;
+               len = BTINTEL_PCIE_BLZR_HWEXP_SIZE; /* exception data length */
+               addr = BTINTEL_PCIE_BLZR_HWEXP_DMP_ADDR;
+       break;
+       case BTINTEL_CNVI_SCP:
+               len = BTINTEL_PCIE_SCP_HWEXP_SIZE;
+               addr = BTINTEL_PCIE_SCP_HWEXP_DMP_ADDR;
+       break;
+       default:
+               bt_dev_err(data->hdev, "Unsupported cnvi 0x%8.8x", intel_data->cnvi_top);
+               return;
+       }
+
+       buf = kzalloc(len, GFP_KERNEL);
+       if (!buf)
+               goto exit_on_error;
+
+       btintel_pcie_mac_init(data);
+
+       err = btintel_pcie_read_device_mem(data, buf, addr, len);
+       if (err)
+               goto exit_on_error;
+
+       val = get_unaligned_le32(buf);
+       if (val != BTINTEL_PCIE_MAGIC_NUM) {
+               bt_dev_err(data->hdev, "Invalid exception dump signature: 0x%8.8x",
+                          val);
+               goto exit_on_error;
+       }
+
+       snprintf(prefix, sizeof(prefix), "Bluetooth: %s: ", bt_dev_name(data->hdev));
+
+       offset = 4;
+       do {
+               pending = len - offset;
+               if (pending < sizeof(*tlv))
+                       break;
+               tlv = (struct tlv *)(buf + offset);
+
+               /* If type == 0, then there are no more TLVs to be parsed */
+               if (!tlv->type) {
+                       bt_dev_dbg(data->hdev, "Invalid TLV type 0");
+                       break;
+               }
+               pkt_len = le16_to_cpu(tlv->len);
+               offset += sizeof(*tlv);
+               pending = len - offset;
+               if (pkt_len > pending)
+                       break;
+
+               offset += pkt_len;
+
+                /* Only TLVs of type == 1 are HCI events, no need to process other
+                 * TLVs
+                 */
+               if (tlv->type != 1)
+                       continue;
+
+               bt_dev_dbg(data->hdev, "TLV packet length: %u", pkt_len);
+               if (pkt_len > HCI_MAX_EVENT_SIZE)
+                       break;
+               skb = bt_skb_alloc(pkt_len, GFP_KERNEL);
+               if (!skb)
+                       goto exit_on_error;
+               hci_skb_pkt_type(skb) = HCI_EVENT_PKT;
+               skb_put_data(skb, tlv->val, pkt_len);
+
+               /* copy Intel specific pcie packet type */
+               val = BTINTEL_PCIE_HCI_EVT_PKT;
+               memcpy(skb_push(skb, BTINTEL_PCIE_HCI_TYPE_LEN), &val,
+                      BTINTEL_PCIE_HCI_TYPE_LEN);
+
+               print_hex_dump(KERN_DEBUG, prefix, DUMP_PREFIX_OFFSET, 16, 1,
+                              tlv->val, pkt_len, false);
+
+               btintel_pcie_recv_frame(data, skb);
+       } while (offset < len);
+
+exit_on_error:
+       kfree(buf);
+}
+
+static void btintel_pcie_msix_hw_exp_handler(struct btintel_pcie_data *data)
+{
+       bt_dev_err(data->hdev, "Received hw exception interrupt");
+
+       if (test_and_set_bit(BTINTEL_PCIE_CORE_HALTED, &data->flags))
+               return;
+
+       if (test_and_set_bit(BTINTEL_PCIE_HWEXP_INPROGRESS, &data->flags))
+               return;
+       queue_work(data->workqueue, &data->rx_work);
+}
+
 static void btintel_pcie_rx_work(struct work_struct *work)
 {
        struct btintel_pcie_data *data = container_of(work,
@@ -802,6 +1005,18 @@ static void btintel_pcie_rx_work(struct work_struct *work)
        int err;
        struct hci_dev *hdev = data->hdev;
 
+       if (test_bit(BTINTEL_PCIE_HWEXP_INPROGRESS, &data->flags)) {
+               /* Unlike usb products, controller will not send hardware
+                * exception event on exception. Instead controller writes the
+                * hardware event to device memory along with optional debug
+                * events, raises MSIX and halts. Driver shall read the
+                * exception event from device memory and passes it stack for
+                * further processing.
+                */
+               btintel_pcie_read_hwexp(data);
+               clear_bit(BTINTEL_PCIE_HWEXP_INPROGRESS, &data->flags);
+       }
+
        /* Process the sk_buf in queue and send to the HCI layer */
        while ((skb = skb_dequeue(&data->rx_skb_q))) {
                err = btintel_pcie_recv_frame(data, skb);
@@ -920,6 +1135,10 @@ static irqreturn_t btintel_pcie_irq_msix_handler(int irq, void *dev_id)
                return IRQ_NONE;
        }
 
+       /* This interrupt is raised when there is an hardware exception */
+       if (intr_hw & BTINTEL_PCIE_MSIX_HW_INT_CAUSES_HWEXP)
+               btintel_pcie_msix_hw_exp_handler(data);
+
        /* This interrupt is triggered by the firmware after updating
         * boot_stage register and image_response register
         */
@@ -1000,7 +1219,8 @@ struct btintel_pcie_causes_list {
 static struct btintel_pcie_causes_list causes_list[] = {
        { BTINTEL_PCIE_MSIX_FH_INT_CAUSES_0,    BTINTEL_PCIE_CSR_MSIX_FH_INT_MASK,      0x00 },
        { BTINTEL_PCIE_MSIX_FH_INT_CAUSES_1,    BTINTEL_PCIE_CSR_MSIX_FH_INT_MASK,      0x01 },
-       { BTINTEL_PCIE_MSIX_HW_INT_CAUSES_GP0, BTINTEL_PCIE_CSR_MSIX_HW_INT_MASK,       0x20 },
+       { BTINTEL_PCIE_MSIX_HW_INT_CAUSES_GP0,  BTINTEL_PCIE_CSR_MSIX_HW_INT_MASK,      0x20 },
+       { BTINTEL_PCIE_MSIX_HW_INT_CAUSES_HWEXP, BTINTEL_PCIE_CSR_MSIX_HW_INT_MASK,     0x23 },
 };
 
 /* This function configures the interrupt masks for both HW_INT_CAUSES and
@@ -1482,6 +1702,7 @@ static void btintel_pcie_release_hdev(struct btintel_pcie_data *data)
 
 static int btintel_pcie_setup_internal(struct hci_dev *hdev)
 {
+       struct btintel_data *data = hci_get_priv(hdev);
        const u8 param[1] = { 0xFF };
        struct intel_version_tlv ver_tlv;
        struct sk_buff *skb;
@@ -1520,6 +1741,7 @@ static int btintel_pcie_setup_internal(struct hci_dev *hdev)
                goto exit_error;
        }
 
+       data->cnvi_top = ver_tlv.cnvi_top;
        switch (INTEL_HW_PLATFORM(ver_tlv.cnvi_bt)) {
        case 0x37:
                break;
index b9d32393002b1d2b678db40f5d7f39863bfabfe8..d17808ebe7251c172d08c20a8b49ee9b6230b145 100644 (file)
@@ -16,6 +16,8 @@
 #define BTINTEL_PCIE_CSR_CI_ADDR_LSB_REG       (BTINTEL_PCIE_CSR_BASE + 0x118)
 #define BTINTEL_PCIE_CSR_CI_ADDR_MSB_REG       (BTINTEL_PCIE_CSR_BASE + 0x11C)
 #define BTINTEL_PCIE_CSR_IMG_RESPONSE_REG      (BTINTEL_PCIE_CSR_BASE + 0x12C)
+#define BTINTEL_PCIE_PRPH_DEV_ADDR_REG         (BTINTEL_PCIE_CSR_BASE + 0x440)
+#define BTINTEL_PCIE_PRPH_DEV_RD_REG           (BTINTEL_PCIE_CSR_BASE + 0x458)
 #define BTINTEL_PCIE_CSR_HBUS_TARG_WRPTR       (BTINTEL_PCIE_CSR_BASE + 0x460)
 
 /* BTINTEL_PCIE_CSR Function Control Register */
 #define BTINTEL_PCIE_CSR_FUNC_CTRL_MAC_INIT            (BIT(6))
 #define BTINTEL_PCIE_CSR_FUNC_CTRL_FUNC_INIT           (BIT(7))
 #define BTINTEL_PCIE_CSR_FUNC_CTRL_MAC_ACCESS_STS      (BIT(20))
+
+#define BTINTEL_PCIE_CSR_FUNC_CTRL_MAC_ACCESS_REQ      (BIT(21))
+/* Stop MAC Access disconnection request */
+#define BTINTEL_PCIE_CSR_FUNC_CTRL_STOP_MAC_ACCESS_DIS (BIT(22))
+#define BTINTEL_PCIE_CSR_FUNC_CTRL_XTAL_CLK_REQ                (BIT(23))
+
 #define BTINTEL_PCIE_CSR_FUNC_CTRL_BUS_MASTER_STS      (BIT(28))
 #define BTINTEL_PCIE_CSR_FUNC_CTRL_BUS_MASTER_DISCON   (BIT(29))
 #define BTINTEL_PCIE_CSR_FUNC_CTRL_SW_RESET            (BIT(31))
@@ -72,6 +80,7 @@ enum msix_fh_int_causes {
 /* Causes for the HW register interrupts */
 enum msix_hw_int_causes {
        BTINTEL_PCIE_MSIX_HW_INT_CAUSES_GP0     = BIT(0),       /* cause 32 */
+       BTINTEL_PCIE_MSIX_HW_INT_CAUSES_HWEXP   = BIT(3),       /* cause 35 */
 };
 
 /* PCIe device states
@@ -84,6 +93,12 @@ enum {
        BTINTEL_PCIE_STATE_D3_HOT = 2,
        BTINTEL_PCIE_STATE_D3_COLD = 3,
 };
+
+enum {
+       BTINTEL_PCIE_CORE_HALTED,
+       BTINTEL_PCIE_HWEXP_INPROGRESS,
+};
+
 #define BTINTEL_PCIE_MSIX_NON_AUTO_CLEAR_CAUSE BIT(7)
 
 /* Minimum and Maximum number of MSI-X Vector
@@ -476,3 +491,11 @@ static inline void btintel_pcie_clr_reg_bits(struct btintel_pcie_data *data,
        r &= ~bits;
        iowrite32(r, data->base_addr + offset);
 }
+
+static inline u32 btintel_pcie_rd_dev_mem(struct btintel_pcie_data *data,
+                                         u32 addr)
+{
+       btintel_pcie_wr_reg32(data, BTINTEL_PCIE_PRPH_DEV_ADDR_REG, addr);
+       return btintel_pcie_rd_reg32(data, BTINTEL_PCIE_PRPH_DEV_RD_REG);
+}
+