1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248 |
- /*
- * Copyright (c) 2017-2021 The Linux Foundation. All rights reserved.
- * Copyright (c) 2022-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: This file contains definition for mandatory legacy API
- */
- #include "qdf_str.h"
- #include "wlan_utility.h"
- #include <wlan_cmn.h>
- #include "wlan_osif_priv.h"
- #include <net/cfg80211.h>
- #include <qdf_module.h>
- #include <wlan_vdev_mlme_api.h>
- #include "cfg_ucfg_api.h"
- #include <wlan_serialization_api.h>
- /* CRC polynomial 0xedb88320 */
- static unsigned long const wlan_shortssid_table[] = {
- 0x00000000, 0x77073096, 0xee0e612c, 0x990951ba, 0x076dc419, 0x706af48f,
- 0xe963a535, 0x9e6495a3, 0x0edb8832, 0x79dcb8a4, 0xe0d5e91e, 0x97d2d988,
- 0x09b64c2b, 0x7eb17cbd, 0xe7b82d07, 0x90bf1d91, 0x1db71064, 0x6ab020f2,
- 0xf3b97148, 0x84be41de, 0x1adad47d, 0x6ddde4eb, 0xf4d4b551, 0x83d385c7,
- 0x136c9856, 0x646ba8c0, 0xfd62f97a, 0x8a65c9ec, 0x14015c4f, 0x63066cd9,
- 0xfa0f3d63, 0x8d080df5, 0x3b6e20c8, 0x4c69105e, 0xd56041e4, 0xa2677172,
- 0x3c03e4d1, 0x4b04d447, 0xd20d85fd, 0xa50ab56b, 0x35b5a8fa, 0x42b2986c,
- 0xdbbbc9d6, 0xacbcf940, 0x32d86ce3, 0x45df5c75, 0xdcd60dcf, 0xabd13d59,
- 0x26d930ac, 0x51de003a, 0xc8d75180, 0xbfd06116, 0x21b4f4b5, 0x56b3c423,
- 0xcfba9599, 0xb8bda50f, 0x2802b89e, 0x5f058808, 0xc60cd9b2, 0xb10be924,
- 0x2f6f7c87, 0x58684c11, 0xc1611dab, 0xb6662d3d, 0x76dc4190, 0x01db7106,
- 0x98d220bc, 0xefd5102a, 0x71b18589, 0x06b6b51f, 0x9fbfe4a5, 0xe8b8d433,
- 0x7807c9a2, 0x0f00f934, 0x9609a88e, 0xe10e9818, 0x7f6a0dbb, 0x086d3d2d,
- 0x91646c97, 0xe6635c01, 0x6b6b51f4, 0x1c6c6162, 0x856530d8, 0xf262004e,
- 0x6c0695ed, 0x1b01a57b, 0x8208f4c1, 0xf50fc457, 0x65b0d9c6, 0x12b7e950,
- 0x8bbeb8ea, 0xfcb9887c, 0x62dd1ddf, 0x15da2d49, 0x8cd37cf3, 0xfbd44c65,
- 0x4db26158, 0x3ab551ce, 0xa3bc0074, 0xd4bb30e2, 0x4adfa541, 0x3dd895d7,
- 0xa4d1c46d, 0xd3d6f4fb, 0x4369e96a, 0x346ed9fc, 0xad678846, 0xda60b8d0,
- 0x44042d73, 0x33031de5, 0xaa0a4c5f, 0xdd0d7cc9, 0x5005713c, 0x270241aa,
- 0xbe0b1010, 0xc90c2086, 0x5768b525, 0x206f85b3, 0xb966d409, 0xce61e49f,
- 0x5edef90e, 0x29d9c998, 0xb0d09822, 0xc7d7a8b4, 0x59b33d17, 0x2eb40d81,
- 0xb7bd5c3b, 0xc0ba6cad, 0xedb88320, 0x9abfb3b6, 0x03b6e20c, 0x74b1d29a,
- 0xead54739, 0x9dd277af, 0x04db2615, 0x73dc1683, 0xe3630b12, 0x94643b84,
- 0x0d6d6a3e, 0x7a6a5aa8, 0xe40ecf0b, 0x9309ff9d, 0x0a00ae27, 0x7d079eb1,
- 0xf00f9344, 0x8708a3d2, 0x1e01f268, 0x6906c2fe, 0xf762575d, 0x806567cb,
- 0x196c3671, 0x6e6b06e7, 0xfed41b76, 0x89d32be0, 0x10da7a5a, 0x67dd4acc,
- 0xf9b9df6f, 0x8ebeeff9, 0x17b7be43, 0x60b08ed5, 0xd6d6a3e8, 0xa1d1937e,
- 0x38d8c2c4, 0x4fdff252, 0xd1bb67f1, 0xa6bc5767, 0x3fb506dd, 0x48b2364b,
- 0xd80d2bda, 0xaf0a1b4c, 0x36034af6, 0x41047a60, 0xdf60efc3, 0xa867df55,
- 0x316e8eef, 0x4669be79, 0xcb61b38c, 0xbc66831a, 0x256fd2a0, 0x5268e236,
- 0xcc0c7795, 0xbb0b4703, 0x220216b9, 0x5505262f, 0xc5ba3bbe, 0xb2bd0b28,
- 0x2bb45a92, 0x5cb36a04, 0xc2d7ffa7, 0xb5d0cf31, 0x2cd99e8b, 0x5bdeae1d,
- 0x9b64c2b0, 0xec63f226, 0x756aa39c, 0x026d930a, 0x9c0906a9, 0xeb0e363f,
- 0x72076785, 0x05005713, 0x95bf4a82, 0xe2b87a14, 0x7bb12bae, 0x0cb61b38,
- 0x92d28e9b, 0xe5d5be0d, 0x7cdcefb7, 0x0bdbdf21, 0x86d3d2d4, 0xf1d4e242,
- 0x68ddb3f8, 0x1fda836e, 0x81be16cd, 0xf6b9265b, 0x6fb077e1, 0x18b74777,
- 0x88085ae6, 0xff0f6a70, 0x66063bca, 0x11010b5c, 0x8f659eff, 0xf862ae69,
- 0x616bffd3, 0x166ccf45, 0xa00ae278, 0xd70dd2ee, 0x4e048354, 0x3903b3c2,
- 0xa7672661, 0xd06016f7, 0x4969474d, 0x3e6e77db, 0xaed16a4a, 0xd9d65adc,
- 0x40df0b66, 0x37d83bf0, 0xa9bcae53, 0xdebb9ec5, 0x47b2cf7f, 0x30b5ffe9,
- 0xbdbdf21c, 0xcabac28a, 0x53b39330, 0x24b4a3a6, 0xbad03605, 0xcdd70693,
- 0x54de5729, 0x23d967bf, 0xb3667a2e, 0xc4614ab8, 0x5d681b02, 0x2a6f2b94,
- 0xb40bbe37, 0xc30c8ea1, 0x5a05df1b, 0x2d02ef8d
- };
- uint32_t wlan_construct_shortssid(uint8_t *ssid, uint8_t ssid_len)
- {
- uint32_t shortssid = 0xffffffff;
- uint8_t i;
- if (!ssid || ssid_len > WLAN_SSID_MAX_LEN)
- return shortssid;
- for (i = 0; i < ssid_len; i++)
- shortssid = wlan_shortssid_table[(shortssid ^ ssid[i]) & 0xff] ^
- (shortssid >> 8);
- return (shortssid ^ 0xffffffff);
- }
- uint32_t wlan_chan_to_freq(uint8_t chan)
- {
- if (chan == 0 )
- return 0;
- if (chan < WLAN_24_GHZ_CHANNEL_14)
- return WLAN_24_GHZ_BASE_FREQ + chan * WLAN_CHAN_SPACING_5MHZ;
- else if (chan == WLAN_24_GHZ_CHANNEL_14)
- return WLAN_CHAN_14_FREQ;
- else if (chan < WLAN_24_GHZ_CHANNEL_27)
- /* ch 15 - ch 26 */
- return WLAN_CHAN_15_FREQ +
- (chan - WLAN_24_GHZ_CHANNEL_15) * WLAN_CHAN_SPACING_20MHZ;
- else if (chan == WLAN_5_GHZ_CHANNEL_170)
- return WLAN_CHAN_170_FREQ;
- else
- return WLAN_5_GHZ_BASE_FREQ + chan * WLAN_CHAN_SPACING_5MHZ;
- }
- uint8_t wlan_freq_to_chan(uint32_t freq)
- {
- uint8_t chan;
- if (freq == 0)
- return 0;
- if (freq > WLAN_24_GHZ_BASE_FREQ && freq < WLAN_CHAN_14_FREQ)
- chan = ((freq - WLAN_24_GHZ_BASE_FREQ) /
- WLAN_CHAN_SPACING_5MHZ);
- else if (freq == WLAN_CHAN_14_FREQ)
- chan = WLAN_24_GHZ_CHANNEL_14;
- else if ((freq > WLAN_24_GHZ_BASE_FREQ) &&
- (freq < WLAN_5_GHZ_BASE_FREQ))
- chan = (((freq - WLAN_CHAN_15_FREQ) /
- WLAN_CHAN_SPACING_20MHZ) +
- WLAN_24_GHZ_CHANNEL_15);
- else
- chan = (freq - WLAN_5_GHZ_BASE_FREQ) /
- WLAN_CHAN_SPACING_5MHZ;
- return chan;
- }
- void
- wlan_get_320_center_freq(qdf_freq_t freq,
- qdf_freq_t *center_freq1,
- qdf_freq_t *center_freq2)
- {
- *center_freq1 = 0;
- *center_freq2 = 0;
- if ((freq >= 5500) && (freq <= 5800)) {
- *center_freq1 = 5650;
- } else if ((freq >= 5955) && (freq <= 6095)) {
- *center_freq1 = 6105;
- } else if ((freq >= 6115) && (freq <= 6255)) {
- *center_freq1 = 6105;
- *center_freq2 = 6265;
- } else if ((freq >= 6275) && (freq <= 6415)) {
- *center_freq1 = 6265;
- *center_freq2 = 6425;
- } else if ((freq >= 6435) && (freq <= 6575)) {
- *center_freq1 = 6425;
- *center_freq2 = 6585;
- } else if ((freq >= 6595) && (freq <= 6735)) {
- *center_freq1 = 6585;
- *center_freq2 = 6745;
- } else if ((freq >= 6755) && (freq <= 6895)) {
- *center_freq1 = 6745;
- *center_freq2 = 6905;
- } else if ((freq >= 6915) && (freq <= 7055)) {
- *center_freq1 = 6905;
- }
- }
- bool wlan_is_ie_valid(const uint8_t *ie, size_t ie_len)
- {
- uint8_t elen;
- while (ie_len) {
- if (ie_len < 2)
- return false;
- elen = ie[1];
- ie_len -= 2;
- ie += 2;
- if (elen > ie_len)
- return false;
- ie_len -= elen;
- ie += elen;
- }
- return true;
- }
- static const uint8_t *wlan_get_ie_ptr_from_eid_n_oui(uint8_t eid,
- const uint8_t *oui,
- uint8_t oui_size,
- const uint8_t *ie,
- uint16_t ie_len)
- {
- int32_t left = ie_len;
- const uint8_t *ptr = ie;
- uint8_t elem_id, elem_len;
- while (left >= 2) {
- elem_id = ptr[0];
- elem_len = ptr[1];
- left -= 2;
- if (elem_len > left)
- return NULL;
- if (eid == elem_id) {
- /* if oui is not provide eid match is enough */
- if (!oui)
- return ptr;
- /*
- * if oui is provided and oui_size is more than left
- * bytes, then we cannot have match
- */
- if (oui_size > left)
- return NULL;
- if (qdf_mem_cmp(&ptr[2], oui, oui_size) == 0)
- return ptr;
- }
- left -= elem_len;
- ptr += (elem_len + 2);
- }
- return NULL;
- }
- const uint8_t *wlan_get_ie_ptr_from_eid(uint8_t eid,
- const uint8_t *ie,
- int ie_len)
- {
- return wlan_get_ie_ptr_from_eid_n_oui(eid, NULL, 0, ie, ie_len);
- }
- const uint8_t *wlan_get_vendor_ie_ptr_from_oui(const uint8_t *oui,
- uint8_t oui_size,
- const uint8_t *ie,
- uint16_t ie_len)
- {
- return wlan_get_ie_ptr_from_eid_n_oui(WLAN_MAC_EID_VENDOR,
- oui, oui_size, ie, ie_len);
- }
- const uint8_t *wlan_get_ext_ie_ptr_from_ext_id(const uint8_t *oui,
- uint8_t oui_size,
- const uint8_t *ie,
- uint16_t ie_len)
- {
- return wlan_get_ie_ptr_from_eid_n_oui(WLAN_MAC_EID_EXT,
- oui, oui_size, ie, ie_len);
- }
- static inline
- QDF_STATUS wlan_get_elemunit_info(bool is_subelem,
- uint8_t subelemfragid,
- uint8_t *elemunit_fragid,
- qdf_size_t *elemunit_hdrlen,
- qdf_size_t *elemunit_maxpayloadlen,
- int *elemunit_id_pos,
- int *elemunit_len_pos,
- int *elemunit_idext_pos)
- {
- /* Helper function to populate information about the given element unit.
- * Here, an 'element unit' refers to either an 802.11 element or a
- * 802.11 subelement.
- *
- * Populating this information in a central helper here allows for
- * better control over handling of future variances, and also for common
- * code for handling different types of element units.
- */
- if (is_subelem) {
- /* Populate the subelement header length */
- if (elemunit_hdrlen)
- *elemunit_hdrlen = sizeof(struct subelem_header);
- /* Populate the subelement's max payload length */
- if (elemunit_maxpayloadlen)
- *elemunit_maxpayloadlen = WLAN_MAX_SUBELEM_LEN;
- /* Populate the index position for the subelement ID */
- if (elemunit_id_pos)
- *elemunit_id_pos = qdf_offsetof(struct subelem_header,
- subelem_id);
- /* Populate the index position for the subelement length */
- if (elemunit_len_pos)
- *elemunit_len_pos = qdf_offsetof(struct subelem_header,
- subelem_len);
- /* Mark that there is (currently) no valid value for subelement
- * ID extension.
- */
- if (elemunit_idext_pos)
- *elemunit_idext_pos = -1;
- /* Populate the subelement fragment ID (which can vary by
- * protocol area). This could also have been directly populated
- * by the caller, but we populate it here for uniformity and
- * future control of variability.
- */
- if (elemunit_fragid)
- *elemunit_fragid = subelemfragid;
- } else {
- /* Populate the element header length */
- if (elemunit_hdrlen)
- *elemunit_hdrlen = sizeof(struct ie_header);
- /* Populate the element's max payload length */
- if (elemunit_maxpayloadlen)
- *elemunit_maxpayloadlen = WLAN_MAX_IE_LEN;
- /* Populate the index position for the element ID */
- if (elemunit_id_pos)
- *elemunit_id_pos = qdf_offsetof(struct ie_header,
- ie_id);
- /* Populate the index position for the element length */
- if (elemunit_len_pos)
- *elemunit_len_pos = qdf_offsetof(struct ie_header,
- ie_len);
- /* Populate the index position for the element ID extension
- */
- if (elemunit_idext_pos)
- *elemunit_idext_pos =
- qdf_offsetof(struct extn_ie_header, ie_extn_id);
- /* Populate the element fragment ID. */
- if (elemunit_fragid)
- *elemunit_fragid = WLAN_ELEMID_FRAGMENT;
- }
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS
- wlan_get_elemsubelem_fragseq_creationparams(bool is_subelem,
- uint8_t id,
- qdf_size_t payloadlen,
- bool *is_frag_required,
- qdf_size_t *expected_fragseqlen,
- qdf_size_t *prepayload_leadbytes,
- uint32_t *num_maxsizefrags,
- qdf_size_t *smallerfrag_size,
- qdf_size_t *extrahdrbytes)
- {
- /* elemunit, i.e. 'element unit' here refers to either an 802.11 element
- * or a 802.11 subelement.
- */
- qdf_size_t elemunit_hdrlen;
- qdf_size_t elemunit_maxpayloadlen;
- qdf_size_t tmp_expected_fragseqlen;
- qdf_size_t tmp_prepayload_leadbytes;
- uint32_t tmp_num_maxsizefrags;
- qdf_size_t tmp_smallerfrag_size;
- qdf_size_t tmp_extrahdrbytes;
- QDF_STATUS ret;
- /* Helper function to determine element or subelement fragment sequence
- * creation parameters. Currently, this helper determines the following
- * parameters (it is mandatory for the caller to provide the pointer
- * for the first parameter, those for the remaining are optional):
- *
- * - Whether fragmentation is required
- * If fragmentation is required then the following are determined, else
- * they should be ignored by the caller:
- * - Expected fragment sequence length (inclusive of payload and all
- * headers)
- * - The lead bytes that occur before the payload (i.e. the lead
- * element/subelement's header, and if applicable, the element's
- * element ID extension)
- * - The number of max sized fragments (inclusive of the lead element)
- * - The size of the smaller sized fragment at the end (non-zero if such
- * a fragment would be present, zero if it would be absent)
- * - The number of extra header bytes that would be introduced (not
- * inclusive of the header of the lead fragment).
- */
- if (!is_frag_required) {
- qdf_nofl_err("Pointer to indication of whether fragmentation is required or not is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- ret = wlan_get_elemunit_info(is_subelem,
- 0,
- NULL,
- &elemunit_hdrlen,
- &elemunit_maxpayloadlen,
- NULL,
- NULL,
- NULL);
- if (QDF_IS_STATUS_ERROR(ret)) {
- qdf_rl_nofl_err("Get elem unit info: Error %d",
- ret);
- return QDF_STATUS_E_FAILURE;
- }
- if (!is_subelem && (id == WLAN_ELEMID_EXTN_ELEM)) {
- if (payloadlen <= (elemunit_maxpayloadlen - 1)) {
- *is_frag_required = false;
- return QDF_STATUS_SUCCESS;
- }
- } else {
- if (payloadlen <= elemunit_maxpayloadlen) {
- *is_frag_required = false;
- return QDF_STATUS_SUCCESS;
- }
- }
- *is_frag_required = true;
- if (!expected_fragseqlen &&
- !prepayload_leadbytes && !num_maxsizefrags &&
- !smallerfrag_size && !extrahdrbytes)
- return QDF_STATUS_SUCCESS;
- tmp_expected_fragseqlen = 0;
- tmp_prepayload_leadbytes = 0;
- tmp_num_maxsizefrags = 0;
- tmp_smallerfrag_size = 0;
- tmp_extrahdrbytes = 0;
- /* As per the standard, the information to be fragmented is divided into
- * M + N portions, where the following define each variable:
- *
- * I)For an element without an Element ID Extension field, or for a
- * subelement:
- * L is the size of the information in octets (this does not include the
- * element/subelement header)
- * M is L/255 floored
- * N is equal to 1 if L mod 255 > 0 and equal to 0 otherwise.
- * The size of each of the M fragments is 255 octets
- * If N is 1, then the size of this single fragment is L mod 255 octets
- *
- * II) For an element with an Element ID Extension field:
- * L is the size of the information in octets (this does not include the
- * element header and the element ID extension field)
- * M is (L + 1)/255 floored
- * N is equal to 1 if (L - 254) mod 255 > 0 and equal to 0 otherwise.
- * The size of each of the M fragments is 255 octets
- * If N is 1, then the size of this single fragment is (L - 254) mod 255
- * octets.
- *
- * For both I and II above, the mapping of code variables is as follows:
- * payloadlen = L
- * tmp_num_maxsizefrags = M
- * tmp_smallerfrag_size = Size of N if N is 1, else 0
- * Additionally, elemunit_maxpayloadlen is used to denote the value
- * 255 for future extensibility if and when required.
- */
- if (!is_subelem && (id == WLAN_ELEMID_EXTN_ELEM)) {
- tmp_num_maxsizefrags = (payloadlen + 1) /
- elemunit_maxpayloadlen;
- tmp_smallerfrag_size =
- (payloadlen - (elemunit_maxpayloadlen - 1)) %
- elemunit_maxpayloadlen;
- } else {
- tmp_num_maxsizefrags = payloadlen / elemunit_maxpayloadlen;
- tmp_smallerfrag_size = payloadlen %
- elemunit_maxpayloadlen;
- }
- /* Determine the number of extra bytes introduced due to the headers of
- * non-leading fragments.
- */
- tmp_extrahdrbytes = (tmp_num_maxsizefrags - 1) * elemunit_hdrlen;
- if (tmp_smallerfrag_size)
- tmp_extrahdrbytes += elemunit_hdrlen;
- if (!is_subelem && (id == WLAN_ELEMID_EXTN_ELEM))
- tmp_prepayload_leadbytes = elemunit_hdrlen + 1;
- else
- tmp_prepayload_leadbytes = elemunit_hdrlen;
- tmp_expected_fragseqlen = tmp_prepayload_leadbytes +
- payloadlen + tmp_extrahdrbytes;
- if (expected_fragseqlen)
- *expected_fragseqlen = tmp_expected_fragseqlen;
- if (prepayload_leadbytes)
- *prepayload_leadbytes = tmp_prepayload_leadbytes;
- if (num_maxsizefrags)
- *num_maxsizefrags = tmp_num_maxsizefrags;
- if (smallerfrag_size)
- *smallerfrag_size = tmp_smallerfrag_size;
- if (extrahdrbytes)
- *extrahdrbytes = tmp_extrahdrbytes;
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS
- wlan_create_elemsubelem_fragseq(bool inline_frag,
- bool is_subelem,
- uint8_t id,
- uint8_t idext,
- uint8_t subelemfragid,
- uint8_t *payloadbuff,
- qdf_size_t payloadbuff_maxsize,
- qdf_size_t payloadlen,
- uint8_t *fragbuff,
- qdf_size_t fragbuff_maxsize,
- qdf_size_t *fragseqlen)
- {
- /* elemunit, i.e. 'element unit' here refers to either an 802.11 element
- * or a 802.11 subelement.
- */
- uint8_t elemunit_fragid;
- qdf_size_t elemunit_hdrlen;
- qdf_size_t elemunit_maxpayloadlen;
- int elemunit_id_pos;
- int elemunit_len_pos;
- int elemunit_idext_pos;
- uint8_t *curr_elemunit_ptr;
- /* Whether fragmentation is required */
- bool is_frag_required;
- /*Fragment sequence length (inclusive of payload and all headers) */
- qdf_size_t expected_fragseqlen;
- /* Number of fragments with the maximum size */
- uint32_t num_maxsizefrags;
- /* Size of the last fragment which is smaller than the maximum (if
- * present). If such a fragment is not present, this size will be zero.
- */
- qdf_size_t smallerfrag_size;
- /* The number of extra header bytes that would be introduced (not
- * inclusive of the header of the lead fragment).
- */
- qdf_size_t extrahdrbytes;
- /* The number of extra header bytes remaining to be introduced */
- qdf_size_t extrahdrbytes_remaining;
- /* The lead bytes that occur before the payload */
- qdf_size_t prepayload_leadbytes;
- /* used for inline copy, the extra bytes needed in the payload buffer
- * due to difference in destination and source.
- * Note that the caller should ensure there is enough bytes beyond
- * valid data until payloadbuff_maxsize*/
- qdf_size_t payloadbuff_shiftsize;
- /* Miscellaneous variables */
- uint8_t *src;
- uint8_t *dst;
- uint16_t i;
- qdf_size_t bytes_to_transfer;
- QDF_STATUS ret;
- /* Helper function to create an element or subelement fragment sequence.
- * Refer to the documentation of the public APIs which call this helper,
- * for more information. These APIs are mainly wrappers over this
- * helper.
- */
- ret = wlan_get_elemunit_info(is_subelem,
- subelemfragid,
- &elemunit_fragid,
- &elemunit_hdrlen,
- &elemunit_maxpayloadlen,
- &elemunit_id_pos,
- &elemunit_len_pos,
- &elemunit_idext_pos);
- if (QDF_IS_STATUS_ERROR(ret)) {
- qdf_rl_nofl_err("Get elem unit info: Error %d",
- ret);
- return QDF_STATUS_E_FAILURE;
- }
- ret = wlan_get_elemsubelem_fragseq_creationparams(is_subelem,
- id,
- payloadlen,
- &is_frag_required,
- &expected_fragseqlen,
- &prepayload_leadbytes,
- &num_maxsizefrags,
- &smallerfrag_size,
- &extrahdrbytes);
- if (QDF_IS_STATUS_ERROR(ret))
- return ret;
- if (!is_frag_required) {
- /* We treat this as an error since the caller is expected to
- * have first determined requirements related to fragmentation,
- * including whether fragmentation is required or not.
- */
- if (!is_subelem && (id == WLAN_ELEMID_EXTN_ELEM))
- qdf_nofl_err("Fragmentation inapplicable for elem with elem ID ext and post elem ID ext payload len %zu",
- payloadlen);
- else
- qdf_nofl_err("Fragmentation inapplicable for subelem/elem without elem ID ext and with payload len %zu",
- payloadlen);
- return QDF_STATUS_E_INVAL;
- }
- if (!payloadbuff) {
- qdf_nofl_err("Payload buff is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (payloadbuff_maxsize == 0) {
- qdf_nofl_err("Payload buff max size is 0");
- return QDF_STATUS_E_INVAL;
- }
- if (payloadbuff_maxsize < payloadlen) {
- qdf_nofl_err("Payload buff max size %zu < payload len %zu",
- payloadbuff_maxsize,
- payloadlen);
- return QDF_STATUS_E_INVAL;
- }
- if (inline_frag) {
- if (payloadbuff_maxsize < expected_fragseqlen) {
- qdf_nofl_err("Inline frag buff max size %zu < frag sequence expected len %zu",
- payloadbuff_maxsize,
- expected_fragseqlen);
- return QDF_STATUS_E_INVAL;
- }
- } else {
- if (!fragbuff) {
- qdf_nofl_err("Frag sequence buff is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (fragbuff_maxsize == 0) {
- qdf_nofl_err("Frag sequence buff max size is 0");
- return QDF_STATUS_E_INVAL;
- }
- if (fragbuff_maxsize < expected_fragseqlen) {
- qdf_nofl_err("Frag sequence buff max size %zu < frag sequence expected len %zu",
- fragbuff_maxsize,
- expected_fragseqlen);
- return QDF_STATUS_E_INVAL;
- }
- }
- if (!fragseqlen) {
- qdf_nofl_err("Pointer to location of frag sequence len is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- /* Preferably, ensure that error checks (if any) for future changes are
- * executed before this point. We wouldn't want to touch the destination
- * buffer unless we are sure we can successfully execute (especially for
- * the inline mode).
- */
- /* We rely on wlan_get_elemsubelem_fragseq_creationparams() to give us
- * sane values for extrahdrbytes and other parameters.
- */
- extrahdrbytes_remaining = extrahdrbytes;
- /* We need to accommodate elemunit_hdrlen bytes for each non-leading
- * fragment by moving the non-leading fragment to a higher location.
- * Shift bytes and form fragment elements/subelements starting with the
- * last fragment and going backwards from there.
- */
- /* First move/copy the smaller sized fragment if present */
- if (smallerfrag_size) {
- /* The source for the copy/move is just after the end of all the
- * max sized fragments (including the lead fragment). The
- * element unit header is present for the lead fragment alone.
- */
- src = payloadbuff + elemunit_hdrlen +
- (num_maxsizefrags * elemunit_maxpayloadlen);
- /* The destination for the copy/move is computed to reflect a
- * shift by extrahdrbytes_remaining to accommodate the headers
- * for the smaller fragment and all the non-lead max sized
- * fragments.
- */
- if (inline_frag)
- dst = src + extrahdrbytes_remaining;
- else
- dst = fragbuff + elemunit_hdrlen +
- (num_maxsizefrags * elemunit_maxpayloadlen) +
- extrahdrbytes_remaining;
- bytes_to_transfer = smallerfrag_size;
- /* Account for increased size due to shift in data */
- if (inline_frag && (dst > src))
- payloadbuff_shiftsize = (dst - src);
- else
- payloadbuff_shiftsize = 0;
- /* In the case of inline fragmentation, if the payload buffer
- * has additional contents beyond the payload, include those
- * contents in the move/copy.
- */
- if (inline_frag &&
- (payloadbuff_maxsize > (prepayload_leadbytes + payloadlen)))
- bytes_to_transfer += (payloadbuff_maxsize -
- prepayload_leadbytes -
- payloadlen -
- payloadbuff_shiftsize);
- if (inline_frag)
- qdf_mem_move(dst, src, bytes_to_transfer);
- else
- qdf_mem_copy(dst, src, bytes_to_transfer);
- /* Copy/move of payload done. Set fragment ID and length in
- * element unit header.
- */
- curr_elemunit_ptr = dst - elemunit_hdrlen;
- curr_elemunit_ptr[elemunit_id_pos] = elemunit_fragid;
- curr_elemunit_ptr[elemunit_len_pos] = smallerfrag_size;
- extrahdrbytes_remaining -= elemunit_hdrlen;
- }
- /* Next, move/copy the non-lead max-sized fragments, if present.
- * Fragments at higher memory locations are processed first.
- */
- for (i = num_maxsizefrags; i > 1; i--) {
- /* Process the 'i'th max-sized fragment. The lead max-sized
- * fragment has i=1 and is not processed in this 'for' loop.
- * Also note that 'previous .* fragments' in comments for this
- * 'for' loop refers to fragments in lower memory locations as
- * compared to the current, i.e. 'i'th max-sized fragment.
- */
- /* The source for the copy/move is just after the end of all the
- * previous max-sized fragments (including the lead fragment).
- * The element unit header is present for the lead fragment
- * alone.
- */
- src = payloadbuff + elemunit_hdrlen +
- ((i - 1) * elemunit_maxpayloadlen);
- /* The destination for the copy/move is computed to reflect a
- * shift by extrahdrbytes_remaining to accommodate the headers
- * for the current non-lead max-sized fragment and all the
- * previous max-sized non-lead fragments.
- */
- if (inline_frag)
- dst = src + extrahdrbytes_remaining;
- else
- dst = fragbuff + elemunit_hdrlen +
- ((i - 1) * elemunit_maxpayloadlen) +
- extrahdrbytes_remaining;
- bytes_to_transfer = elemunit_maxpayloadlen;
- /* Account for increased size due to shift in data */
- if (inline_frag && (dst > src))
- payloadbuff_shiftsize = (dst - src);
- else
- payloadbuff_shiftsize = 0;
- /* In the case of inline fragmentation, if this is the last
- * non-lead max-sized fragment (i.e. at the highest memory
- * location), if the payload buffer has additional contents
- * beyond the payload, and these additional contents have not
- * already been taken care of by the presence (and processing)
- * of a smaller fragment, include the additional contents in the
- * move/copy.
- */
- if (inline_frag &&
- (i == num_maxsizefrags) &&
- (payloadbuff_maxsize > (prepayload_leadbytes +
- payloadlen)) &&
- !smallerfrag_size)
- bytes_to_transfer += (payloadbuff_maxsize -
- prepayload_leadbytes -
- payloadlen -
- payloadbuff_shiftsize);
- if (inline_frag)
- qdf_mem_move(dst, src, bytes_to_transfer);
- else
- qdf_mem_copy(dst, src, bytes_to_transfer);
- /* Copy/move of payload done. Set fragment ID and length in
- * element unit header.
- */
- curr_elemunit_ptr = dst - elemunit_hdrlen;
- curr_elemunit_ptr[elemunit_id_pos] = elemunit_fragid;
- curr_elemunit_ptr[elemunit_len_pos] = elemunit_maxpayloadlen;
- extrahdrbytes_remaining -= elemunit_hdrlen;
- }
- /* Update the element unit pointer for the lead max-sized fragment.
- *
- * Copy the payload of the lead max-sized fragment if inline
- * fragmentation is not being used.
- */
- if (inline_frag) {
- curr_elemunit_ptr = payloadbuff;
- } else {
- qdf_mem_copy(fragbuff + elemunit_hdrlen,
- payloadbuff + elemunit_hdrlen,
- elemunit_maxpayloadlen);
- curr_elemunit_ptr = fragbuff;
- }
- /* Set IDs and length in the header for the leading fragment */
- curr_elemunit_ptr[elemunit_id_pos] = id;
- curr_elemunit_ptr[elemunit_len_pos] = elemunit_maxpayloadlen;
- if (!is_subelem && (id == WLAN_ELEMID_EXTN_ELEM))
- curr_elemunit_ptr[elemunit_idext_pos] = idext;
- *fragseqlen = expected_fragseqlen;
- return QDF_STATUS_SUCCESS;
- }
- static inline QDF_STATUS
- wlan_get_elemsubelem_successorfrag(bool is_subelem,
- uint8_t subelemfragid,
- uint8_t *curr_elemunit_ptr,
- uint8_t *buff,
- qdf_size_t buff_maxsize,
- uint8_t **successorfrag,
- qdf_size_t *successorfrag_totallen,
- qdf_size_t *successorfrag_payloadlen)
- {
- /* elemunit, i.e. 'element unit' here refers to either an 802.11 element
- * or a 802.11 subelement.
- */
- uint8_t elemunit_fragid;
- qdf_size_t elemunit_hdrlen;
- qdf_size_t elemunit_maxpayloadlen;
- int elemunit_id_pos;
- int elemunit_len_pos;
- qdf_size_t curr_elemunit_totallen;
- uint8_t *next_elemunit_ptr;
- qdf_size_t next_elemunit_totallen;
- QDF_STATUS ret;
- /* This helper checks if the very next element unit after the current
- * one is a valid fragment element unit and that there is sufficient
- * space in the buffer for this next element, and if so, it returns a
- * pointer to this fragment element unit as well as the total length of
- * this fragment element unit and the length of the payload of this
- * fragment element unit.
- */
- ret = wlan_get_elemunit_info(is_subelem,
- subelemfragid,
- &elemunit_fragid,
- &elemunit_hdrlen,
- &elemunit_maxpayloadlen,
- &elemunit_id_pos,
- &elemunit_len_pos,
- NULL);
- if (QDF_IS_STATUS_ERROR(ret)) {
- qdf_rl_nofl_err("Get elem unit info: Error %d",
- ret);
- return QDF_STATUS_E_FAILURE;
- }
- if (!curr_elemunit_ptr) {
- qdf_nofl_err("Ptr to curr elem unit is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (!buff) {
- qdf_nofl_err("Elem unit buff is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (buff_maxsize == 0) {
- qdf_nofl_err("Max size of elem unit buff is 0");
- return QDF_STATUS_E_INVAL;
- }
- if (!successorfrag) {
- qdf_nofl_err("Double ptr to successor frag is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (!successorfrag_totallen) {
- qdf_nofl_err("Ptr to successor frag total len is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (!successorfrag_payloadlen) {
- qdf_nofl_err("Ptr to successor frag payload len is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if ((buff + buff_maxsize) < (curr_elemunit_ptr + elemunit_hdrlen)) {
- qdf_rl_nofl_err("(Space %zu after curr elem unit offset %zu in elem unit buff) < (header size of elem unit %zu)",
- buff_maxsize - (curr_elemunit_ptr - buff),
- curr_elemunit_ptr - buff,
- elemunit_hdrlen);
- return QDF_STATUS_E_PROTO;
- }
- curr_elemunit_totallen =
- elemunit_hdrlen + curr_elemunit_ptr[elemunit_len_pos];
- if ((buff + buff_maxsize) <
- (curr_elemunit_ptr + curr_elemunit_totallen)) {
- qdf_rl_nofl_err("(Space %zu after curr elem unit offset %zu in elem unit buff) < (indicated total len of elem unit %zu)",
- buff_maxsize - (curr_elemunit_ptr - buff),
- curr_elemunit_ptr - buff,
- curr_elemunit_totallen);
- return QDF_STATUS_E_PROTO;
- }
- if ((buff + buff_maxsize) ==
- (curr_elemunit_ptr + curr_elemunit_totallen)) {
- /* We have reached the end of the buffer. There is no successor
- * fragment.
- */
- *successorfrag = NULL;
- return QDF_STATUS_SUCCESS;
- }
- next_elemunit_ptr = curr_elemunit_ptr + curr_elemunit_totallen;
- if ((buff + buff_maxsize) < (next_elemunit_ptr + elemunit_hdrlen)) {
- qdf_rl_nofl_err("(Space %zu after next elem unit offset %zu in elem unit buff) < (header size of elem unit %zu)",
- buff_maxsize - (next_elemunit_ptr - buff),
- next_elemunit_ptr - buff,
- elemunit_hdrlen);
- return QDF_STATUS_E_PROTO;
- }
- next_elemunit_totallen =
- elemunit_hdrlen + next_elemunit_ptr[elemunit_len_pos];
- if ((buff + buff_maxsize) <
- (next_elemunit_ptr + next_elemunit_totallen)) {
- qdf_rl_nofl_err("(Space %zu after next elem unit offset %zu in elem unit buff) < (indicated total len of elem unit %zu)",
- buff_maxsize - (next_elemunit_ptr - buff),
- next_elemunit_ptr - buff,
- next_elemunit_totallen);
- return QDF_STATUS_E_PROTO;
- }
- if (next_elemunit_ptr[elemunit_id_pos] != elemunit_fragid) {
- *successorfrag = NULL;
- return QDF_STATUS_SUCCESS;
- }
- /* We should not be seeing a successor fragment if the length of the
- * current element unit is lesser than the max.
- */
- if (curr_elemunit_ptr[elemunit_len_pos] != elemunit_maxpayloadlen) {
- qdf_rl_nofl_err("Potential successor frag found though (len %u of payload of curr elem unit) != (max payload len %zu)",
- curr_elemunit_ptr[elemunit_len_pos],
- elemunit_maxpayloadlen);
- return QDF_STATUS_E_PROTO;
- }
- if (next_elemunit_ptr[elemunit_len_pos] == 0) {
- qdf_rl_nofl_err("Potential successor frag len is 0");
- return QDF_STATUS_E_PROTO;
- }
- *successorfrag = next_elemunit_ptr;
- *successorfrag_totallen = next_elemunit_totallen;
- *successorfrag_payloadlen = next_elemunit_ptr[elemunit_len_pos];
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS
- wlan_get_elemsubelem_fragseq_info(bool is_subelem,
- uint8_t subelemfragid,
- uint8_t *buff,
- qdf_size_t buff_maxsize,
- bool *is_fragseq,
- qdf_size_t *fragseq_totallen,
- qdf_size_t *fragseq_payloadlen)
- {
- /* elemunit, i.e. 'element unit' here refers to either an 802.11 element
- * or a 802.11 subelement.
- */
- qdf_size_t elemunit_hdrlen;
- int elemunit_id_pos;
- int elemunit_len_pos;
- uint8_t *curr_elemunit_ptr;
- qdf_size_t curr_elemunit_totallen;
- qdf_size_t fragseq_currtotallen;
- qdf_size_t fragseq_currpayloadlen;
- uint8_t *successorfrag;
- qdf_size_t successorfrag_totallen;
- qdf_size_t successorfrag_payloadlen;
- QDF_STATUS ret;
- /* Helper function to get element or subelement fragment sequence
- * information. Refer to the documentation of the public APIs which
- * call this helper, for more information. These APIs are mainly
- * wrappers over this helper.
- *
- * If this helper reports that an element fragment sequence is present,
- * it also serves to check for the sanity of various lengths and
- * protocol requirements related to the fragment sequence (either by
- * itself or though other helpers).
- */
- ret = wlan_get_elemunit_info(is_subelem,
- 0,
- NULL,
- &elemunit_hdrlen,
- NULL,
- &elemunit_id_pos,
- &elemunit_len_pos,
- NULL);
- if (QDF_IS_STATUS_ERROR(ret)) {
- qdf_rl_nofl_err("Get elem unit info: Error %d",
- ret);
- return QDF_STATUS_E_FAILURE;
- }
- if (!buff) {
- qdf_nofl_err("Elem unit buff is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (buff_maxsize == 0) {
- qdf_nofl_err("Max size of elem unit buff is 0");
- return QDF_STATUS_E_INVAL;
- }
- if (!is_fragseq) {
- qdf_nofl_err("Ptr to status of frag seq presence is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (!fragseq_totallen) {
- qdf_nofl_err("Ptr to total len of frag seq is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (!fragseq_payloadlen) {
- qdf_nofl_err("Ptr to payload len of frag seq is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- curr_elemunit_ptr = buff;
- fragseq_currtotallen = 0;
- fragseq_currpayloadlen = 0;
- if ((buff + buff_maxsize) < (curr_elemunit_ptr + elemunit_hdrlen)) {
- qdf_rl_nofl_err("(Space %zu after curr elem unit offset %zu in elem unit buff) < (header size of elem unit %zu)",
- buff_maxsize - (curr_elemunit_ptr - buff),
- curr_elemunit_ptr - buff,
- elemunit_hdrlen);
- return QDF_STATUS_E_PROTO;
- }
- curr_elemunit_totallen =
- elemunit_hdrlen + curr_elemunit_ptr[elemunit_len_pos];
- if ((buff + buff_maxsize) <
- (curr_elemunit_ptr + curr_elemunit_totallen)) {
- qdf_rl_nofl_err("(Space %zu after curr elem unit offset %zu in elem unit buff) < (indicated total len of elem unit %zu)",
- buff_maxsize - (curr_elemunit_ptr - buff),
- curr_elemunit_ptr - buff,
- curr_elemunit_totallen);
- return QDF_STATUS_E_PROTO;
- }
- successorfrag = NULL;
- ret = wlan_get_elemsubelem_successorfrag(is_subelem,
- subelemfragid,
- curr_elemunit_ptr,
- buff,
- buff_maxsize,
- &successorfrag,
- &successorfrag_totallen,
- &successorfrag_payloadlen);
- if (QDF_IS_STATUS_ERROR(ret))
- return ret;
- if (!successorfrag) {
- *is_fragseq = false;
- *fragseq_totallen = 0;
- *fragseq_payloadlen = 0;
- return QDF_STATUS_SUCCESS;
- }
- fragseq_currtotallen += curr_elemunit_totallen;
- if (!is_subelem &&
- (curr_elemunit_ptr[elemunit_id_pos] == WLAN_ELEMID_EXTN_ELEM)) {
- fragseq_currpayloadlen +=
- (curr_elemunit_ptr[elemunit_len_pos] - 1);
- } else {
- fragseq_currpayloadlen +=
- curr_elemunit_ptr[elemunit_len_pos];
- }
- while (successorfrag) {
- /* wlan_get_elemsubelem_successorfrag() has already validated
- * the length values for the successor fragment.
- */
- fragseq_currtotallen += successorfrag_totallen;
- fragseq_currpayloadlen += successorfrag_payloadlen;
- curr_elemunit_ptr = successorfrag;
- successorfrag = NULL;
- ret = wlan_get_elemsubelem_successorfrag(is_subelem,
- subelemfragid,
- curr_elemunit_ptr,
- buff,
- buff_maxsize,
- &successorfrag,
- &successorfrag_totallen,
- &successorfrag_payloadlen);
- if (QDF_IS_STATUS_ERROR(ret))
- return ret;
- }
- *is_fragseq = true;
- *fragseq_totallen = fragseq_currtotallen;
- *fragseq_payloadlen = fragseq_currpayloadlen;
- return QDF_STATUS_SUCCESS;
- }
- static QDF_STATUS wlan_defrag_elemsubelem_fragseq(bool inline_defrag,
- bool is_subelem,
- uint8_t subelemfragid,
- uint8_t *fragbuff,
- qdf_size_t fragbuff_maxsize,
- uint8_t *defragbuff,
- qdf_size_t defragbuff_maxsize,
- qdf_size_t *defragpayload_len)
- {
- /* elemunit, i.e. 'element unit' here refers to either an 802.11 element
- * or a 802.11 subelement.
- */
- uint8_t elemunit_fragid;
- qdf_size_t elemunit_hdrlen;
- int elemunit_id_pos;
- int elemunit_len_pos;
- int elemunit_idext_pos;
- bool is_fragseq;
- qdf_size_t fragseq_totallen;
- qdf_size_t fragseq_payloadlen;
- uint8_t *curr_elemunit_ptr;
- qdf_size_t curr_elemunit_payloadlen;
- qdf_size_t curr_elemunit_totallen;
- uint8_t *src;
- uint8_t *dst;
- /* Current length of the defragmented payload */
- qdf_size_t defragpayload_currlen;
- /* Remaining length available in the source buffer containing the
- * fragment sequence, after element units processed so far.
- */
- qdf_size_t fragbuff_remlen;
- QDF_STATUS ret;
- /* Helper function to de-fragment element or subelement fragment
- * sequence. Refer to the documentation of the public APIs which call
- * this helper, for more information. Those APIs are mainly wrappers
- * over this helper.
- */
- ret = wlan_get_elemunit_info(is_subelem,
- subelemfragid,
- &elemunit_fragid,
- &elemunit_hdrlen,
- NULL,
- &elemunit_id_pos,
- &elemunit_len_pos,
- &elemunit_idext_pos);
- if (QDF_IS_STATUS_ERROR(ret)) {
- qdf_rl_nofl_err("Get elem unit info: Error %d",
- ret);
- return QDF_STATUS_E_FAILURE;
- }
- if (!fragbuff) {
- qdf_nofl_err("Src buff for frag seq is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (fragbuff_maxsize == 0) {
- qdf_nofl_err("Size of src buff for frag seq is 0");
- return QDF_STATUS_E_INVAL;
- }
- if (!inline_defrag) {
- if (!defragbuff) {
- qdf_nofl_err("Dest buff for defragged payload is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- if (defragbuff_maxsize == 0) {
- qdf_nofl_err("Size of dest buff for defragged payload is 0");
- return QDF_STATUS_E_INVAL;
- }
- }
- if (!defragpayload_len) {
- qdf_nofl_err("Ptr to len of defragged payload is NULL");
- return QDF_STATUS_E_NULL_VALUE;
- }
- ret = wlan_get_elemsubelem_fragseq_info(is_subelem,
- subelemfragid,
- fragbuff,
- fragbuff_maxsize,
- &is_fragseq,
- &fragseq_totallen,
- &fragseq_payloadlen);
- if (QDF_IS_STATUS_ERROR(ret))
- return ret;
- if (!is_fragseq) {
- /* We treat this as an error since the caller is supposed to
- * check this.
- */
- qdf_rl_nofl_err("Frag seq not found at start of src buff for frag seq");
- return QDF_STATUS_E_INVAL;
- }
- /* fragseq_totallen is known to be smaller than or equal to
- * fragbuff_maxsize since wlan_get_elemsubelem_fragseq_info() is bound
- * by fragbuff_maxsize in the search for a fragment sequence and it's
- * total length.
- */
- if (!inline_defrag && (defragbuff_maxsize < fragseq_payloadlen)) {
- qdf_rl_nofl_err("(Size of dest buff for defragged payload %zu) < (size of frag seq payload %zu)",
- defragbuff_maxsize, fragseq_payloadlen);
- return QDF_STATUS_E_INVAL;
- }
- defragpayload_currlen = 0;
- fragbuff_remlen = fragbuff_maxsize;
- /* We have already validated through wlan_get_elemsubelem_fragseq_info()
- * that the elements we are about to access below are within the bounds
- * of fragbuff.
- */
- curr_elemunit_ptr = fragbuff;
- if (!is_subelem &&
- (curr_elemunit_ptr[elemunit_id_pos] == WLAN_ELEMID_EXTN_ELEM)) {
- curr_elemunit_payloadlen =
- curr_elemunit_ptr[elemunit_len_pos] - 1;
- src = curr_elemunit_ptr + elemunit_hdrlen + 1;
- } else {
- curr_elemunit_payloadlen = curr_elemunit_ptr[elemunit_len_pos];
- src = curr_elemunit_ptr + elemunit_hdrlen;
- }
- curr_elemunit_totallen =
- elemunit_hdrlen + curr_elemunit_ptr[elemunit_len_pos];
- if (inline_defrag) {
- /* There is no need to move any bytes in the lead element. Set
- * dst=src so that the next update for dst can happen in a
- * manner uniform with the non-inlined defrag case.
- */
- dst = src;
- } else {
- dst = defragbuff;
- qdf_mem_copy(dst, src, curr_elemunit_payloadlen);
- }
- defragpayload_currlen += curr_elemunit_payloadlen;
- fragbuff_remlen -= curr_elemunit_totallen;
- dst += curr_elemunit_payloadlen;
- curr_elemunit_ptr += curr_elemunit_totallen;
- /* We have already validated through wlan_get_elemsubelem_fragseq_info()
- * that at least one non-lead fragment element is present as required in
- * the standard.
- */
- while (curr_elemunit_ptr[elemunit_id_pos] == elemunit_fragid) {
- curr_elemunit_payloadlen = curr_elemunit_ptr[elemunit_len_pos];
- curr_elemunit_totallen =
- elemunit_hdrlen + curr_elemunit_ptr[elemunit_len_pos];
- src = curr_elemunit_ptr + elemunit_hdrlen;
- if (inline_defrag)
- qdf_mem_move(dst, src, curr_elemunit_payloadlen);
- else
- qdf_mem_copy(dst, src, curr_elemunit_payloadlen);
- defragpayload_currlen += curr_elemunit_payloadlen;
- fragbuff_remlen -= curr_elemunit_totallen;
- if (fragbuff_remlen == 0)
- break;
- dst += curr_elemunit_payloadlen;
- curr_elemunit_ptr += curr_elemunit_totallen;
- }
- if (inline_defrag && (fragbuff_remlen != 0)) {
- /* Move the residual content after the fragments, in the source
- * buffer.
- */
- src = curr_elemunit_ptr;
- qdf_mem_move(dst, src, fragbuff_remlen);
- }
- *defragpayload_len = defragpayload_currlen;
- return QDF_STATUS_SUCCESS;
- }
- QDF_STATUS
- wlan_get_elem_fragseq_requirements(uint8_t elemid,
- qdf_size_t payloadlen,
- bool *is_frag_required,
- qdf_size_t *required_fragbuff_size)
- {
- return wlan_get_elemsubelem_fragseq_creationparams(false,
- elemid,
- payloadlen,
- is_frag_required,
- required_fragbuff_size,
- NULL,
- NULL,
- NULL,
- NULL);
- }
- QDF_STATUS wlan_create_elem_fragseq(bool inline_frag,
- uint8_t elemid,
- uint8_t elemidext,
- uint8_t *payloadbuff,
- qdf_size_t payloadbuff_maxsize,
- qdf_size_t payloadlen,
- uint8_t *fragbuff,
- qdf_size_t fragbuff_maxsize,
- qdf_size_t *fragseqlen)
- {
- return wlan_create_elemsubelem_fragseq(inline_frag,
- false,
- elemid,
- elemidext,
- 0,
- payloadbuff,
- payloadbuff_maxsize,
- payloadlen,
- fragbuff,
- fragbuff_maxsize,
- fragseqlen);
- }
- QDF_STATUS
- wlan_get_subelem_fragseq_requirements(uint8_t subelemid,
- qdf_size_t payloadlen,
- bool *is_frag_required,
- qdf_size_t *required_fragbuff_size)
- {
- return wlan_get_elemsubelem_fragseq_creationparams(true,
- subelemid,
- payloadlen,
- is_frag_required,
- required_fragbuff_size,
- NULL,
- NULL,
- NULL,
- NULL);
- }
- QDF_STATUS wlan_create_subelem_fragseq(bool inline_frag,
- uint8_t subelemid,
- uint8_t subelemfragid,
- uint8_t *payloadbuff,
- qdf_size_t payloadbuff_maxsize,
- qdf_size_t payloadlen,
- uint8_t *fragbuff,
- qdf_size_t fragbuff_maxsize,
- qdf_size_t *fragseqlen)
- {
- return wlan_create_elemsubelem_fragseq(inline_frag,
- true,
- subelemid,
- 0,
- subelemfragid,
- payloadbuff,
- payloadbuff_maxsize,
- payloadlen,
- fragbuff,
- fragbuff_maxsize,
- fragseqlen);
- }
- QDF_STATUS wlan_get_elem_fragseq_info(uint8_t *elembuff,
- qdf_size_t elembuff_maxsize,
- bool *is_fragseq,
- qdf_size_t *fragseq_totallen,
- qdf_size_t *fragseq_payloadlen)
- {
- return wlan_get_elemsubelem_fragseq_info(false,
- 0,
- elembuff,
- elembuff_maxsize,
- is_fragseq,
- fragseq_totallen,
- fragseq_payloadlen);
- }
- QDF_STATUS wlan_defrag_elem_fragseq(bool inline_defrag,
- uint8_t *fragbuff,
- qdf_size_t fragbuff_maxsize,
- uint8_t *defragbuff,
- qdf_size_t defragbuff_maxsize,
- qdf_size_t *defragpayload_len)
- {
- return wlan_defrag_elemsubelem_fragseq(inline_defrag,
- false,
- 0,
- fragbuff,
- fragbuff_maxsize,
- defragbuff,
- defragbuff_maxsize,
- defragpayload_len);
- }
- QDF_STATUS wlan_get_subelem_fragseq_info(uint8_t subelemfragid,
- uint8_t *subelembuff,
- qdf_size_t subelembuff_maxsize,
- bool *is_fragseq,
- qdf_size_t *fragseq_totallen,
- qdf_size_t *fragseq_payloadlen)
- {
- return wlan_get_elemsubelem_fragseq_info(true,
- subelemfragid,
- subelembuff,
- subelembuff_maxsize,
- is_fragseq,
- fragseq_totallen,
- fragseq_payloadlen);
- }
- QDF_STATUS wlan_defrag_subelem_fragseq(bool inline_defrag,
- uint8_t subelemfragid,
- uint8_t *fragbuff,
- qdf_size_t fragbuff_maxsize,
- uint8_t *defragbuff,
- qdf_size_t defragbuff_maxsize,
- qdf_size_t *defragpayload_len)
- {
- return wlan_defrag_elemsubelem_fragseq(inline_defrag,
- true,
- subelemfragid,
- fragbuff,
- fragbuff_maxsize,
- defragbuff,
- defragbuff_maxsize,
- defragpayload_len);
- }
- bool wlan_is_emulation_platform(uint32_t phy_version)
- {
- if ((phy_version == 0xABC0) || (phy_version == 0xABC1) ||
- (phy_version == 0xABC2) || (phy_version == 0xABC3) ||
- (phy_version == 0xFFFF) || (phy_version == 0xABCD))
- return true;
- return false;
- }
- uint32_t wlan_get_pdev_id_from_vdev_id(struct wlan_objmgr_psoc *psoc,
- uint8_t vdev_id,
- wlan_objmgr_ref_dbgid dbg_id)
- {
- struct wlan_objmgr_vdev *vdev;
- struct wlan_objmgr_pdev *pdev = NULL;
- uint32_t pdev_id = WLAN_INVALID_PDEV_ID;
- vdev = wlan_objmgr_get_vdev_by_id_from_psoc(psoc,
- vdev_id, dbg_id);
- if (vdev) {
- pdev = wlan_vdev_get_pdev(vdev);
- if (pdev)
- pdev_id = wlan_objmgr_pdev_get_pdev_id(pdev);
- wlan_objmgr_vdev_release_ref(vdev, dbg_id);
- }
- return pdev_id;
- }
- qdf_export_symbol(wlan_get_pdev_id_from_vdev_id);
- static void wlan_vdev_active(struct wlan_objmgr_pdev *pdev, void *object,
- void *arg)
- {
- struct wlan_objmgr_vdev *vdev = (struct wlan_objmgr_vdev *)object;
- uint8_t *flag = (uint8_t *)arg;
- wlan_vdev_obj_lock(vdev);
- if (wlan_vdev_mlme_is_active(vdev) == QDF_STATUS_SUCCESS)
- *flag = 1;
- wlan_vdev_obj_unlock(vdev);
- }
- QDF_STATUS wlan_vdev_is_up(struct wlan_objmgr_vdev *vdev)
- {
- return wlan_vdev_allow_connect_n_tx(vdev);
- }
- qdf_export_symbol(wlan_vdev_is_up);
- QDF_STATUS wlan_util_is_vdev_active(struct wlan_objmgr_pdev *pdev,
- wlan_objmgr_ref_dbgid dbg_id)
- {
- uint8_t flag = 0;
- if (!pdev)
- return QDF_STATUS_E_INVAL;
- wlan_objmgr_pdev_iterate_obj_list(pdev, WLAN_VDEV_OP, wlan_vdev_active,
- &flag, 0, dbg_id);
- if (flag == 1)
- return QDF_STATUS_SUCCESS;
- return QDF_STATUS_E_INVAL;
- }
- qdf_export_symbol(wlan_util_is_vdev_active);
- void wlan_util_change_map_index(unsigned long *map, uint8_t id, uint8_t set)
- {
- if (set)
- qdf_set_bit(id, map);
- else
- qdf_clear_bit(id, map);
- }
- bool wlan_util_map_index_is_set(unsigned long *map, uint8_t id)
- {
- return qdf_test_bit(id, map);
- }
- bool wlan_util_map_is_any_index_set(unsigned long *map, unsigned long nbytes)
- {
- return !qdf_bitmap_empty(map, QDF_CHAR_BIT * nbytes);
- }
- static void wlan_vdev_chan_change_pending(struct wlan_objmgr_pdev *pdev,
- void *object, void *arg)
- {
- struct wlan_objmgr_vdev *vdev = (struct wlan_objmgr_vdev *)object;
- unsigned long *vdev_id_map = (unsigned long *)arg;
- uint8_t id = 0;
- struct wlan_objmgr_psoc *psoc;
- psoc = wlan_pdev_get_psoc(pdev);
- if (!psoc)
- return;
- wlan_vdev_obj_lock(vdev);
- if (wlan_vdev_chan_config_valid(vdev) == QDF_STATUS_SUCCESS) {
- id = wlan_vdev_get_id(vdev);
- /* Invalid vdev id */
- if (id >= wlan_psoc_get_max_vdev_count(psoc)) {
- wlan_vdev_obj_unlock(vdev);
- return;
- }
- wlan_util_change_map_index(vdev_id_map, id, 1);
- }
- wlan_vdev_obj_unlock(vdev);
- }
- QDF_STATUS wlan_pdev_chan_change_pending_vdevs(struct wlan_objmgr_pdev *pdev,
- unsigned long *vdev_id_map,
- wlan_objmgr_ref_dbgid dbg_id)
- {
- if (!pdev)
- return QDF_STATUS_E_INVAL;
- wlan_objmgr_pdev_iterate_obj_list(pdev, WLAN_VDEV_OP,
- wlan_vdev_chan_change_pending,
- vdev_id_map, 0, dbg_id);
- return QDF_STATUS_SUCCESS;
- }
- static void wlan_vdev_down_pending(struct wlan_objmgr_pdev *pdev,
- void *object, void *arg)
- {
- struct wlan_objmgr_vdev *vdev = (struct wlan_objmgr_vdev *)object;
- unsigned long *vdev_id_map = (unsigned long *)arg;
- uint8_t id = 0;
- struct wlan_objmgr_psoc *psoc;
- enum wlan_serialization_cmd_type cmd_type;
- psoc = wlan_pdev_get_psoc(pdev);
- if (!psoc)
- return;
- cmd_type = wlan_serialization_get_vdev_active_cmd_type(vdev);
- wlan_vdev_obj_lock(vdev);
- if ((wlan_vdev_mlme_is_init_state(vdev) != QDF_STATUS_SUCCESS) ||
- (cmd_type == WLAN_SER_CMD_VDEV_START_BSS)) {
- id = wlan_vdev_get_id(vdev);
- /* Invalid vdev id */
- if (id >= wlan_psoc_get_max_vdev_count(psoc)) {
- wlan_vdev_obj_unlock(vdev);
- return;
- }
- wlan_util_change_map_index(vdev_id_map, id, 1);
- }
- wlan_vdev_obj_unlock(vdev);
- }
- static void wlan_vdev_ap_down_pending(struct wlan_objmgr_pdev *pdev,
- void *object, void *arg)
- {
- struct wlan_objmgr_vdev *vdev = (struct wlan_objmgr_vdev *)object;
- unsigned long *vdev_id_map = (unsigned long *)arg;
- uint8_t id = 0;
- struct wlan_objmgr_psoc *psoc;
- enum wlan_serialization_cmd_type cmd_type;
- psoc = wlan_pdev_get_psoc(pdev);
- if (!psoc)
- return;
- if (wlan_vdev_mlme_get_opmode(vdev) != QDF_SAP_MODE)
- return;
- cmd_type = wlan_serialization_get_vdev_active_cmd_type(vdev);
- wlan_vdev_obj_lock(vdev);
- if ((wlan_vdev_mlme_is_init_state(vdev) != QDF_STATUS_SUCCESS) ||
- (cmd_type == WLAN_SER_CMD_VDEV_START_BSS)) {
- id = wlan_vdev_get_id(vdev);
- /* Invalid vdev id */
- if (id >= wlan_psoc_get_max_vdev_count(psoc)) {
- wlan_vdev_obj_unlock(vdev);
- return;
- }
- wlan_util_change_map_index(vdev_id_map, id, 1);
- }
- wlan_vdev_obj_unlock(vdev);
- }
- QDF_STATUS wlan_pdev_chan_change_pending_vdevs_down(
- struct wlan_objmgr_pdev *pdev,
- unsigned long *vdev_id_map,
- wlan_objmgr_ref_dbgid dbg_id)
- {
- if (!pdev)
- return QDF_STATUS_E_INVAL;
- wlan_objmgr_pdev_iterate_obj_list(pdev, WLAN_VDEV_OP,
- wlan_vdev_down_pending,
- vdev_id_map, 0, dbg_id);
- return QDF_STATUS_SUCCESS;
- }
- QDF_STATUS wlan_pdev_chan_change_pending_ap_vdevs_down(
- struct wlan_objmgr_pdev *pdev,
- unsigned long *vdev_id_map,
- wlan_objmgr_ref_dbgid dbg_id)
- {
- if (!pdev)
- return QDF_STATUS_E_INVAL;
- wlan_objmgr_pdev_iterate_obj_list(pdev, WLAN_VDEV_OP,
- wlan_vdev_ap_down_pending,
- vdev_id_map, 0, dbg_id);
- return QDF_STATUS_SUCCESS;
- }
- #ifdef WLAN_FEATURE_11BE
- static inline bool
- wlan_chan_puncture_eq(struct wlan_channel *chan1, struct wlan_channel *chan2)
- {
- if (chan1->puncture_bitmap == chan2->puncture_bitmap)
- return true;
- return false;
- }
- #else
- static inline bool
- wlan_chan_puncture_eq(struct wlan_channel *chan1, struct wlan_channel *chan2)
- {
- return true;
- }
- #endif /* WLAN_FEATURE_11BE */
- QDF_STATUS wlan_chan_eq(struct wlan_channel *chan1, struct wlan_channel *chan2)
- {
- if ((chan1->ch_ieee == chan2->ch_ieee) &&
- (chan1->ch_freq_seg2 == chan2->ch_freq_seg2) &&
- wlan_chan_puncture_eq(chan1, chan2))
- return QDF_STATUS_SUCCESS;
- return QDF_STATUS_E_FAILURE;
- }
- void wlan_chan_copy(struct wlan_channel *tgt, struct wlan_channel *src)
- {
- qdf_mem_copy(tgt, src, sizeof(struct wlan_channel));
- }
- struct wlan_channel *wlan_vdev_get_active_channel(struct wlan_objmgr_vdev *vdev)
- {
- struct wlan_channel *comp_vdev_chan = NULL;
- if (wlan_vdev_chan_config_valid(vdev) == QDF_STATUS_SUCCESS) {
- /* compare with BSS channel, when vdev is active, since desired
- * channel gets update, if channel is triggered in another path
- */
- if (wlan_vdev_mlme_is_active(vdev) == QDF_STATUS_SUCCESS)
- comp_vdev_chan = wlan_vdev_mlme_get_bss_chan(vdev);
- else
- comp_vdev_chan = wlan_vdev_mlme_get_des_chan(vdev);
- }
- return comp_vdev_chan;
- }
- /**
- * struct wlan_check_bssid_context - bssid check context
- * @bssid: bssid to be checked
- * @connected: connected by vdev or not
- * @vdev_id: vdev id of connected vdev
- */
- struct wlan_check_bssid_context {
- struct qdf_mac_addr bssid;
- bool connected;
- uint8_t vdev_id;
- };
- /**
- * wlan_get_connected_vdev_handler() - check vdev connected on bssid
- * @psoc: psoc object
- * @obj: vdev object
- * @args: handler context
- *
- * This function will check whether vdev is connected on bssid or not and
- * update the result to handler context accordingly.
- *
- * Return: void
- */
- static void wlan_get_connected_vdev_handler(struct wlan_objmgr_psoc *psoc,
- void *obj, void *args)
- {
- struct wlan_objmgr_vdev *vdev = (struct wlan_objmgr_vdev *)obj;
- struct wlan_check_bssid_context *context =
- (struct wlan_check_bssid_context *)args;
- struct qdf_mac_addr bss_peer_mac;
- enum QDF_OPMODE op_mode;
- if (context->connected)
- return;
- op_mode = wlan_vdev_mlme_get_opmode(vdev);
- if (op_mode != QDF_STA_MODE && op_mode != QDF_P2P_CLIENT_MODE)
- return;
- if (wlan_vdev_is_up(vdev) != QDF_STATUS_SUCCESS)
- return;
- if (wlan_vdev_get_bss_peer_mac(vdev, &bss_peer_mac) !=
- QDF_STATUS_SUCCESS)
- return;
- if (qdf_is_macaddr_equal(&bss_peer_mac, &context->bssid)) {
- context->connected = true;
- context->vdev_id = wlan_vdev_get_id(vdev);
- }
- }
- bool wlan_get_connected_vdev_from_psoc_by_bssid(struct wlan_objmgr_psoc *psoc,
- uint8_t *bssid,
- uint8_t *vdev_id)
- {
- struct wlan_check_bssid_context context;
- qdf_mem_zero(&context, sizeof(struct wlan_check_bssid_context));
- qdf_mem_copy(context.bssid.bytes, bssid, QDF_MAC_ADDR_SIZE);
- wlan_objmgr_iterate_obj_list(psoc, WLAN_VDEV_OP,
- wlan_get_connected_vdev_handler,
- &context, true, WLAN_OSIF_SCAN_ID);
- if (context.connected)
- *vdev_id = context.vdev_id;
- return context.connected;
- }
- qdf_export_symbol(wlan_get_connected_vdev_from_psoc_by_bssid);
- bool wlan_get_connected_vdev_by_bssid(struct wlan_objmgr_pdev *pdev,
- uint8_t *bssid, uint8_t *vdev_id)
- {
- return wlan_get_connected_vdev_from_psoc_by_bssid(
- wlan_pdev_get_psoc(pdev), bssid, vdev_id);
- }
- qdf_export_symbol(wlan_get_connected_vdev_by_bssid);
- #ifdef WLAN_FEATURE_11BE_MLO
- /**
- * struct wlan_check_mld_addr_context - mld mac addr check context
- * @mld_addr: mld_addrto be checked
- * @connected: connected by vdev or not
- * @vdev_id: vdev id of connected vdev
- */
- struct wlan_check_mld_addr_context {
- struct qdf_mac_addr mld_addr;
- bool connected;
- uint8_t vdev_id;
- };
- /**
- * wlan_get_connected_mlo_dev_ctx_handler() - check vdev connected on mld mac
- * @psoc: psoc object
- * @obj: vdev object
- * @args: handler context
- *
- * This function will check whether vdev is connected on mld mac or not and
- * update the result to handler context accordingly.
- *
- * Return: void
- */
- static void wlan_get_connected_mlo_dev_ctx_handler(
- struct wlan_objmgr_psoc *psoc,
- void *obj, void *args)
- {
- struct wlan_objmgr_vdev *vdev = (struct wlan_objmgr_vdev *)obj;
- struct wlan_check_mld_addr_context *context =
- (struct wlan_check_mld_addr_context *)args;
- struct qdf_mac_addr bss_peer_mld_mac;
- enum QDF_OPMODE op_mode;
- if (context->connected)
- return;
- op_mode = wlan_vdev_mlme_get_opmode(vdev);
- if (op_mode != QDF_STA_MODE && op_mode != QDF_P2P_CLIENT_MODE)
- return;
- if (wlan_vdev_is_up(vdev) != QDF_STATUS_SUCCESS)
- return;
- if (QDF_IS_STATUS_ERROR(wlan_vdev_get_bss_peer_mld_mac(
- vdev, &bss_peer_mld_mac)))
- return;
- if (qdf_is_macaddr_equal(&bss_peer_mld_mac, &context->mld_addr)) {
- context->connected = true;
- context->vdev_id = wlan_vdev_get_id(vdev);
- }
- }
- bool wlan_get_connected_vdev_by_mld_addr(struct wlan_objmgr_psoc *psoc,
- uint8_t *mld_mac, uint8_t *vdev_id)
- {
- struct wlan_check_mld_addr_context context;
- qdf_mem_zero(&context, sizeof(struct wlan_check_mld_addr_context));
- qdf_copy_macaddr(&context.mld_addr, (struct qdf_mac_addr *)mld_mac);
- wlan_objmgr_iterate_obj_list(psoc, WLAN_VDEV_OP,
- wlan_get_connected_mlo_dev_ctx_handler,
- &context, true, WLAN_MLME_OBJMGR_ID);
- if (context.connected)
- *vdev_id = context.vdev_id;
- return context.connected;
- }
- #endif
- static void wlan_pdev_chan_match(struct wlan_objmgr_pdev *pdev, void *object,
- void *arg)
- {
- struct wlan_objmgr_vdev *comp_vdev = (struct wlan_objmgr_vdev *)object;
- struct wlan_vdev_ch_check_filter *ch_filter = arg;
- struct wlan_channel vdev_chan, *chan;
- struct wlan_channel *iter_vdev_chan;
- if (ch_filter->flag)
- return;
- if (comp_vdev == ch_filter->vdev)
- return;
- wlan_vdev_obj_lock(comp_vdev);
- chan = wlan_vdev_get_active_channel(comp_vdev);
- if (!chan) {
- wlan_vdev_obj_unlock(comp_vdev);
- return;
- }
- wlan_chan_copy(&vdev_chan, chan);
- wlan_vdev_obj_unlock(comp_vdev);
- wlan_vdev_obj_lock(ch_filter->vdev);
- iter_vdev_chan = wlan_vdev_mlme_get_des_chan(ch_filter->vdev);
- if (wlan_chan_eq(&vdev_chan, iter_vdev_chan)
- != QDF_STATUS_SUCCESS) {
- ch_filter->flag = 1;
- qdf_debug("==> iter vdev id: %d: ieee %d, mode %d",
- wlan_vdev_get_id(comp_vdev),
- vdev_chan.ch_ieee,
- vdev_chan.ch_phymode);
- qdf_debug("fl %016llx, fl-ext %08x, s1 %d, s2 %d ",
- vdev_chan.ch_flags, vdev_chan.ch_flagext,
- vdev_chan.ch_freq_seg1,
- vdev_chan.ch_freq_seg2);
- qdf_debug("==> base vdev id: %d: ieee %d mode %d",
- wlan_vdev_get_id(ch_filter->vdev),
- iter_vdev_chan->ch_ieee,
- iter_vdev_chan->ch_phymode);
- qdf_debug("fl %016llx, fl-ext %08x s1 %d, s2 %d",
- iter_vdev_chan->ch_flags,
- iter_vdev_chan->ch_flagext,
- iter_vdev_chan->ch_freq_seg1,
- iter_vdev_chan->ch_freq_seg2);
- }
- wlan_vdev_obj_unlock(ch_filter->vdev);
- }
- QDF_STATUS wlan_util_pdev_vdevs_deschan_match(struct wlan_objmgr_pdev *pdev,
- struct wlan_objmgr_vdev *vdev,
- wlan_objmgr_ref_dbgid dbg_id)
- {
- struct wlan_vdev_ch_check_filter ch_filter;
- if (!pdev)
- return QDF_STATUS_E_INVAL;
- if (wlan_pdev_nif_feat_cap_get(pdev, WLAN_PDEV_F_CHAN_CONCURRENCY))
- return QDF_STATUS_SUCCESS;
- if (wlan_objmgr_vdev_try_get_ref(vdev, dbg_id) == QDF_STATUS_SUCCESS) {
- ch_filter.flag = 0;
- ch_filter.vdev = vdev;
- wlan_objmgr_pdev_iterate_obj_list(pdev, WLAN_VDEV_OP,
- wlan_pdev_chan_match,
- &ch_filter, 0, dbg_id);
- wlan_objmgr_vdev_release_ref(vdev, dbg_id);
- if (ch_filter.flag == 0)
- return QDF_STATUS_SUCCESS;
- }
- return QDF_STATUS_E_FAILURE;
- }
- static void wlan_vdev_restart_progress(struct wlan_objmgr_pdev *pdev,
- void *object, void *arg)
- {
- struct wlan_objmgr_vdev *vdev = (struct wlan_objmgr_vdev *)object;
- uint8_t *flag = (uint8_t *)arg;
- wlan_vdev_obj_lock(vdev);
- if (wlan_vdev_is_restart_progress(vdev) == QDF_STATUS_SUCCESS)
- *flag = 1;
- wlan_vdev_obj_unlock(vdev);
- }
- QDF_STATUS wlan_util_is_pdev_restart_progress(struct wlan_objmgr_pdev *pdev,
- wlan_objmgr_ref_dbgid dbg_id)
- {
- uint8_t flag = 0;
- if (!pdev)
- return QDF_STATUS_E_INVAL;
- wlan_objmgr_pdev_iterate_obj_list(pdev, WLAN_VDEV_OP,
- wlan_vdev_restart_progress,
- &flag, 0, dbg_id);
- if (flag == 1)
- return QDF_STATUS_SUCCESS;
- return QDF_STATUS_E_INVAL;
- }
- static void wlan_vdev_scan_allowed(struct wlan_objmgr_pdev *pdev, void *object,
- void *arg)
- {
- struct wlan_objmgr_vdev *vdev = (struct wlan_objmgr_vdev *)object;
- uint8_t *flag = (uint8_t *)arg;
- wlan_vdev_obj_lock(vdev);
- if (wlan_vdev_mlme_is_scan_allowed(vdev) != QDF_STATUS_SUCCESS)
- *flag = 1;
- wlan_vdev_obj_unlock(vdev);
- }
- QDF_STATUS wlan_util_is_pdev_scan_allowed(struct wlan_objmgr_pdev *pdev,
- wlan_objmgr_ref_dbgid dbg_id)
- {
- uint8_t flag = 0;
- if (!pdev)
- return QDF_STATUS_E_INVAL;
- wlan_objmgr_pdev_iterate_obj_list(pdev, WLAN_VDEV_OP,
- wlan_vdev_scan_allowed,
- &flag, 0, dbg_id);
- if (flag == 1)
- return QDF_STATUS_E_FAILURE;
- return QDF_STATUS_SUCCESS;
- }
- void
- wlan_util_stats_get_rssi(bool db2dbm_enabled, int32_t bcn_snr, int32_t dat_snr,
- int8_t *rssi)
- {
- uint32_t snr;
- if (db2dbm_enabled) {
- if (TGT_IS_VALID_RSSI(bcn_snr))
- *rssi = bcn_snr;
- else if (TGT_IS_VALID_RSSI(dat_snr))
- *rssi = dat_snr;
- else
- *rssi = TGT_NOISE_FLOOR_DBM;
- } else {
- if (TGT_IS_VALID_SNR(bcn_snr))
- snr = bcn_snr;
- else if (TGT_IS_VALID_SNR(dat_snr))
- snr = dat_snr;
- else
- snr = TGT_INVALID_SNR;
- /* Get the absolute rssi value from the current rssi value */
- *rssi = snr + TGT_NOISE_FLOOR_DBM;
- }
- }
- /**
- * wlan_util_get_mode_specific_peer_count - This api gives vdev mode specific
- * peer count`
- * @pdev: PDEV object
- * @object: vdev object
- * @arg: argument passed by caller
- *
- * Return: void
- */
- static void
- wlan_util_get_mode_specific_peer_count(struct wlan_objmgr_pdev *pdev,
- void *object, void *arg)
- {
- struct wlan_objmgr_vdev *vdev = object;
- uint16_t temp_count = 0;
- struct wlan_op_mode_peer_count *count = arg;
- wlan_vdev_obj_lock(vdev);
- if (wlan_vdev_mlme_get_opmode(vdev) == count->opmode) {
- temp_count = wlan_vdev_get_peer_count(vdev);
- /* Decrement the self peer count */
- if (temp_count > 1)
- count->peer_count += (temp_count - 1);
- }
- wlan_vdev_obj_unlock(vdev);
- }
- uint16_t wlan_util_get_peer_count_for_mode(struct wlan_objmgr_pdev *pdev,
- enum QDF_OPMODE mode)
- {
- struct wlan_op_mode_peer_count count;
- count.opmode = mode;
- count.peer_count = 0;
- wlan_objmgr_pdev_iterate_obj_list(pdev, WLAN_VDEV_OP,
- wlan_util_get_mode_specific_peer_count, &count,
- 0, WLAN_OBJMGR_ID);
- return count.peer_count;
- }
- #ifdef CONFIG_QCA_MINIDUMP
- static bool wlan_minidump_log_enabled(struct wlan_objmgr_psoc *psoc,
- enum wlan_minidump_host_data type)
- {
- bool setval = false;
- switch (type) {
- case WLAN_MD_CP_EXT_PDEV:
- if (cfg_get(psoc, CFG_OL_MD_CP_EXT_PDEV))
- setval = true;
- break;
- case WLAN_MD_CP_EXT_PSOC:
- if (cfg_get(psoc, CFG_OL_MD_CP_EXT_PSOC))
- setval = true;
- break;
- case WLAN_MD_CP_EXT_VDEV:
- if (cfg_get(psoc, CFG_OL_MD_CP_EXT_VDEV))
- setval = true;
- break;
- case WLAN_MD_CP_EXT_PEER:
- if (cfg_get(psoc, CFG_OL_MD_CP_EXT_PEER))
- setval = true;
- break;
- case WLAN_MD_DP_SOC:
- if (cfg_get(psoc, CFG_OL_MD_DP_SOC))
- setval = true;
- break;
- case WLAN_MD_DP_PDEV:
- if (cfg_get(psoc, CFG_OL_MD_DP_PDEV))
- setval = true;
- break;
- case WLAN_MD_DP_PEER:
- if (cfg_get(psoc, CFG_OL_MD_DP_PEER))
- setval = true;
- break;
- case WLAN_MD_DP_SRNG_REO_DEST:
- case WLAN_MD_DP_SRNG_REO_EXCEPTION:
- case WLAN_MD_DP_SRNG_RX_REL:
- case WLAN_MD_DP_SRNG_REO_REINJECT:
- case WLAN_MD_DP_SRNG_REO_CMD:
- case WLAN_MD_DP_SRNG_REO_STATUS:
- if (cfg_get(psoc, CFG_OL_MD_DP_SRNG_REO))
- setval = true;
- break;
- case WLAN_MD_DP_SRNG_TCL_DATA:
- case WLAN_MD_DP_SRNG_TCL_CMD:
- case WLAN_MD_DP_SRNG_TCL_STATUS:
- case WLAN_MD_DP_SRNG_TX_COMP:
- if (cfg_get(psoc, CFG_OL_MD_DP_SRNG_TCL))
- setval = true;
- break;
- case WLAN_MD_DP_SRNG_WBM_DESC_REL:
- case WLAN_MD_DP_SRNG_WBM_IDLE_LINK:
- if (cfg_get(psoc, CFG_OL_MD_DP_SRNG_WBM))
- setval = true;
- break;
- case WLAN_MD_DP_LINK_DESC_BANK:
- if (cfg_get(psoc, CFG_OL_MD_DP_LINK_DESC_BANK))
- setval = true;
- break;
- case WLAN_MD_DP_SRNG_RXDMA_MON_BUF:
- case WLAN_MD_DP_SRNG_RXDMA_MON_DST:
- case WLAN_MD_DP_SRNG_RXDMA_MON_DESC:
- case WLAN_MD_DP_SRNG_RXDMA_ERR_DST:
- case WLAN_MD_DP_SRNG_RXDMA_MON_STATUS:
- if (cfg_get(psoc, CFG_OL_MD_DP_SRNG_RXDMA))
- setval = true;
- break;
- case WLAN_MD_DP_HAL_SOC:
- if (cfg_get(psoc, CFG_OL_MD_DP_HAL_SOC))
- setval = true;
- break;
- case WLAN_MD_OBJMGR_PSOC:
- case WLAN_MD_OBJMGR_PSOC_TGT_INFO:
- if (cfg_get(psoc, CFG_OL_MD_OBJMGR_PSOC))
- setval = true;
- break;
- case WLAN_MD_OBJMGR_PDEV:
- case WLAN_MD_OBJMGR_PDEV_MLME:
- if (cfg_get(psoc, CFG_OL_MD_OBJMGR_PDEV))
- setval = true;
- break;
- case WLAN_MD_OBJMGR_VDEV_MLME:
- case WLAN_MD_OBJMGR_VDEV_SM:
- case WLAN_MD_OBJMGR_VDEV:
- if (cfg_get(psoc, CFG_OL_MD_OBJMGR_VDEV))
- setval = true;
- break;
- default:
- qdf_debug("Minidump: Type not implemented");
- }
- return setval;
- }
- #else /* CONFIG_QCA_MINIDUMP */
- static bool wlan_minidump_log_enabled(struct wlan_objmgr_psoc *psoc,
- enum wlan_minidump_host_data type)
- {
- return false;
- }
- #endif
- void wlan_minidump_log(void *start_addr, const size_t size,
- void *psoc_obj,
- enum wlan_minidump_host_data type,
- const char *name)
- {
- struct wlan_objmgr_psoc *psoc;
- if (!psoc_obj) {
- qdf_debug("Minidump: Psoc is NULL");
- return;
- }
- psoc = (struct wlan_objmgr_psoc *)psoc_obj;
- if (psoc && wlan_minidump_log_enabled(psoc, type))
- qdf_minidump_log(start_addr, size, name);
- }
- qdf_export_symbol(wlan_minidump_log);
- void wlan_minidump_remove(void *start_addr, const size_t size,
- void *psoc_obj,
- enum wlan_minidump_host_data type,
- const char *name)
- {
- struct wlan_objmgr_psoc *psoc;
- if (!psoc_obj) {
- qdf_debug("Minidump: Psoc is NULL");
- return;
- }
- psoc = (struct wlan_objmgr_psoc *)psoc_obj;
- if (psoc && wlan_minidump_log_enabled(psoc, type))
- qdf_minidump_remove(start_addr, size, name);
- }
- qdf_export_symbol(wlan_minidump_remove);
|