From b201998fe9fc2dc6890a57b16d0b299f1c0ed4f7 Mon Sep 17 00:00:00 2001 From: Thomson Kang Date: Fri, 7 Aug 2020 13:10:38 +0900 Subject: Initial Drop for bcm4389, 2020.08.07 Version : 101.10.355 Bug: 162998780 Test: Make sure it builds, starts at boot, and passes smoke test Signed-off-by: Thomson Kang Change-Id: Iba369c92c096a3bcf25ada42ad6a80ac78ecb43d Signed-off-by: Ahmed ElArabawy --- frag.c | 108 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 108 insertions(+) create mode 100644 frag.c (limited to 'frag.c') diff --git a/frag.c b/frag.c new file mode 100644 index 0000000..e49c335 --- /dev/null +++ b/frag.c @@ -0,0 +1,108 @@ +/* + * 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. + * + * + * <> + */ + +#include +#include +#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); +} -- cgit v1.2.3