/* * Copyright (c) 2013-2021 The Linux Foundation. All rights reserved. * Copyright (c) 2021-2023 Qualcomm Innovation Center, Inc. All rights reserved. * * Permission to use, copy, modify, and/or distribute this software for * any purpose with or without fee is hereby granted, provided that the * above copyright notice and this permission notice appear in all * copies. * * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL * WARRANTIES WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED * WARRANTIES OF MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE * AUTHOR BE LIABLE FOR ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL * DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR * PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER * TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR * PERFORMANCE OF THIS SOFTWARE. */ /** * DOC: HDD WMM * * This module (wlan_hdd_wmm.h interface + wlan_hdd_wmm.c implementation) * houses all the logic for WMM in HDD. * * On the control path, it has the logic to setup QoS, modify QoS and delete * QoS (QoS here refers to a TSPEC). The setup QoS comes in two flavors: an * explicit application invoked and an internal HDD invoked. The implicit QoS * is for applications that do NOT call the custom QCT WLAN OIDs for QoS but * which DO mark their traffic for priortization. It also has logic to start, * update and stop the U-APSD trigger frame generation. It also has logic to * read WMM related config parameters from the registry. * * On the data path, it has the logic to figure out the WMM AC of an egress * packet and when to signal TL to serve a particular AC queue. It also has the * logic to retrieve a packet based on WMM priority in response to a fetch from * TL. * * The remaining functions are utility functions for information hiding. */ /* Include files */ #include #include #include #include #include #include #include #include "osif_sync.h" #include "os_if_fwol.h" #include #include #include #include #include #include #include "sme_api.h" #include "wlan_mlme_ucfg_api.h" #include "cfg_ucfg_api.h" #include "wlan_hdd_object_manager.h" #include "wlan_hdd_cm_api.h" #include "wlan_dp_ucfg_api.h" #define HDD_WMM_UP_TO_AC_MAP_SIZE 8 #define DSCP(x) x #define MIN_HANDLE_VALUE 5000 #define MAX_HANDLE_VALUE 6000 const uint8_t hdd_wmm_up_to_ac_map[] = { SME_AC_BE, SME_AC_BK, SME_AC_BK, SME_AC_BE, SME_AC_VI, SME_AC_VI, SME_AC_VO, SME_AC_VO }; #define CONFIG_TSPEC_OPERATION \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_OPERATION #define CONFIG_TSPEC_TSID \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_TSID #define CONFIG_TSPEC_DIRECTION \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_DIRECTION #define CONFIG_TSPEC_APSD \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_APSD #define CONFIG_TSPEC_USER_PRIORITY \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_USER_PRIORITY #define CONFIG_TSPEC_ACK_POLICY \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_ACK_POLICY #define CONFIG_TSPEC_NOMINAL_MSDU_SIZE \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_NOMINAL_MSDU_SIZE #define CONFIG_TSPEC_MAXIMUM_MSDU_SIZE \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_MAXIMUM_MSDU_SIZE #define CONFIG_TSPEC_MIN_SERVICE_INTERVAL \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_MIN_SERVICE_INTERVAL #define CONFIG_TSPEC_MAX_SERVICE_INTERVAL \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_MAX_SERVICE_INTERVAL #define CONFIG_TSPEC_INACTIVITY_INTERVAL \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_INACTIVITY_INTERVAL #define CONFIG_TSPEC_SUSPENSION_INTERVAL \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_SUSPENSION_INTERVAL #define CONFIG_TSPEC_MINIMUM_DATA_RATE \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_MINIMUM_DATA_RATE #define CONFIG_TSPEC_MEAN_DATA_RATE \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_MEAN_DATA_RATE #define CONFIG_TSPEC_PEAK_DATA_RATE \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_PEAK_DATA_RATE #define CONFIG_TSPEC_BURST_SIZE \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_BURST_SIZE #define CONFIG_TSPEC_MINIMUM_PHY_RATE \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_MINIMUM_PHY_RATE #define CONFIG_TSPEC_SURPLUS_BANDWIDTH_ALLOWANCE \ QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_SURPLUS_BANDWIDTH_ALLOWANCE const struct nla_policy config_tspec_policy[QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_MAX + 1] = { [CONFIG_TSPEC_OPERATION] = {.type = NLA_U8}, [CONFIG_TSPEC_TSID] = {.type = NLA_U8}, [CONFIG_TSPEC_DIRECTION] = {.type = NLA_U8}, [CONFIG_TSPEC_APSD] = {.type = NLA_FLAG}, [CONFIG_TSPEC_USER_PRIORITY] = {.type = NLA_U8}, [CONFIG_TSPEC_ACK_POLICY] = {.type = NLA_U8}, [CONFIG_TSPEC_NOMINAL_MSDU_SIZE] = {.type = NLA_U16}, [CONFIG_TSPEC_MAXIMUM_MSDU_SIZE] = {.type = NLA_U16}, [CONFIG_TSPEC_MIN_SERVICE_INTERVAL] = {.type = NLA_U32}, [CONFIG_TSPEC_MAX_SERVICE_INTERVAL] = {.type = NLA_U32}, [CONFIG_TSPEC_INACTIVITY_INTERVAL] = {.type = NLA_U32}, [CONFIG_TSPEC_SUSPENSION_INTERVAL] = {.type = NLA_U32}, [CONFIG_TSPEC_MINIMUM_DATA_RATE] = {.type = NLA_U32}, [CONFIG_TSPEC_MEAN_DATA_RATE] = {.type = NLA_U32}, [CONFIG_TSPEC_PEAK_DATA_RATE] = {.type = NLA_U32}, [CONFIG_TSPEC_BURST_SIZE] = {.type = NLA_U32}, [CONFIG_TSPEC_MINIMUM_PHY_RATE] = {.type = NLA_U32}, [CONFIG_TSPEC_SURPLUS_BANDWIDTH_ALLOWANCE] = {.type = NLA_U16}, }; #ifdef QCA_LL_TX_FLOW_CONTROL_V2 void wlan_hdd_process_peer_unauthorised_pause(struct hdd_adapter *adapter) { uint8_t i; netif_wake_subqueue(adapter->dev, HDD_LINUX_AC_HI_PRIO * TX_QUEUES_PER_AC); for (i = 0; i < TX_QUEUES_PER_AC; i++) { netif_stop_subqueue(adapter->dev, TX_GET_QUEUE_IDX(HDD_LINUX_AC_VO, i)); netif_stop_subqueue(adapter->dev, TX_GET_QUEUE_IDX(HDD_LINUX_AC_VI, i)); netif_stop_subqueue(adapter->dev, TX_GET_QUEUE_IDX(HDD_LINUX_AC_BE, i)); netif_stop_subqueue(adapter->dev, TX_GET_QUEUE_IDX(HDD_LINUX_AC_BK, i)); } } #else void wlan_hdd_process_peer_unauthorised_pause(struct hdd_adapter *adapter) { } #endif /* Linux based UP -> AC Mapping */ const uint8_t hdd_linux_up_to_ac_map[HDD_WMM_UP_TO_AC_MAP_SIZE] = { HDD_LINUX_AC_BE, HDD_LINUX_AC_BK, HDD_LINUX_AC_BK, HDD_LINUX_AC_BE, HDD_LINUX_AC_VI, HDD_LINUX_AC_VI, HDD_LINUX_AC_VO, HDD_LINUX_AC_VO }; #ifndef WLAN_MDM_CODE_REDUCTION_OPT /** * hdd_wmm_enable_tl_uapsd() - function which decides whether and * how to update UAPSD parameters in TL * * @qos_context: [in] the pointer the QoS instance control block * * Return: None */ static void hdd_wmm_enable_tl_uapsd(struct hdd_wmm_qos_context *qos_context) { struct hdd_adapter *adapter = qos_context->adapter; sme_ac_enum_type ac_type = qos_context->ac_type; struct hdd_wmm_ac_status *ac = &adapter->hdd_wmm_status.ac_status[ac_type]; struct hdd_context *hdd_ctx = WLAN_HDD_GET_CTX(adapter); QDF_STATUS status; uint32_t service_interval; uint32_t suspension_interval; enum sme_qos_wmm_dir_type direction; bool psb; uint32_t delayed_trgr_frm_int; /* The TSPEC must be valid */ if (ac->is_tspec_valid == false) { hdd_err("Invoked with invalid TSPEC"); return; } /* determine the service interval */ if (ac->tspec.min_service_interval) { service_interval = ac->tspec.min_service_interval; } else if (ac->tspec.max_service_interval) { service_interval = ac->tspec.max_service_interval; } else { /* no service interval is present in the TSPEC */ /* this is OK, there just won't be U-APSD */ hdd_debug("No service interval supplied"); service_interval = 0; } /* determine the suspension interval & direction */ suspension_interval = ac->tspec.suspension_interval; direction = ac->tspec.ts_info.direction; psb = ac->tspec.ts_info.psb; /* if we have previously enabled U-APSD, have any params changed? */ if ((ac->is_uapsd_info_valid) && (ac->uapsd_service_interval == service_interval) && (ac->uapsd_suspension_interval == suspension_interval) && (ac->uapsd_direction == direction) && (ac->is_uapsd_enabled == psb)) { hdd_debug("No change in U-APSD parameters"); return; } ucfg_mlme_get_tl_delayed_trgr_frm_int(hdd_ctx->psoc, &delayed_trgr_frm_int); /* everything is in place to notify TL */ status = sme_enable_uapsd_for_ac(ac_type, ac->tspec.ts_info.tid, ac->tspec.ts_info.up, service_interval, suspension_interval, direction, psb, adapter->deflink->vdev_id, delayed_trgr_frm_int); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Failed to enable U-APSD for AC=%d", ac_type); return; } /* stash away the parameters that were used */ ac->is_uapsd_info_valid = true; ac->uapsd_service_interval = service_interval; ac->uapsd_suspension_interval = suspension_interval; ac->uapsd_direction = direction; ac->is_uapsd_enabled = psb; hdd_debug("Enabled UAPSD in TL srv_int=%d susp_int=%d dir=%d AC=%d", service_interval, suspension_interval, direction, ac_type); } /** * hdd_wmm_disable_tl_uapsd() - function which decides whether * to disable UAPSD parameters in TL * * @qos_context: [in] the pointer the QoS instance control block * * Return: None */ static void hdd_wmm_disable_tl_uapsd(struct hdd_wmm_qos_context *qos_context) { struct hdd_adapter *adapter = qos_context->adapter; sme_ac_enum_type ac_type = qos_context->ac_type; struct hdd_wmm_ac_status *ac = &adapter->hdd_wmm_status.ac_status[ac_type]; QDF_STATUS status; /* have we previously enabled UAPSD? */ if (ac->is_uapsd_info_valid == true) { status = sme_disable_uapsd_for_ac(ac_type, adapter->deflink->vdev_id); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Failed to disable U-APSD for AC=%d", ac_type); } else { /* TL no longer has valid UAPSD info */ ac->is_uapsd_info_valid = false; hdd_debug("Disabled UAPSD in TL for AC=%d", ac_type); } } } #endif /** * hdd_wmm_free_context() - function which frees a QoS context * * @qos_context: [in] the pointer the QoS instance control block * * Return: None */ static void hdd_wmm_free_context(struct hdd_wmm_qos_context *qos_context) { struct hdd_adapter *adapter; hdd_debug("Entered, context %pK", qos_context); if (unlikely((!qos_context) || (HDD_WMM_CTX_MAGIC != qos_context->magic))) { /* must have been freed in another thread */ return; } /* get pointer to the adapter context */ adapter = qos_context->adapter; /* take the mutex since we're manipulating the context list */ mutex_lock(&adapter->hdd_wmm_status.mutex); /* make sure nobody thinks this is a valid context */ qos_context->magic = 0; /* unlink the context */ list_del(&qos_context->node); /* done manipulating the list */ mutex_unlock(&adapter->hdd_wmm_status.mutex); /* reclaim memory */ qdf_mem_free(qos_context); } #ifndef WLAN_MDM_CODE_REDUCTION_OPT /** * hdd_wmm_notify_app() - function which notifies an application * of changes in state of it flow * * @qos_context: [in] the pointer the QoS instance control block * * Return: None */ static void hdd_wmm_notify_app(struct hdd_wmm_qos_context *qos_context) { #define MAX_NOTIFY_LEN 50 struct hdd_adapter *adapter; union iwreq_data wrqu; char buf[MAX_NOTIFY_LEN + 1]; hdd_debug("Entered, context %pK", qos_context); if (unlikely((!qos_context) || (HDD_WMM_CTX_MAGIC != qos_context->magic))) { hdd_err("Invalid QoS Context"); return; } /* create the event */ memset(&wrqu, 0, sizeof(wrqu)); memset(buf, 0, sizeof(buf)); snprintf(buf, MAX_NOTIFY_LEN, "QCOM: TS change[%u: %u]", (unsigned int)qos_context->handle, (unsigned int)qos_context->status); wrqu.data.pointer = buf; wrqu.data.length = strlen(buf); /* get pointer to the adapter */ adapter = qos_context->adapter; /* send the event */ hdd_debug("Sending [%s]", buf); hdd_wext_send_event(adapter->dev, IWEVCUSTOM, &wrqu, buf); } #ifdef FEATURE_WLAN_ESE /** * hdd_wmm_inactivity_timer_cb() - inactivity timer callback function * * @user_data: opaque user data registered with the timer. In the * case of this timer, the associated wmm QoS context is registered. * * This timer handler function is called for every inactivity interval * per AC. This function gets the current transmitted packets on the * given AC, and checks if there was any TX activity from the previous * interval. If there was no traffic then it would delete the TS that * was negotiated on that AC. * * Return: None */ static void hdd_wmm_inactivity_timer_cb(void *user_data) { struct hdd_wmm_qos_context *qos_context = user_data; struct hdd_adapter *adapter; struct hdd_wmm_ac_status *ac; hdd_wlan_wmm_status_e status; QDF_STATUS qdf_status; uint32_t traffic_count = 0; sme_ac_enum_type ac_type; unsigned int cpu; struct hdd_tx_rx_stats *tx_rx_stats; if (!qos_context) { hdd_err("invalid user data"); return; } ac_type = qos_context->ac_type; adapter = qos_context->adapter; if ((!adapter) || (WLAN_HDD_ADAPTER_MAGIC != adapter->magic)) { hdd_err("invalid adapter: %pK", adapter); return; } ac = &adapter->hdd_wmm_status.ac_status[ac_type]; tx_rx_stats = &adapter->deflink->hdd_stats.tx_rx_stats; /* Get the Tx stats for this AC. */ for (cpu = 0; cpu < NUM_CPUS; cpu++) traffic_count += tx_rx_stats->per_cpu[cpu].tx_classified_ac[qos_context->ac_type]; hdd_warn("WMM inactivity check for AC=%d, count=%u, last=%u", ac_type, traffic_count, ac->last_traffic_count); if (ac->last_traffic_count == traffic_count) { /* there is no traffic activity, delete the TSPEC for this AC */ status = hdd_wmm_delts(adapter, qos_context->handle); hdd_warn("Deleted TS on AC %d, due to inactivity with status = %d!!!", ac_type, status); } else { ac->last_traffic_count = traffic_count; if (ac->inactivity_timer.state == QDF_TIMER_STATE_STOPPED) { /* Restart the timer */ qdf_status = qdf_mc_timer_start(&ac->inactivity_timer, ac->inactivity_time); if (!QDF_IS_STATUS_SUCCESS(qdf_status)) { hdd_err("Restarting inactivity timer failed on AC %d", ac_type); } } else { QDF_ASSERT(qdf_mc_timer_get_current_state (&ac->inactivity_timer) == QDF_TIMER_STATE_STOPPED); } } } /** * hdd_wmm_enable_inactivity_timer() - * function to enable the traffic inactivity timer for the given AC * * @qos_context: [in] pointer to qos_context * @inactivity_time: [in] value of the inactivity interval in millisecs * * When a QoS-Tspec is successfully setup, if the inactivity interval * time specified in the AddTS parameters is non-zero, this function * is invoked to start a traffic inactivity timer for the given AC. * * Return: QDF_STATUS enumeration */ static QDF_STATUS hdd_wmm_enable_inactivity_timer(struct hdd_wmm_qos_context *qos_context, uint32_t inactivity_time) { QDF_STATUS qdf_status = QDF_STATUS_E_FAILURE; struct hdd_adapter *adapter = qos_context->adapter; sme_ac_enum_type ac_type = qos_context->ac_type; struct hdd_wmm_ac_status *ac; unsigned int cpu; struct hdd_tx_rx_stats *tx_rx_stats; adapter = qos_context->adapter; ac = &adapter->hdd_wmm_status.ac_status[ac_type]; qdf_status = qdf_mc_timer_init(&ac->inactivity_timer, QDF_TIMER_TYPE_SW, hdd_wmm_inactivity_timer_cb, qos_context); if (!QDF_IS_STATUS_SUCCESS(qdf_status)) { hdd_err("Initializing inactivity timer failed on AC %d", ac_type); return qdf_status; } /* Start the inactivity timer */ qdf_status = qdf_mc_timer_start(&ac->inactivity_timer, inactivity_time); if (!QDF_IS_STATUS_SUCCESS(qdf_status)) { hdd_err("Starting inactivity timer failed on AC %d", ac_type); qdf_status = qdf_mc_timer_destroy(&ac->inactivity_timer); if (!QDF_IS_STATUS_SUCCESS(qdf_status)) hdd_err("Failed to destroy inactivity timer"); return qdf_status; } ac->inactivity_time = inactivity_time; ac->last_traffic_count = 0; /* Initialize the current tx traffic count on this AC */ tx_rx_stats = &adapter->deflink->hdd_stats.tx_rx_stats; for (cpu = 0; cpu < NUM_CPUS; cpu++) { ac->last_traffic_count += tx_rx_stats->per_cpu[cpu].tx_classified_ac[qos_context->ac_type]; } qos_context->is_inactivity_timer_running = true; return qdf_status; } /** * hdd_wmm_disable_inactivity_timer() - * function to disable the traffic inactivity timer for the given AC. * * @qos_context: [in] pointer to qos_context * * This function is invoked to disable the traffic inactivity timer * for the given AC. This is normally done when the TS is deleted. * * Return: QDF_STATUS enumeration */ static QDF_STATUS hdd_wmm_disable_inactivity_timer(struct hdd_wmm_qos_context *qos_context) { struct hdd_adapter *adapter = qos_context->adapter; sme_ac_enum_type ac_type = qos_context->ac_type; struct hdd_wmm_ac_status *ac = &adapter->hdd_wmm_status.ac_status[ac_type]; QDF_STATUS qdf_status = QDF_STATUS_E_FAILURE; /* Clear the timer and the counter */ ac->inactivity_time = 0; ac->last_traffic_count = 0; if (qos_context->is_inactivity_timer_running == true) { qos_context->is_inactivity_timer_running = false; qdf_status = qdf_mc_timer_stop(&ac->inactivity_timer); if (!QDF_IS_STATUS_SUCCESS(qdf_status)) { hdd_err("Failed to stop inactivity timer"); return qdf_status; } qdf_status = qdf_mc_timer_destroy(&ac->inactivity_timer); if (!QDF_IS_STATUS_SUCCESS(qdf_status)) hdd_err("Failed to destroy inactivity timer:Timer started"); } return qdf_status; } #else static QDF_STATUS hdd_wmm_disable_inactivity_timer(struct hdd_wmm_qos_context *qos_context) { return QDF_STATUS_SUCCESS; } #endif /* FEATURE_WLAN_ESE */ /** * hdd_wmm_sme_callback() - callback for QoS notifications * * @mac_handle: [in] the MAC handle * @context : [in] the HDD callback context * @tspec_info : [in] the TSPEC params * @sme_status : [in] the QoS related SME status * @flow_id: [in] the unique identifier of the flow * * This callback is registered by HDD with SME for receiving QoS * notifications. Even though this function has a static scope it * gets called externally through some function pointer magic (so * there is a need for rigorous parameter checking). * * Return: QDF_STATUS enumeration */ static QDF_STATUS hdd_wmm_sme_callback(mac_handle_t mac_handle, void *context, struct sme_qos_wmmtspecinfo *tspec_info, enum sme_qos_statustype sme_status, uint32_t flow_id) { struct hdd_wmm_qos_context *qos_context = context; struct hdd_adapter *adapter; sme_ac_enum_type ac_type; struct hdd_wmm_ac_status *ac; hdd_debug("Entered, context %pK", qos_context); if (unlikely((!qos_context) || (HDD_WMM_CTX_MAGIC != qos_context->magic))) { hdd_err("Invalid QoS Context"); return QDF_STATUS_E_FAILURE; } adapter = qos_context->adapter; ac_type = qos_context->ac_type; ac = &adapter->hdd_wmm_status.ac_status[ac_type]; hdd_debug("status %d flowid %d info %pK", sme_status, flow_id, tspec_info); switch (sme_status) { case SME_QOS_STATUS_SETUP_SUCCESS_IND: hdd_debug("Setup is complete"); /* there will always be a TSPEC returned with this * status, even if a TSPEC is not exchanged OTA */ if (tspec_info) { ac->is_tspec_valid = true; memcpy(&ac->tspec, tspec_info, sizeof(ac->tspec)); } ac->is_access_allowed = true; ac->was_access_granted = true; ac->is_access_pending = false; ac->has_access_failed = false; if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { hdd_debug("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_SETUP_SUCCESS; hdd_wmm_notify_app(qos_context); } #ifdef FEATURE_WLAN_ESE /* Check if the inactivity interval is specified */ if (tspec_info && tspec_info->inactivity_interval) { hdd_debug("Inactivity timer value = %d for AC=%d", tspec_info->inactivity_interval, ac_type); hdd_wmm_enable_inactivity_timer(qos_context, tspec_info-> inactivity_interval); } #endif /* FEATURE_WLAN_ESE */ /* notify TL to enable trigger frames if necessary */ hdd_wmm_enable_tl_uapsd(qos_context); break; case SME_QOS_STATUS_SETUP_SUCCESS_APSD_SET_ALREADY: hdd_debug("Setup is complete (U-APSD set previously)"); ac->is_access_allowed = true; ac->was_access_granted = true; ac->is_access_pending = false; if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { hdd_debug("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_SETUP_SUCCESS_NO_ACM_UAPSD_EXISTING; hdd_wmm_notify_app(qos_context); } break; case SME_QOS_STATUS_SETUP_FAILURE_RSP: hdd_err("Setup failed"); /* QoS setup failed */ ac->is_access_pending = false; ac->has_access_failed = true; ac->is_access_allowed = false; if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { hdd_debug("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_SETUP_FAILED; hdd_wmm_notify_app(qos_context); } /* disable the inactivity timer */ hdd_wmm_disable_inactivity_timer(qos_context); /* Setting up QoS Failed, QoS context can be released. * SME is releasing this flow information and if HDD * doesn't release this context, next time if * application uses the same handle to set-up QoS, HDD * (as it has QoS context for this handle) will issue * Modify QoS request to SME but SME will reject as now * it has no information for this flow. */ hdd_wmm_free_context(qos_context); break; case SME_QOS_STATUS_SETUP_INVALID_PARAMS_RSP: hdd_err("Setup Invalid Params, notify TL"); /* QoS setup failed */ ac->is_access_allowed = false; if (HDD_WMM_HANDLE_IMPLICIT == qos_context->handle) { /* we note the failure, but we also mark * access as allowed so that the packets will * flow. Note that the MAC will "do the right * thing" */ ac->is_access_pending = false; ac->has_access_failed = true; ac->is_access_allowed = true; } else { hdd_debug("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_SETUP_FAILED_BAD_PARAM; hdd_wmm_notify_app(qos_context); } break; case SME_QOS_STATUS_SETUP_NOT_QOS_AP_RSP: hdd_err("Setup failed, not a QoS AP"); if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { hdd_info("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_SETUP_FAILED_NO_WMM; hdd_wmm_notify_app(qos_context); } break; case SME_QOS_STATUS_SETUP_REQ_PENDING_RSP: hdd_debug("Setup pending"); /* not a callback status -- ignore if we get it */ break; case SME_QOS_STATUS_SETUP_MODIFIED_IND: hdd_debug("Setup modified"); if (tspec_info) { /* update the TSPEC */ ac->is_tspec_valid = true; memcpy(&ac->tspec, tspec_info, sizeof(ac->tspec)); if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { hdd_debug("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_MODIFIED; hdd_wmm_notify_app(qos_context); } /* need to tell TL to update its UAPSD handling */ hdd_wmm_enable_tl_uapsd(qos_context); } break; case SME_QOS_STATUS_SETUP_SUCCESS_NO_ACM_NO_APSD_RSP: if (HDD_WMM_HANDLE_IMPLICIT == qos_context->handle) { /* this was triggered by implicit QoS so we * know packets are pending */ ac->is_access_pending = false; ac->was_access_granted = true; ac->is_access_allowed = true; } else { hdd_debug("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_SETUP_SUCCESS_NO_ACM_NO_UAPSD; hdd_wmm_notify_app(qos_context); } break; case SME_QOS_STATUS_SETUP_SUCCESS_IND_APSD_PENDING: /* nothing to do for now */ break; case SME_QOS_STATUS_SETUP_SUCCESS_IND_APSD_SET_FAILED: hdd_err("Setup successful but U-APSD failed"); if (HDD_WMM_HANDLE_IMPLICIT == qos_context->handle) { /* QoS setup was successful but setting U=APSD * failed. Since the OTA part of the request * was successful, we don't mark this as a * failure. the packets will flow. Note that * the MAC will "do the right thing" */ ac->was_access_granted = true; ac->is_access_allowed = true; ac->has_access_failed = false; ac->is_access_pending = false; } else { hdd_info("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_SETUP_UAPSD_SET_FAILED; hdd_wmm_notify_app(qos_context); } /* Since U-APSD portion failed disabled trigger frame * generation */ hdd_wmm_disable_tl_uapsd(qos_context); break; case SME_QOS_STATUS_RELEASE_SUCCESS_RSP: hdd_debug("Release is complete"); if (tspec_info) { hdd_debug("flows still active"); /* there is still at least one flow active for * this AC so update the AC state */ memcpy(&ac->tspec, tspec_info, sizeof(ac->tspec)); /* need to tell TL to update its UAPSD handling */ hdd_wmm_enable_tl_uapsd(qos_context); } else { hdd_debug("last flow"); /* this is the last flow active for this AC so * update the AC state */ ac->is_tspec_valid = false; /* DELTS is successful, do not allow */ ac->is_access_allowed = false; /* need to tell TL to update its UAPSD handling */ hdd_wmm_disable_tl_uapsd(qos_context); } if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { hdd_debug("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_RELEASE_SUCCESS; hdd_wmm_notify_app(qos_context); } /* disable the inactivity timer */ hdd_wmm_disable_inactivity_timer(qos_context); /* we are done with this flow */ hdd_wmm_free_context(qos_context); break; case SME_QOS_STATUS_RELEASE_FAILURE_RSP: hdd_debug("Release failure"); /* we don't need to update our state or TL since * nothing has changed */ if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { hdd_debug("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_RELEASE_FAILED; hdd_wmm_notify_app(qos_context); } break; case SME_QOS_STATUS_RELEASE_QOS_LOST_IND: hdd_debug("QOS Lost indication received"); /* current TSPEC is no longer valid */ ac->is_tspec_valid = false; /* AP has sent DELTS, do not allow */ ac->is_access_allowed = false; /* need to tell TL to update its UAPSD handling */ hdd_wmm_disable_tl_uapsd(qos_context); if (HDD_WMM_HANDLE_IMPLICIT == qos_context->handle) { /* we no longer have implicit access granted */ ac->was_access_granted = false; ac->has_access_failed = false; } else { hdd_debug("Explicit Qos, notifying user space"); /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_LOST; hdd_wmm_notify_app(qos_context); } /* disable the inactivity timer */ hdd_wmm_disable_inactivity_timer(qos_context); /* we are done with this flow */ hdd_wmm_free_context(qos_context); break; case SME_QOS_STATUS_RELEASE_REQ_PENDING_RSP: hdd_debug("Release pending"); /* not a callback status -- ignore if we get it */ break; case SME_QOS_STATUS_RELEASE_INVALID_PARAMS_RSP: hdd_err("Release Invalid Params"); if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_RELEASE_FAILED_BAD_PARAM; hdd_wmm_notify_app(qos_context); } break; case SME_QOS_STATUS_MODIFY_SETUP_SUCCESS_IND: hdd_debug("Modification is complete, notify TL"); /* there will always be a TSPEC returned with this * status, even if a TSPEC is not exchanged OTA */ if (tspec_info) { ac->is_tspec_valid = true; memcpy(&ac->tspec, tspec_info, sizeof(ac->tspec)); } if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_MODIFY_SUCCESS; hdd_wmm_notify_app(qos_context); } /* notify TL to enable trigger frames if necessary */ hdd_wmm_enable_tl_uapsd(qos_context); break; case SME_QOS_STATUS_MODIFY_SETUP_SUCCESS_APSD_SET_ALREADY: if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_MODIFY_SUCCESS_NO_ACM_UAPSD_EXISTING; hdd_wmm_notify_app(qos_context); } break; case SME_QOS_STATUS_MODIFY_SETUP_FAILURE_RSP: /* the flow modification failed so we'll leave in * place whatever existed beforehand */ if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_MODIFY_FAILED; hdd_wmm_notify_app(qos_context); } break; case SME_QOS_STATUS_MODIFY_SETUP_PENDING_RSP: hdd_debug("modification pending"); /* not a callback status -- ignore if we get it */ break; case SME_QOS_STATUS_MODIFY_SETUP_SUCCESS_NO_ACM_NO_APSD_RSP: /* the flow modification was successful but no QoS * changes required */ if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_MODIFY_SUCCESS_NO_ACM_NO_UAPSD; hdd_wmm_notify_app(qos_context); } break; case SME_QOS_STATUS_MODIFY_SETUP_INVALID_PARAMS_RSP: /* invalid params -- notify the application */ if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_MODIFY_FAILED_BAD_PARAM; hdd_wmm_notify_app(qos_context); } break; case SME_QOS_STATUS_MODIFY_SETUP_SUCCESS_IND_APSD_PENDING: /* nothing to do for now. when APSD is established we'll have work to do */ break; case SME_QOS_STATUS_MODIFY_SETUP_SUCCESS_IND_APSD_SET_FAILED: hdd_err("Modify successful but U-APSD failed"); /* QoS modification was successful but setting U=APSD * failed. This will always be an explicit QoS * instance, so all we can do is notify the * application and let it clean up. */ if (HDD_WMM_HANDLE_IMPLICIT != qos_context->handle) { /* this was triggered by an application */ qos_context->status = HDD_WLAN_WMM_STATUS_MODIFY_UAPSD_SET_FAILED; hdd_wmm_notify_app(qos_context); } /* Since U-APSD portion failed disabled trigger frame * generation */ hdd_wmm_disable_tl_uapsd(qos_context); break; case SME_QOS_STATUS_HANDING_OFF: /* no roaming so we won't see this */ break; case SME_QOS_STATUS_OUT_OF_APSD_POWER_MODE_IND: /* need to tell TL to stop trigger frame generation */ hdd_wmm_disable_tl_uapsd(qos_context); break; case SME_QOS_STATUS_INTO_APSD_POWER_MODE_IND: /* need to tell TL to start sending trigger frames again */ hdd_wmm_enable_tl_uapsd(qos_context); break; default: hdd_err("unexpected SME Status=%d", sme_status); QDF_ASSERT(0); } /* if Tspec only allows downstream traffic then access is not * allowed */ if (ac->is_tspec_valid && (ac->tspec.ts_info.direction == SME_QOS_WMM_TS_DIR_DOWNLINK)) { ac->is_access_allowed = false; } /* if we have valid Tpsec or if ACM bit is not set, allow access */ if ((ac->is_tspec_valid && (ac->tspec.ts_info.direction != SME_QOS_WMM_TS_DIR_DOWNLINK)) || !ac->is_access_required) { ac->is_access_allowed = true; } hdd_debug("complete, access for TL AC %d is%sallowed", ac_type, ac->is_access_allowed ? " " : " not "); return QDF_STATUS_SUCCESS; } #endif /** * hdd_wmmps_helper() - Function to set uapsd psb dynamically * * @adapter: [in] pointer to adapter structure * @ptr: [in] pointer to command buffer * * Return: Zero on success, appropriate error on failure. */ int hdd_wmmps_helper(struct hdd_adapter *adapter, uint8_t *ptr) { if (!adapter) { hdd_err("adapter is NULL"); return -EINVAL; } if (!ptr) { hdd_err("ptr is NULL"); return -EINVAL; } /* convert ASCII to integer */ adapter->configured_psb = ptr[9] - '0'; adapter->psb_changed = HDD_PSB_CHANGED; return 0; } /** * __hdd_wmm_do_implicit_qos() - Function which will attempt to setup * QoS for any AC requiring it. * @qos_context: the QoS context to operate against * * Return: none */ static void __hdd_wmm_do_implicit_qos(struct hdd_wmm_qos_context *qos_context) { struct hdd_adapter *adapter; sme_ac_enum_type ac_type; struct hdd_wmm_ac_status *ac; #ifndef WLAN_MDM_CODE_REDUCTION_OPT enum sme_qos_statustype sme_status; #endif struct sme_qos_wmmtspecinfo tspec; struct hdd_context *hdd_ctx; mac_handle_t mac_handle; QDF_STATUS status = QDF_STATUS_SUCCESS; uint8_t dir_ac, mask = 0; uint16_t nom_msdu_size_ac = 0; uint32_t rate_ac = 0; uint16_t sba_ac = 0; uint32_t uapsd_value = 0; bool is_ts_burst_enable; enum mlme_ts_info_ack_policy ack_policy; hdd_debug("Entered, context %pK", qos_context); adapter = qos_context->adapter; hdd_ctx = WLAN_HDD_GET_CTX(adapter); if (wlan_hdd_validate_context(hdd_ctx)) return; mac_handle = hdd_ctx->mac_handle; ac_type = qos_context->ac_type; ac = &adapter->hdd_wmm_status.ac_status[ac_type]; hdd_debug("adapter %pK ac_type %d", adapter, ac_type); if (!ac->is_access_needed) { hdd_err("AC %d doesn't need service", ac_type); qos_context->magic = 0; qdf_mem_free(qos_context); return; } ac->is_access_pending = true; ac->is_access_needed = false; memset(&tspec, 0, sizeof(tspec)); tspec.ts_info.psb = adapter->configured_psb; switch (ac_type) { case SME_AC_VO: tspec.ts_info.up = SME_QOS_WMM_UP_VO; /* Check if there is any valid configuration from framework */ if (HDD_PSB_CFG_INVALID == adapter->configured_psb) { status = ucfg_mlme_get_wmm_uapsd_mask(hdd_ctx->psoc, &mask); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_mask failed"); return; } tspec.ts_info.psb = (mask & SME_QOS_UAPSD_VO) ? 1 : 0; } status = ucfg_mlme_get_wmm_dir_ac_vo(hdd_ctx->psoc, &dir_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get infra_dir_ac_vo failed"); return; } tspec.ts_info.direction = dir_ac; tspec.ts_info.tid = 255; status = ucfg_mlme_get_wmm_uapsd_vo_srv_intv(hdd_ctx->psoc, &uapsd_value); if (QDF_IS_STATUS_ERROR(status)) { hdd_err("Get uapsd_srv_intv failed"); return; } tspec.min_service_interval = uapsd_value; status = ucfg_mlme_get_wmm_uapsd_vo_sus_intv(hdd_ctx->psoc, &uapsd_value); if (QDF_IS_STATUS_ERROR(status)) { hdd_err("Get uapsd_vo_sus_intv failed"); return; } tspec.suspension_interval = uapsd_value; status = ucfg_mlme_get_wmm_mean_data_rate_ac_vo(hdd_ctx->psoc, &rate_ac); if (QDF_IS_STATUS_ERROR(status)) { hdd_err("Get mean_data_rate_ac_vo failed"); return; } tspec.mean_data_rate = rate_ac; status = ucfg_mlme_get_wmm_min_phy_rate_ac_vo(hdd_ctx->psoc, &rate_ac); if (QDF_IS_STATUS_ERROR(status)) { hdd_err("Get min_phy_rate_ac_vo failed"); return; } tspec.min_phy_rate = rate_ac; status = ucfg_mlme_get_wmm_nom_msdu_size_ac_vo(hdd_ctx->psoc, &nom_msdu_size_ac); if (QDF_IS_STATUS_ERROR(status)) { hdd_err("Get nom_msdu_size_ac_vo failed"); return; } tspec.nominal_msdu_size = nom_msdu_size_ac; status = ucfg_mlme_get_wmm_sba_ac_vo(hdd_ctx->psoc, &sba_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get sba_ac_vo failed"); return; } tspec.surplus_bw_allowance = sba_ac; break; case SME_AC_VI: tspec.ts_info.up = SME_QOS_WMM_UP_VI; /* Check if there is any valid configuration from framework */ if (HDD_PSB_CFG_INVALID == adapter->configured_psb) { status = ucfg_mlme_get_wmm_uapsd_mask(hdd_ctx->psoc, &mask); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_mask failed"); return; } tspec.ts_info.psb = (mask & SME_QOS_UAPSD_VI) ? 1 : 0; } status = ucfg_mlme_get_wmm_dir_ac_vi( hdd_ctx->psoc, &dir_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get infra_dir_ac_vi failed"); return; } tspec.ts_info.direction = dir_ac; tspec.ts_info.tid = 255; status = ucfg_mlme_get_wmm_uapsd_vi_srv_intv( hdd_ctx->psoc, &uapsd_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_vi_srv_intv failed"); return; } tspec.min_service_interval = uapsd_value; status = ucfg_mlme_get_wmm_uapsd_vi_sus_intv( hdd_ctx->psoc, &uapsd_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_vi_sus_intv failed"); return; } tspec.suspension_interval = uapsd_value; status = ucfg_mlme_get_wmm_mean_data_rate_ac_vi( hdd_ctx->psoc, &rate_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get mean_data_rate_ac_vi failed"); return; } tspec.mean_data_rate = rate_ac; status = ucfg_mlme_get_wmm_min_phy_rate_ac_vi( hdd_ctx->psoc, &rate_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get min_phy_rate_ac_vi failed"); return; } tspec.min_phy_rate = rate_ac; status = ucfg_mlme_get_wmm_nom_msdu_size_ac_vi( hdd_ctx->psoc, &nom_msdu_size_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get nom_msdu_size_ac_vi failed"); return; } tspec.nominal_msdu_size = nom_msdu_size_ac; status = ucfg_mlme_get_wmm_sba_ac_vi( hdd_ctx->psoc, &sba_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get sba_ac_vi failed"); return; } tspec.surplus_bw_allowance = sba_ac; break; default: case SME_AC_BE: tspec.ts_info.up = SME_QOS_WMM_UP_BE; /* Check if there is any valid configuration from framework */ if (HDD_PSB_CFG_INVALID == adapter->configured_psb) { status = ucfg_mlme_get_wmm_uapsd_mask(hdd_ctx->psoc, &mask); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_mask failed"); return; } tspec.ts_info.psb = (mask & SME_QOS_UAPSD_BE) ? 1 : 0; } status = ucfg_mlme_get_wmm_dir_ac_be(hdd_ctx->psoc, &dir_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get infra_dir_ac_be failed"); return; } tspec.ts_info.direction = dir_ac; tspec.ts_info.tid = 255; status = ucfg_mlme_get_wmm_uapsd_be_srv_intv(hdd_ctx->psoc, &uapsd_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_vi_srv_intv failed"); return; } tspec.min_service_interval = uapsd_value; status = ucfg_mlme_get_wmm_uapsd_be_sus_intv(hdd_ctx->psoc, &uapsd_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_vi_sus_intv failed"); return; } tspec.suspension_interval = uapsd_value; status = ucfg_mlme_get_wmm_mean_data_rate_ac_be(hdd_ctx->psoc, &rate_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get mean_data_rate_ac_be failed"); return; } tspec.mean_data_rate = rate_ac; status = ucfg_mlme_get_wmm_min_phy_rate_ac_be(hdd_ctx->psoc, &rate_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get min_phy_rate_ac_be failed"); return; } tspec.min_phy_rate = rate_ac; status = ucfg_mlme_get_wmm_nom_msdu_size_ac_be(hdd_ctx->psoc, &nom_msdu_size_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get nom_msdu_size_ac_be failed"); return; } tspec.nominal_msdu_size = nom_msdu_size_ac; status = ucfg_mlme_get_wmm_sba_ac_be(hdd_ctx->psoc, &sba_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get sba_ac_be failed"); return; } tspec.surplus_bw_allowance = sba_ac; break; case SME_AC_BK: tspec.ts_info.up = SME_QOS_WMM_UP_BK; /* Check if there is any valid configuration from framework */ if (HDD_PSB_CFG_INVALID == adapter->configured_psb) { status = ucfg_mlme_get_wmm_uapsd_mask(hdd_ctx->psoc, &mask); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_mask failed"); return; } tspec.ts_info.psb = (mask & SME_QOS_UAPSD_BK) ? 1 : 0; } status = ucfg_mlme_get_wmm_dir_ac_bk(hdd_ctx->psoc, &dir_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get infra_dir_ac_bk failed"); return; } tspec.ts_info.direction = dir_ac; tspec.ts_info.tid = 255; status = ucfg_mlme_get_wmm_uapsd_bk_srv_intv(hdd_ctx->psoc, &uapsd_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_bk_srv_intv failed"); return; } tspec.min_service_interval = uapsd_value; status = ucfg_mlme_get_wmm_uapsd_bk_sus_intv(hdd_ctx->psoc, &uapsd_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_bk_sus_intv failed"); return; } tspec.suspension_interval = uapsd_value; status = ucfg_mlme_get_wmm_mean_data_rate_ac_bk(hdd_ctx->psoc, &rate_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get mean_data_rate_ac_bk failed"); return; } tspec.mean_data_rate = rate_ac; status = ucfg_mlme_get_wmm_min_phy_rate_ac_bk(hdd_ctx->psoc, &rate_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get min_phy_rate_ac_bk failed"); return; } tspec.min_phy_rate = rate_ac; status = ucfg_mlme_get_wmm_nom_msdu_size_ac_bk(hdd_ctx->psoc, &nom_msdu_size_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get nom_msdu_size_ac_bk failed"); return; } tspec.nominal_msdu_size = nom_msdu_size_ac; status = ucfg_mlme_get_wmm_sba_ac_bk(hdd_ctx->psoc, &sba_ac); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get sba_ac_bk failed"); return; } tspec.surplus_bw_allowance = sba_ac; break; } #ifdef FEATURE_WLAN_ESE ucfg_mlme_get_inactivity_interval(hdd_ctx->psoc, &uapsd_value); tspec.inactivity_interval = uapsd_value; #endif ucfg_mlme_get_is_ts_burst_size_enable(hdd_ctx->psoc, &is_ts_burst_enable); tspec.ts_info.burst_size_defn = is_ts_burst_enable; ucfg_mlme_get_ts_info_ack_policy(hdd_ctx->psoc, &ack_policy); switch (ack_policy) { case TS_INFO_ACK_POLICY_NORMAL_ACK: tspec.ts_info.ack_policy = SME_QOS_WMM_TS_ACK_POLICY_NORMAL_ACK; break; case TS_INFO_ACK_POLICY_HT_IMMEDIATE_BLOCK_ACK: tspec.ts_info.ack_policy = SME_QOS_WMM_TS_ACK_POLICY_HT_IMMEDIATE_BLOCK_ACK; break; default: /* unknown */ tspec.ts_info.ack_policy = SME_QOS_WMM_TS_ACK_POLICY_NORMAL_ACK; } if (tspec.ts_info.ack_policy == SME_QOS_WMM_TS_ACK_POLICY_HT_IMMEDIATE_BLOCK_ACK) { if (!sme_qos_is_ts_info_ack_policy_valid( mac_handle, &tspec, adapter->deflink->vdev_id)) { tspec.ts_info.ack_policy = SME_QOS_WMM_TS_ACK_POLICY_NORMAL_ACK; } } mutex_lock(&adapter->hdd_wmm_status.mutex); list_add(&qos_context->node, &adapter->hdd_wmm_status.context_list); mutex_unlock(&adapter->hdd_wmm_status.mutex); #ifndef WLAN_MDM_CODE_REDUCTION_OPT sme_status = sme_qos_setup_req(mac_handle, adapter->deflink->vdev_id, &tspec, hdd_wmm_sme_callback, qos_context, tspec.ts_info.up, &qos_context->flow_id); hdd_debug("sme_qos_setup_req returned %d flowid %d", sme_status, qos_context->flow_id); /* need to check the return values and act appropriately */ switch (sme_status) { case SME_QOS_STATUS_SETUP_REQ_PENDING_RSP: case SME_QOS_STATUS_SETUP_SUCCESS_IND_APSD_PENDING: /* setup is pending, so no more work to do now. all * further work will be done in hdd_wmm_sme_callback() */ hdd_debug("Setup is pending, no further work"); break; case SME_QOS_STATUS_SETUP_FAILURE_RSP: /* disable the inactivity timer */ hdd_wmm_disable_inactivity_timer(qos_context); /* we can't tell the difference between when a request * fails because AP rejected it versus when SME * encountered an internal error. in either case SME * won't ever reference this context so free the * record */ hdd_wmm_free_context(qos_context); /* start packets flowing */ fallthrough; case SME_QOS_STATUS_SETUP_SUCCESS_NO_ACM_NO_APSD_RSP: /* no ACM in effect, no need to setup U-APSD */ case SME_QOS_STATUS_SETUP_SUCCESS_APSD_SET_ALREADY: /* no ACM in effect, U-APSD is desired but was already setup */ /* for these cases everything is already setup so we * can signal TL that it has work to do */ hdd_debug("Setup is complete, notify TL"); ac->is_access_allowed = true; ac->was_access_granted = true; ac->is_access_pending = false; break; default: hdd_err("unexpected SME Status=%d", sme_status); QDF_ASSERT(0); } #endif } /** * hdd_wmm_do_implicit_qos() - SSR wrapper function for hdd_wmm_do_implicit_qos * @work: pointer to work_struct * * Return: none */ static void hdd_wmm_do_implicit_qos(struct work_struct *work) { struct hdd_wmm_qos_context *qos_ctx = container_of(work, struct hdd_wmm_qos_context, implicit_qos_work); struct osif_vdev_sync *vdev_sync; if (qos_ctx->magic != HDD_WMM_CTX_MAGIC) { hdd_err("Invalid QoS Context"); return; } if (osif_vdev_sync_op_start(qos_ctx->adapter->dev, &vdev_sync)) return; __hdd_wmm_do_implicit_qos(qos_ctx); osif_vdev_sync_op_stop(vdev_sync); } QDF_STATUS hdd_send_dscp_up_map_to_fw(struct hdd_adapter *adapter) { uint32_t *dscp_to_up_map = adapter->dscp_to_up_map; struct wlan_objmgr_vdev *vdev; int ret; vdev = hdd_objmgr_get_vdev_by_user(adapter->deflink, WLAN_FWOL_NB_ID); if (vdev) { /* Send DSCP to TID map table to FW */ ret = os_if_fwol_send_dscp_up_map_to_fw(vdev, dscp_to_up_map); hdd_objmgr_put_vdev_by_user(vdev, WLAN_FWOL_NB_ID); if (ret && ret != -EOPNOTSUPP) return QDF_STATUS_E_FAILURE; } return QDF_STATUS_SUCCESS; } /** * hdd_fill_dscp_to_up_map() - Fill up dscp_to_up_map table with default values * @dscp_to_up_map: Array of DSCP-to-UP map * * This function will fill up the DSCP-to-UP map table with default values. * * Return: QDF_STATUS enumeration */ static inline void hdd_fill_dscp_to_up_map( enum sme_qos_wmmuptype *dscp_to_up_map) { uint8_t dscp; /* * DSCP to User Priority Lookup Table * By default use the 3 Precedence bits of DSCP as the User Priority * * In case of changing the default map values, need to take care of * hdd_custom_dscp_up_map as well. */ for (dscp = 0; dscp <= WLAN_MAX_DSCP; dscp++) dscp_to_up_map[dscp] = dscp >> 3; /* Special case for Expedited Forwarding (DSCP 46) in default mapping */ dscp_to_up_map[DSCP(46)] = SME_QOS_WMM_UP_VO; } #ifdef WLAN_CUSTOM_DSCP_UP_MAP /** * hdd_custom_dscp_up_map() - Customize dscp_to_up_map based on RFC8325 * @dscp_to_up_map: Array of DSCP-to-UP map * * This function will customize the DSCP-to-UP map table based on RFC8325.. * * Return: QDF_STATUS enumeration */ static inline QDF_STATUS hdd_custom_dscp_up_map( enum sme_qos_wmmuptype *dscp_to_up_map) { /* * Customizing few of DSCP to UP mapping based on RFC8325, * those are different from default hdd_fill_dscp_to_up_map values. * So, below changes are always relative to hdd_fill_dscp_to_up_map. */ dscp_to_up_map[DSCP(10)] = SME_QOS_WMM_UP_BE; dscp_to_up_map[DSCP(12)] = SME_QOS_WMM_UP_BE; dscp_to_up_map[DSCP(14)] = SME_QOS_WMM_UP_BE; dscp_to_up_map[DSCP(16)] = SME_QOS_WMM_UP_BE; dscp_to_up_map[DSCP(18)] = SME_QOS_WMM_UP_EE; dscp_to_up_map[DSCP(20)] = SME_QOS_WMM_UP_EE; dscp_to_up_map[DSCP(22)] = SME_QOS_WMM_UP_EE; dscp_to_up_map[DSCP(24)] = SME_QOS_WMM_UP_CL; dscp_to_up_map[DSCP(26)] = SME_QOS_WMM_UP_CL; dscp_to_up_map[DSCP(28)] = SME_QOS_WMM_UP_CL; dscp_to_up_map[DSCP(30)] = SME_QOS_WMM_UP_CL; dscp_to_up_map[DSCP(44)] = SME_QOS_WMM_UP_VO; dscp_to_up_map[DSCP(48)] = SME_QOS_WMM_UP_NC; return QDF_STATUS_SUCCESS; } #else static inline QDF_STATUS hdd_custom_dscp_up_map( enum sme_qos_wmmuptype *dscp_to_up_map) { return QDF_STATUS_E_NOSUPPORT; } #endif /* WLAN_CUSTOM_DSCP_UP_MAP */ /** * hdd_wmm_dscp_initial_state() - initialize the WMM DSCP configuration * @adapter : [in] pointer to Adapter context * * This function will initialize the WMM DSCP configuration of an * adapter to an initial state. The configuration can later be * overwritten via application APIs or via QoS Map sent OTA. * * Return: QDF_STATUS enumeration */ QDF_STATUS hdd_wmm_dscp_initial_state(struct hdd_adapter *adapter) { enum sme_qos_wmmuptype *dscp_to_up_map = adapter->dscp_to_up_map; struct wlan_objmgr_psoc *psoc = adapter->hdd_ctx->psoc; QDF_STATUS status = QDF_STATUS_SUCCESS; if (!psoc) { hdd_err("Invalid psoc handle"); return QDF_STATUS_E_FAILURE; } hdd_fill_dscp_to_up_map(dscp_to_up_map); if (hdd_custom_dscp_up_map(dscp_to_up_map) == QDF_STATUS_SUCCESS) { /* Send DSCP to TID map table to FW */ status = hdd_send_dscp_up_map_to_fw(adapter); } return status; } /** * hdd_wmm_adapter_init() - initialize the WMM configuration of an adapter * @adapter: [in] pointer to Adapter context * * This function will initialize the WMM configuration and status of an * adapter to an initial state. The configuration can later be * overwritten via application APIs * * Return: QDF_STATUS enumeration */ QDF_STATUS hdd_wmm_adapter_init(struct hdd_adapter *adapter) { struct hdd_wmm_ac_status *ac_status; sme_ac_enum_type ac_type; hdd_enter(); hdd_wmm_dscp_initial_state(adapter); adapter->hdd_wmm_status.qap = false; INIT_LIST_HEAD(&adapter->hdd_wmm_status.context_list); mutex_init(&adapter->hdd_wmm_status.mutex); for (ac_type = 0; ac_type < WLAN_MAX_AC; ac_type++) { ac_status = &adapter->hdd_wmm_status.ac_status[ac_type]; ac_status->is_access_required = false; ac_status->is_access_needed = false; ac_status->is_access_pending = false; ac_status->has_access_failed = false; ac_status->was_access_granted = false; ac_status->is_access_allowed = false; ac_status->is_tspec_valid = false; ac_status->is_uapsd_info_valid = false; } /* Invalid value(0xff) to indicate psb not configured through * framework initially. */ adapter->configured_psb = HDD_PSB_CFG_INVALID; return QDF_STATUS_SUCCESS; } /** * hdd_wmm_adapter_clear() - Function which will clear the WMM status * for all the ACs * * @adapter: [in] pointer to Adapter context * * Return: QDF_STATUS enumeration */ QDF_STATUS hdd_wmm_adapter_clear(struct hdd_adapter *adapter) { struct hdd_wmm_ac_status *ac_status; sme_ac_enum_type ac_type; hdd_enter(); for (ac_type = 0; ac_type < WLAN_MAX_AC; ac_type++) { ac_status = &adapter->hdd_wmm_status.ac_status[ac_type]; ac_status->is_access_required = false; ac_status->is_access_needed = false; ac_status->is_access_pending = false; ac_status->has_access_failed = false; ac_status->was_access_granted = false; ac_status->is_access_allowed = false; ac_status->is_tspec_valid = false; ac_status->is_uapsd_info_valid = false; } return QDF_STATUS_SUCCESS; } /** * hdd_wmm_adapter_close() - WMM close function * @adapter: [in] pointer to adapter context * * Function which will perform any necessary work to to clean up the * WMM functionality prior to the kernel module unload. * * Return: QDF_STATUS enumeration */ QDF_STATUS hdd_wmm_adapter_close(struct hdd_adapter *adapter) { struct hdd_wmm_qos_context *qos_context; hdd_enter(); /* free any context records that we still have linked */ while (!list_empty(&adapter->hdd_wmm_status.context_list)) { qos_context = list_first_entry(&adapter->hdd_wmm_status.context_list, struct hdd_wmm_qos_context, node); hdd_wmm_disable_inactivity_timer(qos_context); if (qos_context->handle == HDD_WMM_HANDLE_IMPLICIT && qos_context->magic == HDD_WMM_CTX_MAGIC) cds_flush_work(&qos_context->implicit_qos_work); hdd_wmm_free_context(qos_context); } return QDF_STATUS_SUCCESS; } /** * hdd_check_upgrade_vo_vi_qos() - Check and upgrade QOS for UDP packets * based on request type received * @adapter: [in] pointer to the adapter context (Should not be invalid) * @user_pri: [out] priority set for this packet * * This function checks for the request type and upgrade based on request type * * UDP_QOS_UPGRADE_ALL: Upgrade QoS of all UDP packets if the current set * priority is below the pre-configured threshold for upgrade. * * UDP_QOS_UPGRADE_BK_BE: Upgrade QoS of all UDP packets if the current set * priority is below the AC VI. */ static inline void hdd_check_upgrade_vo_vi_qos(struct hdd_adapter *adapter, enum sme_qos_wmmuptype *user_pri) { switch (adapter->udp_qos_upgrade_type) { case UDP_QOS_UPGRADE_ALL: if (*user_pri < qca_wlan_ac_to_sme_qos(adapter->upgrade_udp_qos_threshold)) *user_pri = qca_wlan_ac_to_sme_qos( adapter->upgrade_udp_qos_threshold); break; case UDP_QOS_UPGRADE_BK_BE: if (*user_pri < qca_wlan_ac_to_sme_qos(QCA_WLAN_AC_VI)) *user_pri = qca_wlan_ac_to_sme_qos( adapter->upgrade_udp_qos_threshold); break; default: break; } } /** * hdd_check_and_upgrade_udp_qos() - Check and upgrade the qos for UDP packets * if the current set priority is below the * pre-configured threshold for upgrade. * @adapter: [in] pointer to the adapter context (Should not be invalid) * @skb: [in] pointer to the packet to be transmitted * @user_pri: [out] priority set for this packet * * This function checks if the packet is a UDP packet and upgrades its * priority if its below the pre-configured upgrade threshold. * The upgrade order is as below: * BK -> BE -> VI -> VO * * Return: none */ static inline void hdd_check_and_upgrade_udp_qos(struct hdd_adapter *adapter, qdf_nbuf_t skb, enum sme_qos_wmmuptype *user_pri) { /* Upgrade UDP pkt priority alone */ if (!(qdf_nbuf_is_ipv4_udp_pkt(skb) || qdf_nbuf_is_ipv6_udp_pkt(skb))) return; switch (adapter->upgrade_udp_qos_threshold) { case QCA_WLAN_AC_BK: break; case QCA_WLAN_AC_BE: if (*user_pri == qca_wlan_ac_to_sme_qos(QCA_WLAN_AC_BK)) *user_pri = qca_wlan_ac_to_sme_qos(QCA_WLAN_AC_BE); break; case QCA_WLAN_AC_VI: case QCA_WLAN_AC_VO: hdd_check_upgrade_vo_vi_qos(adapter, user_pri); break; default: break; } } /** * hdd_wmm_classify_critical_pkt() - Function checks and classifies critical skb * @skb: pointer to network buffer * @user_pri: user priority of the OS packet to be determined * @is_critical: pointer to be marked true for a critical packet * * Function checks if the packet is one of the critical packets and determines * 'user_pri' for it. EAPOL, ARP, DHCP(v4,v6), NS, NA are considered critical. * * Note that wlan_hdd_mark_critical_pkt is used to mark packet type in CB for * these critical packets. This is done as skb->cb amay be overwritten between * _select_queue and_hard_start_xmit functions. hdd_wmm_classify_critical_pkt * and wlan_hdd_mark_critical_pkt should be in sync w.r.t packet types. * * Return: None */ static void hdd_wmm_classify_critical_pkt(struct sk_buff *skb, enum sme_qos_wmmuptype *user_pri, bool *is_critical) { enum qdf_proto_subtype proto_subtype; /* Send EAPOL on TID 6(VO). Rest are sent on TID 0(BE). */ if (qdf_nbuf_is_ipv4_eapol_pkt(skb)) { *is_critical = true; *user_pri = SME_QOS_WMM_UP_VO; } else if (qdf_nbuf_is_ipv4_arp_pkt(skb)) { *is_critical = true; *user_pri = SME_QOS_WMM_UP_BE; } else if (qdf_nbuf_is_ipv4_dhcp_pkt(skb)) { *is_critical = true; *user_pri = SME_QOS_WMM_UP_BE; } else if (qdf_nbuf_is_ipv6_dhcp_pkt(skb)) { *is_critical = true; *user_pri = SME_QOS_WMM_UP_BE; } else if (qdf_nbuf_is_icmpv6_pkt(skb)) { proto_subtype = qdf_nbuf_get_icmpv6_subtype(skb); switch (proto_subtype) { case QDF_PROTO_ICMPV6_NA: case QDF_PROTO_ICMPV6_NS: *is_critical = true; *user_pri = SME_QOS_WMM_UP_BE; break; default: break; } } } #ifdef DP_TRAFFIC_END_INDICATION /** * hdd_wmm_traffic_end_indication_is_enable() - Get feature enable/disable * status * @adapter: hdd adapter handle * * Return: true if feature is enable else false */ static inline bool hdd_wmm_traffic_end_indication_is_enable(struct hdd_adapter *adapter) { return qdf_unlikely(adapter->traffic_end_ind_en); } #else static inline bool hdd_wmm_traffic_end_indication_is_enable(struct hdd_adapter *adapter) { return false; } #endif static void hdd_wmm_get_user_priority_from_ip_tos(struct hdd_adapter *adapter, struct sk_buff *skb, enum sme_qos_wmmuptype *user_pri) { unsigned char dscp; unsigned char tos; union generic_ethhdr *eth_hdr; struct iphdr *ip_hdr; struct ipv6hdr *ipv6hdr; unsigned char *pkt; struct wlan_objmgr_psoc *psoc; /* this code is executed for every packet therefore * all debug code is kept conditional */ #ifdef HDD_WMM_DEBUG hdd_enter(); #endif /* HDD_WMM_DEBUG */ pkt = skb->data; eth_hdr = (union generic_ethhdr *)pkt; #ifdef HDD_WMM_DEBUG hdd_debug("proto is 0x%04x", skb->protocol); #endif /* HDD_WMM_DEBUG */ if (eth_hdr->eth_II.h_proto == htons(ETH_P_IP)) { /* case 1: Ethernet II IP packet */ ip_hdr = (struct iphdr *)&pkt[sizeof(eth_hdr->eth_II)]; tos = ip_hdr->tos; #ifdef HDD_WMM_DEBUG hdd_debug("Ethernet II IP Packet, tos is %d", tos); #endif /* HDD_WMM_DEBUG */ } else if (eth_hdr->eth_II.h_proto == htons(ETH_P_IPV6)) { ipv6hdr = ipv6_hdr(skb); tos = ntohs(*(const __be16 *)ipv6hdr) >> 4; #ifdef HDD_WMM_DEBUG hdd_debug("Ethernet II IPv6 Packet, tos is %d", tos); #endif /* HDD_WMM_DEBUG */ } else if ((ntohs(eth_hdr->eth_II.h_proto) < WLAN_MIN_PROTO) && (eth_hdr->eth_8023.h_snap.dsap == WLAN_SNAP_DSAP) && (eth_hdr->eth_8023.h_snap.ssap == WLAN_SNAP_SSAP) && (eth_hdr->eth_8023.h_snap.ctrl == WLAN_SNAP_CTRL) && (eth_hdr->eth_8023.h_proto == htons(ETH_P_IP))) { /* case 2: 802.3 LLC/SNAP IP packet */ ip_hdr = (struct iphdr *)&pkt[sizeof(eth_hdr->eth_8023)]; tos = ip_hdr->tos; #ifdef HDD_WMM_DEBUG hdd_debug("802.3 LLC/SNAP IP Packet, tos is %d", tos); #endif /* HDD_WMM_DEBUG */ } else if (eth_hdr->eth_II.h_proto == htons(ETH_P_8021Q)) { /* VLAN tagged */ if (eth_hdr->eth_IIv.h_vlan_encapsulated_proto == htons(ETH_P_IP)) { /* case 3: Ethernet II vlan-tagged IP packet */ ip_hdr = (struct iphdr *) &pkt[sizeof(eth_hdr->eth_IIv)]; tos = ip_hdr->tos; #ifdef HDD_WMM_DEBUG hdd_debug("Ether II VLAN tagged IP Packet, tos is %d", tos); #endif /* HDD_WMM_DEBUG */ } else if ((ntohs(eth_hdr->eth_IIv.h_vlan_encapsulated_proto) < WLAN_MIN_PROTO) && (eth_hdr->eth_8023v.h_snap.dsap == WLAN_SNAP_DSAP) && (eth_hdr->eth_8023v.h_snap.ssap == WLAN_SNAP_SSAP) && (eth_hdr->eth_8023v.h_snap.ctrl == WLAN_SNAP_CTRL) && (eth_hdr->eth_8023v.h_proto == htons(ETH_P_IP))) { /* case 4: 802.3 LLC/SNAP vlan-tagged IP packet */ ip_hdr = (struct iphdr *) &pkt[sizeof(eth_hdr->eth_8023v)]; tos = ip_hdr->tos; #ifdef HDD_WMM_DEBUG hdd_debug("802.3 LLC/SNAP VLAN tagged IP Packet, tos is %d", tos); #endif /* HDD_WMM_DEBUG */ } else { /* default */ #ifdef HDD_WMM_DEBUG hdd_warn("VLAN tagged Unhandled Protocol, using default tos"); #endif /* HDD_WMM_DEBUG */ tos = 0; } } else { /* default */ #ifdef HDD_WMM_DEBUG hdd_warn("Unhandled Protocol, using default tos"); #endif /* HDD_WMM_DEBUG */ /* Give the highest priority to 802.1x packet */ if (eth_hdr->eth_II.h_proto == htons(HDD_ETHERTYPE_802_1_X)) { tos = 0xC0; } else tos = 0; } dscp = (tos >> 2) & 0x3f; if (hdd_wmm_traffic_end_indication_is_enable(adapter)) { psoc = adapter->hdd_ctx->psoc; ucfg_dp_traffic_end_indication_update_dscp( psoc, adapter->deflink->vdev_id, &dscp); } *user_pri = adapter->dscp_to_up_map[dscp]; #ifdef HDD_WMM_DEBUG hdd_debug("tos is %d, dscp is %d, up is %d", tos, dscp, *user_pri); #endif /* HDD_WMM_DEBUG */ } /** * hdd_wmm_classify_pkt() - Function to classify skb into WMM AC based on DSCP * * @adapter: adapter upon which the packet is being transmitted * @skb: pointer to network buffer * @user_pri: user priority of the OS packet * @is_critical: pointer to be marked true for a critical packet * * Function checks if the packet is one of the critical packets and determines * 'user_pri' for it. Else it uses IP TOS value to determine 'user_pri'. * It is the responsibility of caller to set the user_pri to skb->priority. * Return: None */ static void hdd_wmm_classify_pkt(struct hdd_adapter *adapter, struct sk_buff *skb, enum sme_qos_wmmuptype *user_pri, bool *is_critical) { hdd_wmm_classify_critical_pkt(skb, user_pri, is_critical); if (false == *is_critical) { hdd_wmm_get_user_priority_from_ip_tos(adapter, skb, user_pri); hdd_check_and_upgrade_udp_qos(adapter, skb, user_pri); } } #ifdef QCA_SUPPORT_TX_MIN_RATES_FOR_SPECIAL_FRAMES void hdd_wmm_classify_pkt_cb(void *adapter, struct sk_buff *skb) { enum sme_qos_wmmuptype user_pri = SME_QOS_WMM_UP_BE; bool is_critical = false; hdd_wmm_classify_critical_pkt(skb, &user_pri, &is_critical); if (is_critical) { skb->priority = user_pri; QDF_NBUF_CB_TX_EXTRA_IS_CRITICAL(skb) = true; } } #endif #ifdef TX_MULTIQ_PER_AC /** * hdd_get_tx_queue_for_ac() - Get the netdev tx queue index * based on access category * @adapter: adapter upon which the packet is being transmitted * @skb: pointer to network buffer * @ac: access category * * Return: tx queue index */ static uint16_t hdd_get_tx_queue_for_ac(struct hdd_adapter *adapter, struct sk_buff *skb, uint16_t ac) { struct sock *sk = skb->sk; int new_index; int cpu = qdf_get_smp_processor_id(); struct hdd_tx_rx_stats *stats = &adapter->deflink->hdd_stats.tx_rx_stats; if (qdf_unlikely(ac == HDD_LINUX_AC_HI_PRIO)) return TX_GET_QUEUE_IDX(HDD_LINUX_AC_HI_PRIO, 0); if (!sk) { /* * Neither valid socket nor skb_hash so default to the * first queue for the access category. */ if (qdf_unlikely(!skb->sw_hash && !skb->l4_hash)) { ++stats->per_cpu[cpu].inv_sk_and_skb_hash; return TX_GET_QUEUE_IDX(ac, 0); } ++stats->per_cpu[cpu].qselect_existing_skb_hash; return TX_GET_QUEUE_IDX(ac, reciprocal_scale(skb->hash, TX_QUEUES_PER_AC)); } if (sk->sk_tx_queue_mapping != NO_QUEUE_MAPPING && sk->sk_tx_queue_mapping < NUM_TX_QUEUES) { ++stats->per_cpu[cpu].qselect_sk_tx_map; return sk->sk_tx_queue_mapping; } ++stats->per_cpu[cpu].qselect_skb_hash_calc; new_index = TX_GET_QUEUE_IDX(ac, reciprocal_scale(skb_get_hash(skb), TX_QUEUES_PER_AC)); if (sk_fullsock(sk) && rcu_access_pointer(sk->sk_dst_cache)) sk_tx_queue_set(sk, new_index); return new_index; } #else static inline uint16_t hdd_get_tx_queue_for_ac(struct hdd_adapter *adapter, struct sk_buff *skb, uint16_t ac) { return ac; } #endif /** * __hdd_get_queue_index() - get queue index * @up: user priority * * Return: queue_index */ static uint16_t __hdd_get_queue_index(uint16_t up) { if (qdf_unlikely(up >= ARRAY_SIZE(hdd_linux_up_to_ac_map))) return HDD_LINUX_AC_BE; return hdd_linux_up_to_ac_map[up]; } #if defined(QCA_LL_TX_FLOW_CONTROL_V2) || \ defined(QCA_HL_NETDEV_FLOW_CONTROL) || \ defined(QCA_LL_PDEV_TX_FLOW_CONTROL) /** * hdd_get_queue_index() - get queue index * @up: user priority * @is_critical: is_critical flag * * Return: queue_index */ static uint16_t hdd_get_queue_index(uint16_t up, bool is_critical) { if (qdf_unlikely(is_critical)) return HDD_LINUX_AC_HI_PRIO; return __hdd_get_queue_index(up); } #else static uint16_t hdd_get_queue_index(uint16_t up, bool is_critical) { return __hdd_get_queue_index(up); } #endif #ifdef DP_TX_PACKET_INSPECT_FOR_ILP /** * hdd_update_pkt_priority_with_inspection() - update TX packets priority * @skb: network buffer * @up: user priority * * Update TX packets priority, if some special TX packets like TCP ack, * reuse skb->priority upper 8 bits(bit24 ~ 31) to mark them. * * Return: None */ static inline void hdd_update_pkt_priority_with_inspection(struct sk_buff *skb, enum sme_qos_wmmuptype up) { skb->priority = up; if (qdf_unlikely(qdf_nbuf_is_ipv4_v6_pure_tcp_ack(skb))) qdf_nbuf_set_priority_pkt_type( skb, QDF_NBUF_PRIORITY_PKT_TCP_ACK); } #else static inline void hdd_update_pkt_priority_with_inspection(struct sk_buff *skb, enum sme_qos_wmmuptype up) { skb->priority = up; } #endif static uint16_t __hdd_wmm_select_queue(struct net_device *dev, struct sk_buff *skb) { enum sme_qos_wmmuptype up = SME_QOS_WMM_UP_BE; uint16_t index; struct hdd_adapter *adapter = WLAN_HDD_GET_PRIV_PTR(dev); bool is_critical = false; struct hdd_context *hdd_ctx = WLAN_HDD_GET_CTX(adapter); if (qdf_unlikely(!hdd_ctx || cds_is_driver_transitioning())) { hdd_debug_rl("driver is transitioning! Using default(BE) queue."); skb->priority = SME_QOS_WMM_UP_BE; return TX_GET_QUEUE_IDX(HDD_LINUX_AC_BE, 0); } /* Get the user priority from IP header */ hdd_wmm_classify_pkt(adapter, skb, &up, &is_critical); hdd_update_pkt_priority_with_inspection(skb, up); index = hdd_get_queue_index(up, is_critical); return hdd_get_tx_queue_for_ac(adapter, skb, index); } uint16_t hdd_wmm_select_queue(struct net_device *dev, struct sk_buff *skb) { uint16_t q_index; q_index = __hdd_wmm_select_queue(dev, skb); return q_index; } #if (LINUX_VERSION_CODE >= KERNEL_VERSION(5, 4, 0)) uint16_t hdd_select_queue(struct net_device *dev, struct sk_buff *skb, struct net_device *sb_dev) { return hdd_wmm_select_queue(dev, skb); } #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(4, 19, 0)) uint16_t hdd_select_queue(struct net_device *dev, struct sk_buff *skb, struct net_device *sb_dev, select_queue_fallback_t fallback) { return hdd_wmm_select_queue(dev, skb); } #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 14, 0)) uint16_t hdd_select_queue(struct net_device *dev, struct sk_buff *skb, void *accel_priv, select_queue_fallback_t fallback) { return hdd_wmm_select_queue(dev, skb); } #elif (LINUX_VERSION_CODE >= KERNEL_VERSION(3, 13, 0)) uint16_t hdd_select_queue(struct net_device *dev, struct sk_buff *skb, void *accel_priv) { return hdd_wmm_select_queue(dev, skb); } #else uint16_t hdd_select_queue(struct net_device *dev, struct sk_buff *skb) { return hdd_wmm_select_queue(dev, skb); } #endif /** * hdd_wmm_acquire_access_required() - Function which will determine * acquire admittance for a WMM AC is required or not based on psb configuration * done in framework * * @adapter: [in] pointer to adapter structure * @ac_type: [in] WMM AC type of OS packet * * Return: void */ void hdd_wmm_acquire_access_required(struct hdd_adapter *adapter, sme_ac_enum_type ac_type) { /* Each bit in the LSB nibble indicates 1 AC. * Clearing the particular bit in LSB nibble to indicate * access required */ switch (ac_type) { case SME_AC_BK: /* clear first bit */ adapter->psb_changed &= ~SME_QOS_UAPSD_CFG_BK_CHANGED_MASK; break; case SME_AC_BE: /* clear second bit */ adapter->psb_changed &= ~SME_QOS_UAPSD_CFG_BE_CHANGED_MASK; break; case SME_AC_VI: /* clear third bit */ adapter->psb_changed &= ~SME_QOS_UAPSD_CFG_VI_CHANGED_MASK; break; case SME_AC_VO: /* clear fourth bit */ adapter->psb_changed &= ~SME_QOS_UAPSD_CFG_VO_CHANGED_MASK; break; default: hdd_err("Invalid AC Type"); break; } } /** * hdd_wmm_acquire_access() - Function which will attempt to acquire * admittance for a WMM AC * * @adapter: [in] pointer to adapter context * @ac_type: [in] WMM AC type of OS packet * @granted: [out] pointer to bool flag when indicates if access * has been granted or not * * Return: QDF_STATUS enumeration */ QDF_STATUS hdd_wmm_acquire_access(struct hdd_adapter *adapter, sme_ac_enum_type ac_type, bool *granted) { struct hdd_wmm_qos_context *qos_context; struct hdd_context *hdd_ctx; /* The ini ImplicitQosIsEnabled is deprecated. By default, the ini * value is disabled. So, setting the variable is_implicit_qos_enabled * value to false. */ bool is_implicit_qos_enabled = false; hdd_ctx = WLAN_HDD_GET_CTX(adapter); QDF_TRACE(QDF_MODULE_ID_HDD_DATA, QDF_TRACE_LEVEL_DEBUG, "%s: Entered for AC %d", __func__, ac_type); if (!hdd_wmm_is_active(adapter) || !(is_implicit_qos_enabled) || !adapter->hdd_wmm_status.ac_status[ac_type].is_access_required) { /* either we don't want QoS or the AP doesn't support * QoS or we don't want to do implicit QoS */ QDF_TRACE(QDF_MODULE_ID_HDD_DATA, QDF_TRACE_LEVEL_DEBUG, "%s: QoS not configured on both ends ", __func__); *granted = adapter->hdd_wmm_status.ac_status[ac_type]. is_access_allowed; return QDF_STATUS_SUCCESS; } /* do we already have an implicit QoS request pending for this AC? */ if ((adapter->hdd_wmm_status.ac_status[ac_type].is_access_needed) || (adapter->hdd_wmm_status.ac_status[ac_type].is_access_pending)) { /* request already pending so we need to wait for that * response */ QDF_TRACE(QDF_MODULE_ID_HDD_DATA, QDF_TRACE_LEVEL_DEBUG, "%s: Implicit QoS for TL AC %d already scheduled", __func__, ac_type); *granted = false; return QDF_STATUS_SUCCESS; } /* did we already fail to establish implicit QoS for this AC? * (if so, access should have been granted when the failure * was handled) */ if (adapter->hdd_wmm_status.ac_status[ac_type].has_access_failed) { /* request previously failed * allow access, but we'll be downgraded */ QDF_TRACE(QDF_MODULE_ID_HDD_DATA, QDF_TRACE_LEVEL_DEBUG, "%s: Implicit QoS for TL AC %d previously failed", __func__, ac_type); if (!adapter->hdd_wmm_status.ac_status[ac_type]. is_access_required) { adapter->hdd_wmm_status.ac_status[ac_type]. is_access_allowed = true; *granted = true; } else { adapter->hdd_wmm_status.ac_status[ac_type]. is_access_allowed = false; *granted = false; } return QDF_STATUS_SUCCESS; } /* we need to establish implicit QoS */ QDF_TRACE(QDF_MODULE_ID_HDD_DATA, QDF_TRACE_LEVEL_DEBUG, "%s: Need to schedule implicit QoS for TL AC %d, adapter is %pK", __func__, ac_type, adapter); adapter->hdd_wmm_status.ac_status[ac_type].is_access_needed = true; qos_context = qdf_mem_malloc(sizeof(*qos_context)); if (!qos_context) { /* no memory for QoS context. Nothing we can do but * let data flow */ adapter->hdd_wmm_status.ac_status[ac_type].is_access_allowed = true; *granted = true; return QDF_STATUS_SUCCESS; } qos_context->ac_type = ac_type; qos_context->adapter = adapter; qos_context->flow_id = 0; qos_context->handle = HDD_WMM_HANDLE_IMPLICIT; qos_context->magic = HDD_WMM_CTX_MAGIC; qos_context->is_inactivity_timer_running = false; INIT_WORK(&qos_context->implicit_qos_work, hdd_wmm_do_implicit_qos); QDF_TRACE(QDF_MODULE_ID_HDD_DATA, QDF_TRACE_LEVEL_DEBUG, "%s: Scheduling work for AC %d, context %pK", __func__, ac_type, qos_context); schedule_work(&qos_context->implicit_qos_work); /* caller will need to wait until the work takes place and * TSPEC negotiation completes */ *granted = false; return QDF_STATUS_SUCCESS; } QDF_STATUS hdd_wmm_assoc(struct hdd_adapter *adapter, bool is_reassoc, uint8_t uapsd_mask) { QDF_STATUS status; uint32_t srv_value = 0; uint32_t sus_value = 0; struct hdd_context *hdd_ctx = WLAN_HDD_GET_CTX(adapter); uint32_t delayed_trgr_frm_int; /* when we associate we need to notify TL if it needs to * enable UAPSD for any access categories */ hdd_enter(); if (is_reassoc) { /* when we reassociate we should continue to use * whatever parameters were previously established. * if we are reassociating due to a U-APSD change for * a particular Access Category, then the change will * be communicated to HDD via the QoS callback * associated with the given flow, and U-APSD * parameters will be updated there */ hdd_debug("Reassoc so no work, Exiting"); return QDF_STATUS_SUCCESS; } hdd_debug("U-APSD mask is 0x%02x", (int)uapsd_mask); ucfg_mlme_get_tl_delayed_trgr_frm_int(hdd_ctx->psoc, &delayed_trgr_frm_int); if (uapsd_mask & HDD_AC_VO) { status = ucfg_mlme_get_wmm_uapsd_vo_srv_intv(hdd_ctx->psoc, &srv_value); if (QDF_IS_STATUS_ERROR(status)) { hdd_err("Get uapsd_srv_intv failed"); return QDF_STATUS_SUCCESS; } status = ucfg_mlme_get_wmm_uapsd_vo_sus_intv(hdd_ctx->psoc, &sus_value); if (QDF_IS_STATUS_ERROR(status)) { hdd_err("Get uapsd_vo_sus_intv failed"); return QDF_STATUS_SUCCESS; } status = sme_enable_uapsd_for_ac( SME_AC_VO, 7, 7, srv_value, sus_value, SME_QOS_WMM_TS_DIR_BOTH, 1, adapter->deflink->vdev_id, delayed_trgr_frm_int); QDF_ASSERT(QDF_IS_STATUS_SUCCESS(status)); } if (uapsd_mask & HDD_AC_VI) { status = ucfg_mlme_get_wmm_uapsd_vi_srv_intv( hdd_ctx->psoc, &srv_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_vi_srv_intv failed"); return QDF_STATUS_SUCCESS; } status = ucfg_mlme_get_wmm_uapsd_vi_sus_intv( hdd_ctx->psoc, &sus_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_vi_sus_intv failed"); return QDF_STATUS_SUCCESS; } status = sme_enable_uapsd_for_ac( SME_AC_VI, 5, 5, srv_value, sus_value, SME_QOS_WMM_TS_DIR_BOTH, 1, adapter->deflink->vdev_id, delayed_trgr_frm_int); QDF_ASSERT(QDF_IS_STATUS_SUCCESS(status)); } if (uapsd_mask & HDD_AC_BK) { status = ucfg_mlme_get_wmm_uapsd_bk_srv_intv(hdd_ctx->psoc, &srv_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_bk_srv_intv failed"); return QDF_STATUS_SUCCESS; } status = ucfg_mlme_get_wmm_uapsd_bk_sus_intv(hdd_ctx->psoc, &sus_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_bk_sus_intv failed"); return QDF_STATUS_SUCCESS; } status = sme_enable_uapsd_for_ac( SME_AC_BK, 2, 2, srv_value, sus_value, SME_QOS_WMM_TS_DIR_BOTH, 1, adapter->deflink->vdev_id, delayed_trgr_frm_int); QDF_ASSERT(QDF_IS_STATUS_SUCCESS(status)); } if (uapsd_mask & HDD_AC_BE) { status = ucfg_mlme_get_wmm_uapsd_be_srv_intv(hdd_ctx->psoc, &srv_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_be_srv_intv failed"); return QDF_STATUS_SUCCESS; } status = ucfg_mlme_get_wmm_uapsd_be_sus_intv(hdd_ctx->psoc, &sus_value); if (!QDF_IS_STATUS_SUCCESS(status)) { hdd_err("Get uapsd_be_sus_intv failed"); return QDF_STATUS_SUCCESS; } status = sme_enable_uapsd_for_ac( SME_AC_BE, 3, 3, srv_value, sus_value, SME_QOS_WMM_TS_DIR_BOTH, 1, adapter->deflink->vdev_id, delayed_trgr_frm_int); QDF_ASSERT(QDF_IS_STATUS_SUCCESS(status)); } status = sme_update_dsc_pto_up_mapping(hdd_ctx->mac_handle, adapter->dscp_to_up_map, adapter->deflink->vdev_id); if (!QDF_IS_STATUS_SUCCESS(status)) hdd_wmm_dscp_initial_state(adapter); hdd_exit(); return QDF_STATUS_SUCCESS; } /** * hdd_wmm_connect() - Function which will handle the housekeeping * required by WMM when a connection is established * * @adapter : [in] pointer to adapter context * @roam_info: [in] pointer to roam information * @bss_type : [in] type of BSS * * Return: QDF_STATUS enumeration */ QDF_STATUS hdd_wmm_connect(struct hdd_adapter *adapter, struct csr_roam_info *roam_info, eCsrRoamBssType bss_type) { int ac; bool qap = true; bool qos_connection = true; uint8_t acm_mask = 0x0; hdd_debug("qap is %d, qos_connection is %d, acm_mask is 0x%x", qap, qos_connection, acm_mask); adapter->hdd_wmm_status.qap = qap; adapter->hdd_wmm_status.qos_connection = qos_connection; for (ac = 0; ac < WLAN_MAX_AC; ac++) { /* admission is not required so access is allowed */ adapter->hdd_wmm_status.ac_status[ac].is_access_required = false; adapter->hdd_wmm_status.ac_status[ac].is_access_allowed = true; } return QDF_STATUS_SUCCESS; } /** * hdd_wmm_is_active() - Function which will determine if WMM is * active on the current connection * * @adapter: [in] pointer to adapter context * * Return: true if WMM is enabled, false if WMM is not enabled */ bool hdd_wmm_is_active(struct hdd_adapter *adapter) { if ((!adapter->hdd_wmm_status.qos_connection) || (!adapter->hdd_wmm_status.qap)) { return false; } else { return true; } } bool hdd_wmm_is_acm_allowed(uint8_t vdev_id) { struct hdd_adapter *adapter; struct hdd_wmm_ac_status *wmm_ac_status; struct hdd_context *hdd_ctx; struct wlan_hdd_link_info *link_info; hdd_ctx = cds_get_context(QDF_MODULE_ID_HDD); if (!hdd_ctx) return false; link_info = hdd_get_link_info_by_vdev(hdd_ctx, vdev_id); if (!link_info || hdd_validate_adapter(link_info->adapter)) return false; adapter = link_info->adapter; wmm_ac_status = adapter->hdd_wmm_status.ac_status; if (hdd_wmm_is_active(adapter) && !(wmm_ac_status[QCA_WLAN_AC_VI].is_access_allowed)) return false; return true; } hdd_wlan_wmm_status_e hdd_wmm_addts(struct hdd_adapter *adapter, uint32_t handle, struct sme_qos_wmmtspecinfo *tspec) { struct hdd_wmm_qos_context *qos_context = NULL; struct hdd_wmm_qos_context *cur_entry; hdd_wlan_wmm_status_e status = HDD_WLAN_WMM_STATUS_SETUP_SUCCESS; #ifndef WLAN_MDM_CODE_REDUCTION_OPT enum sme_qos_statustype sme_status; #endif mac_handle_t mac_handle = hdd_adapter_get_mac_handle(adapter); hdd_debug("Entered with handle 0x%x", handle); /* see if a context already exists with the given handle */ mutex_lock(&adapter->hdd_wmm_status.mutex); list_for_each_entry(cur_entry, &adapter->hdd_wmm_status.context_list, node) { if (cur_entry->handle == handle) { qos_context = cur_entry; break; } } mutex_unlock(&adapter->hdd_wmm_status.mutex); if (qos_context) { /* record with that handle already exists */ hdd_err("Record already exists with handle 0x%x", handle); /* Application is trying to modify some of the Tspec * params. Allow it */ sme_status = sme_qos_modify_req(mac_handle, tspec, qos_context->flow_id); /* need to check the return value and act appropriately */ switch (sme_status) { case SME_QOS_STATUS_MODIFY_SETUP_PENDING_RSP: status = HDD_WLAN_WMM_STATUS_MODIFY_PENDING; break; case SME_QOS_STATUS_MODIFY_SETUP_SUCCESS_NO_ACM_NO_APSD_RSP: status = HDD_WLAN_WMM_STATUS_MODIFY_SUCCESS_NO_ACM_NO_UAPSD; break; case SME_QOS_STATUS_MODIFY_SETUP_SUCCESS_APSD_SET_ALREADY: status = HDD_WLAN_WMM_STATUS_MODIFY_SUCCESS_NO_ACM_UAPSD_EXISTING; break; case SME_QOS_STATUS_MODIFY_SETUP_INVALID_PARAMS_RSP: status = HDD_WLAN_WMM_STATUS_MODIFY_FAILED_BAD_PARAM; break; case SME_QOS_STATUS_MODIFY_SETUP_FAILURE_RSP: status = HDD_WLAN_WMM_STATUS_MODIFY_FAILED; break; case SME_QOS_STATUS_SETUP_NOT_QOS_AP_RSP: status = HDD_WLAN_WMM_STATUS_SETUP_FAILED_NO_WMM; break; default: /* we didn't get back one of the * SME_QOS_STATUS_MODIFY_* status codes */ hdd_err("unexpected SME Status=%d", sme_status); QDF_ASSERT(0); return HDD_WLAN_WMM_STATUS_MODIFY_FAILED; } /* we were successful, save the status */ mutex_lock(&adapter->hdd_wmm_status.mutex); if (qos_context->magic == HDD_WMM_CTX_MAGIC) qos_context->status = status; mutex_unlock(&adapter->hdd_wmm_status.mutex); return status; } qos_context = qdf_mem_malloc(sizeof(*qos_context)); if (!qos_context) { /* no memory for QoS context. Nothing we can do */ return HDD_WLAN_WMM_STATUS_INTERNAL_FAILURE; } /* we assume the tspec has already been validated by the caller */ qos_context->handle = handle; if (tspec->ts_info.up < HDD_WMM_UP_TO_AC_MAP_SIZE) qos_context->ac_type = hdd_wmm_up_to_ac_map[tspec->ts_info.up]; else { hdd_err("ts_info.up (%d) larger than max value (%d), use default ac_type (%d)", tspec->ts_info.up, HDD_WMM_UP_TO_AC_MAP_SIZE - 1, hdd_wmm_up_to_ac_map[0]); qos_context->ac_type = hdd_wmm_up_to_ac_map[0]; } qos_context->adapter = adapter; qos_context->flow_id = 0; qos_context->ts_id = tspec->ts_info.tid; qos_context->magic = HDD_WMM_CTX_MAGIC; qos_context->is_inactivity_timer_running = false; hdd_debug("Setting up QoS, context %pK", qos_context); mutex_lock(&adapter->hdd_wmm_status.mutex); list_add(&qos_context->node, &adapter->hdd_wmm_status.context_list); mutex_unlock(&adapter->hdd_wmm_status.mutex); #ifndef WLAN_MDM_CODE_REDUCTION_OPT sme_status = sme_qos_setup_req(mac_handle, adapter->deflink->vdev_id, tspec, hdd_wmm_sme_callback, qos_context, tspec->ts_info.up, &qos_context->flow_id); hdd_debug("sme_qos_setup_req returned %d flowid %d", sme_status, qos_context->flow_id); /* need to check the return value and act appropriately */ switch (sme_status) { case SME_QOS_STATUS_SETUP_REQ_PENDING_RSP: status = HDD_WLAN_WMM_STATUS_SETUP_PENDING; break; case SME_QOS_STATUS_SETUP_SUCCESS_NO_ACM_NO_APSD_RSP: status = HDD_WLAN_WMM_STATUS_SETUP_SUCCESS_NO_ACM_NO_UAPSD; break; case SME_QOS_STATUS_SETUP_SUCCESS_APSD_SET_ALREADY: status = HDD_WLAN_WMM_STATUS_SETUP_SUCCESS_NO_ACM_UAPSD_EXISTING; break; case SME_QOS_STATUS_SETUP_SUCCESS_IND_APSD_PENDING: status = HDD_WLAN_WMM_STATUS_SETUP_PENDING; break; case SME_QOS_STATUS_SETUP_INVALID_PARAMS_RSP: /* disable the inactivity timer */ hdd_wmm_disable_inactivity_timer(qos_context); hdd_wmm_free_context(qos_context); return HDD_WLAN_WMM_STATUS_SETUP_FAILED_BAD_PARAM; case SME_QOS_STATUS_SETUP_FAILURE_RSP: /* disable the inactivity timer */ hdd_wmm_disable_inactivity_timer(qos_context); /* we can't tell the difference between when a request * fails because AP rejected it versus when SME * encountered an internal error */ hdd_wmm_free_context(qos_context); return HDD_WLAN_WMM_STATUS_SETUP_FAILED; case SME_QOS_STATUS_SETUP_NOT_QOS_AP_RSP: /* disable the inactivity timer */ hdd_wmm_disable_inactivity_timer(qos_context); hdd_wmm_free_context(qos_context); return HDD_WLAN_WMM_STATUS_SETUP_FAILED_NO_WMM; default: /* disable the inactivity timer */ hdd_wmm_disable_inactivity_timer(qos_context); /* we didn't get back one of the * SME_QOS_STATUS_SETUP_* status codes */ hdd_wmm_free_context(qos_context); hdd_err("unexpected SME Status=%d", sme_status); QDF_ASSERT(0); return HDD_WLAN_WMM_STATUS_SETUP_FAILED; } #endif /* we were successful, save the status */ mutex_lock(&adapter->hdd_wmm_status.mutex); if (qos_context->magic == HDD_WMM_CTX_MAGIC) qos_context->status = status; mutex_unlock(&adapter->hdd_wmm_status.mutex); return status; } /** * hdd_wmm_delts() - Function which will delete a traffic spec at the * request of an application * * @adapter: [in] pointer to adapter context * @handle: [in] handle to uniquely identify a TS * * Return: HDD_WLAN_WMM_STATUS_* */ hdd_wlan_wmm_status_e hdd_wmm_delts(struct hdd_adapter *adapter, uint32_t handle) { struct hdd_wmm_qos_context *qos_context = NULL; struct hdd_wmm_qos_context *cur_entry; sme_ac_enum_type ac_type = 0; uint32_t flow_id = 0; hdd_wlan_wmm_status_e status = HDD_WLAN_WMM_STATUS_SETUP_SUCCESS; #ifndef WLAN_MDM_CODE_REDUCTION_OPT enum sme_qos_statustype sme_status; mac_handle_t mac_handle = hdd_adapter_get_mac_handle(adapter); #endif hdd_debug("Entered with handle 0x%x", handle); /* locate the context with the given handle */ mutex_lock(&adapter->hdd_wmm_status.mutex); list_for_each_entry(cur_entry, &adapter->hdd_wmm_status.context_list, node) { if (cur_entry->handle == handle) { qos_context = cur_entry; break; } } mutex_unlock(&adapter->hdd_wmm_status.mutex); if (!qos_context) { /* we didn't find the handle, tid is already freed */ hdd_info("tid already freed for handle 0x%x", handle); return HDD_WLAN_WMM_STATUS_RELEASE_SUCCESS; } ac_type = qos_context->ac_type; flow_id = qos_context->flow_id; hdd_debug("found handle 0x%x, flow %d, AC %d", handle, flow_id, ac_type); #ifndef WLAN_MDM_CODE_REDUCTION_OPT sme_status = sme_qos_release_req(mac_handle, adapter->deflink->vdev_id, flow_id); hdd_debug("SME flow %d released, SME status %d", flow_id, sme_status); switch (sme_status) { case SME_QOS_STATUS_RELEASE_SUCCESS_RSP: /* this flow is the only one on that AC, so go ahead * and update our TSPEC state for the AC */ adapter->hdd_wmm_status.ac_status[ac_type].is_tspec_valid = false; adapter->hdd_wmm_status.ac_status[ac_type].is_access_allowed = false; /* need to tell TL to stop trigger timer, etc */ hdd_wmm_disable_tl_uapsd(qos_context); /* disable the inactivity timer */ hdd_wmm_disable_inactivity_timer(qos_context); /* we are done with this context */ hdd_wmm_free_context(qos_context); /* SME must not fire any more callbacks for this flow * since the context is no longer valid */ return HDD_WLAN_WMM_STATUS_RELEASE_SUCCESS; case SME_QOS_STATUS_RELEASE_REQ_PENDING_RSP: /* do nothing as we will get a response from SME */ status = HDD_WLAN_WMM_STATUS_RELEASE_PENDING; break; case SME_QOS_STATUS_RELEASE_INVALID_PARAMS_RSP: /* nothing we can do with the existing flow except leave it */ status = HDD_WLAN_WMM_STATUS_RELEASE_FAILED_BAD_PARAM; break; case SME_QOS_STATUS_RELEASE_FAILURE_RSP: /* nothing we can do with the existing flow except leave it */ status = HDD_WLAN_WMM_STATUS_RELEASE_FAILED; break; default: /* we didn't get back one of the * SME_QOS_STATUS_RELEASE_* status codes */ hdd_err("unexpected SME Status=%d", sme_status); QDF_ASSERT(0); status = HDD_WLAN_WMM_STATUS_RELEASE_FAILED; } #endif mutex_lock(&adapter->hdd_wmm_status.mutex); if (qos_context->magic == HDD_WMM_CTX_MAGIC) qos_context->status = status; mutex_unlock(&adapter->hdd_wmm_status.mutex); return status; } /** * hdd_wmm_checkts() - Function which will return the status of a traffic * spec at the request of an application * * @adapter: [in] pointer to adapter context * @handle: [in] handle to uniquely identify a TS * * Return: HDD_WLAN_WMM_STATUS_* */ hdd_wlan_wmm_status_e hdd_wmm_checkts(struct hdd_adapter *adapter, uint32_t handle) { struct hdd_wmm_qos_context *qos_context; hdd_wlan_wmm_status_e status = HDD_WLAN_WMM_STATUS_LOST; hdd_debug("Entered with handle 0x%x", handle); /* locate the context with the given handle */ mutex_lock(&adapter->hdd_wmm_status.mutex); list_for_each_entry(qos_context, &adapter->hdd_wmm_status.context_list, node) { if (qos_context->handle == handle) { hdd_debug("found handle 0x%x, context %pK", handle, qos_context); status = qos_context->status; break; } } mutex_unlock(&adapter->hdd_wmm_status.mutex); return status; } /** * hdd_get_handle_from_ts_id() - get handle from ts id * @adapter : hdd adapter * @ts_id: ts_id * @del_tspec_handle: handle to delete the request * * Return: None */ static void hdd_get_handle_from_ts_id(struct hdd_adapter *adapter, uint8_t ts_id, uint32_t *del_tspec_handle) { struct hdd_wmm_qos_context *cur_entry; hdd_debug("Entered with ts_id 0x%x", ts_id); mutex_lock(&adapter->hdd_wmm_status.mutex); list_for_each_entry(cur_entry, &adapter->hdd_wmm_status.context_list, node) { if (cur_entry->ts_id == ts_id) { *del_tspec_handle = cur_entry->handle; break; } } mutex_unlock(&adapter->hdd_wmm_status.mutex); } /** * __wlan_hdd_cfg80211_config_tspec() - config tspec * @wiphy: pointer to wireless wiphy structure. * @wdev: pointer to wireless_dev structure. * @data: pointer to config tspec command parameters. * @data_len: the length in byte of config tspec command parameters. * * Return: An error code or 0 on success. */ static int __wlan_hdd_cfg80211_config_tspec(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { struct hdd_adapter *adapter = WLAN_HDD_GET_PRIV_PTR(wdev->netdev); struct hdd_context *hdd_ctx = wiphy_priv(wiphy); struct sme_qos_wmmtspecinfo tspec; struct nlattr *tb[QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_MAX + 1]; uint8_t oper, ts_id; static uint32_t add_tspec_handle = MIN_HANDLE_VALUE; uint32_t del_tspec_handle = 0; hdd_wlan_wmm_status_e status; int ret; hdd_enter_dev(wdev->netdev); if (QDF_GLOBAL_FTM_MODE == hdd_get_conparam()) { hdd_err("Command not allowed in FTM mode"); return -EPERM; } ret = wlan_hdd_validate_context(hdd_ctx); if (ret != 0) return ret; ret = wlan_cfg80211_nla_parse(tb, QCA_WLAN_VENDOR_ATTR_CONFIG_TSPEC_MAX, data, data_len, config_tspec_policy); if (ret) { hdd_err_rl("Invalid ATTR"); return -EINVAL; } if (!tb[CONFIG_TSPEC_OPERATION] || !tb[CONFIG_TSPEC_TSID]) { hdd_err_rl("Mandatory attributes are not present"); return -EINVAL; } memset(&tspec, 0, sizeof(tspec)); oper = nla_get_u8(tb[CONFIG_TSPEC_OPERATION]); ts_id = nla_get_u8(tb[CONFIG_TSPEC_TSID]); switch (oper) { case QCA_WLAN_TSPEC_ADD: tspec.ts_info.tid = ts_id; /* Mandatory attributes */ if (tb[CONFIG_TSPEC_DIRECTION]) { uint8_t direction = nla_get_u8( tb[CONFIG_TSPEC_DIRECTION]); switch (direction) { case QCA_WLAN_TSPEC_DIRECTION_UPLINK: tspec.ts_info.direction = SME_QOS_WMM_TS_DIR_UPLINK; break; case QCA_WLAN_TSPEC_DIRECTION_DOWNLINK: tspec.ts_info.direction = SME_QOS_WMM_TS_DIR_DOWNLINK; break; case QCA_WLAN_TSPEC_DIRECTION_BOTH: tspec.ts_info.direction = SME_QOS_WMM_TS_DIR_BOTH; break; default: hdd_err_rl("Invalid direction %d", direction); return -EINVAL; } } else { hdd_err_rl("Direction is not present"); return -EINVAL; } if (tb[CONFIG_TSPEC_APSD]) tspec.ts_info.psb = 1; if (tb[CONFIG_TSPEC_ACK_POLICY]) { uint8_t ack_policy = nla_get_u8( tb[CONFIG_TSPEC_ACK_POLICY]); switch (ack_policy) { case QCA_WLAN_TSPEC_NORMAL_ACK: tspec.ts_info.ack_policy = SME_QOS_WMM_TS_ACK_POLICY_NORMAL_ACK; break; case QCA_WLAN_TSPEC_BLOCK_ACK: tspec.ts_info.ack_policy = SME_QOS_WMM_TS_ACK_POLICY_HT_IMMEDIATE_BLOCK_ACK; break; default: hdd_err_rl("Invalid ack policy %d", ack_policy); return -EINVAL; } } else { hdd_err_rl("ACK policy is not present"); return -EINVAL; } if (tb[CONFIG_TSPEC_NOMINAL_MSDU_SIZE]) { tspec.nominal_msdu_size = nla_get_u16( tb[CONFIG_TSPEC_NOMINAL_MSDU_SIZE]); } else { hdd_err_rl("Nominal msdu size is not present"); return -EINVAL; } if (tb[CONFIG_TSPEC_MAXIMUM_MSDU_SIZE]) { tspec.maximum_msdu_size = nla_get_u16( tb[CONFIG_TSPEC_MAXIMUM_MSDU_SIZE]); } else { hdd_err_rl("Maximum msdu size is not present"); return -EINVAL; } if (tb[CONFIG_TSPEC_MIN_SERVICE_INTERVAL]) { tspec.min_service_interval = nla_get_u32( tb[CONFIG_TSPEC_MIN_SERVICE_INTERVAL]); } else { hdd_err_rl("Min service interval is not present"); return -EINVAL; } if (tb[CONFIG_TSPEC_MAX_SERVICE_INTERVAL]) { tspec.max_service_interval = nla_get_u32( tb[CONFIG_TSPEC_MAX_SERVICE_INTERVAL]); } else { hdd_err_rl("Max service interval is not present"); return -EINVAL; } if (tb[CONFIG_TSPEC_INACTIVITY_INTERVAL]) { tspec.inactivity_interval = nla_get_u32( tb[CONFIG_TSPEC_INACTIVITY_INTERVAL]); } else { hdd_err_rl("Inactivity interval is not present"); return -EINVAL; } if (tb[CONFIG_TSPEC_SUSPENSION_INTERVAL]) { tspec.suspension_interval = nla_get_u32( tb[CONFIG_TSPEC_SUSPENSION_INTERVAL]); } else { hdd_err_rl("Suspension interval is not present"); return -EINVAL; } if (tb[CONFIG_TSPEC_SURPLUS_BANDWIDTH_ALLOWANCE]) { tspec.surplus_bw_allowance = nla_get_u16( tb[CONFIG_TSPEC_SURPLUS_BANDWIDTH_ALLOWANCE]); } else { hdd_err_rl("Surplus bw allowance is not present"); return -EINVAL; } /* Optional attributes */ if (tb[CONFIG_TSPEC_USER_PRIORITY]) tspec.ts_info.up = nla_get_u8( tb[CONFIG_TSPEC_USER_PRIORITY]); if (tb[CONFIG_TSPEC_MINIMUM_DATA_RATE]) tspec.min_data_rate = nla_get_u32( tb[CONFIG_TSPEC_MINIMUM_DATA_RATE]); if (tb[CONFIG_TSPEC_MEAN_DATA_RATE]) tspec.mean_data_rate = nla_get_u32( tb[CONFIG_TSPEC_MEAN_DATA_RATE]); if (tb[CONFIG_TSPEC_PEAK_DATA_RATE]) tspec.peak_data_rate = nla_get_u32( tb[CONFIG_TSPEC_PEAK_DATA_RATE]); if (tb[CONFIG_TSPEC_BURST_SIZE]) tspec.max_burst_size = nla_get_u32( tb[CONFIG_TSPEC_BURST_SIZE]); if (tspec.max_burst_size) tspec.ts_info.burst_size_defn = 1; if (tb[CONFIG_TSPEC_MINIMUM_PHY_RATE]) tspec.min_phy_rate = nla_get_u32( tb[CONFIG_TSPEC_MINIMUM_PHY_RATE]); /* * ts_id send by upper layer is always same as handle and host * doesn't add new TS entry for same handle. To avoid this * issue host modifies handle internally. */ status = hdd_wmm_addts(adapter, add_tspec_handle, &tspec); if (status == HDD_WLAN_WMM_STATUS_SETUP_FAILED || status == HDD_WLAN_WMM_STATUS_SETUP_FAILED_BAD_PARAM || status == HDD_WLAN_WMM_STATUS_SETUP_FAILED_NO_WMM || status == HDD_WLAN_WMM_STATUS_MODIFY_FAILED || status == HDD_WLAN_WMM_STATUS_MODIFY_FAILED_BAD_PARAM || status == HDD_WLAN_WMM_STATUS_SETUP_UAPSD_SET_FAILED || status == HDD_WLAN_WMM_STATUS_MODIFY_UAPSD_SET_FAILED || status == HDD_WLAN_WMM_STATUS_INTERNAL_FAILURE) { hdd_err_rl("hdd_wmm_addts failed %d", status); return -EINVAL; } add_tspec_handle++; if (add_tspec_handle >= MAX_HANDLE_VALUE) add_tspec_handle = MIN_HANDLE_VALUE; break; case QCA_WLAN_TSPEC_DEL: /* * Host modifies handle internally. So, always * delete the entry for provided ts_id. */ hdd_get_handle_from_ts_id(adapter, ts_id, &del_tspec_handle); if (!del_tspec_handle) { hdd_err_rl("ts_id is already freed %d", ts_id); break; } status = hdd_wmm_delts(adapter, del_tspec_handle); if (status == HDD_WLAN_WMM_STATUS_RELEASE_FAILED || status == HDD_WLAN_WMM_STATUS_RELEASE_FAILED_BAD_PARAM || status == HDD_WLAN_WMM_STATUS_INTERNAL_FAILURE) { hdd_err_rl("hdd_wmm_delts failed %d", status); return -EINVAL; } break; case QCA_WLAN_TSPEC_GET: status = hdd_wmm_checkts(adapter, ts_id); if (status == HDD_WLAN_WMM_STATUS_LOST || status == HDD_WLAN_WMM_STATUS_INTERNAL_FAILURE) { hdd_err_rl("hdd_wmm_checkts failed %d", status); return -EINVAL; } break; default: hdd_err_rl("Invalid operation %d", oper); return -EINVAL; } hdd_exit(); return 0; } int wlan_hdd_cfg80211_config_tspec(struct wiphy *wiphy, struct wireless_dev *wdev, const void *data, int data_len) { int errno; struct osif_vdev_sync *vdev_sync; errno = osif_vdev_sync_op_start(wdev->netdev, &vdev_sync); if (errno) return errno; errno = __wlan_hdd_cfg80211_config_tspec(wiphy, wdev, data, data_len); osif_vdev_sync_op_stop(vdev_sync); return errno; }