luckfox-pico-sdk/sysdrv/drv_ko/wifi/bcmdhd/frag.c
luckfox-eng29 8f34c2760d project:build.sh: Added fastboot support; custom modifications to U-Boot and kernel implemented using patches.
project:cfg:BoardConfig_IPC: Added fastboot BoardConfig file and firmware post-scripts, distinguishing between
the BoardConfigs for Luckfox Pico Pro and Luckfox Pico Max. project:app: Added fastboot_client and rk_smart_door
for quick boot applications; updated rkipc app to adapt to the latest media library. media:samples: Added more
usage examples. media:rockit: Fixed bugs; removed support for retrieving data frames from VPSS. media:isp:
Updated rkaiq library and related tools to support connection to RKISP_Tuner. sysdrv:Makefile: Added support for
compiling drv_ko on Luckfox Pico Ultra W using Ubuntu; added support for custom root filesystem.
sysdrv:tools:board: Updated Buildroot optional mirror sources, updated some software versions, and stored device
tree files and configuration files that undergo multiple modifications for U-Boot and kernel separately.
sysdrv:source:mcu: Used RISC-V MCU SDK with RT-Thread system, mainly for initializing camera AE during quick
boot. sysdrv:source:uboot: Added support for fastboot; added high baud rate DDR bin for serial firmware upgrades.
sysdrv:source:kernel: Upgraded to version 5.10.160; increased NPU frequency for RV1106G3; added support for
fastboot.

Signed-off-by: luckfox-eng29 <eng29@luckfox.com>
2024-10-14 09:47:04 +08:00

109 lines
3.0 KiB
C

/*
* IE/TLV fragmentation/defragmentation support for
* Broadcom 802.11bang Networking Device Driver
*
* Copyright (C) 2020, Broadcom.
*
* Unless you and Broadcom execute a separate written software license
* agreement governing use of this software, this software is licensed to you
* under the terms of the GNU General Public License version 2 (the "GPL"),
* available at http://www.broadcom.com/licenses/GPLv2.php, with the
* following added to such license:
*
* As a special exception, the copyright holders of this software give you
* permission to link this software with independent modules, and to copy and
* distribute the resulting executable under terms of your choice, provided that
* you also meet, for each linked independent module, the terms and conditions of
* the license of that module. An independent module is a module which is not
* derived from this software. The special exception does not apply to any
* modifications of the software.
*
*
* <<Broadcom-WL-IPTag/Dual:>>
*/
#include <bcmutils.h>
#include <frag.h>
#include <802.11.h>
/* defrag a fragmented dot11 ie/tlv. if space does not permit, return the needed
* ie length to contain all the fragments with status BCME_BUFTOOSHORT.
* out_len is in/out parameter, max length on input, used/required length on output
*/
int
bcm_tlv_dot11_defrag(const void *buf, uint buf_len, uint8 id, bool id_ext,
uint8 *out, uint *out_len)
{
int err = BCME_OK;
const bcm_tlv_t *ie;
uint tot_len = 0;
uint out_left;
/* find the ie; includes validation */
ie = bcm_parse_tlvs_dot11(buf, buf_len, id, id_ext);
if (!ie) {
err = BCME_IE_NOTFOUND;
goto done;
}
out_left = (out && out_len) ? *out_len : 0;
/* first fragment */
tot_len = id_ext ? ie->len - 1 : ie->len;
/* copy out if output space permits */
if (out_left < tot_len) {
err = BCME_BUFTOOSHORT;
out_left = 0; /* prevent further copy */
} else {
memcpy(out, &ie->data[id_ext ? 1 : 0], tot_len);
out += tot_len;
out_left -= tot_len;
}
/* if not fragmened or not fragmentable per 802.11 table 9-77 11md0.1 bail
* we can introduce the latter check later
*/
if (ie->len != BCM_TLV_MAX_DATA_SIZE) {
goto done;
}
/* adjust buf_len to length after ie including it */
buf_len -= (uint)(((const uint8 *)ie - (const uint8 *)buf));
/* update length from fragments, okay if no next ie */
while ((ie = bcm_next_tlv(ie, &buf_len)) &&
(ie->id == DOT11_MNG_FRAGMENT_ID)) {
/* note: buf_len starts at next ie and last frag may be partial */
if (out_left < ie->len) {
err = BCME_BUFTOOSHORT;
out_left = 0;
} else {
memcpy(out, &ie->data[0], ie->len);
out += ie->len;
out_left -= ie->len;
}
tot_len += ie->len + BCM_TLV_HDR_SIZE;
/* all but last should be of max size */
if (ie->len < BCM_TLV_MAX_DATA_SIZE) {
break;
}
}
done:
if (out_len) {
*out_len = tot_len;
}
return err;
}
int
bcm_tlv_dot11_frag_tot_len(const void *buf, uint buf_len,
uint8 id, bool id_ext, uint *ie_len)
{
return bcm_tlv_dot11_defrag(buf, buf_len, id, id_ext, NULL, ie_len);
}