| // SPDX-License-Identifier: BSD-3-Clause-Clear | |
| /* | |
| * Copyright (c) 2018-2019 The Linux Foundation. All rights reserved. | |
| * Copyright (c) Qualcomm Technologies, Inc. and/or its subsidiaries. | |
| */ | |
| #include <linux/module.h> | |
| #include <linux/platform_device.h> | |
| #include <linux/property.h> | |
| #include <linux/of_device.h> | |
| #include <linux/of.h> | |
| #include <linux/of_reserved_mem.h> | |
| #include <linux/dma-mapping.h> | |
| #include <linux/iommu.h> | |
| #include "ahb.h" | |
| #include "debug.h" | |
| #include "hif.h" | |
| #include "qmi.h" | |
| #include <linux/remoteproc.h> | |
| #include "pcic.h" | |
| #include <linux/soc/qcom/smem.h> | |
| #include <linux/soc/qcom/smem_state.h> | |
| static const struct of_device_id ath11k_ahb_of_match[] = { | |
| /* TODO: Should we change the compatible string to something similar | |
| * to one that ath10k uses? | |
| */ | |
| { .compatible = "qcom,ipq8074-wifi", | |
| .data = (void *)ATH11K_HW_IPQ8074, | |
| }, | |
| { .compatible = "qcom,ipq6018-wifi", | |
| .data = (void *)ATH11K_HW_IPQ6018_HW10, | |
| }, | |
| { .compatible = "qcom,wcn6750-wifi", | |
| .data = (void *)ATH11K_HW_WCN6750_HW10, | |
| }, | |
| { .compatible = "qcom,ipq5018-wifi", | |
| .data = (void *)ATH11K_HW_IPQ5018_HW10, | |
| }, | |
| { } | |
| }; | |
| MODULE_DEVICE_TABLE(of, ath11k_ahb_of_match); | |
| #define ATH11K_IRQ_CE0_OFFSET 4 | |
| static const char *irq_name[ATH11K_IRQ_NUM_MAX] = { | |
| "misc-pulse1", | |
| "misc-latch", | |
| "sw-exception", | |
| "watchdog", | |
| "ce0", | |
| "ce1", | |
| "ce2", | |
| "ce3", | |
| "ce4", | |
| "ce5", | |
| "ce6", | |
| "ce7", | |
| "ce8", | |
| "ce9", | |
| "ce10", | |
| "ce11", | |
| "host2wbm-desc-feed", | |
| "host2reo-re-injection", | |
| "host2reo-command", | |
| "host2rxdma-monitor-ring3", | |
| "host2rxdma-monitor-ring2", | |
| "host2rxdma-monitor-ring1", | |
| "reo2ost-exception", | |
| "wbm2host-rx-release", | |
| "reo2host-status", | |
| "reo2host-destination-ring4", | |
| "reo2host-destination-ring3", | |
| "reo2host-destination-ring2", | |
| "reo2host-destination-ring1", | |
| "rxdma2host-monitor-destination-mac3", | |
| "rxdma2host-monitor-destination-mac2", | |
| "rxdma2host-monitor-destination-mac1", | |
| "ppdu-end-interrupts-mac3", | |
| "ppdu-end-interrupts-mac2", | |
| "ppdu-end-interrupts-mac1", | |
| "rxdma2host-monitor-status-ring-mac3", | |
| "rxdma2host-monitor-status-ring-mac2", | |
| "rxdma2host-monitor-status-ring-mac1", | |
| "host2rxdma-host-buf-ring-mac3", | |
| "host2rxdma-host-buf-ring-mac2", | |
| "host2rxdma-host-buf-ring-mac1", | |
| "rxdma2host-destination-ring-mac3", | |
| "rxdma2host-destination-ring-mac2", | |
| "rxdma2host-destination-ring-mac1", | |
| "host2tcl-input-ring4", | |
| "host2tcl-input-ring3", | |
| "host2tcl-input-ring2", | |
| "host2tcl-input-ring1", | |
| "wbm2host-tx-completions-ring3", | |
| "wbm2host-tx-completions-ring2", | |
| "wbm2host-tx-completions-ring1", | |
| "tcl2host-status-ring", | |
| }; | |
| /* enum ext_irq_num - irq numbers that can be used by external modules | |
| * like datapath | |
| */ | |
| enum ext_irq_num { | |
| host2wbm_desc_feed = 16, | |
| host2reo_re_injection, | |
| host2reo_command, | |
| host2rxdma_monitor_ring3, | |
| host2rxdma_monitor_ring2, | |
| host2rxdma_monitor_ring1, | |
| reo2host_exception, | |
| wbm2host_rx_release, | |
| reo2host_status, | |
| reo2host_destination_ring4, | |
| reo2host_destination_ring3, | |
| reo2host_destination_ring2, | |
| reo2host_destination_ring1, | |
| rxdma2host_monitor_destination_mac3, | |
| rxdma2host_monitor_destination_mac2, | |
| rxdma2host_monitor_destination_mac1, | |
| ppdu_end_interrupts_mac3, | |
| ppdu_end_interrupts_mac2, | |
| ppdu_end_interrupts_mac1, | |
| rxdma2host_monitor_status_ring_mac3, | |
| rxdma2host_monitor_status_ring_mac2, | |
| rxdma2host_monitor_status_ring_mac1, | |
| host2rxdma_host_buf_ring_mac3, | |
| host2rxdma_host_buf_ring_mac2, | |
| host2rxdma_host_buf_ring_mac1, | |
| rxdma2host_destination_ring_mac3, | |
| rxdma2host_destination_ring_mac2, | |
| rxdma2host_destination_ring_mac1, | |
| host2tcl_input_ring4, | |
| host2tcl_input_ring3, | |
| host2tcl_input_ring2, | |
| host2tcl_input_ring1, | |
| wbm2host_tx_completions_ring3, | |
| wbm2host_tx_completions_ring2, | |
| wbm2host_tx_completions_ring1, | |
| tcl2host_status_ring, | |
| }; | |
| static int | |
| ath11k_ahb_get_msi_irq_wcn6750(struct ath11k_base *ab, unsigned int vector) | |
| { | |
| return ab->pci.msi.irqs[vector]; | |
| } | |
| static inline u32 | |
| ath11k_ahb_get_window_start_wcn6750(struct ath11k_base *ab, u32 offset) | |
| { | |
| u32 window_start = 0; | |
| /* If offset lies within DP register range, use 1st window */ | |
| if ((offset ^ HAL_SEQ_WCSS_UMAC_OFFSET) < ATH11K_PCI_WINDOW_RANGE_MASK) | |
| window_start = ATH11K_PCI_WINDOW_START; | |
| /* If offset lies within CE register range, use 2nd window */ | |
| else if ((offset ^ HAL_SEQ_WCSS_UMAC_CE0_SRC_REG(ab)) < | |
| ATH11K_PCI_WINDOW_RANGE_MASK) | |
| window_start = 2 * ATH11K_PCI_WINDOW_START; | |
| return window_start; | |
| } | |
| static void | |
| ath11k_ahb_window_write32_wcn6750(struct ath11k_base *ab, u32 offset, u32 value) | |
| { | |
| u32 window_start; | |
| /* WCN6750 uses static window based register access*/ | |
| window_start = ath11k_ahb_get_window_start_wcn6750(ab, offset); | |
| iowrite32(value, ab->mem + window_start + | |
| (offset & ATH11K_PCI_WINDOW_RANGE_MASK)); | |
| } | |
| static u32 ath11k_ahb_window_read32_wcn6750(struct ath11k_base *ab, u32 offset) | |
| { | |
| u32 window_start; | |
| u32 val; | |
| /* WCN6750 uses static window based register access */ | |
| window_start = ath11k_ahb_get_window_start_wcn6750(ab, offset); | |
| val = ioread32(ab->mem + window_start + | |
| (offset & ATH11K_PCI_WINDOW_RANGE_MASK)); | |
| return val; | |
| } | |
| static const struct ath11k_pci_ops ath11k_ahb_pci_ops_wcn6750 = { | |
| .wakeup = NULL, | |
| .release = NULL, | |
| .get_msi_irq = ath11k_ahb_get_msi_irq_wcn6750, | |
| .window_write32 = ath11k_ahb_window_write32_wcn6750, | |
| .window_read32 = ath11k_ahb_window_read32_wcn6750, | |
| }; | |
| static inline u32 ath11k_ahb_read32(struct ath11k_base *ab, u32 offset) | |
| { | |
| return ioread32(ab->mem + offset); | |
| } | |
| static inline void ath11k_ahb_write32(struct ath11k_base *ab, u32 offset, u32 value) | |
| { | |
| iowrite32(value, ab->mem + offset); | |
| } | |
| static void ath11k_ahb_kill_tasklets(struct ath11k_base *ab) | |
| { | |
| int i; | |
| for (i = 0; i < ab->hw_params.ce_count; i++) { | |
| struct ath11k_ce_pipe *ce_pipe = &ab->ce.ce_pipe[i]; | |
| if (ath11k_ce_get_attr_flags(ab, i) & CE_ATTR_DIS_INTR) | |
| continue; | |
| tasklet_kill(&ce_pipe->intr_tq); | |
| } | |
| } | |
| static void ath11k_ahb_ext_grp_disable(struct ath11k_ext_irq_grp *irq_grp) | |
| { | |
| int i; | |
| for (i = 0; i < irq_grp->num_irq; i++) | |
| disable_irq_nosync(irq_grp->ab->irq_num[irq_grp->irqs[i]]); | |
| } | |
| static void __ath11k_ahb_ext_irq_disable(struct ath11k_base *ab) | |
| { | |
| int i; | |
| for (i = 0; i < ATH11K_EXT_IRQ_GRP_NUM_MAX; i++) { | |
| struct ath11k_ext_irq_grp *irq_grp = &ab->ext_irq_grp[i]; | |
| ath11k_ahb_ext_grp_disable(irq_grp); | |
| if (irq_grp->napi_enabled) { | |
| napi_synchronize(&irq_grp->napi); | |
| napi_disable(&irq_grp->napi); | |
| irq_grp->napi_enabled = false; | |
| } | |
| } | |
| } | |
| static void ath11k_ahb_ext_grp_enable(struct ath11k_ext_irq_grp *irq_grp) | |
| { | |
| int i; | |
| for (i = 0; i < irq_grp->num_irq; i++) | |
| enable_irq(irq_grp->ab->irq_num[irq_grp->irqs[i]]); | |
| } | |
| static void ath11k_ahb_setbit32(struct ath11k_base *ab, u8 bit, u32 offset) | |
| { | |
| u32 val; | |
| val = ath11k_ahb_read32(ab, offset); | |
| ath11k_ahb_write32(ab, offset, val | BIT(bit)); | |
| } | |
| static void ath11k_ahb_clearbit32(struct ath11k_base *ab, u8 bit, u32 offset) | |
| { | |
| u32 val; | |
| val = ath11k_ahb_read32(ab, offset); | |
| ath11k_ahb_write32(ab, offset, val & ~BIT(bit)); | |
| } | |
| static void ath11k_ahb_ce_irq_enable(struct ath11k_base *ab, u16 ce_id) | |
| { | |
| const struct ce_attr *ce_attr; | |
| const struct ce_ie_addr *ce_ie_addr = ab->hw_params.ce_ie_addr; | |
| u32 ie1_reg_addr, ie2_reg_addr, ie3_reg_addr; | |
| ie1_reg_addr = ce_ie_addr->ie1_reg_addr + ATH11K_CE_OFFSET(ab); | |
| ie2_reg_addr = ce_ie_addr->ie2_reg_addr + ATH11K_CE_OFFSET(ab); | |
| ie3_reg_addr = ce_ie_addr->ie3_reg_addr + ATH11K_CE_OFFSET(ab); | |
| ce_attr = &ab->hw_params.host_ce_config[ce_id]; | |
| if (ce_attr->src_nentries) | |
| ath11k_ahb_setbit32(ab, ce_id, ie1_reg_addr); | |
| if (ce_attr->dest_nentries) { | |
| ath11k_ahb_setbit32(ab, ce_id, ie2_reg_addr); | |
| ath11k_ahb_setbit32(ab, ce_id + CE_HOST_IE_3_SHIFT, | |
| ie3_reg_addr); | |
| } | |
| } | |
| static void ath11k_ahb_ce_irq_disable(struct ath11k_base *ab, u16 ce_id) | |
| { | |
| const struct ce_attr *ce_attr; | |
| const struct ce_ie_addr *ce_ie_addr = ab->hw_params.ce_ie_addr; | |
| u32 ie1_reg_addr, ie2_reg_addr, ie3_reg_addr; | |
| ie1_reg_addr = ce_ie_addr->ie1_reg_addr + ATH11K_CE_OFFSET(ab); | |
| ie2_reg_addr = ce_ie_addr->ie2_reg_addr + ATH11K_CE_OFFSET(ab); | |
| ie3_reg_addr = ce_ie_addr->ie3_reg_addr + ATH11K_CE_OFFSET(ab); | |
| ce_attr = &ab->hw_params.host_ce_config[ce_id]; | |
| if (ce_attr->src_nentries) | |
| ath11k_ahb_clearbit32(ab, ce_id, ie1_reg_addr); | |
| if (ce_attr->dest_nentries) { | |
| ath11k_ahb_clearbit32(ab, ce_id, ie2_reg_addr); | |
| ath11k_ahb_clearbit32(ab, ce_id + CE_HOST_IE_3_SHIFT, | |
| ie3_reg_addr); | |
| } | |
| } | |
| static void ath11k_ahb_sync_ce_irqs(struct ath11k_base *ab) | |
| { | |
| int i; | |
| int irq_idx; | |
| for (i = 0; i < ab->hw_params.ce_count; i++) { | |
| if (ath11k_ce_get_attr_flags(ab, i) & CE_ATTR_DIS_INTR) | |
| continue; | |
| irq_idx = ATH11K_IRQ_CE0_OFFSET + i; | |
| synchronize_irq(ab->irq_num[irq_idx]); | |
| } | |
| } | |
| static void ath11k_ahb_sync_ext_irqs(struct ath11k_base *ab) | |
| { | |
| int i, j; | |
| int irq_idx; | |
| for (i = 0; i < ATH11K_EXT_IRQ_GRP_NUM_MAX; i++) { | |
| struct ath11k_ext_irq_grp *irq_grp = &ab->ext_irq_grp[i]; | |
| for (j = 0; j < irq_grp->num_irq; j++) { | |
| irq_idx = irq_grp->irqs[j]; | |
| synchronize_irq(ab->irq_num[irq_idx]); | |
| } | |
| } | |
| } | |
| static void ath11k_ahb_ce_irqs_enable(struct ath11k_base *ab) | |
| { | |
| int i; | |
| for (i = 0; i < ab->hw_params.ce_count; i++) { | |
| if (ath11k_ce_get_attr_flags(ab, i) & CE_ATTR_DIS_INTR) | |
| continue; | |
| ath11k_ahb_ce_irq_enable(ab, i); | |
| } | |
| } | |
| static void ath11k_ahb_ce_irqs_disable(struct ath11k_base *ab) | |
| { | |
| int i; | |
| for (i = 0; i < ab->hw_params.ce_count; i++) { | |
| if (ath11k_ce_get_attr_flags(ab, i) & CE_ATTR_DIS_INTR) | |
| continue; | |
| ath11k_ahb_ce_irq_disable(ab, i); | |
| } | |
| } | |
| static int ath11k_ahb_start(struct ath11k_base *ab) | |
| { | |
| ath11k_ahb_ce_irqs_enable(ab); | |
| ath11k_ce_rx_post_buf(ab); | |
| return 0; | |
| } | |
| static void ath11k_ahb_ext_irq_enable(struct ath11k_base *ab) | |
| { | |
| int i; | |
| for (i = 0; i < ATH11K_EXT_IRQ_GRP_NUM_MAX; i++) { | |
| struct ath11k_ext_irq_grp *irq_grp = &ab->ext_irq_grp[i]; | |
| if (!irq_grp->napi_enabled) { | |
| napi_enable(&irq_grp->napi); | |
| irq_grp->napi_enabled = true; | |
| } | |
| ath11k_ahb_ext_grp_enable(irq_grp); | |
| } | |
| } | |
| static void ath11k_ahb_ext_irq_disable(struct ath11k_base *ab) | |
| { | |
| __ath11k_ahb_ext_irq_disable(ab); | |
| ath11k_ahb_sync_ext_irqs(ab); | |
| } | |
| static void ath11k_ahb_stop(struct ath11k_base *ab) | |
| { | |
| if (!test_bit(ATH11K_FLAG_CRASH_FLUSH, &ab->dev_flags)) | |
| ath11k_ahb_ce_irqs_disable(ab); | |
| ath11k_ahb_sync_ce_irqs(ab); | |
| ath11k_ahb_kill_tasklets(ab); | |
| timer_delete_sync(&ab->rx_replenish_retry); | |
| ath11k_ce_cleanup_pipes(ab); | |
| } | |
| static int ath11k_ahb_power_up(struct ath11k_base *ab) | |
| { | |
| struct ath11k_ahb *ab_ahb = ath11k_ahb_priv(ab); | |
| int ret; | |
| ret = rproc_boot(ab_ahb->tgt_rproc); | |
| if (ret) | |
| ath11k_err(ab, "failed to boot the remote processor Q6\n"); | |
| return ret; | |
| } | |
| static void ath11k_ahb_power_down(struct ath11k_base *ab, bool is_suspend) | |
| { | |
| struct ath11k_ahb *ab_ahb = ath11k_ahb_priv(ab); | |
| rproc_shutdown(ab_ahb->tgt_rproc); | |
| } | |
| static void ath11k_ahb_init_qmi_ce_config(struct ath11k_base *ab) | |
| { | |
| struct ath11k_qmi_ce_cfg *cfg = &ab->qmi.ce_cfg; | |
| cfg->tgt_ce_len = ab->hw_params.target_ce_count; | |
| cfg->tgt_ce = ab->hw_params.target_ce_config; | |
| cfg->svc_to_ce_map_len = ab->hw_params.svc_to_ce_map_len; | |
| cfg->svc_to_ce_map = ab->hw_params.svc_to_ce_map; | |
| ab->qmi.service_ins_id = ab->hw_params.qmi_service_ins_id; | |
| } | |
| static void ath11k_ahb_free_ext_irq_grp(struct ath11k_base *ab, | |
| struct ath11k_ext_irq_grp *irq_grp) | |
| { | |
| int j; | |
| for (j = 0; j < irq_grp->num_irq; j++) | |
| free_irq(ab->irq_num[irq_grp->irqs[j]], irq_grp); | |
| netif_napi_del(&irq_grp->napi); | |
| free_netdev(irq_grp->napi_ndev); | |
| } | |
| static void ath11k_ahb_free_ext_irq(struct ath11k_base *ab) | |
| { | |
| int i; | |
| for (i = 0; i < ATH11K_EXT_IRQ_GRP_NUM_MAX; i++) | |
| ath11k_ahb_free_ext_irq_grp(ab, &ab->ext_irq_grp[i]); | |
| } | |
| static void ath11k_ahb_free_ce_irqs(struct ath11k_base *ab, int max_idx) | |
| { | |
| int irq_idx, i; | |
| for (i = 0; i < max_idx; i++) { | |
| if (ath11k_ce_get_attr_flags(ab, i) & CE_ATTR_DIS_INTR) | |
| continue; | |
| irq_idx = ATH11K_IRQ_CE0_OFFSET + i; | |
| free_irq(ab->irq_num[irq_idx], &ab->ce.ce_pipe[i]); | |
| } | |
| } | |
| static void ath11k_ahb_free_irq(struct ath11k_base *ab) | |
| { | |
| if (ab->hw_params.hybrid_bus_type) | |
| return ath11k_pcic_free_irq(ab); | |
| ath11k_ahb_free_ce_irqs(ab, ab->hw_params.ce_count); | |
| ath11k_ahb_free_ext_irq(ab); | |
| } | |
| static void ath11k_ahb_ce_tasklet(struct tasklet_struct *t) | |
| { | |
| struct ath11k_ce_pipe *ce_pipe = from_tasklet(ce_pipe, t, intr_tq); | |
| ath11k_ce_per_engine_service(ce_pipe->ab, ce_pipe->pipe_num); | |
| ath11k_ahb_ce_irq_enable(ce_pipe->ab, ce_pipe->pipe_num); | |
| } | |
| static irqreturn_t ath11k_ahb_ce_interrupt_handler(int irq, void *arg) | |
| { | |
| struct ath11k_ce_pipe *ce_pipe = arg; | |
| /* last interrupt received for this CE */ | |
| ce_pipe->timestamp = jiffies; | |
| ath11k_ahb_ce_irq_disable(ce_pipe->ab, ce_pipe->pipe_num); | |
| tasklet_schedule(&ce_pipe->intr_tq); | |
| return IRQ_HANDLED; | |
| } | |
| static int ath11k_ahb_ext_grp_napi_poll(struct napi_struct *napi, int budget) | |
| { | |
| struct ath11k_ext_irq_grp *irq_grp = container_of(napi, | |
| struct ath11k_ext_irq_grp, | |
| napi); | |
| struct ath11k_base *ab = irq_grp->ab; | |
| int work_done; | |
| work_done = ath11k_dp_service_srng(ab, irq_grp, budget); | |
| if (work_done < budget) { | |
| napi_complete_done(napi, work_done); | |
| ath11k_ahb_ext_grp_enable(irq_grp); | |
| } | |
| if (work_done > budget) | |
| work_done = budget; | |
| return work_done; | |
| } | |
| static irqreturn_t ath11k_ahb_ext_interrupt_handler(int irq, void *arg) | |
| { | |
| struct ath11k_ext_irq_grp *irq_grp = arg; | |
| /* last interrupt received for this group */ | |
| irq_grp->timestamp = jiffies; | |
| ath11k_ahb_ext_grp_disable(irq_grp); | |
| napi_schedule(&irq_grp->napi); | |
| return IRQ_HANDLED; | |
| } | |
| static int ath11k_ahb_config_ext_irq(struct ath11k_base *ab) | |
| { | |
| struct ath11k_hw_params *hw = &ab->hw_params; | |
| struct ath11k_ext_irq_grp *irq_grp; | |
| int i, j; | |
| int irq; | |
| int ret; | |
| for (i = 0; i < ATH11K_EXT_IRQ_GRP_NUM_MAX; i++) { | |
| u32 num_irq = 0; | |
| irq_grp = &ab->ext_irq_grp[i]; | |
| irq_grp->ab = ab; | |
| irq_grp->grp_id = i; | |
| irq_grp->napi_ndev = alloc_netdev_dummy(0); | |
| if (!irq_grp->napi_ndev) { | |
| ret = -ENOMEM; | |
| irq_grp->num_irq = 0; | |
| goto err_request_irq; | |
| } | |
| netif_napi_add(irq_grp->napi_ndev, &irq_grp->napi, | |
| ath11k_ahb_ext_grp_napi_poll); | |
| for (j = 0; j < ATH11K_EXT_IRQ_NUM_MAX; j++) { | |
| if (ab->hw_params.ring_mask->tx[i] & BIT(j)) { | |
| irq_grp->irqs[num_irq++] = | |
| wbm2host_tx_completions_ring1 - j; | |
| } | |
| if (ab->hw_params.ring_mask->rx[i] & BIT(j)) { | |
| irq_grp->irqs[num_irq++] = | |
| reo2host_destination_ring1 - j; | |
| } | |
| if (ab->hw_params.ring_mask->rx_err[i] & BIT(j)) | |
| irq_grp->irqs[num_irq++] = reo2host_exception; | |
| if (ab->hw_params.ring_mask->rx_wbm_rel[i] & BIT(j)) | |
| irq_grp->irqs[num_irq++] = wbm2host_rx_release; | |
| if (ab->hw_params.ring_mask->reo_status[i] & BIT(j)) | |
| irq_grp->irqs[num_irq++] = reo2host_status; | |
| if (j < ab->hw_params.max_radios) { | |
| if (ab->hw_params.ring_mask->rxdma2host[i] & BIT(j)) { | |
| irq_grp->irqs[num_irq++] = | |
| rxdma2host_destination_ring_mac1 - | |
| ath11k_hw_get_mac_from_pdev_id(hw, j); | |
| } | |
| if (ab->hw_params.ring_mask->host2rxdma[i] & BIT(j)) { | |
| irq_grp->irqs[num_irq++] = | |
| host2rxdma_host_buf_ring_mac1 - | |
| ath11k_hw_get_mac_from_pdev_id(hw, j); | |
| } | |
| if (ab->hw_params.ring_mask->rx_mon_status[i] & BIT(j)) { | |
| irq_grp->irqs[num_irq++] = | |
| ppdu_end_interrupts_mac1 - | |
| ath11k_hw_get_mac_from_pdev_id(hw, j); | |
| irq_grp->irqs[num_irq++] = | |
| rxdma2host_monitor_status_ring_mac1 - | |
| ath11k_hw_get_mac_from_pdev_id(hw, j); | |
| } | |
| } | |
| } | |
| for (j = 0; j < num_irq; j++) { | |
| int irq_idx = irq_grp->irqs[j]; | |
| irq = platform_get_irq_byname(ab->pdev, | |
| irq_name[irq_idx]); | |
| irq_set_status_flags(irq, IRQ_NOAUTOEN | IRQ_DISABLE_UNLAZY); | |
| ret = request_irq(irq, ath11k_ahb_ext_interrupt_handler, | |
| IRQF_TRIGGER_RISING, | |
| irq_name[irq_idx], irq_grp); | |
| if (ret) { | |
| ath11k_err(ab, "failed request_irq for %d\n", | |
| irq); | |
| irq_grp->num_irq = j; | |
| ath11k_ahb_free_ext_irq_grp(ab, irq_grp); | |
| goto err_request_irq; | |
| } | |
| ab->irq_num[irq_idx] = irq; | |
| } | |
| irq_grp->num_irq = num_irq; | |
| } | |
| return 0; | |
| err_request_irq: | |
| for (i--; i >= 0; i--) { | |
| irq_grp = &ab->ext_irq_grp[i]; | |
| ath11k_ahb_free_ext_irq_grp(ab, irq_grp); | |
| } | |
| return ret; | |
| } | |
| static int ath11k_ahb_config_irq(struct ath11k_base *ab) | |
| { | |
| int irq, irq_idx, i; | |
| int ret; | |
| if (ab->hw_params.hybrid_bus_type) | |
| return ath11k_pcic_config_irq(ab); | |
| /* Configure CE irqs */ | |
| for (i = 0; i < ab->hw_params.ce_count; i++) { | |
| struct ath11k_ce_pipe *ce_pipe = &ab->ce.ce_pipe[i]; | |
| if (ath11k_ce_get_attr_flags(ab, i) & CE_ATTR_DIS_INTR) | |
| continue; | |
| irq_idx = ATH11K_IRQ_CE0_OFFSET + i; | |
| tasklet_setup(&ce_pipe->intr_tq, ath11k_ahb_ce_tasklet); | |
| irq = platform_get_irq_byname(ab->pdev, irq_name[irq_idx]); | |
| ret = request_irq(irq, ath11k_ahb_ce_interrupt_handler, | |
| IRQF_TRIGGER_RISING, irq_name[irq_idx], | |
| ce_pipe); | |
| if (ret) { | |
| ath11k_err(ab, "failed request_irq for %d\n", irq); | |
| ath11k_ahb_free_ce_irqs(ab, i); | |
| return ret; | |
| } | |
| ab->irq_num[irq_idx] = irq; | |
| } | |
| /* Configure external interrupts */ | |
| ret = ath11k_ahb_config_ext_irq(ab); | |
| if (ret) { | |
| ath11k_err(ab, "failed to configure ext irq: %d\n", ret); | |
| ath11k_ahb_free_ce_irqs(ab, ab->hw_params.ce_count); | |
| return ret; | |
| } | |
| return 0; | |
| } | |
| static int ath11k_ahb_map_service_to_pipe(struct ath11k_base *ab, u16 service_id, | |
| u8 *ul_pipe, u8 *dl_pipe) | |
| { | |
| const struct service_to_pipe *entry; | |
| bool ul_set = false, dl_set = false; | |
| int i; | |
| for (i = 0; i < ab->hw_params.svc_to_ce_map_len; i++) { | |
| entry = &ab->hw_params.svc_to_ce_map[i]; | |
| if (__le32_to_cpu(entry->service_id) != service_id) | |
| continue; | |
| switch (__le32_to_cpu(entry->pipedir)) { | |
| case PIPEDIR_NONE: | |
| break; | |
| case PIPEDIR_IN: | |
| WARN_ON(dl_set); | |
| *dl_pipe = __le32_to_cpu(entry->pipenum); | |
| dl_set = true; | |
| break; | |
| case PIPEDIR_OUT: | |
| WARN_ON(ul_set); | |
| *ul_pipe = __le32_to_cpu(entry->pipenum); | |
| ul_set = true; | |
| break; | |
| case PIPEDIR_INOUT: | |
| WARN_ON(dl_set); | |
| WARN_ON(ul_set); | |
| *dl_pipe = __le32_to_cpu(entry->pipenum); | |
| *ul_pipe = __le32_to_cpu(entry->pipenum); | |
| dl_set = true; | |
| ul_set = true; | |
| break; | |
| } | |
| } | |
| if (WARN_ON(!ul_set || !dl_set)) | |
| return -ENOENT; | |
| return 0; | |
| } | |
| static int ath11k_ahb_hif_suspend(struct ath11k_base *ab) | |
| { | |
| struct ath11k_ahb *ab_ahb = ath11k_ahb_priv(ab); | |
| u32 wake_irq; | |
| u32 value = 0; | |
| int ret; | |
| if (!device_may_wakeup(ab->dev)) | |
| return -EPERM; | |
| wake_irq = ab->irq_num[ATH11K_PCI_IRQ_CE0_OFFSET + ATH11K_PCI_CE_WAKE_IRQ]; | |
| ret = enable_irq_wake(wake_irq); | |
| if (ret) { | |
| ath11k_err(ab, "failed to enable wakeup irq :%d\n", ret); | |
| return ret; | |
| } | |
| value = u32_encode_bits(ab_ahb->smp2p_info.seq_no++, | |
| ATH11K_AHB_SMP2P_SMEM_SEQ_NO); | |
| value |= u32_encode_bits(ATH11K_AHB_POWER_SAVE_ENTER, | |
| ATH11K_AHB_SMP2P_SMEM_MSG); | |
| ret = qcom_smem_state_update_bits(ab_ahb->smp2p_info.smem_state, | |
| ATH11K_AHB_SMP2P_SMEM_VALUE_MASK, value); | |
| if (ret) { | |
| ath11k_err(ab, "failed to send smp2p power save enter cmd :%d\n", ret); | |
| return ret; | |
| } | |
| ath11k_dbg(ab, ATH11K_DBG_AHB, "device suspended\n"); | |
| return ret; | |
| } | |
| static int ath11k_ahb_hif_resume(struct ath11k_base *ab) | |
| { | |
| struct ath11k_ahb *ab_ahb = ath11k_ahb_priv(ab); | |
| u32 wake_irq; | |
| u32 value = 0; | |
| int ret; | |
| if (!device_may_wakeup(ab->dev)) | |
| return -EPERM; | |
| wake_irq = ab->irq_num[ATH11K_PCI_IRQ_CE0_OFFSET + ATH11K_PCI_CE_WAKE_IRQ]; | |
| ret = disable_irq_wake(wake_irq); | |
| if (ret) { | |
| ath11k_err(ab, "failed to disable wakeup irq: %d\n", ret); | |
| return ret; | |
| } | |
| reinit_completion(&ab->wow.wakeup_completed); | |
| value = u32_encode_bits(ab_ahb->smp2p_info.seq_no++, | |
| ATH11K_AHB_SMP2P_SMEM_SEQ_NO); | |
| value |= u32_encode_bits(ATH11K_AHB_POWER_SAVE_EXIT, | |
| ATH11K_AHB_SMP2P_SMEM_MSG); | |
| ret = qcom_smem_state_update_bits(ab_ahb->smp2p_info.smem_state, | |
| ATH11K_AHB_SMP2P_SMEM_VALUE_MASK, value); | |
| if (ret) { | |
| ath11k_err(ab, "failed to send smp2p power save enter cmd :%d\n", ret); | |
| return ret; | |
| } | |
| ret = wait_for_completion_timeout(&ab->wow.wakeup_completed, 3 * HZ); | |
| if (ret == 0) { | |
| ath11k_warn(ab, "timed out while waiting for wow wakeup completion\n"); | |
| return -ETIMEDOUT; | |
| } | |
| ath11k_dbg(ab, ATH11K_DBG_AHB, "device resumed\n"); | |
| return 0; | |
| } | |
| static const struct ath11k_hif_ops ath11k_ahb_hif_ops_ipq8074 = { | |
| .start = ath11k_ahb_start, | |
| .stop = ath11k_ahb_stop, | |
| .read32 = ath11k_ahb_read32, | |
| .write32 = ath11k_ahb_write32, | |
| .read = NULL, | |
| .irq_enable = ath11k_ahb_ext_irq_enable, | |
| .irq_disable = ath11k_ahb_ext_irq_disable, | |
| .map_service_to_pipe = ath11k_ahb_map_service_to_pipe, | |
| .power_down = ath11k_ahb_power_down, | |
| .power_up = ath11k_ahb_power_up, | |
| }; | |
| static const struct ath11k_hif_ops ath11k_ahb_hif_ops_wcn6750 = { | |
| .start = ath11k_pcic_start, | |
| .stop = ath11k_pcic_stop, | |
| .read32 = ath11k_pcic_read32, | |
| .write32 = ath11k_pcic_write32, | |
| .read = NULL, | |
| .irq_enable = ath11k_pcic_ext_irq_enable, | |
| .irq_disable = ath11k_pcic_ext_irq_disable, | |
| .get_msi_address = ath11k_pcic_get_msi_address, | |
| .get_user_msi_vector = ath11k_pcic_get_user_msi_assignment, | |
| .map_service_to_pipe = ath11k_pcic_map_service_to_pipe, | |
| .power_down = ath11k_ahb_power_down, | |
| .power_up = ath11k_ahb_power_up, | |
| .suspend = ath11k_ahb_hif_suspend, | |
| .resume = ath11k_ahb_hif_resume, | |
| .ce_irq_enable = ath11k_pci_enable_ce_irqs_except_wake_irq, | |
| .ce_irq_disable = ath11k_pci_disable_ce_irqs_except_wake_irq, | |
| }; | |
| static int ath11k_core_get_rproc(struct ath11k_base *ab) | |
| { | |
| struct ath11k_ahb *ab_ahb = ath11k_ahb_priv(ab); | |
| struct device *dev = ab->dev; | |
| struct rproc *prproc; | |
| phandle rproc_phandle; | |
| if (of_property_read_u32(dev->of_node, "qcom,rproc", &rproc_phandle)) { | |
| ath11k_err(ab, "failed to get q6_rproc handle\n"); | |
| return -ENOENT; | |
| } | |
| prproc = rproc_get_by_phandle(rproc_phandle); | |
| if (!prproc) | |
| return dev_err_probe(&ab->pdev->dev, -EPROBE_DEFER, "failed to get rproc\n"); | |
| ab_ahb->tgt_rproc = prproc; | |
| return 0; | |
| } | |
| static int ath11k_ahb_setup_msi_resources(struct ath11k_base *ab) | |
| { | |
| struct platform_device *pdev = ab->pdev; | |
| phys_addr_t msi_addr_pa; | |
| dma_addr_t msi_addr_iova; | |
| struct resource *res; | |
| int int_prop; | |
| int ret; | |
| int i; | |
| ret = ath11k_pcic_init_msi_config(ab); | |
| if (ret) { | |
| ath11k_err(ab, "failed to init msi config: %d\n", ret); | |
| return ret; | |
| } | |
| res = platform_get_resource(pdev, IORESOURCE_MEM, 0); | |
| if (!res) { | |
| ath11k_err(ab, "failed to fetch msi_addr\n"); | |
| return -ENOENT; | |
| } | |
| msi_addr_pa = res->start; | |
| msi_addr_iova = dma_map_resource(ab->dev, msi_addr_pa, PAGE_SIZE, | |
| DMA_FROM_DEVICE, 0); | |
| if (dma_mapping_error(ab->dev, msi_addr_iova)) | |
| return -ENOMEM; | |
| ab->pci.msi.addr_lo = lower_32_bits(msi_addr_iova); | |
| ab->pci.msi.addr_hi = upper_32_bits(msi_addr_iova); | |
| ret = of_property_read_u32_index(ab->dev->of_node, "interrupts", 1, &int_prop); | |
| if (ret) | |
| return ret; | |
| ab->pci.msi.ep_base_data = int_prop + 32; | |
| for (i = 0; i < ab->pci.msi.config->total_vectors; i++) { | |
| ret = platform_get_irq(pdev, i); | |
| if (ret < 0) | |
| return ret; | |
| ab->pci.msi.irqs[i] = ret; | |
| } | |
| set_bit(ATH11K_FLAG_MULTI_MSI_VECTORS, &ab->dev_flags); | |
| return 0; | |
| } | |
| static int ath11k_ahb_setup_smp2p_handle(struct ath11k_base *ab) | |
| { | |
| struct ath11k_ahb *ab_ahb = ath11k_ahb_priv(ab); | |
| if (!ab->hw_params.smp2p_wow_exit) | |
| return 0; | |
| ab_ahb->smp2p_info.smem_state = qcom_smem_state_get(ab->dev, "wlan-smp2p-out", | |
| &ab_ahb->smp2p_info.smem_bit); | |
| if (IS_ERR(ab_ahb->smp2p_info.smem_state)) { | |
| ath11k_err(ab, "failed to fetch smem state: %ld\n", | |
| PTR_ERR(ab_ahb->smp2p_info.smem_state)); | |
| return PTR_ERR(ab_ahb->smp2p_info.smem_state); | |
| } | |
| return 0; | |
| } | |
| static void ath11k_ahb_release_smp2p_handle(struct ath11k_base *ab) | |
| { | |
| struct ath11k_ahb *ab_ahb = ath11k_ahb_priv(ab); | |
| if (!ab->hw_params.smp2p_wow_exit) | |
| return; | |
| qcom_smem_state_put(ab_ahb->smp2p_info.smem_state); | |
| } | |
| static int ath11k_ahb_setup_resources(struct ath11k_base *ab) | |
| { | |
| struct platform_device *pdev = ab->pdev; | |
| struct resource *mem_res; | |
| void __iomem *mem; | |
| if (ab->hw_params.hybrid_bus_type) | |
| return ath11k_ahb_setup_msi_resources(ab); | |
| mem = devm_platform_get_and_ioremap_resource(pdev, 0, &mem_res); | |
| if (IS_ERR(mem)) { | |
| dev_err(&pdev->dev, "ioremap error\n"); | |
| return PTR_ERR(mem); | |
| } | |
| ab->mem = mem; | |
| ab->mem_len = resource_size(mem_res); | |
| return 0; | |
| } | |
| static int ath11k_ahb_setup_msa_resources(struct ath11k_base *ab) | |
| { | |
| struct ath11k_ahb *ab_ahb = ath11k_ahb_priv(ab); | |
| struct device *dev = ab->dev; | |
| struct resource r; | |
| int ret; | |
| ret = of_reserved_mem_region_to_resource(dev->of_node, 0, &r); | |
| if (ret) { | |
| dev_err(dev, "failed to resolve msa fixed region\n"); | |
| return ret; | |
| } | |
| ab_ahb->fw.msa_paddr = r.start; | |
| ab_ahb->fw.msa_size = resource_size(&r); | |
| ret = of_reserved_mem_region_to_resource(dev->of_node, 1, &r); | |
| if (ret) { | |
| dev_err(dev, "failed to resolve ce fixed region\n"); | |
| return ret; | |
| } | |
| ab_ahb->fw.ce_paddr = r.start; | |
| ab_ahb->fw.ce_size = resource_size(&r); | |
| return 0; | |
| } | |
| static int ath11k_ahb_ce_remap(struct ath11k_base *ab) | |
| { | |
| const struct ce_remap *ce_remap = ab->hw_params.ce_remap; | |
| struct platform_device *pdev = ab->pdev; | |
| if (!ce_remap) { | |
| /* no separate CE register space */ | |
| ab->mem_ce = ab->mem; | |
| return 0; | |
| } | |
| /* ce register space is moved out of wcss unlike ipq8074 or ipq6018 | |
| * and the space is not contiguous, hence remapping the CE registers | |
| * to a new space for accessing them. | |
| */ | |
| ab->mem_ce = ioremap(ce_remap->base, ce_remap->size); | |
| if (!ab->mem_ce) { | |
| dev_err(&pdev->dev, "ce ioremap error\n"); | |
| return -ENOMEM; | |
| } | |
| return 0; | |
| } | |
| static void ath11k_ahb_ce_unmap(struct ath11k_base *ab) | |
| { | |
| if (ab->hw_params.ce_remap) | |
| iounmap(ab->mem_ce); | |
| } | |
| static int ath11k_ahb_fw_resources_init(struct ath11k_base *ab) | |
| { | |
| struct ath11k_ahb *ab_ahb = ath11k_ahb_priv(ab); | |
| struct device *host_dev = ab->dev; | |
| struct platform_device_info info = {}; | |
| struct iommu_domain *iommu_dom; | |
| struct platform_device *pdev; | |
| struct device_node *node; | |
| int ret; | |
| /* Chipsets not requiring MSA need not initialize | |
| * MSA resources, return success in such cases. | |
| */ | |
| if (!ab->hw_params.fixed_fw_mem) | |
| return 0; | |
| node = of_get_child_by_name(host_dev->of_node, "wifi-firmware"); | |
| if (!node) { | |
| ab_ahb->fw.use_tz = true; | |
| return 0; | |
| } | |
| ret = ath11k_ahb_setup_msa_resources(ab); | |
| if (ret) { | |
| ath11k_err(ab, "failed to setup msa resources\n"); | |
| of_node_put(node); | |
| return ret; | |
| } | |
| info.fwnode = &node->fwnode; | |
| info.parent = host_dev; | |
| info.name = node->name; | |
| info.dma_mask = DMA_BIT_MASK(32); | |
| pdev = platform_device_register_full(&info); | |
| if (IS_ERR(pdev)) { | |
| of_node_put(node); | |
| return PTR_ERR(pdev); | |
| } | |
| ret = of_dma_configure(&pdev->dev, node, true); | |
| if (ret) { | |
| ath11k_err(ab, "dma configure fail: %d\n", ret); | |
| goto err_unregister; | |
| } | |
| ab_ahb->fw.dev = &pdev->dev; | |
| iommu_dom = iommu_paging_domain_alloc(ab_ahb->fw.dev); | |
| if (IS_ERR(iommu_dom)) { | |
| ath11k_err(ab, "failed to allocate iommu domain\n"); | |
| ret = PTR_ERR(iommu_dom); | |
| goto err_unregister; | |
| } | |
| ret = iommu_attach_device(iommu_dom, ab_ahb->fw.dev); | |
| if (ret) { | |
| ath11k_err(ab, "could not attach device: %d\n", ret); | |
| goto err_iommu_free; | |
| } | |
| ret = iommu_map(iommu_dom, ab_ahb->fw.msa_paddr, | |
| ab_ahb->fw.msa_paddr, ab_ahb->fw.msa_size, | |
| IOMMU_READ | IOMMU_WRITE, GFP_KERNEL); | |
| if (ret) { | |
| ath11k_err(ab, "failed to map firmware region: %d\n", ret); | |
| goto err_iommu_detach; | |
| } | |
| ret = iommu_map(iommu_dom, ab_ahb->fw.ce_paddr, | |
| ab_ahb->fw.ce_paddr, ab_ahb->fw.ce_size, | |
| IOMMU_READ | IOMMU_WRITE, GFP_KERNEL); | |
| if (ret) { | |
| ath11k_err(ab, "failed to map firmware CE region: %d\n", ret); | |
| goto err_iommu_unmap; | |
| } | |
| ab_ahb->fw.use_tz = false; | |
| ab_ahb->fw.iommu_domain = iommu_dom; | |
| of_node_put(node); | |
| return 0; | |
| err_iommu_unmap: | |
| iommu_unmap(iommu_dom, ab_ahb->fw.msa_paddr, ab_ahb->fw.msa_size); | |
| err_iommu_detach: | |
| iommu_detach_device(iommu_dom, ab_ahb->fw.dev); | |
| err_iommu_free: | |
| iommu_domain_free(iommu_dom); | |
| err_unregister: | |
| platform_device_unregister(pdev); | |
| of_node_put(node); | |
| return ret; | |
| } | |
| static int ath11k_ahb_fw_resource_deinit(struct ath11k_base *ab) | |
| { | |
| struct ath11k_ahb *ab_ahb = ath11k_ahb_priv(ab); | |
| struct iommu_domain *iommu; | |
| size_t unmapped_size; | |
| /* Chipsets not requiring MSA would have not initialized | |
| * MSA resources, return success in such cases. | |
| */ | |
| if (!ab->hw_params.fixed_fw_mem) | |
| return 0; | |
| if (ab_ahb->fw.use_tz) | |
| return 0; | |
| iommu = ab_ahb->fw.iommu_domain; | |
| unmapped_size = iommu_unmap(iommu, ab_ahb->fw.msa_paddr, ab_ahb->fw.msa_size); | |
| if (unmapped_size != ab_ahb->fw.msa_size) | |
| ath11k_err(ab, "failed to unmap firmware: %zu\n", | |
| unmapped_size); | |
| unmapped_size = iommu_unmap(iommu, ab_ahb->fw.ce_paddr, ab_ahb->fw.ce_size); | |
| if (unmapped_size != ab_ahb->fw.ce_size) | |
| ath11k_err(ab, "failed to unmap firmware CE memory: %zu\n", | |
| unmapped_size); | |
| iommu_detach_device(iommu, ab_ahb->fw.dev); | |
| iommu_domain_free(iommu); | |
| platform_device_unregister(to_platform_device(ab_ahb->fw.dev)); | |
| return 0; | |
| } | |
| static int ath11k_ahb_probe(struct platform_device *pdev) | |
| { | |
| struct ath11k_base *ab; | |
| const struct ath11k_hif_ops *hif_ops; | |
| const struct ath11k_pci_ops *pci_ops; | |
| enum ath11k_hw_rev hw_rev; | |
| int ret; | |
| hw_rev = (uintptr_t)device_get_match_data(&pdev->dev); | |
| switch (hw_rev) { | |
| case ATH11K_HW_IPQ8074: | |
| case ATH11K_HW_IPQ6018_HW10: | |
| case ATH11K_HW_IPQ5018_HW10: | |
| hif_ops = &ath11k_ahb_hif_ops_ipq8074; | |
| pci_ops = NULL; | |
| break; | |
| case ATH11K_HW_WCN6750_HW10: | |
| hif_ops = &ath11k_ahb_hif_ops_wcn6750; | |
| pci_ops = &ath11k_ahb_pci_ops_wcn6750; | |
| break; | |
| default: | |
| dev_err(&pdev->dev, "unsupported device type %d\n", hw_rev); | |
| return -EOPNOTSUPP; | |
| } | |
| ret = dma_set_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32)); | |
| if (ret) { | |
| dev_err(&pdev->dev, "failed to set 32-bit consistent dma\n"); | |
| return ret; | |
| } | |
| ab = ath11k_core_alloc(&pdev->dev, sizeof(struct ath11k_ahb), | |
| ATH11K_BUS_AHB); | |
| if (!ab) { | |
| dev_err(&pdev->dev, "failed to allocate ath11k base\n"); | |
| return -ENOMEM; | |
| } | |
| ab->hif.ops = hif_ops; | |
| ab->pdev = pdev; | |
| ab->hw_rev = hw_rev; | |
| ab->fw_mode = ATH11K_FIRMWARE_MODE_NORMAL; | |
| platform_set_drvdata(pdev, ab); | |
| ret = ath11k_pcic_register_pci_ops(ab, pci_ops); | |
| if (ret) { | |
| ath11k_err(ab, "failed to register PCI ops: %d\n", ret); | |
| goto err_core_free; | |
| } | |
| ret = ath11k_core_pre_init(ab); | |
| if (ret) | |
| goto err_core_free; | |
| ret = ath11k_ahb_setup_resources(ab); | |
| if (ret) | |
| goto err_core_free; | |
| ret = ath11k_ahb_ce_remap(ab); | |
| if (ret) | |
| goto err_core_free; | |
| ret = ath11k_ahb_fw_resources_init(ab); | |
| if (ret) | |
| goto err_ce_unmap; | |
| ret = ath11k_ahb_setup_smp2p_handle(ab); | |
| if (ret) | |
| goto err_fw_deinit; | |
| ret = ath11k_hal_srng_init(ab); | |
| if (ret) | |
| goto err_release_smp2p_handle; | |
| ret = ath11k_ce_alloc_pipes(ab); | |
| if (ret) { | |
| ath11k_err(ab, "failed to allocate ce pipes: %d\n", ret); | |
| goto err_hal_srng_deinit; | |
| } | |
| ath11k_ahb_init_qmi_ce_config(ab); | |
| ret = ath11k_core_get_rproc(ab); | |
| if (ret) | |
| goto err_ce_free; | |
| ret = ath11k_core_init(ab); | |
| if (ret) { | |
| ath11k_err(ab, "failed to init core: %d\n", ret); | |
| goto err_ce_free; | |
| } | |
| ret = ath11k_ahb_config_irq(ab); | |
| if (ret) { | |
| ath11k_err(ab, "failed to configure irq: %d\n", ret); | |
| goto err_ce_free; | |
| } | |
| ath11k_qmi_fwreset_from_cold_boot(ab); | |
| return 0; | |
| err_ce_free: | |
| ath11k_ce_free_pipes(ab); | |
| err_hal_srng_deinit: | |
| ath11k_hal_srng_deinit(ab); | |
| err_release_smp2p_handle: | |
| ath11k_ahb_release_smp2p_handle(ab); | |
| err_fw_deinit: | |
| ath11k_ahb_fw_resource_deinit(ab); | |
| err_ce_unmap: | |
| ath11k_ahb_ce_unmap(ab); | |
| err_core_free: | |
| ath11k_core_free(ab); | |
| platform_set_drvdata(pdev, NULL); | |
| return ret; | |
| } | |
| static void ath11k_ahb_remove_prepare(struct ath11k_base *ab) | |
| { | |
| unsigned long left; | |
| if (test_bit(ATH11K_FLAG_RECOVERY, &ab->dev_flags)) { | |
| left = wait_for_completion_timeout(&ab->driver_recovery, | |
| ATH11K_AHB_RECOVERY_TIMEOUT); | |
| if (!left) | |
| ath11k_warn(ab, "failed to receive recovery response completion\n"); | |
| } | |
| set_bit(ATH11K_FLAG_UNREGISTERING, &ab->dev_flags); | |
| cancel_work_sync(&ab->restart_work); | |
| cancel_work_sync(&ab->qmi.event_work); | |
| } | |
| static void ath11k_ahb_free_resources(struct ath11k_base *ab) | |
| { | |
| struct platform_device *pdev = ab->pdev; | |
| ath11k_ahb_free_irq(ab); | |
| ath11k_hal_srng_deinit(ab); | |
| ath11k_ahb_release_smp2p_handle(ab); | |
| ath11k_ahb_fw_resource_deinit(ab); | |
| ath11k_ce_free_pipes(ab); | |
| ath11k_ahb_ce_unmap(ab); | |
| ath11k_core_free(ab); | |
| platform_set_drvdata(pdev, NULL); | |
| } | |
| static void ath11k_ahb_remove(struct platform_device *pdev) | |
| { | |
| struct ath11k_base *ab = platform_get_drvdata(pdev); | |
| if (test_bit(ATH11K_FLAG_QMI_FAIL, &ab->dev_flags)) { | |
| ath11k_ahb_power_down(ab, false); | |
| ath11k_debugfs_soc_destroy(ab); | |
| ath11k_qmi_deinit_service(ab); | |
| goto qmi_fail; | |
| } | |
| ath11k_ahb_remove_prepare(ab); | |
| ath11k_core_deinit(ab); | |
| qmi_fail: | |
| ath11k_fw_destroy(ab); | |
| ath11k_ahb_free_resources(ab); | |
| } | |
| static void ath11k_ahb_shutdown(struct platform_device *pdev) | |
| { | |
| struct ath11k_base *ab = platform_get_drvdata(pdev); | |
| /* platform shutdown() & remove() are mutually exclusive. | |
| * remove() is invoked during rmmod & shutdown() during | |
| * system reboot/shutdown. | |
| */ | |
| ath11k_ahb_remove_prepare(ab); | |
| if (!(test_bit(ATH11K_FLAG_REGISTERED, &ab->dev_flags))) | |
| goto free_resources; | |
| ath11k_core_deinit(ab); | |
| free_resources: | |
| ath11k_fw_destroy(ab); | |
| ath11k_ahb_free_resources(ab); | |
| } | |
| static struct platform_driver ath11k_ahb_driver = { | |
| .driver = { | |
| .name = "ath11k", | |
| .of_match_table = ath11k_ahb_of_match, | |
| }, | |
| .probe = ath11k_ahb_probe, | |
| .remove = ath11k_ahb_remove, | |
| .shutdown = ath11k_ahb_shutdown, | |
| }; | |
| module_platform_driver(ath11k_ahb_driver); | |
| MODULE_DESCRIPTION("Driver support for Qualcomm Technologies 802.11ax WLAN AHB devices"); | |
| MODULE_LICENSE("Dual BSD/GPL"); |