qcacmn: APIs to add and parse TID-to-link mapping IEs
Create wlan_mlo_t2lm.h and wlan_mlo_t2lm.c files for T2LM. Add APIs to add and parse TID-to-link mapping IEs. Change-Id: I6ae23a35662185040ad9f5a4d983a16782e3fc35 CRs-Fixed: 3329887
This commit is contained in:
Shashikala Prabhu
کامیت شده توسط
Madan Koyyalamudi
Madan Koyyalamudi
والد
8e2032cc6a
کامیت
da59d95884
80
umac/mlo_mgr/inc/wlan_mlo_t2lm.h
Normal file
80
umac/mlo_mgr/inc/wlan_mlo_t2lm.h
Normal file
@@ -0,0 +1,80 @@
|
||||
/*
|
||||
* Copyright (c) 2022 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: contains T2LM APIs
|
||||
*/
|
||||
|
||||
#ifndef _WLAN_MLO_T2LM_H_
|
||||
#define _WLAN_MLO_T2LM_H_
|
||||
|
||||
#ifdef WLAN_FEATURE_11BE
|
||||
|
||||
#define t2lm_alert(format, args...) \
|
||||
QDF_TRACE_FATAL(QDF_MODULE_ID_T2LM, format, ## args)
|
||||
|
||||
#define t2lm_err(format, args...) \
|
||||
QDF_TRACE_ERROR(QDF_MODULE_ID_T2LM, format, ## args)
|
||||
|
||||
#define t2lm_warn(format, args...) \
|
||||
QDF_TRACE_WARN(QDF_MODULE_ID_T2LM, format, ## args)
|
||||
|
||||
#define t2lm_info(format, args...) \
|
||||
QDF_TRACE_INFO(QDF_MODULE_ID_T2LM, format, ## args)
|
||||
|
||||
#define t2lm_debug(format, args...) \
|
||||
QDF_TRACE_DEBUG(QDF_MODULE_ID_T2LM, format, ## args)
|
||||
|
||||
#define WLAN_T2LM_MAX_NUM_LINKS 16
|
||||
|
||||
/**
|
||||
* wlan_mlo_parse_t2lm_ie() - API to parse the T2LM IE
|
||||
* @peer: Pointer to peer structure
|
||||
* @t2lm: Pointer to T2LM structure
|
||||
* @ie: Pointer to T2LM IE
|
||||
*
|
||||
* Return: QDF_STATUS
|
||||
*/
|
||||
QDF_STATUS wlan_mlo_parse_t2lm_ie(
|
||||
struct wlan_objmgr_peer *peer,
|
||||
struct wlan_t2lm_onging_negotiation_info *t2lm, uint8_t *ie);
|
||||
|
||||
/**
|
||||
* wlan_mlo_add_t2lm_ie() - API to add TID-to-link mapping IE
|
||||
* @frm: Pointer to buffer
|
||||
* @peer: Pointer to peer structure
|
||||
* @t2lm: Pointer to t2lm mapping structure
|
||||
*
|
||||
* Return: Updated frame pointer
|
||||
*/
|
||||
uint8_t *wlan_mlo_add_t2lm_ie(uint8_t *frm, struct wlan_objmgr_peer *peer,
|
||||
struct wlan_t2lm_onging_negotiation_info *t2lm);
|
||||
#else
|
||||
static inline QDF_STATUS wlan_mlo_parse_t2lm_ie(
|
||||
struct wlan_objmgr_peer *peer,
|
||||
struct wlan_t2lm_onging_negotiation_info *t2lm, uint8_t *ie)
|
||||
{
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
|
||||
static inline
|
||||
int8_t *wlan_mlo_add_t2lm_ie(uint8_t *frm, struct wlan_objmgr_peer *peer,
|
||||
struct wlan_t2lm_onging_negotiation_info *t2lm)
|
||||
{
|
||||
return frm;
|
||||
}
|
||||
#endif /* WLAN_FEATURE_11BE */
|
||||
#endif /* _WLAN_MLO_T2LM_H_ */
|
||||
495
umac/mlo_mgr/src/wlan_mlo_t2lm.c
Normal file
495
umac/mlo_mgr/src/wlan_mlo_t2lm.c
Normal file
@@ -0,0 +1,495 @@
|
||||
/*
|
||||
* Copyright (c) 2022 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: contains T2LM APIs
|
||||
*/
|
||||
|
||||
#include <wlan_objmgr_pdev_obj.h>
|
||||
#include <wlan_objmgr_vdev_obj.h>
|
||||
#include <wlan_objmgr_peer_obj.h>
|
||||
#include <wlan_mlo_mgr_public_structs.h>
|
||||
#include <wlan_mlo_t2lm.h>
|
||||
#include <wlan_mlo_mgr_cmn.h>
|
||||
#include <qdf_util.h>
|
||||
|
||||
/**
|
||||
* wlan_mlo_get_hw_link_id_mask() - Return hw_link_id mask for a given
|
||||
* ieee_link_id_mask.
|
||||
* @wlan_vdev_list: vdev list
|
||||
* @vdev_count: vdev count
|
||||
* @ieee_link_id_mask: IEEE link id mask
|
||||
*
|
||||
* Return: hw_link_id mask
|
||||
*/
|
||||
static uint8_t wlan_mlo_get_hw_link_id_mask(
|
||||
struct wlan_objmgr_vdev **wlan_vdev_list,
|
||||
uint16_t vdev_count, uint16_t ieee_link_id_mask)
|
||||
{
|
||||
struct wlan_objmgr_pdev *pdev;
|
||||
struct wlan_objmgr_vdev *vdev;
|
||||
uint8_t link_id;
|
||||
uint16_t ieee_link_id;
|
||||
uint16_t hw_link_id_mask = 0;
|
||||
int i;
|
||||
|
||||
for (link_id = 0; link_id < WLAN_T2LM_MAX_NUM_LINKS; link_id++) {
|
||||
ieee_link_id = ieee_link_id_mask & BIT(link_id);
|
||||
if (!ieee_link_id)
|
||||
continue;
|
||||
|
||||
for (i = 0; i < vdev_count; i++) {
|
||||
vdev = wlan_vdev_list[i];
|
||||
if (!vdev) {
|
||||
t2lm_err("vdev is null");
|
||||
continue;
|
||||
}
|
||||
|
||||
if (ieee_link_id != BIT(vdev->vdev_mlme.mlo_link_id))
|
||||
continue;
|
||||
|
||||
pdev = wlan_vdev_get_pdev(vdev);
|
||||
if (!pdev) {
|
||||
t2lm_err("pdev is null");
|
||||
continue;
|
||||
}
|
||||
|
||||
hw_link_id_mask |=
|
||||
BIT(wlan_mlo_get_pdev_hw_link_id(pdev));
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
return hw_link_id_mask;
|
||||
}
|
||||
|
||||
/**
|
||||
* wlan_mlo_parse_t2lm_provisioned_links() - Parse the T2LM provisioned links
|
||||
* from the T2LM IE.
|
||||
* @peer: Pointer to peer structure
|
||||
* @link_mapping_presence_ind: This indicates whether the link mapping of TIDs
|
||||
* present in the T2LM IE.
|
||||
* @link_mapping_of_tids: Link mapping of each TID
|
||||
* @t2lm: Pointer to a T2LM structure
|
||||
* @dir: DL/UL/BIDI direction
|
||||
*
|
||||
* Return: QDF_STATUS
|
||||
*/
|
||||
static QDF_STATUS wlan_mlo_parse_t2lm_provisioned_links(
|
||||
struct wlan_objmgr_peer *peer,
|
||||
uint8_t link_mapping_presence_ind,
|
||||
uint8_t *link_mapping_of_tids,
|
||||
struct wlan_t2lm_onging_negotiation_info *t2lm,
|
||||
enum wlan_t2lm_direction dir)
|
||||
{
|
||||
struct wlan_objmgr_vdev *vdev;
|
||||
struct wlan_objmgr_vdev *wlan_vdev_list[WLAN_UMAC_MLO_MAX_VDEVS] = {0};
|
||||
uint16_t vdev_count = 0;
|
||||
uint16_t hw_link_id_mask;
|
||||
uint8_t tid_num;
|
||||
uint16_t i;
|
||||
|
||||
vdev = wlan_peer_get_vdev(peer);
|
||||
if (!vdev) {
|
||||
t2lm_err("vdev is null");
|
||||
return QDF_STATUS_E_NULL_VALUE;
|
||||
}
|
||||
|
||||
mlo_get_ml_vdev_list(vdev, &vdev_count, wlan_vdev_list);
|
||||
if (!vdev_count) {
|
||||
t2lm_err("Number of VDEVs under MLD is reported as 0");
|
||||
return QDF_STATUS_E_NULL_VALUE;
|
||||
}
|
||||
|
||||
for (tid_num = 0; tid_num < T2LM_MAX_NUM_TIDS; tid_num++) {
|
||||
if (link_mapping_presence_ind & BIT(tid_num)) {
|
||||
hw_link_id_mask = wlan_mlo_get_hw_link_id_mask(
|
||||
wlan_vdev_list, vdev_count,
|
||||
*(uint16_t *)link_mapping_of_tids);
|
||||
t2lm->t2lm_info[dir].t2lm_provisioned_links[tid_num] =
|
||||
hw_link_id_mask;
|
||||
link_mapping_of_tids += sizeof(uint16_t);
|
||||
}
|
||||
}
|
||||
|
||||
for (i = 0; i < vdev_count; i++)
|
||||
mlo_release_vdev_ref(wlan_vdev_list[i]);
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* wlan_mlo_parse_t2lm_info() - Parse T2LM IE fields
|
||||
* @peer: Pointer to peer structure
|
||||
* @ie: Pointer to T2LM IE
|
||||
* @t2lm: Pointer to T2LM structure
|
||||
*
|
||||
* Return: QDF_STATUS
|
||||
*/
|
||||
static QDF_STATUS wlan_mlo_parse_t2lm_info(
|
||||
struct wlan_objmgr_peer *peer, uint8_t *ie,
|
||||
struct wlan_t2lm_onging_negotiation_info *t2lm)
|
||||
{
|
||||
enum wlan_t2lm_direction dir;
|
||||
uint8_t *t2lm_control_field;
|
||||
uint16_t t2lm_control;
|
||||
uint8_t link_mapping_presence_ind;
|
||||
uint8_t *link_mapping_of_tids;
|
||||
uint8_t tid_num;
|
||||
QDF_STATUS ret;
|
||||
|
||||
t2lm_control_field = ie + sizeof(struct wlan_ie_tid_to_link_mapping);
|
||||
if (!t2lm_control_field) {
|
||||
t2lm_err("t2lm_control_field is null");
|
||||
return QDF_STATUS_E_NULL_VALUE;
|
||||
}
|
||||
|
||||
t2lm_control = *(uint16_t *)t2lm_control_field;
|
||||
|
||||
dir = QDF_GET_BITS(t2lm_control, WLAN_T2LM_CONTROL_DIRECTION_IDX,
|
||||
WLAN_T2LM_CONTROL_DIRECTION_BITS);
|
||||
if (dir > WLAN_T2LM_BIDI_DIRECTION) {
|
||||
t2lm_err("Invalid direction");
|
||||
return QDF_STATUS_E_NULL_VALUE;
|
||||
}
|
||||
|
||||
t2lm->t2lm_info[dir].direction = dir;
|
||||
t2lm->t2lm_info[dir].default_link_mapping =
|
||||
QDF_GET_BITS(t2lm_control,
|
||||
WLAN_T2LM_CONTROL_DEFAULT_LINK_MAPPING_IDX,
|
||||
WLAN_T2LM_CONTROL_DEFAULT_LINK_MAPPING_BITS);
|
||||
|
||||
t2lm_debug("direction:%d default_link_mapping:%d",
|
||||
t2lm->t2lm_info[dir].direction,
|
||||
t2lm->t2lm_info[dir].default_link_mapping);
|
||||
|
||||
/* Link mapping of TIDs are not present when default mapping is set */
|
||||
if (t2lm->t2lm_info[dir].default_link_mapping)
|
||||
return QDF_STATUS_SUCCESS;
|
||||
|
||||
link_mapping_presence_ind = QDF_GET_BITS(
|
||||
t2lm_control,
|
||||
WLAN_T2LM_CONTROL_LINK_MAPPING_PRESENCE_INDICATOR_IDX,
|
||||
WLAN_T2LM_CONTROL_LINK_MAPPING_PRESENCE_INDICATOR_BITS);
|
||||
|
||||
link_mapping_of_tids = t2lm_control_field + sizeof(t2lm_control);
|
||||
|
||||
ret = wlan_mlo_parse_t2lm_provisioned_links(peer,
|
||||
link_mapping_presence_ind,
|
||||
link_mapping_of_tids, t2lm,
|
||||
dir);
|
||||
if (ret) {
|
||||
t2lm_err("failed to populate provisioned links");
|
||||
return ret;
|
||||
}
|
||||
|
||||
for (tid_num = 0; tid_num < T2LM_MAX_NUM_TIDS; tid_num++) {
|
||||
if (link_mapping_presence_ind & BIT(tid_num))
|
||||
t2lm_debug("link mapping of TID%d is %x", tid_num,
|
||||
t2lm->t2lm_info[dir].t2lm_provisioned_links[tid_num]);
|
||||
}
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
QDF_STATUS wlan_mlo_parse_t2lm_ie(
|
||||
struct wlan_objmgr_peer *peer,
|
||||
struct wlan_t2lm_onging_negotiation_info *t2lm, uint8_t *ie)
|
||||
{
|
||||
struct extn_ie_header *ext_ie_hdr;
|
||||
enum wlan_t2lm_direction dir;
|
||||
QDF_STATUS retval;
|
||||
|
||||
if (!peer) {
|
||||
t2lm_err("null peer");
|
||||
return QDF_STATUS_E_NULL_VALUE;
|
||||
}
|
||||
|
||||
for (dir = 0; dir < WLAN_T2LM_MAX_DIRECTION; dir++)
|
||||
t2lm->t2lm_info[dir].direction = WLAN_T2LM_INVALID_DIRECTION;
|
||||
|
||||
for (dir = 0; dir < WLAN_T2LM_MAX_DIRECTION; dir++) {
|
||||
if (!ie) {
|
||||
t2lm_err("ie is null");
|
||||
return QDF_STATUS_E_NULL_VALUE;
|
||||
}
|
||||
|
||||
ext_ie_hdr = (struct extn_ie_header *)ie;
|
||||
|
||||
if (ext_ie_hdr->ie_id == WLAN_ELEMID_EXTN_ELEM &&
|
||||
ext_ie_hdr->ie_extn_id == WLAN_EXTN_ELEMID_T2LM) {
|
||||
retval = wlan_mlo_parse_t2lm_info(peer, ie, t2lm);
|
||||
if (retval) {
|
||||
t2lm_err("Failed to parse the T2LM IE");
|
||||
return retval;
|
||||
}
|
||||
ie += ext_ie_hdr->ie_len + sizeof(struct ie_header);
|
||||
}
|
||||
}
|
||||
|
||||
if ((t2lm->t2lm_info[WLAN_T2LM_DL_DIRECTION].direction ==
|
||||
WLAN_T2LM_DL_DIRECTION ||
|
||||
t2lm->t2lm_info[WLAN_T2LM_UL_DIRECTION].direction ==
|
||||
WLAN_T2LM_UL_DIRECTION) &&
|
||||
t2lm->t2lm_info[WLAN_T2LM_BIDI_DIRECTION].direction ==
|
||||
WLAN_T2LM_BIDI_DIRECTION) {
|
||||
t2lm_err("Both DL/UL and BIDI T2LM IEs should not be present at the same time");
|
||||
|
||||
qdf_mem_zero(t2lm, sizeof(*t2lm));
|
||||
for (dir = 0; dir < WLAN_T2LM_MAX_DIRECTION; dir++) {
|
||||
t2lm->t2lm_info[dir].direction =
|
||||
WLAN_T2LM_INVALID_DIRECTION;
|
||||
}
|
||||
|
||||
return QDF_STATUS_E_FAILURE;
|
||||
}
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* wlan_get_ieee_link_id_mask() - Get ieee_link_id mask from hw_link_id mask
|
||||
* @wlan_vdev_list: Pointer to vdev list
|
||||
* @vdev_count: vdev count
|
||||
* @hw_link_id_mask: hw_link_id mask
|
||||
*
|
||||
* Return: IEEE link ID mask
|
||||
*/
|
||||
static uint8_t wlan_get_ieee_link_id_mask(
|
||||
struct wlan_objmgr_vdev **wlan_vdev_list,
|
||||
uint16_t vdev_count, uint16_t hw_link_id_mask)
|
||||
{
|
||||
struct wlan_objmgr_pdev *pdev;
|
||||
struct wlan_objmgr_vdev *vdev;
|
||||
uint8_t link_id;
|
||||
uint16_t hw_link_id;
|
||||
uint16_t ieee_link_id_mask = 0;
|
||||
int i;
|
||||
|
||||
for (link_id = 0; link_id < WLAN_T2LM_MAX_NUM_LINKS; link_id++) {
|
||||
hw_link_id = hw_link_id_mask & BIT(link_id);
|
||||
if (!hw_link_id)
|
||||
continue;
|
||||
|
||||
for (i = 0; i < vdev_count; i++) {
|
||||
vdev = wlan_vdev_list[i];
|
||||
if (!vdev) {
|
||||
t2lm_err("vdev is null");
|
||||
continue;
|
||||
}
|
||||
|
||||
pdev = wlan_vdev_get_pdev(vdev);
|
||||
if (!pdev) {
|
||||
t2lm_err("pdev is null");
|
||||
continue;
|
||||
}
|
||||
|
||||
if (hw_link_id != BIT(wlan_mlo_get_pdev_hw_link_id(pdev)))
|
||||
continue;
|
||||
|
||||
ieee_link_id_mask |= BIT(vdev->vdev_mlme.mlo_link_id);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
return ieee_link_id_mask;
|
||||
}
|
||||
|
||||
/**
|
||||
* wlan_mlo_add_t2lm_provisioned_links() - API to add provisioned links in the
|
||||
* T2LM IE
|
||||
* @peer: Pointer to peer structure
|
||||
* @link_mapping_presence_indicator: This indicates whether the link mapping of
|
||||
* TIDs present in the T2LM IE.
|
||||
* @link_mapping_of_tids: Link mapping of each TID
|
||||
* @t2lm: Pointer to a T2LM structure
|
||||
* @num_tids: Pointer to save num TIDs
|
||||
*
|
||||
* Return: QDF_STATUS
|
||||
*/
|
||||
static QDF_STATUS wlan_mlo_add_t2lm_provisioned_links(
|
||||
struct wlan_objmgr_peer *peer,
|
||||
uint8_t link_mapping_presence_indicator,
|
||||
uint8_t *link_mapping_of_tids, struct wlan_t2lm_of_tids *t2lm,
|
||||
uint8_t *num_tids)
|
||||
{
|
||||
struct wlan_objmgr_vdev *vdev;
|
||||
struct wlan_objmgr_vdev *wlan_vdev_list[WLAN_UMAC_MLO_MAX_VDEVS] = {0};
|
||||
uint16_t vdev_count = 0;
|
||||
uint16_t hw_link_id_mask;
|
||||
uint16_t ieee_link_id_mask;
|
||||
uint8_t tid_num;
|
||||
uint16_t i;
|
||||
|
||||
vdev = wlan_peer_get_vdev(peer);
|
||||
if (!vdev) {
|
||||
t2lm_err("vdev is null");
|
||||
return QDF_STATUS_E_NULL_VALUE;
|
||||
}
|
||||
|
||||
mlo_get_ml_vdev_list(vdev, &vdev_count, wlan_vdev_list);
|
||||
if (!vdev_count) {
|
||||
t2lm_err("Number of VDEVs under MLD is reported as 0");
|
||||
return QDF_STATUS_E_NULL_VALUE;
|
||||
}
|
||||
|
||||
for (tid_num = 0; tid_num < T2LM_MAX_NUM_TIDS; tid_num++) {
|
||||
ieee_link_id_mask = 0;
|
||||
|
||||
if (t2lm->t2lm_provisioned_links[tid_num]) {
|
||||
hw_link_id_mask = t2lm->t2lm_provisioned_links[tid_num];
|
||||
ieee_link_id_mask = wlan_get_ieee_link_id_mask(
|
||||
wlan_vdev_list, vdev_count,
|
||||
hw_link_id_mask);
|
||||
}
|
||||
|
||||
*(uint16_t *)link_mapping_of_tids = ieee_link_id_mask;
|
||||
t2lm_info("link mapping of TID%d is %x", tid_num,
|
||||
ieee_link_id_mask);
|
||||
link_mapping_of_tids += sizeof(uint16_t);
|
||||
(*num_tids)++;
|
||||
}
|
||||
|
||||
for (i = 0; i < vdev_count; i++)
|
||||
mlo_release_vdev_ref(wlan_vdev_list[i]);
|
||||
|
||||
return QDF_STATUS_SUCCESS;
|
||||
}
|
||||
|
||||
/**
|
||||
* wlan_add_t2lm_info_ie() - Add T2LM IE for UL/DL/Bidirection
|
||||
* @frm: Pointer to buffer
|
||||
* @peer: Pointer to peer structure
|
||||
* @t2lm: Pointer to t2lm mapping structure
|
||||
*
|
||||
* Return: Updated frame pointer
|
||||
*/
|
||||
static uint8_t *wlan_add_t2lm_info_ie(uint8_t *frm,
|
||||
struct wlan_objmgr_peer *peer,
|
||||
struct wlan_t2lm_of_tids *t2lm)
|
||||
{
|
||||
struct wlan_ie_tid_to_link_mapping *t2lm_ie;
|
||||
uint16_t t2lm_control = 0;
|
||||
uint8_t *t2lm_control_field;
|
||||
uint8_t *link_mapping_of_tids;
|
||||
uint8_t tid_num;
|
||||
uint8_t num_tids = 0;
|
||||
uint8_t link_mapping_presence_indicator = 0;
|
||||
uint8_t *efrm = frm;
|
||||
int ret;
|
||||
|
||||
t2lm_ie = (struct wlan_ie_tid_to_link_mapping *)frm;
|
||||
t2lm_ie->elem_id = WLAN_ELEMID_EXTN_ELEM;
|
||||
t2lm_ie->elem_id_extn = WLAN_EXTN_ELEMID_T2LM;
|
||||
|
||||
t2lm_ie->elem_len = sizeof(*t2lm_ie) - sizeof(struct ie_header);
|
||||
|
||||
t2lm_control_field = t2lm_ie->data;
|
||||
|
||||
QDF_SET_BITS(t2lm_control, WLAN_T2LM_CONTROL_DIRECTION_IDX,
|
||||
WLAN_T2LM_CONTROL_DIRECTION_BITS, t2lm->direction);
|
||||
|
||||
QDF_SET_BITS(t2lm_control, WLAN_T2LM_CONTROL_DEFAULT_LINK_MAPPING_IDX,
|
||||
WLAN_T2LM_CONTROL_DEFAULT_LINK_MAPPING_BITS,
|
||||
t2lm->default_link_mapping);
|
||||
|
||||
if (t2lm->default_link_mapping) {
|
||||
/* Link mapping of TIDs are not present when default mapping is
|
||||
* set. Hence, the size of TID-To-Link mapping control is one
|
||||
* octet.
|
||||
*/
|
||||
*t2lm_control_field = (uint8_t)t2lm_control;
|
||||
|
||||
t2lm_ie->elem_len += sizeof(uint8_t);
|
||||
|
||||
t2lm_info("T2LM IE added, default_link_mapping: %d dir:%d",
|
||||
t2lm->default_link_mapping, t2lm->direction);
|
||||
|
||||
frm += sizeof(*t2lm_ie) + sizeof(uint8_t);
|
||||
} else {
|
||||
for (tid_num = 0; tid_num < T2LM_MAX_NUM_TIDS; tid_num++)
|
||||
if (t2lm->t2lm_provisioned_links[tid_num])
|
||||
link_mapping_presence_indicator |= BIT(tid_num);
|
||||
|
||||
QDF_SET_BITS(t2lm_control,
|
||||
WLAN_T2LM_CONTROL_LINK_MAPPING_PRESENCE_INDICATOR_IDX,
|
||||
WLAN_T2LM_CONTROL_LINK_MAPPING_PRESENCE_INDICATOR_BITS,
|
||||
link_mapping_presence_indicator);
|
||||
t2lm_info("T2LM IE added, direction:%d link_mapping_presence_indicator:%x",
|
||||
t2lm->direction, link_mapping_presence_indicator);
|
||||
|
||||
/* The size of TID-To-Link mapping control is two octets when
|
||||
* default link mapping is not set.
|
||||
*/
|
||||
*(uint16_t *)t2lm_control_field = htole16(t2lm_control);
|
||||
|
||||
link_mapping_of_tids = t2lm_control_field + sizeof(uint16_t);
|
||||
|
||||
ret = wlan_mlo_add_t2lm_provisioned_links(
|
||||
peer, link_mapping_presence_indicator,
|
||||
link_mapping_of_tids, t2lm, &num_tids);
|
||||
if (ret) {
|
||||
t2lm_err("Failed to add t2lm provisioned links");
|
||||
return efrm;
|
||||
}
|
||||
|
||||
t2lm_ie->elem_len += sizeof(uint16_t) +
|
||||
(num_tids * sizeof(uint16_t));
|
||||
|
||||
frm += sizeof(*t2lm_ie) + sizeof(uint16_t) +
|
||||
(num_tids * sizeof(uint16_t));
|
||||
}
|
||||
|
||||
return frm;
|
||||
}
|
||||
|
||||
uint8_t *wlan_mlo_add_t2lm_ie(uint8_t *frm, struct wlan_objmgr_peer *peer,
|
||||
struct wlan_t2lm_onging_negotiation_info *t2lm)
|
||||
{
|
||||
uint8_t dir;
|
||||
|
||||
if (!frm) {
|
||||
t2lm_err("frm is null");
|
||||
return NULL;
|
||||
}
|
||||
|
||||
if (!t2lm) {
|
||||
t2lm_err("t2lm is null");
|
||||
return NULL;
|
||||
}
|
||||
|
||||
/* As per spec, the frame should include one or two T2LM IEs. When it is
|
||||
* two, then direction should DL and UL.
|
||||
*/
|
||||
if ((t2lm->t2lm_info[WLAN_T2LM_DL_DIRECTION].direction ==
|
||||
WLAN_T2LM_DL_DIRECTION ||
|
||||
t2lm->t2lm_info[WLAN_T2LM_UL_DIRECTION].direction ==
|
||||
WLAN_T2LM_UL_DIRECTION) &&
|
||||
t2lm->t2lm_info[WLAN_T2LM_BIDI_DIRECTION].direction ==
|
||||
WLAN_T2LM_BIDI_DIRECTION) {
|
||||
t2lm_err("Both DL/UL and BIDI T2LM IEs should not be present at the same time");
|
||||
return NULL;
|
||||
}
|
||||
|
||||
for (dir = 0; dir < WLAN_T2LM_MAX_DIRECTION; dir++) {
|
||||
if (t2lm->t2lm_info[dir].direction !=
|
||||
WLAN_T2LM_INVALID_DIRECTION)
|
||||
frm = wlan_add_t2lm_info_ie(frm, peer,
|
||||
&t2lm->t2lm_info[dir]);
|
||||
}
|
||||
|
||||
return frm;
|
||||
}
|
||||
مرجع در شماره جدید
Block a user