gl_kal.c 124 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473347434753476347734783479348034813482348334843485348634873488348934903491349234933494349534963497349834993500350135023503350435053506350735083509351035113512351335143515351635173518351935203521352235233524352535263527352835293530353135323533353435353536353735383539354035413542354335443545354635473548354935503551355235533554355535563557355835593560356135623563356435653566356735683569357035713572357335743575357635773578357935803581358235833584358535863587358835893590359135923593359435953596359735983599360036013602360336043605360636073608360936103611361236133614361536163617361836193620362136223623362436253626362736283629363036313632363336343635363636373638363936403641364236433644364536463647364836493650365136523653365436553656365736583659366036613662366336643665366636673668366936703671367236733674367536763677367836793680368136823683368436853686368736883689369036913692369336943695369636973698369937003701370237033704370537063707370837093710371137123713371437153716371737183719372037213722372337243725372637273728372937303731373237333734373537363737373837393740374137423743374437453746374737483749375037513752375337543755375637573758375937603761376237633764376537663767376837693770377137723773377437753776377737783779378037813782378337843785378637873788378937903791379237933794379537963797379837993800380138023803380438053806380738083809381038113812381338143815381638173818381938203821382238233824382538263827382838293830383138323833383438353836383738383839384038413842384338443845384638473848384938503851385238533854385538563857385838593860386138623863386438653866386738683869387038713872387338743875387638773878387938803881388238833884388538863887388838893890389138923893389438953896389738983899390039013902390339043905390639073908390939103911391239133914391539163917391839193920392139223923392439253926392739283929393039313932393339343935393639373938393939403941394239433944394539463947394839493950395139523953395439553956395739583959396039613962396339643965396639673968396939703971397239733974397539763977397839793980398139823983398439853986398739883989399039913992399339943995399639973998399940004001400240034004400540064007400840094010401140124013401440154016401740184019402040214022402340244025402640274028402940304031403240334034403540364037403840394040404140424043404440454046404740484049405040514052405340544055405640574058405940604061406240634064406540664067406840694070407140724073407440754076407740784079408040814082408340844085408640874088408940904091409240934094409540964097409840994100410141024103410441054106410741084109411041114112411341144115411641174118411941204121412241234124412541264127412841294130413141324133413441354136413741384139414041414142414341444145414641474148414941504151415241534154415541564157415841594160416141624163416441654166416741684169417041714172417341744175417641774178417941804181418241834184418541864187418841894190419141924193419441954196419741984199420042014202420342044205420642074208420942104211421242134214421542164217421842194220
  1. /*
  2. * This program is free software; you can redistribute it and/or modify
  3. * it under the terms of the GNU General Public License version 2 as
  4. * published by the Free Software Foundation.
  5. *
  6. * This program is distributed in the hope that it will be useful,
  7. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  8. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
  9. * See http://www.gnu.org/licenses/gpl-2.0.html for more details.
  10. */
  11. /*******************************************************************************
  12. * C O M P I L E R F L A G S
  13. ********************************************************************************
  14. */
  15. /*******************************************************************************
  16. * E X T E R N A L R E F E R E N C E S
  17. ********************************************************************************
  18. */
  19. #include "gl_os.h"
  20. #include "gl_wext.h"
  21. #include "precomp.h"
  22. #if defined(CONFIG_MTK_TC1_FEATURE)
  23. #include <tc1_partition.h>
  24. #endif
  25. #if CFG_SUPPORT_AGPS_ASSIST
  26. #include <net/netlink.h>
  27. #endif
  28. #if CFG_SUPPORT_WAKEUP_REASON_DEBUG
  29. #include <mt_sleep.h>
  30. #endif
  31. /*******************************************************************************
  32. * C O N S T A N T S
  33. ********************************************************************************
  34. */
  35. /*******************************************************************************
  36. * D A T A T Y P E S
  37. ********************************************************************************
  38. */
  39. /*******************************************************************************
  40. * P U B L I C D A T A
  41. ********************************************************************************
  42. */
  43. #if DBG
  44. int allocatedMemSize = 0;
  45. #endif
  46. /*******************************************************************************
  47. * P R I V A T E D A T A
  48. ********************************************************************************
  49. */
  50. /* #define MTK_DMA_BUF_MEMCPY_SUP */
  51. static PVOID pvIoBuffer;
  52. #ifdef MTK_DMA_BUF_MEMCPY_SUP
  53. static PVOID pvIoPhyBuf;
  54. static PVOID pvDmaBuffer;
  55. static PVOID pvDmaPhyBuf;
  56. #endif /* MTK_DMA_BUF_MEMCPY_SUP */
  57. static UINT_32 pvIoBufferSize;
  58. static UINT_32 pvIoBufferUsage;
  59. /* framebuffer callback related variable and status flag */
  60. static struct notifier_block wlan_fb_notifier;
  61. void *wlan_fb_notifier_priv_data = NULL;
  62. BOOLEAN wlan_fb_power_down = FALSE;
  63. static struct KAL_HALT_CTRL_T rHaltCtrl = {
  64. .lock = __SEMAPHORE_INITIALIZER(rHaltCtrl.lock, 1),
  65. .owner = NULL,
  66. .fgHalt = TRUE,
  67. .fgHeldByKalIoctl = FALSE,
  68. .u4HoldStart = 0,
  69. };
  70. /*******************************************************************************
  71. * M A C R O S
  72. ********************************************************************************
  73. */
  74. /*******************************************************************************
  75. * F U N C T I O N D E C L A R A T I O N S
  76. ********************************************************************************
  77. */
  78. #if defined(MT6620) && CFG_MULTI_ECOVER_SUPPORT
  79. typedef enum _ENUM_WMTHWVER_TYPE_T {
  80. WMTHWVER_MT6620_E1 = 0x0,
  81. WMTHWVER_MT6620_E2 = 0x1,
  82. WMTHWVER_MT6620_E3 = 0x2,
  83. WMTHWVER_MT6620_E4 = 0x3,
  84. WMTHWVER_MT6620_E5 = 0x4,
  85. WMTHWVER_MT6620_E6 = 0x5,
  86. WMTHWVER_MT6620_MAX,
  87. WMTHWVER_INVALID = 0xff
  88. } ENUM_WMTHWVER_TYPE_T, *P_ENUM_WMTHWVER_TYPE_T;
  89. #endif
  90. /*******************************************************************************
  91. * F U N C T I O N S
  92. ********************************************************************************
  93. */
  94. VOID kalHifAhbKalWakeLockTimeout(IN P_GLUE_INFO_T prGlueInfo)
  95. {
  96. KAL_WAKE_LOCK_TIMEOUT(prGlueInfo->prAdapter, &(prGlueInfo->rAhbIsrWakeLock), (HZ / 10)); /* 100ms */
  97. }
  98. #if CFG_ENABLE_FW_DOWNLOAD
  99. static struct file *filp;
  100. static uid_t orgfsuid;
  101. static gid_t orgfsgid;
  102. static mm_segment_t orgfs;
  103. /*----------------------------------------------------------------------------*/
  104. /*!
  105. * \brief This function is provided by GLUE Layer for internal driver stack to
  106. * open firmware image in kernel space
  107. *
  108. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  109. *
  110. * \retval WLAN_STATUS_SUCCESS.
  111. * \retval WLAN_STATUS_FAILURE.
  112. *
  113. */
  114. /*----------------------------------------------------------------------------*/
  115. WLAN_STATUS kalFirmwareOpen(IN P_GLUE_INFO_T prGlueInfo)
  116. {
  117. UINT_8 aucFilePath[50];
  118. /* FIX ME: since we don't have hotplug script in the filesystem
  119. * , so the request_firmware() KAPI can not work properly
  120. */
  121. /* save uid and gid used for filesystem access.
  122. * set user and group to 0(root) */
  123. struct cred *cred = (struct cred *)get_current_cred();
  124. orgfsuid = cred->fsuid.val;
  125. orgfsgid = cred->fsgid.val;
  126. cred->fsuid.val = cred->fsgid.val = 0;
  127. ASSERT(prGlueInfo);
  128. orgfs = get_fs();
  129. set_fs(get_ds());
  130. /* open the fw file */
  131. #if defined(MT6620) & CFG_MULTI_ECOVER_SUPPORT
  132. switch (mtk_wcn_wmt_hwver_get()) {
  133. case WMTHWVER_MT6620_E1:
  134. case WMTHWVER_MT6620_E2:
  135. case WMTHWVER_MT6620_E3:
  136. case WMTHWVER_MT6620_E4:
  137. case WMTHWVER_MT6620_E5:
  138. filp = filp_open("/etc/firmware/" CFG_FW_FILENAME, O_RDONLY, 0);
  139. break;
  140. case WMTHWVER_MT6620_E6:
  141. default:
  142. filp = filp_open("/etc/firmware/" CFG_FW_FILENAME "_E6", O_RDONLY, 0);
  143. break;
  144. }
  145. #elif defined(MT6628)
  146. /* filp = filp_open("/etc/firmware/"CFG_FW_FILENAME"_MT6628", O_RDONLY, 0); */
  147. /* filp = filp_open("/etc/firmware/"CFG_FW_FILENAME"_MT6582", O_RDONLY, 0); */
  148. #if 0 /* new wifi ram code mechanism, waiting firmware ready, then we can enable these code */
  149. kalMemZero(aucFilePath, sizeof(aucFilePath));
  150. kalMemCopy(aucFilePath, "/etc/firmware/" CFG_FW_FILENAME "_AD", sizeof("/etc/firmware/" CFG_FW_FILENAME "_AD"));
  151. filp = filp_open(aucFilePath, O_RDONLY, 0);
  152. if (!IS_ERR(filp))
  153. goto open_success;
  154. #endif
  155. kalMemZero(aucFilePath, sizeof(aucFilePath));
  156. kalMemCopy(aucFilePath, "/etc/firmware/" CFG_FW_FILENAME "_", strlen("/etc/firmware/" CFG_FW_FILENAME "_"));
  157. glGetChipInfo(prGlueInfo, &aucFilePath[strlen("/etc/firmware/" CFG_FW_FILENAME "_")]);
  158. DBGLOG(INIT, INFO, "open file: %s\n", aucFilePath);
  159. filp = filp_open(aucFilePath, O_RDONLY, 0);
  160. #else
  161. filp = filp_open("/etc/firmware/" CFG_FW_FILENAME, O_RDONLY, 0);
  162. #endif
  163. if (IS_ERR(filp)) {
  164. DBGLOG(INIT, ERROR, "Open FW image: %s failed\n", CFG_FW_FILENAME);
  165. goto error_open;
  166. }
  167. #if 0
  168. open_success:
  169. #endif
  170. DBGLOG(INIT, TRACE, "Open FW image: %s done\n", CFG_FW_FILENAME);
  171. return WLAN_STATUS_SUCCESS;
  172. error_open:
  173. /* restore */
  174. set_fs(orgfs);
  175. cred->fsuid.val = orgfsuid;
  176. cred->fsgid.val = orgfsgid;
  177. put_cred(cred);
  178. return WLAN_STATUS_FAILURE;
  179. }
  180. /*----------------------------------------------------------------------------*/
  181. /*!
  182. * \brief This function is provided by GLUE Layer for internal driver stack to
  183. * release firmware image in kernel space
  184. *
  185. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  186. *
  187. * \retval WLAN_STATUS_SUCCESS.
  188. * \retval WLAN_STATUS_FAILURE.
  189. *
  190. */
  191. /*----------------------------------------------------------------------------*/
  192. WLAN_STATUS kalFirmwareClose(IN P_GLUE_INFO_T prGlueInfo)
  193. {
  194. ASSERT(prGlueInfo);
  195. if ((filp != NULL) && !IS_ERR(filp)) {
  196. /* close firmware file */
  197. filp_close(filp, NULL);
  198. /* restore */
  199. set_fs(orgfs);
  200. {
  201. struct cred *cred = (struct cred *)get_current_cred();
  202. cred->fsuid.val = orgfsuid;
  203. cred->fsgid.val = orgfsgid;
  204. put_cred(cred);
  205. }
  206. filp = NULL;
  207. }
  208. return WLAN_STATUS_SUCCESS;
  209. }
  210. /*----------------------------------------------------------------------------*/
  211. /*!
  212. * \brief This function is provided by GLUE Layer for internal driver stack to
  213. * load firmware image in kernel space
  214. *
  215. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  216. *
  217. * \retval WLAN_STATUS_SUCCESS.
  218. * \retval WLAN_STATUS_FAILURE.
  219. *
  220. */
  221. /*----------------------------------------------------------------------------*/
  222. WLAN_STATUS kalFirmwareLoad(IN P_GLUE_INFO_T prGlueInfo, OUT PVOID prBuf, IN UINT_32 u4Offset, OUT PUINT_32 pu4Size)
  223. {
  224. ASSERT(prGlueInfo);
  225. ASSERT(pu4Size);
  226. ASSERT(prBuf);
  227. /* l = filp->f_path.dentry->d_inode->i_size; */
  228. /* the object must have a read method */
  229. if ((filp == NULL) || IS_ERR(filp) || (filp->f_op == NULL) || (filp->f_op->read == NULL)) {
  230. goto error_read;
  231. } else {
  232. filp->f_pos = u4Offset;
  233. *pu4Size = filp->f_op->read(filp, prBuf, *pu4Size, &filp->f_pos);
  234. }
  235. return WLAN_STATUS_SUCCESS;
  236. error_read:
  237. return WLAN_STATUS_FAILURE;
  238. }
  239. /*----------------------------------------------------------------------------*/
  240. /*!
  241. * \brief This function is provided by GLUE Layer for internal driver stack to
  242. * query firmware image size in kernel space
  243. *
  244. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  245. *
  246. * \retval WLAN_STATUS_SUCCESS.
  247. * \retval WLAN_STATUS_FAILURE.
  248. *
  249. */
  250. /*----------------------------------------------------------------------------*/
  251. WLAN_STATUS kalFirmwareSize(IN P_GLUE_INFO_T prGlueInfo, OUT PUINT_32 pu4Size)
  252. {
  253. ASSERT(prGlueInfo);
  254. ASSERT(pu4Size);
  255. *pu4Size = filp->f_path.dentry->d_inode->i_size;
  256. return WLAN_STATUS_SUCCESS;
  257. }
  258. /*----------------------------------------------------------------------------*/
  259. /*!
  260. * \brief This routine is used to load firmware image
  261. *
  262. * \param pvGlueInfo Pointer of GLUE Data Structure
  263. * \param ppvMapFileBuf Pointer of pointer to memory-mapped firmware image
  264. * \param pu4FileLength File length and memory mapped length as well
  265. * \retval Map File Handle, used for unammping
  266. */
  267. /*----------------------------------------------------------------------------*/
  268. PVOID kalFirmwareImageMapping(IN P_GLUE_INFO_T prGlueInfo, OUT PPVOID ppvMapFileBuf, OUT PUINT_32 pu4FileLength)
  269. {
  270. UINT_32 u4FwSize = 0;
  271. PVOID prFwBuffer = NULL;
  272. DEBUGFUNC("kalFirmwareImageMapping");
  273. ASSERT(prGlueInfo);
  274. ASSERT(ppvMapFileBuf);
  275. ASSERT(pu4FileLength);
  276. do {
  277. /* <1> Open firmware */
  278. if (kalFirmwareOpen(prGlueInfo) != WLAN_STATUS_SUCCESS) {
  279. DBGLOG(INIT, TRACE, "kalFirmwareOpen fail!\n");
  280. break;
  281. }
  282. /* <2> Query firmare size */
  283. kalFirmwareSize(prGlueInfo, &u4FwSize);
  284. /* <3> Use vmalloc for allocating large memory trunk */
  285. prFwBuffer = vmalloc(ALIGN_4(u4FwSize));
  286. /* <4> Load image binary into buffer */
  287. if (kalFirmwareLoad(prGlueInfo, prFwBuffer, 0, &u4FwSize) != WLAN_STATUS_SUCCESS) {
  288. vfree(prFwBuffer);
  289. kalFirmwareClose(prGlueInfo);
  290. DBGLOG(INIT, TRACE, "kalFirmwareLoad fail!\n");
  291. break;
  292. }
  293. /* <5> write back info */
  294. *pu4FileLength = u4FwSize;
  295. *ppvMapFileBuf = prFwBuffer;
  296. return prFwBuffer;
  297. } while (FALSE);
  298. return NULL;
  299. }
  300. /*----------------------------------------------------------------------------*/
  301. /*!
  302. * \brief This routine is used to unload firmware image mapped memory
  303. *
  304. * \param pvGlueInfo Pointer of GLUE Data Structure
  305. * \param pvFwHandle Pointer to mapping handle
  306. * \param pvMapFileBuf Pointer to memory-mapped firmware image
  307. *
  308. * \retval none
  309. */
  310. /*----------------------------------------------------------------------------*/
  311. VOID kalFirmwareImageUnmapping(IN P_GLUE_INFO_T prGlueInfo, IN PVOID prFwHandle, IN PVOID pvMapFileBuf)
  312. {
  313. DEBUGFUNC("kalFirmwareImageUnmapping");
  314. ASSERT(prGlueInfo);
  315. /* pvMapFileBuf might be NULL when file doesn't exist */
  316. if (pvMapFileBuf)
  317. vfree(pvMapFileBuf);
  318. kalFirmwareClose(prGlueInfo);
  319. }
  320. #endif
  321. #if 0
  322. /*----------------------------------------------------------------------------*/
  323. /*!
  324. * \brief This routine is used to load firmware image
  325. *
  326. * \param pvGlueInfo Pointer of GLUE Data Structure
  327. * \param ppvMapFileBuf Pointer of pointer to memory-mapped firmware image
  328. * \param pu4FileLength File length and memory mapped length as well
  329. * \retval Map File Handle, used for unammping
  330. */
  331. /*----------------------------------------------------------------------------*/
  332. PVOID kalFirmwareImageMapping(IN P_GLUE_INFO_T prGlueInfo, OUT PPVOID ppvMapFileBuf, OUT PUINT_32 pu4FileLength)
  333. {
  334. INT_32 i4Ret = 0;
  335. DEBUGFUNC("kalFirmwareImageMapping");
  336. ASSERT(prGlueInfo);
  337. ASSERT(ppvMapFileBuf);
  338. ASSERT(pu4FileLength);
  339. do {
  340. GL_HIF_INFO_T *prHifInfo = &prGlueInfo->rHifInfo;
  341. prGlueInfo->prFw = NULL;
  342. /* <1> Open firmware */
  343. i4Ret = request_firmware(&prGlueInfo->prFw, CFG_FW_FILENAME, prHifInfo->Dev);
  344. if (i4Ret) {
  345. DBGLOG(INIT, TRACE, "fw %s:request failed %d\n", CFG_FW_FILENAME, i4Ret);
  346. break;
  347. }
  348. *pu4FileLength = prGlueInfo->prFw->size;
  349. *ppvMapFileBuf = prGlueInfo->prFw->data;
  350. return prGlueInfo->prFw->data;
  351. } while (FALSE);
  352. return NULL;
  353. }
  354. /*----------------------------------------------------------------------------*/
  355. /*!
  356. * \brief This routine is used to unload firmware image mapped memory
  357. *
  358. * \param pvGlueInfo Pointer of GLUE Data Structure
  359. * \param pvFwHandle Pointer to mapping handle
  360. * \param pvMapFileBuf Pointer to memory-mapped firmware image
  361. *
  362. * \retval none
  363. */
  364. /*----------------------------------------------------------------------------*/
  365. VOID kalFirmwareImageUnmapping(IN P_GLUE_INFO_T prGlueInfo, IN PVOID prFwHandle, IN PVOID pvMapFileBuf)
  366. {
  367. DEBUGFUNC("kalFirmwareImageUnmapping");
  368. ASSERT(prGlueInfo);
  369. ASSERT(pvMapFileBuf);
  370. release_firmware(prGlueInfo->prFw);
  371. }
  372. #endif
  373. /*----------------------------------------------------------------------------*/
  374. /*!
  375. * \brief This function is provided by GLUE Layer for internal driver stack to acquire
  376. * OS SPIN_LOCK.
  377. *
  378. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  379. * \param[in] rLockCategory Specify which SPIN_LOCK
  380. * \param[out] pu4Flags Pointer of a variable for saving IRQ flags
  381. *
  382. * \return (none)
  383. */
  384. /*----------------------------------------------------------------------------*/
  385. VOID
  386. kalAcquireSpinLock(IN P_GLUE_INFO_T prGlueInfo, IN ENUM_SPIN_LOCK_CATEGORY_E rLockCategory, OUT unsigned long *pu4Flags)
  387. {
  388. unsigned long u4Flags = 0;
  389. ASSERT(prGlueInfo);
  390. ASSERT(pu4Flags);
  391. if (rLockCategory < SPIN_LOCK_NUM) {
  392. #if CFG_USE_SPIN_LOCK_BOTTOM_HALF
  393. spin_lock_bh(&prGlueInfo->rSpinLock[rLockCategory]);
  394. #else /* !CFG_USE_SPIN_LOCK_BOTTOM_HALF */
  395. spin_lock_irqsave(&prGlueInfo->rSpinLock[rLockCategory], u4Flags);
  396. #endif /* !CFG_USE_SPIN_LOCK_BOTTOM_HALF */
  397. *pu4Flags = u4Flags;
  398. /* DBGLOG(INIT, TRACE, ("A+%d\n", rLockCategory)); */
  399. }
  400. } /* end of kalAcquireSpinLock() */
  401. /*----------------------------------------------------------------------------*/
  402. /*!
  403. * \brief This function is provided by GLUE Layer for internal driver stack to release
  404. * OS SPIN_LOCK.
  405. *
  406. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  407. * \param[in] rLockCategory Specify which SPIN_LOCK
  408. * \param[in] u4Flags Saved IRQ flags
  409. *
  410. * \return (none)
  411. */
  412. /*----------------------------------------------------------------------------*/
  413. VOID kalReleaseSpinLock(IN P_GLUE_INFO_T prGlueInfo, IN ENUM_SPIN_LOCK_CATEGORY_E rLockCategory, IN UINT_32 u4Flags)
  414. {
  415. ASSERT(prGlueInfo);
  416. if (rLockCategory < SPIN_LOCK_NUM) {
  417. /* DBGLOG(INIT, TRACE, ("A-%d %d %d\n", rLockCategory, u4MemAllocCnt, u4MemFreeCnt)); */
  418. #if CFG_USE_SPIN_LOCK_BOTTOM_HALF
  419. spin_unlock_bh(&prGlueInfo->rSpinLock[rLockCategory]);
  420. #else /* !CFG_USE_SPIN_LOCK_BOTTOM_HALF */
  421. spin_unlock_irqrestore(&prGlueInfo->rSpinLock[rLockCategory], u4Flags);
  422. #endif /* !CFG_USE_SPIN_LOCK_BOTTOM_HALF */
  423. }
  424. } /* end of kalReleaseSpinLock() */
  425. /*----------------------------------------------------------------------------*/
  426. /*!
  427. * \brief This function is provided by GLUE Layer for internal driver stack to update
  428. * current MAC address.
  429. *
  430. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  431. * \param[in] pucMacAddr Pointer of current MAC address
  432. *
  433. * \return (none)
  434. */
  435. /*----------------------------------------------------------------------------*/
  436. VOID kalUpdateMACAddress(IN P_GLUE_INFO_T prGlueInfo, IN PUINT_8 pucMacAddr)
  437. {
  438. ASSERT(prGlueInfo);
  439. ASSERT(pucMacAddr);
  440. if (UNEQUAL_MAC_ADDR(prGlueInfo->prDevHandler->dev_addr, pucMacAddr))
  441. memcpy(prGlueInfo->prDevHandler->dev_addr, pucMacAddr, PARAM_MAC_ADDR_LEN);
  442. }
  443. #if CFG_TCP_IP_CHKSUM_OFFLOAD
  444. /*----------------------------------------------------------------------------*/
  445. /*!
  446. * \brief To query the packet information for offload related parameters.
  447. *
  448. * \param[in] pvPacket Pointer to the packet descriptor.
  449. * \param[in] pucFlag Points to the offload related parameter.
  450. *
  451. * \return (none)
  452. *
  453. */
  454. /*----------------------------------------------------------------------------*/
  455. VOID kalQueryTxChksumOffloadParam(IN PVOID pvPacket, OUT PUINT_8 pucFlag)
  456. {
  457. struct sk_buff *skb = (struct sk_buff *)pvPacket;
  458. UINT_8 ucFlag = 0;
  459. ASSERT(pvPacket);
  460. ASSERT(pucFlag);
  461. if (skb->ip_summed == CHECKSUM_PARTIAL) {
  462. #if DBG
  463. /* Kevin: do double check, we can remove this part in Normal Driver.
  464. * Because we register NIC feature with NETIF_F_IP_CSUM for MT5912B MAC, so
  465. * we'll process IP packet only.
  466. */
  467. if (skb->protocol != htons(ETH_P_IP)) {
  468. /* printk("Wrong skb->protocol( = %08x) for TX Checksum Offload.\n", skb->protocol); */
  469. } else
  470. #endif
  471. ucFlag |= (TX_CS_IP_GEN | TX_CS_TCP_UDP_GEN);
  472. }
  473. *pucFlag = ucFlag;
  474. } /* kalQueryChksumOffloadParam */
  475. /* 4 2007/10/8, mikewu, this is rewritten by Mike */
  476. /*----------------------------------------------------------------------------*/
  477. /*!
  478. * \brief To update the checksum offload status to the packet to be indicated to OS.
  479. *
  480. * \param[in] pvPacket Pointer to the packet descriptor.
  481. * \param[in] pucFlag Points to the offload related parameter.
  482. *
  483. * \return (none)
  484. *
  485. */
  486. /*----------------------------------------------------------------------------*/
  487. VOID kalUpdateRxCSUMOffloadParam(IN PVOID pvPacket, IN ENUM_CSUM_RESULT_T aeCSUM[])
  488. {
  489. struct sk_buff *skb = (struct sk_buff *)pvPacket;
  490. ASSERT(pvPacket);
  491. if ((aeCSUM[CSUM_TYPE_IPV4] == CSUM_RES_SUCCESS || aeCSUM[CSUM_TYPE_IPV6] == CSUM_RES_SUCCESS) &&
  492. ((aeCSUM[CSUM_TYPE_TCP] == CSUM_RES_SUCCESS) || (aeCSUM[CSUM_TYPE_UDP] == CSUM_RES_SUCCESS))) {
  493. skb->ip_summed = CHECKSUM_UNNECESSARY;
  494. } else {
  495. skb->ip_summed = CHECKSUM_NONE;
  496. #if DBG
  497. if (aeCSUM[CSUM_TYPE_IPV4] == CSUM_RES_NONE && aeCSUM[CSUM_TYPE_IPV6] == CSUM_RES_NONE)
  498. DBGLOG(RX, TRACE, "RX: \"non-IPv4/IPv6\" Packet\n");
  499. else if (aeCSUM[CSUM_TYPE_IPV4] == CSUM_RES_FAILED)
  500. DBGLOG(RX, TRACE, "RX: \"bad IP Checksum\" Packet\n");
  501. else if (aeCSUM[CSUM_TYPE_TCP] == CSUM_RES_FAILED)
  502. DBGLOG(RX, TRACE, "RX: \"bad TCP Checksum\" Packet\n");
  503. else if (aeCSUM[CSUM_TYPE_UDP] == CSUM_RES_FAILED)
  504. DBGLOG(RX, TRACE, "RX: \"bad UDP Checksum\" Packet\n");
  505. else
  506. /* Do nothing */
  507. #endif
  508. }
  509. } /* kalUpdateRxCSUMOffloadParam */
  510. #endif /* CFG_TCP_IP_CHKSUM_OFFLOAD */
  511. /*----------------------------------------------------------------------------*/
  512. /*!
  513. * \brief This function is called to free packet allocated from kalPacketAlloc.
  514. *
  515. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  516. * \param[in] pvPacket Pointer of the packet descriptor
  517. *
  518. * \return (none)
  519. */
  520. /*----------------------------------------------------------------------------*/
  521. VOID kalPacketFree(IN P_GLUE_INFO_T prGlueInfo, IN PVOID pvPacket)
  522. {
  523. dev_kfree_skb((struct sk_buff *)pvPacket);
  524. }
  525. /*----------------------------------------------------------------------------*/
  526. /*!
  527. * \brief Only handles driver own creating packet (coalescing buffer).
  528. *
  529. * \param prGlueInfo Pointer of GLUE Data Structure
  530. * \param u4Size Pointer of Packet Handle
  531. * \param ppucData Status Code for OS upper layer
  532. *
  533. * \return NULL: Failed to allocate skb, Not NULL get skb
  534. */
  535. /*----------------------------------------------------------------------------*/
  536. PVOID kalPacketAlloc(IN P_GLUE_INFO_T prGlueInfo, IN UINT_32 u4Size, OUT PUINT_8 *ppucData)
  537. {
  538. struct sk_buff *prSkb = dev_alloc_skb(u4Size);
  539. if (prSkb)
  540. *ppucData = (PUINT_8) (prSkb->data);
  541. else
  542. DBGLOG(RX, WARN, "kalPacketAlloc fail!!\n");
  543. #if DBG
  544. {
  545. PUINT_32 pu4Head = (PUINT_32) &prSkb->cb[0];
  546. *pu4Head = (UINT_32) prSkb->head;
  547. DBGLOG(RX, TRACE, "prSkb->head = %#x, prSkb->cb = %#x\n", (UINT_32) prSkb->head, *pu4Head);
  548. }
  549. #endif
  550. return (PVOID) prSkb;
  551. }
  552. /*----------------------------------------------------------------------------*/
  553. /*!
  554. * \brief Process the received packet for indicating to OS.
  555. *
  556. * \param[in] prGlueInfo Pointer to the Adapter structure.
  557. * \param[in] pvPacket Pointer of the packet descriptor
  558. * \param[in] pucPacketStart The starting address of the buffer of Rx packet.
  559. * \param[in] u4PacketLen The packet length.
  560. * \param[in] pfgIsRetain Is the packet to be retained.
  561. * \param[in] aerCSUM The result of TCP/ IP checksum offload.
  562. *
  563. * \retval WLAN_STATUS_SUCCESS.
  564. * \retval WLAN_STATUS_FAILURE.
  565. *
  566. */
  567. /*----------------------------------------------------------------------------*/
  568. WLAN_STATUS
  569. kalProcessRxPacket(IN P_GLUE_INFO_T prGlueInfo, IN PVOID pvPacket, IN PUINT_8 pucPacketStart, IN UINT_32 u4PacketLen,
  570. /* IN PBOOLEAN pfgIsRetain, */
  571. IN BOOLEAN fgIsRetain, IN ENUM_CSUM_RESULT_T aerCSUM[])
  572. {
  573. WLAN_STATUS rStatus = WLAN_STATUS_SUCCESS;
  574. struct sk_buff *skb = (struct sk_buff *)pvPacket;
  575. skb->data = pucPacketStart;
  576. skb_reset_tail_pointer(skb); /* reset tail pointer first, for 64bit kernel,we should call linux kernel API */
  577. skb_trim(skb, 0); /* only if skb->len > len, then skb_trim has effect */
  578. skb_put(skb, u4PacketLen); /* shift tail and skb->len to correct value */
  579. #if CFG_TCP_IP_CHKSUM_OFFLOAD
  580. kalUpdateRxCSUMOffloadParam(skb, aerCSUM);
  581. #endif
  582. return rStatus;
  583. }
  584. #if (CONF_HIF_LOOPBACK_AUTO == 1)
  585. /*----------------------------------------------------------------------------*/
  586. /*!
  587. * \brief Do HIF loopback test.
  588. *
  589. * \param[in] GlueInfo Pointer to the GLUE_INFO_T structure.
  590. *
  591. * \retval None
  592. */
  593. /*----------------------------------------------------------------------------*/
  594. unsigned int testmode = 0;
  595. unsigned int testlen = 64;
  596. void kalDevLoopbkAuto(IN GLUE_INFO_T *GlueInfo)
  597. {
  598. #define HIF_LOOPBK_AUTO_TEST_LEN 1600
  599. /* GL_HIF_INFO_T *HifInfo; */
  600. static unsigned int txcnt;
  601. struct sk_buff *MsduInfo;
  602. UINT_8 *Pkt;
  603. UINT_32 RegVal;
  604. UINT_32 PktLen = 16;
  605. /* Init */
  606. if (testmode != 0) {
  607. PktLen = kalRandomNumber() % 1520;
  608. if (PktLen < 64)
  609. PktLen = 64;
  610. } else {
  611. PktLen = testlen++;
  612. if (PktLen > 1520) {
  613. testmode = 1;
  614. PktLen = 64;
  615. }
  616. }
  617. /* PktLen = 100; */
  618. DBGLOG(INIT, INFO, "kalDevLoopbkAuto> Send a packet to HIF (len = %d) (total = %d)...\n", PktLen, ++txcnt);
  619. /* HifInfo = &GlueInfo->rHifInfo; */
  620. /* Allocate a MSDU_INFO_T */
  621. MsduInfo = kalPacketAlloc(GlueInfo, HIF_LOOPBK_AUTO_TEST_LEN, &Pkt);
  622. if (MsduInfo == NULL) {
  623. DBGLOG(INIT, WARN, "No PKT_INFO_T for sending loopback packet!\n");
  624. return;
  625. }
  626. /* Init the packet */
  627. MsduInfo->dev = GlueInfo->prDevHandler;
  628. if (MsduInfo->dev == NULL) {
  629. DBGLOG(INIT, WARN, "MsduInfo->dev == NULL!!\n");
  630. kalPacketFree(GlueInfo, MsduInfo);
  631. return;
  632. }
  633. MsduInfo->len = PktLen;
  634. kalMemSet(MsduInfo->data, 0xff, 6);
  635. kalMemSet(MsduInfo->data + 6, 0x5a, PktLen - 6);
  636. /* Simulate OS to send the packet */
  637. wlanHardStartXmit(MsduInfo, MsduInfo->dev);
  638. #if 0
  639. PktLen += 4;
  640. if (PktLen >= 1600)
  641. PktLen = 16;
  642. #endif
  643. /* Note: in FPGA, clock is not accuracy so 3000 here, not 10000 */
  644. /* HifInfo->HifTmrLoopbkFn.expires = jiffies + MSEC_TO_SYSTIME(1000); */
  645. /* add_timer(&(HifInfo->HifTmrLoopbkFn)); */
  646. }
  647. int kalDevLoopbkThread(IN void *data)
  648. {
  649. struct net_device *dev = data;
  650. P_GLUE_INFO_T GlueInfo = *((P_GLUE_INFO_T *) netdev_priv(dev));
  651. GL_HIF_INFO_T *HifInfo = &GlueInfo->rHifInfo;
  652. int ret;
  653. static int test;
  654. while (TRUE) {
  655. ret = wait_event_interruptible(HifInfo->HifWaitq, (HifInfo->HifLoopbkFlg != 0));
  656. if (HifInfo->HifLoopbkFlg == 0xFFFFFFFF)
  657. break;
  658. while (TRUE) {
  659. /* if ((HifInfo->HifLoopbkFlg & 0x01) == 0) */
  660. if (GlueInfo->i4TxPendingFrameNum < 64) {
  661. DBGLOG(INIT, INFO, "GlueInfo->i4TxPendingFrameNum = %d\n",
  662. GlueInfo->i4TxPendingFrameNum);
  663. kalDevLoopbkAuto(GlueInfo);
  664. if (testmode == 0)
  665. kalMsleep(3000);
  666. } else
  667. kalMsleep(1);
  668. }
  669. }
  670. }
  671. void kalDevLoopbkRxHandle(IN P_ADAPTER_T prAdapter, IN OUT P_SW_RFB_T prSwRfb)
  672. {
  673. static unsigned int rxcnt;
  674. UINT_32 i;
  675. UINT_8 *Buf = prSwRfb->pucRecvBuff + sizeof(HIF_TX_HEADER_T);
  676. P_HIF_RX_HEADER_T prHifRxHdr = prSwRfb->prHifRxHdr;
  677. UINT_32 len = prHifRxHdr->u2PacketLen - sizeof(HIF_TX_HEADER_T);
  678. if (len > 1600) {
  679. while (1)
  680. DBGLOG(INIT, ERROR, "HIF> Loopback len > 1600!!! error!!!\n");
  681. }
  682. for (i = 0; i < 6; i++) {
  683. if (Buf[i] != 0xff) {
  684. while (1) {
  685. DBGLOG(INIT, ERROR, "HIF> Loopbk dst addr error (len = %d)!\n", len);
  686. dumpMemory8(prSwRfb->pucRecvBuff, prHifRxHdr->u2PacketLen);
  687. }
  688. }
  689. }
  690. for (i = 6; i < len; i++) {
  691. if (Buf[i] != 0x5a) {
  692. while (1) {
  693. DBGLOG(INIT, ERROR, "HIF> Loopbk error (len = %d)!\n", len);
  694. dumpMemory8(prSwRfb->pucRecvBuff, prHifRxHdr->u2PacketLen);
  695. }
  696. }
  697. }
  698. DBGLOG(INIT, INFO, "HIF> Loopbk OK (len = %d) (total = %d)!\n", len, ++rxcnt);
  699. }
  700. #endif /* CONF_HIF_LOOPBACK_AUTO */
  701. /*----------------------------------------------------------------------------*/
  702. /*!
  703. * \brief To indicate an array of received packets is available for higher
  704. * level protocol uses.
  705. *
  706. * \param[in] prGlueInfo Pointer to the Adapter structure.
  707. * \param[in] apvPkts The packet array to be indicated
  708. * \param[in] ucPktNum The number of packets to be indicated
  709. *
  710. * \retval TRUE Success.
  711. *
  712. */
  713. /*----------------------------------------------------------------------------*/
  714. WLAN_STATUS kalRxIndicatePkts(IN P_GLUE_INFO_T prGlueInfo, IN PVOID apvPkts[], IN UINT_8 ucPktNum)
  715. {
  716. UINT_8 ucIdx = 0;
  717. struct net_device *prNetDev = prGlueInfo->prDevHandler;
  718. struct sk_buff *prSkb = NULL;
  719. ASSERT(prGlueInfo);
  720. ASSERT(apvPkts);
  721. #if CFG_BOW_TEST
  722. UINT_32 i;
  723. #endif
  724. for (ucIdx = 0; ucIdx < ucPktNum; ucIdx++) {
  725. prSkb = apvPkts[ucIdx];
  726. #if DBG
  727. do {
  728. PUINT_8 pu4Head = (PUINT_8) &prSkb->cb[0];
  729. UINT_32 u4HeadValue = 0;
  730. kalMemCopy(&u4HeadValue, pu4Head, sizeof(u4HeadValue));
  731. DBGLOG(RX, TRACE, "prSkb->head = %p, prSkb->cb = 0x%x\n", pu4Head, u4HeadValue);
  732. } while (0);
  733. #endif
  734. if (GLUE_GET_PKT_IS_P2P(prSkb)) {
  735. /* P2P */
  736. #if CFG_ENABLE_WIFI_DIRECT
  737. if (prGlueInfo->prAdapter->fgIsP2PRegistered)
  738. prNetDev = kalP2PGetDevHdlr(prGlueInfo);
  739. /* prNetDev->stats.rx_bytes += prSkb->len; */
  740. /* prNetDev->stats.rx_packets++; */
  741. prGlueInfo->prP2PInfo->rNetDevStats.rx_bytes += prSkb->len;
  742. prGlueInfo->prP2PInfo->rNetDevStats.rx_packets++;
  743. #else
  744. prNetDev = prGlueInfo->prDevHandler;
  745. #endif
  746. } else if (GLUE_GET_PKT_IS_PAL(prSkb)) {
  747. /* BOW */
  748. #if CFG_ENABLE_BT_OVER_WIFI && CFG_BOW_SEPARATE_DATA_PATH
  749. if (prGlueInfo->rBowInfo.fgIsNetRegistered)
  750. prNetDev = prGlueInfo->rBowInfo.prDevHandler;
  751. #else
  752. prNetDev = prGlueInfo->prDevHandler;
  753. #endif
  754. } else {
  755. /* AIS */
  756. prNetDev = prGlueInfo->prDevHandler;
  757. prGlueInfo->rNetDevStats.rx_bytes += prSkb->len;
  758. prGlueInfo->rNetDevStats.rx_packets++;
  759. }
  760. /* check if the "unicast" packet is from us */
  761. if (kalMemCmp(prSkb->data, prSkb->data + 6, 6) == 0) {
  762. /* we will filter broadcast/multicast packet sent from us in hardware */
  763. /* source address = destination address ? */
  764. DBGLOG(RX, EVENT,
  765. "kalRxIndicatePkts got from us!!! Drop it! ([ %pM ] len %d)\n",
  766. prSkb->data, prSkb->len);
  767. wlanReturnPacket(prGlueInfo->prAdapter, prSkb);
  768. continue;
  769. }
  770. #if (CFG_SUPPORT_TDLS == 1)
  771. if (TdlsexRxFrameDrop(prGlueInfo, prSkb->data) == TRUE) {
  772. /* drop the received TDLS action frame */
  773. DBGLOG(TDLS, WARN,
  774. "<tdls_fme> %s: drop a received packet from %pM %u\n",
  775. __func__, prSkb->data,
  776. (UINT32) ((P_ADAPTER_T) (prGlueInfo->prAdapter))->rRxCtrl.rFreeSwRfbList.u4NumElem);
  777. wlanReturnPacket(prGlueInfo->prAdapter, prSkb);
  778. continue;
  779. }
  780. /*
  781. get a TDLS request/response/confirm, we need to parse the HT IE
  782. because older supplicant does not pass HT IE to us
  783. */
  784. TdlsexRxFrameHandle(prGlueInfo, prSkb->data, prSkb->len);
  785. #endif /* CFG_SUPPORT_TDLS */
  786. STATS_RX_PKT_INFO_DISPLAY(prSkb->data);
  787. prNetDev->last_rx = jiffies;
  788. prSkb->protocol = eth_type_trans(prSkb, prNetDev);
  789. prSkb->dev = prNetDev;
  790. /* DBGLOG_MEM32(RX, TRACE, (PUINT_32)prSkb->data, prSkb->len); */
  791. DBGLOG(RX, TRACE, "kalRxIndicatePkts len = %d\n", prSkb->len);
  792. #if CFG_BOW_TEST
  793. DBGLOG(BOW, TRACE, "Rx sk_buff->len: %d\n", prSkb->len);
  794. DBGLOG(BOW, TRACE, "Rx sk_buff->data_len: %d\n", prSkb->data_len);
  795. DBGLOG(BOW, TRACE, "Rx sk_buff->data:\n");
  796. for (i = 0; i < prSkb->len; i++) {
  797. DBGLOG(BOW, TRACE, "%4x", prSkb->data[i]);
  798. if ((i + 1) % 16 == 0)
  799. DBGLOG(BOW, TRACE, "\n");
  800. }
  801. DBGLOG(BOW, TRACE, "\n");
  802. #endif
  803. if (!in_interrupt())
  804. netif_rx_ni(prSkb); /* only in non-interrupt context */
  805. else
  806. netif_rx(prSkb);
  807. wlanReturnPacket(prGlueInfo->prAdapter, NULL);
  808. }
  809. if (netif_carrier_ok(prNetDev))
  810. kalPerMonStart(prGlueInfo);
  811. return WLAN_STATUS_SUCCESS;
  812. }
  813. /*----------------------------------------------------------------------------*/
  814. /*!
  815. * \brief Called by driver to indicate event to upper layer, for example, the wpa
  816. * supplicant or wireless tools.
  817. *
  818. * \param[in] pvAdapter Pointer to the adapter descriptor.
  819. * \param[in] eStatus Indicated status.
  820. * \param[in] pvBuf Indicated message buffer.
  821. * \param[in] u4BufLen Indicated message buffer size.
  822. *
  823. * \return (none)
  824. *
  825. */
  826. /*----------------------------------------------------------------------------*/
  827. UINT_32 ScanCnt = 0, ScanDoneFailCnt = 0;
  828. VOID
  829. kalIndicateStatusAndComplete(IN P_GLUE_INFO_T prGlueInfo, IN WLAN_STATUS eStatus, IN PVOID pvBuf, IN UINT_32 u4BufLen)
  830. {
  831. UINT_32 bufLen;
  832. P_PARAM_STATUS_INDICATION_T pStatus = (P_PARAM_STATUS_INDICATION_T) pvBuf;
  833. P_PARAM_AUTH_EVENT_T pAuth = (P_PARAM_AUTH_EVENT_T) pStatus;
  834. P_PARAM_PMKID_CANDIDATE_LIST_T pPmkid = (P_PARAM_PMKID_CANDIDATE_LIST_T) (pStatus + 1);
  835. PARAM_MAC_ADDRESS arBssid;
  836. struct cfg80211_scan_request *prScanRequest = NULL;
  837. PARAM_SSID_T ssid;
  838. struct ieee80211_channel *prChannel = NULL;
  839. struct cfg80211_bss *bss;
  840. UINT_8 ucChannelNum;
  841. P_BSS_DESC_T prBssDesc = NULL;
  842. UINT_16 u2StatusCode = WLAN_STATUS_AUTH_TIMEOUT;
  843. GLUE_SPIN_LOCK_DECLARATION();
  844. kalMemZero(arBssid, MAC_ADDR_LEN);
  845. ASSERT(prGlueInfo);
  846. switch (eStatus) {
  847. case WLAN_STATUS_ROAM_OUT_FIND_BEST:
  848. case WLAN_STATUS_MEDIA_CONNECT:
  849. prGlueInfo->eParamMediaStateIndicated = PARAM_MEDIA_STATE_CONNECTED;
  850. /* indicate assoc event */
  851. wlanQueryInformation(prGlueInfo->prAdapter, wlanoidQueryBssid, &arBssid[0], sizeof(arBssid), &bufLen);
  852. wext_indicate_wext_event(prGlueInfo, SIOCGIWAP, arBssid, bufLen);
  853. /* switch netif on */
  854. netif_carrier_on(prGlueInfo->prDevHandler);
  855. do {
  856. /* print message on console */
  857. wlanQueryInformation(prGlueInfo->prAdapter, wlanoidQuerySsid, &ssid, sizeof(ssid), &bufLen);
  858. ssid.aucSsid[(ssid.u4SsidLen >= PARAM_MAX_LEN_SSID) ?
  859. (PARAM_MAX_LEN_SSID - 1) : ssid.u4SsidLen] = '\0';
  860. DBGLOG(AIS, INFO, " %s netif_carrier_on [ssid:%s %pM ]\n",
  861. prGlueInfo->prDevHandler->name, ssid.aucSsid, arBssid);
  862. } while (0);
  863. if (prGlueInfo->fgIsRegistered == TRUE) {
  864. struct cfg80211_bss *bss_others = NULL;
  865. UINT_8 ucLoopCnt = 15; /* only loop 15 times to avoid dead loop */
  866. /* retrieve channel */
  867. ucChannelNum = wlanGetChannelNumberByNetwork(prGlueInfo->prAdapter, NETWORK_TYPE_AIS_INDEX);
  868. if (ucChannelNum <= 14) {
  869. prChannel =
  870. ieee80211_get_channel(priv_to_wiphy(prGlueInfo),
  871. ieee80211_channel_to_frequency(ucChannelNum,
  872. IEEE80211_BAND_2GHZ));
  873. } else {
  874. prChannel =
  875. ieee80211_get_channel(priv_to_wiphy(prGlueInfo),
  876. ieee80211_channel_to_frequency(ucChannelNum,
  877. IEEE80211_BAND_5GHZ));
  878. }
  879. if (!prChannel)
  880. DBGLOG(SCN, ERROR, "prChannel is NULL and ucChannelNum is %d\n", ucChannelNum);
  881. /* ensure BSS exists */
  882. bss = cfg80211_get_bss(priv_to_wiphy(prGlueInfo), prChannel, arBssid,
  883. ssid.aucSsid, ssid.u4SsidLen, WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS);
  884. if (bss == NULL) {
  885. /* create BSS on-the-fly */
  886. prBssDesc =
  887. wlanGetTargetBssDescByNetwork(prGlueInfo->prAdapter, NETWORK_TYPE_AIS_INDEX);
  888. if (prBssDesc != NULL) {
  889. bss = cfg80211_inform_bss(priv_to_wiphy(prGlueInfo), prChannel,
  890. CFG80211_BSS_FTYPE_PRESP,
  891. arBssid, 0, /* TSF */
  892. WLAN_CAPABILITY_ESS,
  893. prBssDesc->u2BeaconInterval, /* beacon interval */
  894. prBssDesc->aucIEBuf, /* IE */
  895. prBssDesc->u2IELength, /* IE Length */
  896. RCPI_TO_dBm(prBssDesc->ucRCPI) * 100, /* MBM */
  897. GFP_KERNEL);
  898. }
  899. }
  900. /* remove all bsses that before and only channel different with the current connected one
  901. if without this patch, UI will show channel A is connected even if AP has change channel
  902. from A to B */
  903. while (ucLoopCnt--) {
  904. bss_others = cfg80211_get_bss(priv_to_wiphy(prGlueInfo), NULL, arBssid,
  905. ssid.aucSsid, ssid.u4SsidLen, WLAN_CAPABILITY_ESS, WLAN_CAPABILITY_ESS);
  906. if (bss && bss_others && bss_others != bss) {
  907. DBGLOG(SCN, INFO, "remove BSSes that only channel different\n");
  908. cfg80211_unlink_bss(priv_to_wiphy(prGlueInfo), bss_others);
  909. } else
  910. break;
  911. }
  912. /* CFG80211 Indication */
  913. if (eStatus == WLAN_STATUS_ROAM_OUT_FIND_BEST) {
  914. cfg80211_roamed_bss(prGlueInfo->prDevHandler,
  915. bss,
  916. prGlueInfo->aucReqIe,
  917. prGlueInfo->u4ReqIeLength,
  918. prGlueInfo->aucRspIe, prGlueInfo->u4RspIeLength, GFP_KERNEL);
  919. } else {
  920. /* to support user space roaming, cfg80211 will change the sme_state to connecting
  921. before reassociate */
  922. cfg80211_connect_result(prGlueInfo->prDevHandler,
  923. arBssid,
  924. prGlueInfo->aucReqIe,
  925. prGlueInfo->u4ReqIeLength,
  926. prGlueInfo->aucRspIe,
  927. prGlueInfo->u4RspIeLength, WLAN_STATUS_SUCCESS, GFP_KERNEL);
  928. }
  929. }
  930. break;
  931. case WLAN_STATUS_MEDIA_DISCONNECT:
  932. case WLAN_STATUS_MEDIA_DISCONNECT_LOCALLY:
  933. /* indicate disassoc event */
  934. wext_indicate_wext_event(prGlueInfo, SIOCGIWAP, NULL, 0);
  935. /* For CR 90 and CR99, While supplicant do reassociate, driver will do netif_carrier_off first,
  936. after associated success, at joinComplete(), do netif_carier_on,
  937. but for unknown reason, the supplicant 1x pkt will not called the driver
  938. hardStartXmit, for template workaround these bugs, add this compiling flag
  939. */
  940. /* switch netif off */
  941. DBGLOG(AIS, INFO, "[wifi] %s netif_carrier_off\n",
  942. prGlueInfo->prDevHandler->name);
  943. netif_carrier_off(prGlueInfo->prDevHandler);
  944. if (prGlueInfo->fgIsRegistered == TRUE) {
  945. P_WIFI_VAR_T prWifiVar = &prGlueInfo->prAdapter->rWifiVar;
  946. UINT_16 u2DeauthReason = prWifiVar->arBssInfo[NETWORK_TYPE_AIS_INDEX].u2DeauthReason;
  947. /* CFG80211 Indication */
  948. DBGLOG(AIS, INFO, "[wifi] %s cfg80211_disconnected: Reason=%d\n",
  949. prGlueInfo->prDevHandler->name, u2DeauthReason);
  950. cfg80211_disconnected(prGlueInfo->prDevHandler, u2DeauthReason, NULL, 0,
  951. eStatus == WLAN_STATUS_MEDIA_DISCONNECT_LOCALLY, GFP_KERNEL);
  952. }
  953. prGlueInfo->eParamMediaStateIndicated = PARAM_MEDIA_STATE_DISCONNECTED;
  954. break;
  955. case WLAN_STATUS_SCAN_COMPLETE:
  956. /* indicate scan complete event */
  957. wext_indicate_wext_event(prGlueInfo, SIOCGIWSCAN, NULL, 0);
  958. /* 1. reset first for newly incoming request */
  959. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_NET_DEV);
  960. if (prGlueInfo->prScanRequest != NULL) {
  961. prScanRequest = prGlueInfo->prScanRequest;
  962. prGlueInfo->prScanRequest = NULL;
  963. }
  964. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_NET_DEV);
  965. /* 2. then CFG80211 Indication */
  966. DBGLOG(SCN, TRACE, "[ais] scan complete %p %d %d\n", prScanRequest, ScanCnt, ScanDoneFailCnt);
  967. if (prScanRequest != NULL)
  968. cfg80211_scan_done(prScanRequest, FALSE);
  969. break;
  970. case WLAN_STATUS_JOIN_FAILURE:
  971. if (pvBuf)
  972. u2StatusCode = *(UINT_16 *)pvBuf;
  973. prBssDesc = prGlueInfo->prAdapter->rWifiVar.rAisFsmInfo.prTargetBssDesc;
  974. DBGLOG(INIT, INFO, "JOIN Failure: u2StatusCode=%d", u2StatusCode);
  975. if (prBssDesc)
  976. COPY_MAC_ADDR(arBssid, prBssDesc->aucBSSID);
  977. else
  978. COPY_MAC_ADDR(arBssid, prGlueInfo->prAdapter->rWifiVar.rConnSettings.aucBSSID);
  979. /* indicate AIS Jion fail event
  980. if (prGlueInfo->prDevHandler->ieee80211_ptr->sme_state == CFG80211_SME_CONNECTING) */
  981. cfg80211_connect_result(prGlueInfo->prDevHandler,
  982. arBssid,
  983. prGlueInfo->aucReqIe,
  984. prGlueInfo->u4ReqIeLength,
  985. prGlueInfo->aucRspIe,
  986. prGlueInfo->u4RspIeLength, u2StatusCode, GFP_KERNEL);
  987. prGlueInfo->eParamMediaStateIndicated = PARAM_MEDIA_STATE_DISCONNECTED;
  988. break;
  989. #if 0
  990. case WLAN_STATUS_MSDU_OK:
  991. if (netif_running(prGlueInfo->prDevHandler))
  992. netif_wake_queue(prGlueInfo->prDevHandler);
  993. break;
  994. #endif
  995. case WLAN_STATUS_MEDIA_SPECIFIC_INDICATION:
  996. if (pStatus) {
  997. switch (pStatus->eStatusType) {
  998. case ENUM_STATUS_TYPE_AUTHENTICATION:
  999. /*
  1000. printk(KERN_NOTICE "ENUM_STATUS_TYPE_AUTHENTICATION: L(%ld) [ %pM ] F:%lx\n",
  1001. pAuth->Request[0].Length,
  1002. pAuth->Request[0].Bssid,
  1003. pAuth->Request[0].Flags);
  1004. */
  1005. /* indicate (UC/GC) MIC ERROR event only */
  1006. if ((pAuth->arRequest[0].u4Flags ==
  1007. PARAM_AUTH_REQUEST_PAIRWISE_ERROR) ||
  1008. (pAuth->arRequest[0].u4Flags == PARAM_AUTH_REQUEST_GROUP_ERROR)) {
  1009. cfg80211_michael_mic_failure(prGlueInfo->prDevHandler, NULL,
  1010. (pAuth->arRequest[0].u4Flags ==
  1011. PARAM_AUTH_REQUEST_PAIRWISE_ERROR) ?
  1012. NL80211_KEYTYPE_PAIRWISE : NL80211_KEYTYPE_GROUP,
  1013. 0, NULL, GFP_KERNEL);
  1014. wext_indicate_wext_event(prGlueInfo, IWEVMICHAELMICFAILURE,
  1015. (unsigned char *)&pAuth->arRequest[0],
  1016. pAuth->arRequest[0].u4Length);
  1017. }
  1018. break;
  1019. case ENUM_STATUS_TYPE_CANDIDATE_LIST:
  1020. /*
  1021. printk(KERN_NOTICE "Param_StatusType_PMKID_CandidateList: Ver(%ld) Num(%ld)\n",
  1022. pPmkid->u2Version,
  1023. pPmkid->u4NumCandidates);
  1024. if (pPmkid->u4NumCandidates > 0) {
  1025. printk(KERN_NOTICE "candidate[ %pM ] preAuth Flag:%lx\n",
  1026. pPmkid->arCandidateList[0].rBSSID,
  1027. pPmkid->arCandidateList[0].fgFlags);
  1028. }
  1029. */
  1030. {
  1031. UINT_32 i = 0;
  1032. /*struct net_device *prDev = prGlueInfo->prDevHandler; */
  1033. P_PARAM_PMKID_CANDIDATE_T prCand = NULL;
  1034. /* indicate pmk candidate via cfg80211 to supplicant,
  1035. the second parameter is 1000 for
  1036. cfg80211_pmksa_candidate_notify, because wpa_supplicant defined it. */
  1037. for (i = 0; i < pPmkid->u4NumCandidates; i++) {
  1038. prCand = &pPmkid->arCandidateList[i];
  1039. cfg80211_pmksa_candidate_notify(prGlueInfo->prDevHandler, 1000,
  1040. prCand->arBSSID, prCand->u4Flags,
  1041. GFP_KERNEL);
  1042. wext_indicate_wext_event(prGlueInfo,
  1043. IWEVPMKIDCAND,
  1044. (unsigned char *)prCand,
  1045. pPmkid->u4NumCandidates);
  1046. }
  1047. }
  1048. break;
  1049. default:
  1050. /* case ENUM_STATUS_TYPE_MEDIA_STREAM_MODE */
  1051. /*
  1052. printk(KERN_NOTICE "unknown media specific indication type:%x\n",
  1053. pStatus->StatusType);
  1054. */
  1055. break;
  1056. }
  1057. } else {
  1058. /*
  1059. printk(KERN_WARNING "media specific indication buffer NULL\n");
  1060. */
  1061. }
  1062. break;
  1063. #if CFG_SUPPORT_BCM && CFG_SUPPORT_BCM_BWCS
  1064. case WLAN_STATUS_BWCS_UPDATE:
  1065. {
  1066. wext_indicate_wext_event(prGlueInfo, IWEVCUSTOM, pvBuf, sizeof(PTA_IPC_T));
  1067. }
  1068. break;
  1069. #endif
  1070. default:
  1071. /*
  1072. printk(KERN_WARNING "unknown indication:%lx\n", eStatus);
  1073. */
  1074. break;
  1075. }
  1076. } /* kalIndicateStatusAndComplete */
  1077. /*----------------------------------------------------------------------------*/
  1078. /*!
  1079. * \brief This routine is called to update the (re)association request
  1080. * information to the structure used to query and set
  1081. * OID_802_11_ASSOCIATION_INFORMATION.
  1082. *
  1083. * \param[in] prGlueInfo Pointer to the Glue structure.
  1084. * \param[in] pucFrameBody Pointer to the frame body of the last (Re)Association
  1085. * Request frame from the AP.
  1086. * \param[in] u4FrameBodyLen The length of the frame body of the last
  1087. * (Re)Association Request frame.
  1088. * \param[in] fgReassocRequest TRUE, if it is a Reassociation Request frame.
  1089. *
  1090. * \return (none)
  1091. *
  1092. */
  1093. /*----------------------------------------------------------------------------*/
  1094. VOID
  1095. kalUpdateReAssocReqInfo(IN P_GLUE_INFO_T prGlueInfo,
  1096. IN PUINT_8 pucFrameBody, IN UINT_32 u4FrameBodyLen, IN BOOLEAN fgReassocRequest)
  1097. {
  1098. PUINT_8 cp;
  1099. ASSERT(prGlueInfo);
  1100. /* reset */
  1101. prGlueInfo->u4ReqIeLength = 0;
  1102. if (fgReassocRequest) {
  1103. if (u4FrameBodyLen < 15) {
  1104. /*
  1105. printk(KERN_WARNING "frameBodyLen too short:%ld\n", frameBodyLen);
  1106. */
  1107. return;
  1108. }
  1109. } else {
  1110. if (u4FrameBodyLen < 9) {
  1111. /*
  1112. printk(KERN_WARNING "frameBodyLen too short:%ld\n", frameBodyLen);
  1113. */
  1114. return;
  1115. }
  1116. }
  1117. cp = pucFrameBody;
  1118. if (fgReassocRequest) {
  1119. /* Capability information field 2 */
  1120. /* Listen interval field 2 */
  1121. /* Current AP address 6 */
  1122. cp += 10;
  1123. u4FrameBodyLen -= 10;
  1124. } else {
  1125. /* Capability information field 2 */
  1126. /* Listen interval field 2 */
  1127. cp += 4;
  1128. u4FrameBodyLen -= 4;
  1129. }
  1130. wext_indicate_wext_event(prGlueInfo, IWEVASSOCREQIE, cp, u4FrameBodyLen);
  1131. if (u4FrameBodyLen <= CFG_CFG80211_IE_BUF_LEN) {
  1132. prGlueInfo->u4ReqIeLength = u4FrameBodyLen;
  1133. kalMemCopy(prGlueInfo->aucReqIe, cp, u4FrameBodyLen);
  1134. }
  1135. }
  1136. /*----------------------------------------------------------------------------*/
  1137. /*!
  1138. * @brief This routine is called to update the (re)association
  1139. * response information to the structure used to reply with
  1140. * cfg80211_connect_result
  1141. *
  1142. * @param prGlueInfo Pointer to adapter descriptor
  1143. * @param pucFrameBody Pointer to the frame body of the last (Re)Association
  1144. * Response frame from the AP
  1145. * @param u4FrameBodyLen The length of the frame body of the last
  1146. * (Re)Association Response frame
  1147. *
  1148. * @return (none)
  1149. */
  1150. /*----------------------------------------------------------------------------*/
  1151. VOID kalUpdateReAssocRspInfo(IN P_GLUE_INFO_T prGlueInfo, IN PUINT_8 pucFrameBody, IN UINT_32 u4FrameBodyLen)
  1152. {
  1153. UINT_32 u4IEOffset = 6; /* cap_info, status_code & assoc_id */
  1154. UINT_32 u4IELength = u4FrameBodyLen - u4IEOffset;
  1155. ASSERT(prGlueInfo);
  1156. /* reset */
  1157. prGlueInfo->u4RspIeLength = 0;
  1158. if (u4IELength <= CFG_CFG80211_IE_BUF_LEN) {
  1159. prGlueInfo->u4RspIeLength = u4IELength;
  1160. kalMemCopy(prGlueInfo->aucRspIe, pucFrameBody + u4IEOffset, u4IELength);
  1161. }
  1162. } /* kalUpdateReAssocRspInfo */
  1163. /*----------------------------------------------------------------------------*/
  1164. /*!
  1165. * \brief Notify OS with SendComplete event of the specific packet. Linux should
  1166. * free packets here.
  1167. *
  1168. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  1169. * \param[in] pvPacket Pointer of Packet Handle
  1170. * \param[in] status Status Code for OS upper layer
  1171. *
  1172. * \return -
  1173. */
  1174. /*----------------------------------------------------------------------------*/
  1175. VOID kalSendCompleteAndAwakeQueue(IN P_GLUE_INFO_T prGlueInfo, IN PVOID pvPacket)
  1176. {
  1177. struct net_device *prDev = NULL;
  1178. struct sk_buff *prSkb = NULL;
  1179. UINT_16 u2QueueIdx = 0;
  1180. UINT_8 ucNetworkType = 0;
  1181. BOOLEAN fgIsValidDevice = TRUE;
  1182. ASSERT(pvPacket);
  1183. ASSERT(prGlueInfo->i4TxPendingFrameNum);
  1184. prSkb = (struct sk_buff *)pvPacket;
  1185. u2QueueIdx = skb_get_queue_mapping(prSkb);
  1186. ASSERT(u2QueueIdx < CFG_MAX_TXQ_NUM);
  1187. if (GLUE_GET_PKT_IS_PAL(prSkb)) {
  1188. ucNetworkType = NETWORK_TYPE_BOW_INDEX;
  1189. } else if (GLUE_GET_PKT_IS_P2P(prSkb)) {
  1190. ucNetworkType = NETWORK_TYPE_P2P_INDEX;
  1191. #if CFG_ENABLE_WIFI_DIRECT
  1192. /* in case packet was sent after P2P device is unregistered */
  1193. if (prGlueInfo->prAdapter->fgIsP2PRegistered == FALSE)
  1194. fgIsValidDevice = FALSE;
  1195. #endif
  1196. } else {
  1197. ucNetworkType = NETWORK_TYPE_AIS_INDEX;
  1198. }
  1199. GLUE_DEC_REF_CNT(prGlueInfo->i4TxPendingFrameNum);
  1200. if (u2QueueIdx < CFG_MAX_TXQ_NUM)
  1201. GLUE_DEC_REF_CNT(prGlueInfo->ai4TxPendingFrameNumPerQueue[ucNetworkType][u2QueueIdx]);
  1202. prDev = prSkb->dev;
  1203. ASSERT(prDev);
  1204. if ((fgIsValidDevice == TRUE) && (u2QueueIdx < CFG_MAX_TXQ_NUM)) {
  1205. if (netif_subqueue_stopped(prDev, prSkb) &&
  1206. prGlueInfo->ai4TxPendingFrameNumPerQueue[ucNetworkType][u2QueueIdx] <=
  1207. CFG_TX_START_NETIF_PER_QUEUE_THRESHOLD) {
  1208. netif_wake_subqueue(prDev, u2QueueIdx);
  1209. #if (CONF_HIF_LOOPBACK_AUTO == 1)
  1210. prGlueInfo->rHifInfo.HifLoopbkFlg &= ~0x01;
  1211. #endif /* CONF_HIF_LOOPBACK_AUTO */
  1212. }
  1213. }
  1214. dev_kfree_skb((struct sk_buff *)pvPacket);
  1215. DBGLOG(TX, EVENT, "----- pending frame %d -----\n", prGlueInfo->i4TxPendingFrameNum);
  1216. }
  1217. /*----------------------------------------------------------------------------*/
  1218. /*!
  1219. * \brief Copy Mac Address setting from registry. It's All Zeros in Linux.
  1220. *
  1221. * \param[in] prAdapter Pointer to the Adapter structure
  1222. *
  1223. * \param[out] paucMacAddr Pointer to the Mac Address buffer
  1224. *
  1225. * \retval WLAN_STATUS_SUCCESS
  1226. *
  1227. * \note
  1228. */
  1229. /*----------------------------------------------------------------------------*/
  1230. VOID kalQueryRegistryMacAddr(IN P_GLUE_INFO_T prGlueInfo, OUT PUINT_8 paucMacAddr)
  1231. {
  1232. UINT_8 aucZeroMac[MAC_ADDR_LEN] = { 0, 0, 0, 0, 0, 0 }
  1233. DEBUGFUNC("kalQueryRegistryMacAddr");
  1234. ASSERT(prGlueInfo);
  1235. ASSERT(paucMacAddr);
  1236. kalMemCopy((PVOID) paucMacAddr, (PVOID) aucZeroMac, MAC_ADDR_LEN);
  1237. } /* end of kalQueryRegistryMacAddr() */
  1238. #if CFG_SUPPORT_EXT_CONFIG
  1239. /*----------------------------------------------------------------------------*/
  1240. /*!
  1241. * \brief Read external configuration, ex. NVRAM or file
  1242. *
  1243. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  1244. *
  1245. * \return none
  1246. */
  1247. /*----------------------------------------------------------------------------*/
  1248. UINT_32 kalReadExtCfg(IN P_GLUE_INFO_T prGlueInfo)
  1249. {
  1250. ASSERT(prGlueInfo);
  1251. /* External data is given from user space by ioctl or /proc, not read by
  1252. driver.
  1253. */
  1254. if (0 != prGlueInfo->u4ExtCfgLength)
  1255. DBGLOG(INIT, TRACE, "Read external configuration data -- OK\n");
  1256. else
  1257. DBGLOG(INIT, TRACE, "Read external configuration data -- fail\n");
  1258. return prGlueInfo->u4ExtCfgLength;
  1259. }
  1260. #endif
  1261. /*----------------------------------------------------------------------------*/
  1262. /*!
  1263. * @brief This inline function is to extract some packet information, including
  1264. * user priority, packet length, destination address, 802.1x and BT over Wi-Fi
  1265. * or not.
  1266. *
  1267. * @param prGlueInfo Pointer to the glue structure
  1268. * @param prNdisPacket Packet descriptor
  1269. * @param pucPriorityParam User priority
  1270. * @param pu4PacketLen Packet length
  1271. * @param pucEthDestAddr Destination address
  1272. * @param pfgIs1X 802.1x packet or not
  1273. * @param pfgIsPAL BT over Wi-Fi packet or not
  1274. * @prGenUse General used param
  1275. *
  1276. * @retval TRUE Success to extract information
  1277. * @retval FALSE Fail to extract correct information
  1278. */
  1279. /*----------------------------------------------------------------------------*/
  1280. BOOLEAN
  1281. kalQoSFrameClassifierAndPacketInfo(IN P_GLUE_INFO_T prGlueInfo,
  1282. IN P_NATIVE_PACKET prPacket,
  1283. OUT PUINT_8 pucPriorityParam,
  1284. OUT PUINT_32 pu4PacketLen,
  1285. OUT PUINT_8 pucEthDestAddr,
  1286. OUT PBOOLEAN pfgIs1X,
  1287. OUT PBOOLEAN pfgIsPAL, OUT PUINT_8 pucNetworkType,
  1288. OUT PVOID prGenUse)
  1289. {
  1290. UINT_32 u4PacketLen;
  1291. UINT_8 ucUserPriority = USER_PRIORITY_DEFAULT; /* Default */
  1292. UINT_16 u2EtherTypeLen;
  1293. struct sk_buff *prSkb = (struct sk_buff *)prPacket;
  1294. PUINT_8 aucLookAheadBuf = NULL;
  1295. DEBUGFUNC("kalQoSFrameClassifierAndPacketInfo");
  1296. u4PacketLen = prSkb->len;
  1297. if (u4PacketLen < ETH_HLEN) {
  1298. DBGLOG(TX, WARN, "Invalid Ether packet length: %u\n", (UINT_32) u4PacketLen);
  1299. return FALSE;
  1300. }
  1301. aucLookAheadBuf = prSkb->data;
  1302. *pfgIs1X = FALSE;
  1303. *pfgIsPAL = FALSE;
  1304. /* 4 <3> Obtain the User Priority for WMM */
  1305. u2EtherTypeLen = (aucLookAheadBuf[ETH_TYPE_LEN_OFFSET] << 8) | (aucLookAheadBuf[ETH_TYPE_LEN_OFFSET + 1]);
  1306. if ((u2EtherTypeLen == ETH_P_IP) && (u4PacketLen >= LOOK_AHEAD_LEN)) {
  1307. PUINT_8 pucIpHdr = &aucLookAheadBuf[ETH_HLEN];
  1308. UINT_8 ucIpVersion;
  1309. ucIpVersion = (pucIpHdr[0] & IPVH_VERSION_MASK) >> IPVH_VERSION_OFFSET;
  1310. if (ucIpVersion == IPVERSION) {
  1311. UINT_8 ucIpTos;
  1312. /* Get the DSCP value from the header of IP packet. */
  1313. ucIpTos = pucIpHdr[1];
  1314. ucUserPriority = ((ucIpTos & IPTOS_PREC_MASK) >> IPTOS_PREC_OFFSET);
  1315. }
  1316. /* TODO(Kevin): Add TSPEC classifier here */
  1317. } else if (u2EtherTypeLen == ETH_P_1X || u2EtherTypeLen == ETH_P_PRE_1X) { /* For Port Control */
  1318. PUINT_8 pucEapol = &aucLookAheadBuf[ETH_HLEN];
  1319. UINT_8 ucEapolType = pucEapol[1];
  1320. UINT_16 u2KeyInfo = pucEapol[5]<<8 | pucEapol[6];
  1321. /*
  1322. * generate a seq number used to trace security frame TX
  1323. */
  1324. if (prGenUse)
  1325. *(UINT_8 *)prGenUse = nicIncreaseCmdSeqNum(prGlueInfo->prAdapter);
  1326. switch (ucEapolType) {
  1327. case 0: /* eap packet */
  1328. DBGLOG(TX, INFO, "<TX> EAP Packet: code %d, id %d, type %d, seqNo %d\n",
  1329. pucEapol[4], pucEapol[5], pucEapol[7],
  1330. prGenUse ? *(UINT_8 *)prGenUse : 0);
  1331. break;
  1332. case 1: /* eapol start */
  1333. DBGLOG(TX, INFO, "<TX> EAPOL: start, seqNo %d\n",
  1334. prGenUse ? *(UINT_8 *)prGenUse : 0);
  1335. break;
  1336. case 3: /* key */
  1337. DBGLOG(TX, INFO,
  1338. "<TX> EAPOL: key, KeyInfo 0x%04x, Nonce %02x%02x%02x%02x%02x%02x%02x%02x... seqNo %d\n",
  1339. u2KeyInfo, pucEapol[17], pucEapol[18], pucEapol[19], pucEapol[20],
  1340. pucEapol[21], pucEapol[22], pucEapol[23], pucEapol[24],
  1341. prGenUse ? *(UINT_8 *)prGenUse : 0);
  1342. break;
  1343. }
  1344. *pfgIs1X = TRUE;
  1345. }
  1346. #if CFG_SUPPORT_WAPI
  1347. else if (u2EtherTypeLen == ETH_WPI_1X) {
  1348. PUINT_8 pucEthBody = &aucLookAheadBuf[ETH_HLEN];
  1349. UINT_8 ucSubType = pucEthBody[3]; /* sub type filed*/
  1350. UINT_16 u2Length = *(PUINT_16)&pucEthBody[6];
  1351. UINT_16 u2Seq = *(PUINT_16)&pucEthBody[8];
  1352. DBGLOG(TX, INFO, "<TX> WAPI: subType %d, Len %d, Seq %d\n",
  1353. ucSubType, u2Length, u2Seq);
  1354. *pfgIs1X = TRUE;
  1355. }
  1356. #endif
  1357. #if (CFG_SUPPORT_TDLS == 1)
  1358. else if (u2EtherTypeLen == TDLS_FRM_PROT_TYPE) {
  1359. /* TDLS case */
  1360. TDLSEX_UP_ASSIGN(ucUserPriority);
  1361. }
  1362. #endif /* CFG_SUPPORT_TDLS */
  1363. else if (u2EtherTypeLen <= 1500) { /* 802.3 Frame */
  1364. UINT_8 ucDSAP, ucSSAP, ucControl;
  1365. UINT_8 aucOUI[3];
  1366. ucDSAP = *(PUINT_8) &aucLookAheadBuf[ETH_LLC_OFFSET];
  1367. ucSSAP = *(PUINT_8) &aucLookAheadBuf[ETH_LLC_OFFSET + 1];
  1368. ucControl = *(PUINT_8) &aucLookAheadBuf[ETH_LLC_OFFSET + 2];
  1369. aucOUI[0] = *(PUINT_8) &aucLookAheadBuf[ETH_SNAP_OFFSET];
  1370. aucOUI[1] = *(PUINT_8) &aucLookAheadBuf[ETH_SNAP_OFFSET + 1];
  1371. aucOUI[2] = *(PUINT_8) &aucLookAheadBuf[ETH_SNAP_OFFSET + 2];
  1372. if (ucDSAP == ETH_LLC_DSAP_SNAP &&
  1373. ucSSAP == ETH_LLC_SSAP_SNAP &&
  1374. ucControl == ETH_LLC_CONTROL_UNNUMBERED_INFORMATION &&
  1375. aucOUI[0] == ETH_SNAP_BT_SIG_OUI_0 &&
  1376. aucOUI[1] == ETH_SNAP_BT_SIG_OUI_1 && aucOUI[2] == ETH_SNAP_BT_SIG_OUI_2) {
  1377. UINT_16 tmp =
  1378. ((aucLookAheadBuf[ETH_SNAP_OFFSET + 3] << 8) | aucLookAheadBuf[ETH_SNAP_OFFSET + 4]);
  1379. *pfgIsPAL = TRUE;
  1380. ucUserPriority = (UINT_8) prSkb->priority;
  1381. if (tmp == BOW_PROTOCOL_ID_SECURITY_FRAME) {
  1382. PUINT_8 pucEapol = &aucLookAheadBuf[ETH_SNAP_OFFSET + 5];
  1383. UINT_8 ucEapolType = pucEapol[1];
  1384. UINT_16 u2KeyInfo = pucEapol[5]<<8 | pucEapol[6];
  1385. if (prGenUse)
  1386. *(UINT_8 *)prGenUse = nicIncreaseCmdSeqNum(prGlueInfo->prAdapter);
  1387. switch (ucEapolType) {
  1388. case 0: /* eap packet */
  1389. DBGLOG(TX, INFO, "<TX> EAP Packet: code %d, id %d, type %d, seqNo %d\n",
  1390. pucEapol[4], pucEapol[5], pucEapol[7],
  1391. prGenUse ? *(UINT_8 *)prGenUse : 0);
  1392. break;
  1393. case 1: /* eapol start */
  1394. DBGLOG(TX, INFO, "<TX> EAPOL: start, seqNo %d\n",
  1395. prGenUse ? *(UINT_8 *)prGenUse : 0);
  1396. break;
  1397. case 3: /* key */
  1398. DBGLOG(TX, INFO,
  1399. "<TX> EAPOL: key, KeyInfo 0x%04x, Nonce %02x%02x%02x%02x%02x%02x%02x%02x seqNo %d\n",
  1400. u2KeyInfo, pucEapol[17], pucEapol[18], pucEapol[19], pucEapol[20],
  1401. pucEapol[21], pucEapol[22], pucEapol[23], pucEapol[24],
  1402. prGenUse ? *(UINT_8 *)prGenUse : 0);
  1403. break;
  1404. }
  1405. *pfgIs1X = TRUE;
  1406. }
  1407. }
  1408. }
  1409. /* 4 <4> Return the value of Priority Parameter. */
  1410. *pucPriorityParam = ucUserPriority;
  1411. /* 4 <5> Retrieve Packet Information - DA */
  1412. /* Packet Length/ Destination Address */
  1413. *pu4PacketLen = u4PacketLen;
  1414. kalMemCopy(pucEthDestAddr, aucLookAheadBuf, PARAM_MAC_ADDR_LEN);
  1415. /* <6> Network type */
  1416. #if CFG_ENABLE_BT_OVER_WIFI
  1417. if (*pfgIsPAL == TRUE) {
  1418. *pucNetworkType = NETWORK_TYPE_BOW_INDEX;
  1419. } else
  1420. #endif
  1421. {
  1422. #if CFG_ENABLE_WIFI_DIRECT
  1423. if (prGlueInfo->prAdapter->fgIsP2PRegistered && GLUE_GET_PKT_IS_P2P(prPacket)) {
  1424. *pucNetworkType = NETWORK_TYPE_P2P_INDEX;
  1425. } else
  1426. #endif
  1427. {
  1428. *pucNetworkType = NETWORK_TYPE_AIS_INDEX;
  1429. }
  1430. }
  1431. return TRUE;
  1432. } /* end of kalQoSFrameClassifier() */
  1433. VOID
  1434. kalOidComplete(IN P_GLUE_INFO_T prGlueInfo,
  1435. IN BOOLEAN fgSetQuery, IN UINT_32 u4SetQueryInfoLen, IN WLAN_STATUS rOidStatus)
  1436. {
  1437. ASSERT(prGlueInfo);
  1438. /* remove timeout check timer */
  1439. wlanoidClearTimeoutCheck(prGlueInfo->prAdapter);
  1440. /* if (prGlueInfo->u4TimeoutFlag != 1) { */
  1441. prGlueInfo->rPendStatus = rOidStatus;
  1442. DBGLOG(OID, TEMP, "kalOidComplete, caller: %p\n", __builtin_return_address(0));
  1443. complete(&prGlueInfo->rPendComp);
  1444. prGlueInfo->u4OidCompleteFlag = 1;
  1445. /* } */
  1446. /* else let it timeout on kalIoctl entry */
  1447. }
  1448. VOID kalOidClearance(IN P_GLUE_INFO_T prGlueInfo)
  1449. {
  1450. /* if (prGlueInfo->u4TimeoutFlag != 1) { */
  1451. /* clear_bit(GLUE_FLAG_OID_BIT, &prGlueInfo->u4Flag); */
  1452. if (prGlueInfo->u4OidCompleteFlag != 1) {
  1453. DBGLOG(OID, TEMP, "kalOidClearance, caller: %p\n", __builtin_return_address(0));
  1454. complete(&prGlueInfo->rPendComp);
  1455. }
  1456. /* } */
  1457. }
  1458. /*----------------------------------------------------------------------------*/
  1459. /*!
  1460. * @brief This function is used to transfer linux ioctl to OID, and we
  1461. * need to specify the behavior of the OID by ourself
  1462. *
  1463. * @param prGlueInfo Pointer to the glue structure
  1464. * @param pvInfoBuf Data buffer
  1465. * @param u4InfoBufLen Data buffer length
  1466. * @param fgRead Is this a read OID
  1467. * @param fgWaitResp does this OID need to wait for values
  1468. * @param fgCmd does this OID compose command packet
  1469. * @param pu4QryInfoLen The data length of the return values
  1470. *
  1471. * @retval TRUE Success to extract information
  1472. * @retval FALSE Fail to extract correct information
  1473. */
  1474. /*----------------------------------------------------------------------------*/
  1475. /* todo: enqueue the i/o requests for multiple processes access */
  1476. /* */
  1477. /* currently, return -1 */
  1478. /* */
  1479. /* static GL_IO_REQ_T OidEntry; */
  1480. WLAN_STATUS
  1481. kalIoctl(IN P_GLUE_INFO_T prGlueInfo,
  1482. IN PFN_OID_HANDLER_FUNC pfnOidHandler,
  1483. IN PVOID pvInfoBuf,
  1484. IN UINT_32 u4InfoBufLen,
  1485. IN BOOLEAN fgRead, IN BOOLEAN fgWaitResp, IN BOOLEAN fgCmd, IN BOOLEAN fgIsP2pOid, OUT PUINT_32 pu4QryInfoLen)
  1486. {
  1487. P_GL_IO_REQ_T prIoReq = NULL;
  1488. WLAN_STATUS ret = WLAN_STATUS_SUCCESS;
  1489. if (fgIsResetting == TRUE)
  1490. return WLAN_STATUS_SUCCESS;
  1491. /* GLUE_SPIN_LOCK_DECLARATION(); */
  1492. ASSERT(prGlueInfo);
  1493. /* <1> Check if driver is halt */
  1494. /* if (prGlueInfo->u4Flag & GLUE_FLAG_HALT) { */
  1495. /* return WLAN_STATUS_ADAPTER_NOT_READY; */
  1496. /* } */
  1497. /* if wait longer than double OID timeout timer, then will show backtrace who held halt lock.
  1498. at this case, we will return kalIoctl failure because tx_thread may be hung */
  1499. if (kalHaltLock(2 * WLAN_OID_TIMEOUT_THRESHOLD))
  1500. return WLAN_STATUS_FAILURE;
  1501. if (kalIsHalted()) {
  1502. kalHaltUnlock();
  1503. return WLAN_STATUS_ADAPTER_NOT_READY;
  1504. }
  1505. if (down_interruptible(&prGlueInfo->ioctl_sem)) {
  1506. kalHaltUnlock();
  1507. return WLAN_STATUS_FAILURE;
  1508. }
  1509. /* <2> TODO: thread-safe */
  1510. /* <3> point to the OidEntry of Glue layer */
  1511. prIoReq = &(prGlueInfo->OidEntry);
  1512. ASSERT(prIoReq);
  1513. /* <4> Compose the I/O request */
  1514. prIoReq->prAdapter = prGlueInfo->prAdapter;
  1515. prIoReq->pfnOidHandler = pfnOidHandler;
  1516. prIoReq->pvInfoBuf = pvInfoBuf;
  1517. prIoReq->u4InfoBufLen = u4InfoBufLen;
  1518. prIoReq->pu4QryInfoLen = pu4QryInfoLen;
  1519. prIoReq->fgRead = fgRead;
  1520. prIoReq->fgWaitResp = fgWaitResp;
  1521. prIoReq->rStatus = WLAN_STATUS_FAILURE;
  1522. #if CFG_ENABLE_WIFI_DIRECT
  1523. prIoReq->fgIsP2pOid = fgIsP2pOid;
  1524. #endif
  1525. /* <5> Reset the status of pending OID */
  1526. prGlueInfo->rPendStatus = WLAN_STATUS_FAILURE;
  1527. /* prGlueInfo->u4TimeoutFlag = 0; */
  1528. /* prGlueInfo->u4OidCompleteFlag = 0; */
  1529. /* <6> Check if we use the command queue */
  1530. prIoReq->u4Flag = fgCmd;
  1531. /* <7> schedule the OID bit */
  1532. set_bit(GLUE_FLAG_OID_BIT, &prGlueInfo->ulFlag);
  1533. /* <8> Wake up tx thread to handle kick start the I/O request */
  1534. wake_up_interruptible(&prGlueInfo->waitq);
  1535. /* <9> Block and wait for event or timeout, current the timeout is 5 secs */
  1536. /* if (wait_for_completion_interruptible_timeout(&prGlueInfo->rPendComp, 5 * KAL_HZ)) { */
  1537. /* if (!wait_for_completion_interruptible(&prGlueInfo->rPendComp)) { */
  1538. DBGLOG(OID, TEMP, "kalIoctl: before wait, caller: %p\n", __builtin_return_address(0));
  1539. wait_for_completion(&prGlueInfo->rPendComp); {
  1540. /* Case 1: No timeout. */
  1541. /* if return WLAN_STATUS_PENDING, the status of cmd is stored in prGlueInfo */
  1542. if (prIoReq->rStatus == WLAN_STATUS_PENDING)
  1543. ret = prGlueInfo->rPendStatus;
  1544. else
  1545. ret = prIoReq->rStatus;
  1546. }
  1547. #if 0
  1548. else {
  1549. /* Case 2: timeout */
  1550. /* clear pending OID's cmd in CMD queue */
  1551. if (fgCmd) {
  1552. prGlueInfo->u4TimeoutFlag = 1;
  1553. wlanReleasePendingOid(prGlueInfo->prAdapter, 0);
  1554. }
  1555. ret = WLAN_STATUS_FAILURE;
  1556. }
  1557. #endif
  1558. DBGLOG(OID, TEMP, "kalIoctl: done\n");
  1559. up(&prGlueInfo->ioctl_sem);
  1560. kalHaltUnlock();
  1561. return ret;
  1562. }
  1563. /*----------------------------------------------------------------------------*/
  1564. /*!
  1565. * \brief This routine is used to clear all pending security frames
  1566. *
  1567. * \param prGlueInfo Pointer of GLUE Data Structure
  1568. *
  1569. * \retval none
  1570. */
  1571. /*----------------------------------------------------------------------------*/
  1572. VOID kalClearSecurityFrames(IN P_GLUE_INFO_T prGlueInfo)
  1573. {
  1574. P_QUE_T prCmdQue;
  1575. QUE_T rTempCmdQue;
  1576. P_QUE_T prTempCmdQue = &rTempCmdQue;
  1577. P_QUE_ENTRY_T prQueueEntry = (P_QUE_ENTRY_T) NULL;
  1578. P_CMD_INFO_T prCmdInfo = (P_CMD_INFO_T) NULL;
  1579. GLUE_SPIN_LOCK_DECLARATION();
  1580. ASSERT(prGlueInfo);
  1581. /* Clear pending security frames in prGlueInfo->rCmdQueue */
  1582. prCmdQue = &prGlueInfo->rCmdQueue;
  1583. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  1584. QUEUE_MOVE_ALL(prTempCmdQue, prCmdQue);
  1585. QUEUE_REMOVE_HEAD(prTempCmdQue, prQueueEntry, P_QUE_ENTRY_T);
  1586. while (prQueueEntry) {
  1587. prCmdInfo = (P_CMD_INFO_T) prQueueEntry;
  1588. if (prCmdInfo->eCmdType == COMMAND_TYPE_SECURITY_FRAME) {
  1589. prCmdInfo->pfCmdTimeoutHandler(prGlueInfo->prAdapter, prCmdInfo);
  1590. cmdBufFreeCmdInfo(prGlueInfo->prAdapter, prCmdInfo);
  1591. } else {
  1592. QUEUE_INSERT_TAIL(prCmdQue, prQueueEntry);
  1593. }
  1594. QUEUE_REMOVE_HEAD(prTempCmdQue, prQueueEntry, P_QUE_ENTRY_T);
  1595. }
  1596. QUEUE_CONCATENATE_QUEUES(prCmdQue, prTempCmdQue);
  1597. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  1598. }
  1599. /*----------------------------------------------------------------------------*/
  1600. /*!
  1601. * \brief This routine is used to clear pending security frames
  1602. * belongs to dedicated network type
  1603. *
  1604. * \param prGlueInfo Pointer of GLUE Data Structure
  1605. * \param eNetworkTypeIdx Network Type Index
  1606. *
  1607. * \retval none
  1608. */
  1609. /*----------------------------------------------------------------------------*/
  1610. VOID kalClearSecurityFramesByNetType(IN P_GLUE_INFO_T prGlueInfo, IN ENUM_NETWORK_TYPE_INDEX_T eNetworkTypeIdx)
  1611. {
  1612. P_QUE_T prCmdQue;
  1613. QUE_T rTempCmdQue;
  1614. P_QUE_T prTempCmdQue = &rTempCmdQue;
  1615. P_QUE_ENTRY_T prQueueEntry = (P_QUE_ENTRY_T) NULL;
  1616. P_CMD_INFO_T prCmdInfo = (P_CMD_INFO_T) NULL;
  1617. GLUE_SPIN_LOCK_DECLARATION();
  1618. ASSERT(prGlueInfo);
  1619. /* Clear pending security frames in prGlueInfo->rCmdQueue */
  1620. prCmdQue = &prGlueInfo->rCmdQueue;
  1621. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  1622. QUEUE_MOVE_ALL(prTempCmdQue, prCmdQue);
  1623. QUEUE_REMOVE_HEAD(prTempCmdQue, prQueueEntry, P_QUE_ENTRY_T);
  1624. while (prQueueEntry) {
  1625. prCmdInfo = (P_CMD_INFO_T) prQueueEntry;
  1626. if (prCmdInfo->eCmdType == COMMAND_TYPE_SECURITY_FRAME && prCmdInfo->eNetworkType == eNetworkTypeIdx) {
  1627. prCmdInfo->pfCmdTimeoutHandler(prGlueInfo->prAdapter, prCmdInfo);
  1628. cmdBufFreeCmdInfo(prGlueInfo->prAdapter, prCmdInfo);
  1629. } else {
  1630. QUEUE_INSERT_TAIL(prCmdQue, prQueueEntry);
  1631. }
  1632. QUEUE_REMOVE_HEAD(prTempCmdQue, prQueueEntry, P_QUE_ENTRY_T);
  1633. }
  1634. QUEUE_CONCATENATE_QUEUES(prCmdQue, prTempCmdQue);
  1635. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  1636. }
  1637. /*----------------------------------------------------------------------------*/
  1638. /*!
  1639. * \brief This routine is used to clear all pending management frames
  1640. *
  1641. * \param prGlueInfo Pointer of GLUE Data Structure
  1642. *
  1643. * \retval none
  1644. */
  1645. /*----------------------------------------------------------------------------*/
  1646. VOID kalClearMgmtFrames(IN P_GLUE_INFO_T prGlueInfo)
  1647. {
  1648. P_QUE_T prCmdQue;
  1649. QUE_T rTempCmdQue;
  1650. P_QUE_T prTempCmdQue = &rTempCmdQue;
  1651. P_QUE_ENTRY_T prQueueEntry = (P_QUE_ENTRY_T) NULL;
  1652. P_CMD_INFO_T prCmdInfo = (P_CMD_INFO_T) NULL;
  1653. GLUE_SPIN_LOCK_DECLARATION();
  1654. ASSERT(prGlueInfo);
  1655. /* Clear pending management frames in prGlueInfo->rCmdQueue */
  1656. prCmdQue = &prGlueInfo->rCmdQueue;
  1657. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  1658. QUEUE_MOVE_ALL(prTempCmdQue, prCmdQue);
  1659. QUEUE_REMOVE_HEAD(prTempCmdQue, prQueueEntry, P_QUE_ENTRY_T);
  1660. while (prQueueEntry) {
  1661. prCmdInfo = (P_CMD_INFO_T) prQueueEntry;
  1662. if (prCmdInfo->eCmdType == COMMAND_TYPE_MANAGEMENT_FRAME) {
  1663. wlanReleaseCommand(prGlueInfo->prAdapter, prCmdInfo);
  1664. cmdBufFreeCmdInfo(prGlueInfo->prAdapter, prCmdInfo);
  1665. } else {
  1666. QUEUE_INSERT_TAIL(prCmdQue, prQueueEntry);
  1667. }
  1668. QUEUE_REMOVE_HEAD(prTempCmdQue, prQueueEntry, P_QUE_ENTRY_T);
  1669. }
  1670. QUEUE_CONCATENATE_QUEUES(prCmdQue, prTempCmdQue);
  1671. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  1672. }
  1673. /*----------------------------------------------------------------------------*/
  1674. /*!
  1675. * \brief This routine is used to clear all pending management frames
  1676. * belongs to dedicated network type
  1677. * \param prGlueInfo Pointer of GLUE Data Structure
  1678. *
  1679. * \retval none
  1680. */
  1681. /*----------------------------------------------------------------------------*/
  1682. VOID kalClearMgmtFramesByNetType(IN P_GLUE_INFO_T prGlueInfo, IN ENUM_NETWORK_TYPE_INDEX_T eNetworkTypeIdx)
  1683. {
  1684. P_QUE_T prCmdQue;
  1685. QUE_T rTempCmdQue;
  1686. P_QUE_T prTempCmdQue = &rTempCmdQue;
  1687. P_QUE_ENTRY_T prQueueEntry = (P_QUE_ENTRY_T) NULL;
  1688. P_CMD_INFO_T prCmdInfo = (P_CMD_INFO_T) NULL;
  1689. GLUE_SPIN_LOCK_DECLARATION();
  1690. ASSERT(prGlueInfo);
  1691. /* Clear pending management frames in prGlueInfo->rCmdQueue */
  1692. prCmdQue = &prGlueInfo->rCmdQueue;
  1693. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  1694. QUEUE_MOVE_ALL(prTempCmdQue, prCmdQue);
  1695. QUEUE_REMOVE_HEAD(prTempCmdQue, prQueueEntry, P_QUE_ENTRY_T);
  1696. while (prQueueEntry) {
  1697. prCmdInfo = (P_CMD_INFO_T) prQueueEntry;
  1698. if (prCmdInfo->eCmdType == COMMAND_TYPE_MANAGEMENT_FRAME &&
  1699. prCmdInfo->eNetworkType == eNetworkTypeIdx) {
  1700. wlanReleaseCommand(prGlueInfo->prAdapter, prCmdInfo);
  1701. cmdBufFreeCmdInfo(prGlueInfo->prAdapter, prCmdInfo);
  1702. } else {
  1703. QUEUE_INSERT_TAIL(prCmdQue, prQueueEntry);
  1704. }
  1705. QUEUE_REMOVE_HEAD(prTempCmdQue, prQueueEntry, P_QUE_ENTRY_T);
  1706. }
  1707. QUEUE_CONCATENATE_QUEUES(prCmdQue, prTempCmdQue);
  1708. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  1709. } /* kalClearMgmtFramesByNetType */
  1710. /*----------------------------------------------------------------------------*/
  1711. /*!
  1712. * @brief This function is a kernel thread function for handling command packets
  1713. * Tx requests and interrupt events
  1714. *
  1715. * @param data data pointer to private data of tx_thread
  1716. *
  1717. * @retval If the function succeeds, the return value is 0.
  1718. * Otherwise, an error code is returned.
  1719. *
  1720. */
  1721. /*----------------------------------------------------------------------------*/
  1722. int tx_thread(void *data)
  1723. {
  1724. struct net_device *dev = data;
  1725. P_GLUE_INFO_T prGlueInfo = *((P_GLUE_INFO_T *) netdev_priv(dev));
  1726. P_QUE_ENTRY_T prQueueEntry = NULL;
  1727. P_GL_IO_REQ_T prIoReq = NULL;
  1728. P_QUE_T prTxQueue = NULL;
  1729. P_QUE_T prCmdQue = NULL;
  1730. P_RX_CTRL_T prRxCtrl;
  1731. P_SW_RFB_T prSwRfb = NULL;
  1732. int i, u4UninitRfbNum = 0;
  1733. int ret = 0;
  1734. BOOLEAN fgNeedHwAccess = FALSE;
  1735. BOOLEAN fgIsUninitRfb = FALSE;
  1736. struct sk_buff *prSkb = NULL;
  1737. /* for spin lock acquire and release */
  1738. GLUE_SPIN_LOCK_DECLARATION();
  1739. prTxQueue = &prGlueInfo->rTxQueue;
  1740. prCmdQue = &prGlueInfo->rCmdQueue;
  1741. prRxCtrl = &prGlueInfo->prAdapter->rRxCtrl;
  1742. current->flags |= PF_NOFREEZE;
  1743. DBGLOG(INIT, INFO, "tx_thread starts running...\n");
  1744. while (TRUE) {
  1745. #if CFG_ENABLE_WIFI_DIRECT
  1746. /*run p2p multicast list work. */
  1747. if (test_and_clear_bit(GLUE_FLAG_SUB_MOD_MULTICAST_BIT, &prGlueInfo->ulFlag))
  1748. p2pSetMulticastListWorkQueueWrapper(prGlueInfo);
  1749. #endif
  1750. if (test_and_clear_bit(GLUE_FLAG_FRAME_FILTER_AIS_BIT, &prGlueInfo->ulFlag)) {
  1751. P_AIS_FSM_INFO_T prAisFsmInfo = (P_AIS_FSM_INFO_T) NULL;
  1752. /* printk("prGlueInfo->u4OsMgmtFrameFilter = %x", prGlueInfo->u4OsMgmtFrameFilter); */
  1753. prAisFsmInfo = &(prGlueInfo->prAdapter->rWifiVar.rAisFsmInfo);
  1754. prAisFsmInfo->u4AisPacketFilter = prGlueInfo->u4OsMgmtFrameFilter;
  1755. }
  1756. if (prGlueInfo->ulFlag & GLUE_FLAG_HALT) {
  1757. KAL_WAKE_UNLOCK(prGlueInfo->prAdapter, &(prGlueInfo->prAdapter)->rTxThreadWakeLock);
  1758. DBGLOG(INIT, INFO, "tx_thread should stop now...\n");
  1759. break;
  1760. }
  1761. /*
  1762. * sleep on waitqueue if no events occurred. Event contain (1) GLUE_FLAG_INT
  1763. * (2) GLUE_FLAG_OID (3) GLUE_FLAG_TXREQ (4) GLUE_FLAG_HALT
  1764. *
  1765. */
  1766. KAL_WAKE_UNLOCK(prGlueInfo->prAdapter, &(prGlueInfo->prAdapter)->rTxThreadWakeLock);
  1767. ret = wait_event_interruptible(prGlueInfo->waitq, (prGlueInfo->ulFlag != 0));
  1768. KAL_WAKE_LOCK(prGlueInfo->prAdapter, &(prGlueInfo->prAdapter)->rTxThreadWakeLock);
  1769. /* #if (CONF_HIF_LOOPBACK_AUTO == 1) */
  1770. /* if (test_and_clear_bit(GLUE_FLAG_HIF_LOOPBK_AUTO_BIT, &prGlueInfo->u4Flag)) { */
  1771. /* kalDevLoopbkAuto(prGlueInfo); */
  1772. /* } */
  1773. /* #endif */ /* CONF_HIF_LOOPBACK_AUTO */
  1774. #if CFG_DBG_GPIO_PINS
  1775. /* TX thread Wake up */
  1776. mtk_wcn_stp_debug_gpio_assert(IDX_TX_THREAD, DBG_TIE_LOW);
  1777. #endif
  1778. #if CFG_ENABLE_WIFI_DIRECT
  1779. /*run p2p multicast list work. */
  1780. if (test_and_clear_bit(GLUE_FLAG_SUB_MOD_MULTICAST_BIT, &prGlueInfo->ulFlag))
  1781. p2pSetMulticastListWorkQueueWrapper(prGlueInfo);
  1782. if (test_and_clear_bit(GLUE_FLAG_FRAME_FILTER_BIT, &prGlueInfo->ulFlag)) {
  1783. p2pFuncUpdateMgmtFrameRegister(prGlueInfo->prAdapter,
  1784. prGlueInfo->prP2PInfo->u4OsMgmtFrameFilter);
  1785. }
  1786. #endif
  1787. if (test_and_clear_bit(GLUE_FLAG_FRAME_FILTER_AIS_BIT, &prGlueInfo->ulFlag)) {
  1788. P_AIS_FSM_INFO_T prAisFsmInfo = (P_AIS_FSM_INFO_T) NULL;
  1789. /* printk("prGlueInfo->u4OsMgmtFrameFilter = %x", prGlueInfo->u4OsMgmtFrameFilter); */
  1790. prAisFsmInfo = &(prGlueInfo->prAdapter->rWifiVar.rAisFsmInfo);
  1791. prAisFsmInfo->u4AisPacketFilter = prGlueInfo->u4OsMgmtFrameFilter;
  1792. }
  1793. if (prGlueInfo->ulFlag & GLUE_FLAG_HALT) {
  1794. KAL_WAKE_UNLOCK(prGlueInfo->prAdapter, &(prGlueInfo->prAdapter)->rTxThreadWakeLock);
  1795. DBGLOG(INIT, INFO, "<1>tx_thread should stop now...\n");
  1796. break;
  1797. }
  1798. fgNeedHwAccess = FALSE;
  1799. /* Handle Interrupt */
  1800. if (test_and_clear_bit(GLUE_FLAG_INT_BIT, &prGlueInfo->ulFlag)) {
  1801. if (fgNeedHwAccess == FALSE) {
  1802. fgNeedHwAccess = TRUE;
  1803. wlanAcquirePowerControl(prGlueInfo->prAdapter);
  1804. }
  1805. /* the Wi-Fi interrupt is already disabled in mmc thread,
  1806. so we set the flag only to enable the interrupt later */
  1807. prGlueInfo->prAdapter->fgIsIntEnable = FALSE;
  1808. /* wlanISR(prGlueInfo->prAdapter, TRUE); */
  1809. if (prGlueInfo->ulFlag & GLUE_FLAG_HALT) {
  1810. /* Should stop now... skip pending interrupt */
  1811. DBGLOG(INIT, INFO, "ignore pending interrupt\n");
  1812. } else {
  1813. TaskIsrCnt++;
  1814. wlanIST(prGlueInfo->prAdapter);
  1815. }
  1816. }
  1817. /* transfer ioctl to OID request */
  1818. #if 0
  1819. if (prGlueInfo->u4Flag & GLUE_FLAG_HALT) {
  1820. DBGLOG(INIT, INFO, "<2>tx_thread should stop now...\n");
  1821. break;
  1822. }
  1823. #endif
  1824. do {
  1825. if (test_and_clear_bit(GLUE_FLAG_OID_BIT, &prGlueInfo->ulFlag)) {
  1826. /* get current prIoReq */
  1827. prGlueInfo->u4OidCompleteFlag = 0;
  1828. prIoReq = &(prGlueInfo->OidEntry);
  1829. #if CFG_ENABLE_WIFI_DIRECT
  1830. if (prGlueInfo->prAdapter->fgIsP2PRegistered == FALSE && prIoReq->fgIsP2pOid == TRUE) {
  1831. /* if this Oid belongs to p2p and p2p module is removed
  1832. * do nothing,
  1833. */
  1834. } else
  1835. #endif
  1836. {
  1837. if (FALSE == prIoReq->fgRead) {
  1838. prIoReq->rStatus = wlanSetInformation(prIoReq->prAdapter,
  1839. prIoReq->pfnOidHandler,
  1840. prIoReq->pvInfoBuf,
  1841. prIoReq->u4InfoBufLen,
  1842. prIoReq->pu4QryInfoLen);
  1843. } else {
  1844. prIoReq->rStatus = wlanQueryInformation(prIoReq->prAdapter,
  1845. prIoReq->pfnOidHandler,
  1846. prIoReq->pvInfoBuf,
  1847. prIoReq->u4InfoBufLen,
  1848. prIoReq->pu4QryInfoLen);
  1849. }
  1850. if (prIoReq->rStatus != WLAN_STATUS_PENDING) {
  1851. DBGLOG(OID, TEMP, "tx_thread, complete\n");
  1852. complete(&prGlueInfo->rPendComp);
  1853. } else {
  1854. wlanoidTimeoutCheck(prGlueInfo->prAdapter, prIoReq->pfnOidHandler);
  1855. }
  1856. }
  1857. }
  1858. } while (FALSE);
  1859. /*
  1860. *
  1861. * if TX request, clear the TXREQ flag. TXREQ set by kalSetEvent/GlueSetEvent
  1862. * indicates the following requests occur
  1863. *
  1864. */
  1865. #if 0
  1866. if (prGlueInfo->u4Flag & GLUE_FLAG_HALT) {
  1867. DBGLOG(INIT, INFO, "<3>tx_thread should stop now...\n");
  1868. break;
  1869. }
  1870. #endif
  1871. if (test_and_clear_bit(GLUE_FLAG_TXREQ_BIT, &prGlueInfo->ulFlag)) {
  1872. /* Process Mailbox Messages */
  1873. wlanProcessMboxMessage(prGlueInfo->prAdapter);
  1874. /* Process CMD request */
  1875. do {
  1876. if (prCmdQue->u4NumElem > 0) {
  1877. if (fgNeedHwAccess == FALSE) {
  1878. fgNeedHwAccess = TRUE;
  1879. wlanAcquirePowerControl(prGlueInfo->prAdapter);
  1880. }
  1881. wlanProcessCommandQueue(prGlueInfo->prAdapter, prCmdQue);
  1882. }
  1883. } while (FALSE);
  1884. /* Handle Packet Tx */
  1885. {
  1886. while (QUEUE_IS_NOT_EMPTY(prTxQueue)) {
  1887. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_TX_QUE);
  1888. QUEUE_REMOVE_HEAD(prTxQueue, prQueueEntry, P_QUE_ENTRY_T);
  1889. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_TX_QUE);
  1890. ASSERT(prQueueEntry);
  1891. if (NULL == prQueueEntry)
  1892. break;
  1893. prSkb = (struct sk_buff *)GLUE_GET_PKT_DESCRIPTOR(prQueueEntry);
  1894. ASSERT(prSkb);
  1895. if (NULL == prSkb) {
  1896. DBGLOG(INIT, ERROR, "prSkb == NULL!\n");
  1897. continue;
  1898. }
  1899. #if (CFG_SUPPORT_TDLS_DBG == 1)
  1900. UINT8 *pkt = prSkb->data;
  1901. UINT16 u2Identifier;
  1902. if ((*(pkt + 12) == 0x08) && (*(pkt + 13) == 0x00)) {
  1903. /* ip */
  1904. u2Identifier = ((*(pkt + 18)) << 8) | (*(pkt + 19));
  1905. DBGLOG(INIT, LOUD, "<TDLS> %d\n", u2Identifier);
  1906. }
  1907. #endif
  1908. if (wlanEnqueueTxPacket(prGlueInfo->prAdapter,
  1909. (P_NATIVE_PACKET) prSkb) == WLAN_STATUS_RESOURCES) {
  1910. /* no available entry in rFreeMsduInfoList */
  1911. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_TX_QUE);
  1912. QUEUE_INSERT_HEAD(prTxQueue, prQueueEntry);
  1913. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_TX_QUE);
  1914. break;
  1915. }
  1916. }
  1917. if (wlanGetTxPendingFrameCount(prGlueInfo->prAdapter) > 0) {
  1918. /* send packets to HIF here */
  1919. wlanTxPendingPackets(prGlueInfo->prAdapter, &fgNeedHwAccess);
  1920. }
  1921. }
  1922. }
  1923. /* Process unInitialized Rfb*/
  1924. if (prRxCtrl->rUnInitializedRfbList.u4NumElem > 0) {
  1925. u4UninitRfbNum = prRxCtrl->rUnInitializedRfbList.u4NumElem;
  1926. DBGLOG(INIT, INFO, "tx_thread :process uninitialziation RFB num=%d\n", u4UninitRfbNum);
  1927. for (i = 0; i < u4UninitRfbNum; i++) {
  1928. fgIsUninitRfb = FALSE;
  1929. KAL_ACQUIRE_SPIN_LOCK(prGlueInfo->prAdapter, SPIN_LOCK_RX_QUE);
  1930. QUEUE_REMOVE_HEAD(&prRxCtrl->rUnInitializedRfbList, prSwRfb, P_SW_RFB_T);
  1931. KAL_RELEASE_SPIN_LOCK(prGlueInfo->prAdapter, SPIN_LOCK_RX_QUE);
  1932. if (prSwRfb) {
  1933. if (nicRxSetupRFB(prGlueInfo->prAdapter, prSwRfb)) {
  1934. DBGLOG(INIT, ERROR, "Setup RFB Fail! insert uninit List!\n");
  1935. fgIsUninitRfb = TRUE;
  1936. }
  1937. nicRxReturnRFBwithUninit(prGlueInfo->prAdapter, prSwRfb, fgIsUninitRfb);
  1938. } else {
  1939. DBGLOG(INIT, ERROR, "prSwRfb is NULL!\n");
  1940. }
  1941. }
  1942. }
  1943. /* Process RX, In linux, we don't need to free sk_buff by ourself */
  1944. /* In linux, we don't need to free sk_buff by ourself */
  1945. /* In linux, we don't do reset */
  1946. if (fgNeedHwAccess == TRUE)
  1947. wlanReleasePowerControl(prGlueInfo->prAdapter);
  1948. /* handle cnmTimer time out */
  1949. if (test_and_clear_bit(GLUE_FLAG_TIMEOUT_BIT, &prGlueInfo->ulFlag))
  1950. wlanTimerTimeoutCheck(prGlueInfo->prAdapter);
  1951. #if CFG_DBG_GPIO_PINS
  1952. /* TX thread go to sleep */
  1953. if (!prGlueInfo->ulFlag)
  1954. mtk_wcn_stp_debug_gpio_assert(IDX_TX_THREAD, DBG_TIE_HIGH);
  1955. #endif
  1956. }
  1957. #if 0
  1958. if (fgNeedHwAccess == TRUE)
  1959. wlanReleasePowerControl(prGlueInfo->prAdapter);
  1960. #endif
  1961. /* exit while loop, tx thread is closed so we flush all pending packets */
  1962. /* flush the pending TX packets */
  1963. if (prGlueInfo->i4TxPendingFrameNum > 0)
  1964. kalFlushPendingTxPackets(prGlueInfo);
  1965. /* flush pending security frames */
  1966. if (prGlueInfo->i4TxPendingSecurityFrameNum > 0)
  1967. kalClearSecurityFrames(prGlueInfo);
  1968. /* remove pending oid */
  1969. wlanReleasePendingOid(prGlueInfo->prAdapter, 0);
  1970. /* In linux, we don't need to free sk_buff by ourself */
  1971. DBGLOG(INIT, INFO, "mtk_sdiod stops\n");
  1972. complete(&prGlueInfo->rHaltComp);
  1973. return 0;
  1974. }
  1975. /*----------------------------------------------------------------------------*/
  1976. /*!
  1977. * \brief This routine is used to check if card is removed
  1978. *
  1979. * \param pvGlueInfo Pointer of GLUE Data Structure
  1980. *
  1981. * \retval TRUE: card is removed
  1982. * FALSE: card is still attached
  1983. */
  1984. /*----------------------------------------------------------------------------*/
  1985. BOOLEAN kalIsCardRemoved(IN P_GLUE_INFO_T prGlueInfo)
  1986. {
  1987. ASSERT(prGlueInfo);
  1988. return FALSE;
  1989. /* Linux MMC doesn't have removal notification yet */
  1990. }
  1991. /*----------------------------------------------------------------------------*/
  1992. /*!
  1993. * \brief This routine is used to send command to firmware for overriding netweork address
  1994. *
  1995. * \param pvGlueInfo Pointer of GLUE Data Structure
  1996. * \retval TRUE
  1997. * FALSE
  1998. */
  1999. /*----------------------------------------------------------------------------*/
  2000. BOOLEAN kalRetrieveNetworkAddress(IN P_GLUE_INFO_T prGlueInfo, IN OUT PARAM_MAC_ADDRESS *prMacAddr)
  2001. {
  2002. ASSERT(prGlueInfo);
  2003. if (prGlueInfo->fgIsMacAddrOverride == FALSE) {
  2004. #if !defined(CONFIG_X86)
  2005. #if !defined(CONFIG_MTK_TC1_FEATURE)
  2006. UINT_32 i;
  2007. #endif
  2008. BOOLEAN fgIsReadError = FALSE;
  2009. #if !defined(CONFIG_MTK_TC1_FEATURE)
  2010. for (i = 0; i < MAC_ADDR_LEN; i += 2) {
  2011. if (kalCfgDataRead16(prGlueInfo,
  2012. OFFSET_OF(WIFI_CFG_PARAM_STRUCT, aucMacAddress) + i,
  2013. (PUINT_16) (((PUINT_8) prMacAddr) + i)) == FALSE) {
  2014. fgIsReadError = TRUE;
  2015. break;
  2016. }
  2017. }
  2018. #else
  2019. TC1_FAC_NAME(FacReadWifiMacAddr) ((unsigned char *)prMacAddr);
  2020. #endif
  2021. if (fgIsReadError == TRUE)
  2022. return FALSE;
  2023. else
  2024. return TRUE;
  2025. #else
  2026. /* x86 Linux doesn't need to override network address so far */
  2027. return FALSE;
  2028. #endif
  2029. } else {
  2030. COPY_MAC_ADDR(prMacAddr, prGlueInfo->rMacAddrOverride);
  2031. return TRUE;
  2032. }
  2033. }
  2034. /*----------------------------------------------------------------------------*/
  2035. /*!
  2036. * \brief This routine is used to flush pending TX packets in glue layer
  2037. *
  2038. * \param pvGlueInfo Pointer of GLUE Data Structure
  2039. *
  2040. * \retval none
  2041. */
  2042. /*----------------------------------------------------------------------------*/
  2043. VOID kalFlushPendingTxPackets(IN P_GLUE_INFO_T prGlueInfo)
  2044. {
  2045. P_QUE_T prTxQue;
  2046. P_QUE_ENTRY_T prQueueEntry;
  2047. PVOID prPacket;
  2048. GLUE_SPIN_LOCK_DECLARATION();
  2049. ASSERT(prGlueInfo);
  2050. prTxQue = &(prGlueInfo->rTxQueue);
  2051. if (prGlueInfo->i4TxPendingFrameNum) {
  2052. while (TRUE) {
  2053. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_TX_QUE);
  2054. QUEUE_REMOVE_HEAD(prTxQue, prQueueEntry, P_QUE_ENTRY_T);
  2055. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_TX_QUE);
  2056. if (prQueueEntry == NULL)
  2057. break;
  2058. prPacket = GLUE_GET_PKT_DESCRIPTOR(prQueueEntry);
  2059. kalSendComplete(prGlueInfo, prPacket, WLAN_STATUS_NOT_ACCEPTED);
  2060. }
  2061. }
  2062. }
  2063. /*----------------------------------------------------------------------------*/
  2064. /*!
  2065. * \brief This routine is get indicated media state
  2066. *
  2067. * \param pvGlueInfo Pointer of GLUE Data Structure
  2068. *
  2069. * \retval
  2070. */
  2071. /*----------------------------------------------------------------------------*/
  2072. ENUM_PARAM_MEDIA_STATE_T kalGetMediaStateIndicated(IN P_GLUE_INFO_T prGlueInfo)
  2073. {
  2074. ASSERT(prGlueInfo);
  2075. return prGlueInfo->eParamMediaStateIndicated;
  2076. }
  2077. /*----------------------------------------------------------------------------*/
  2078. /*!
  2079. * \brief This routine is used to set indicated media state
  2080. *
  2081. * \param pvGlueInfo Pointer of GLUE Data Structure
  2082. *
  2083. * \retval none
  2084. */
  2085. /*----------------------------------------------------------------------------*/
  2086. VOID kalSetMediaStateIndicated(IN P_GLUE_INFO_T prGlueInfo, IN ENUM_PARAM_MEDIA_STATE_T eParamMediaStateIndicate)
  2087. {
  2088. ASSERT(prGlueInfo);
  2089. prGlueInfo->eParamMediaStateIndicated = eParamMediaStateIndicate;
  2090. }
  2091. /*----------------------------------------------------------------------------*/
  2092. /*!
  2093. * \brief This routine is used to clear pending OID staying in command queue
  2094. *
  2095. * \param prGlueInfo Pointer of GLUE Data Structure
  2096. *
  2097. * \retval none
  2098. */
  2099. /*----------------------------------------------------------------------------*/
  2100. VOID kalOidCmdClearance(IN P_GLUE_INFO_T prGlueInfo)
  2101. {
  2102. P_QUE_T prCmdQue;
  2103. QUE_T rTempCmdQue;
  2104. P_QUE_T prTempCmdQue = &rTempCmdQue;
  2105. P_QUE_ENTRY_T prQueueEntry = (P_QUE_ENTRY_T) NULL;
  2106. P_CMD_INFO_T prCmdInfo = (P_CMD_INFO_T) NULL;
  2107. GLUE_SPIN_LOCK_DECLARATION();
  2108. ASSERT(prGlueInfo);
  2109. prCmdQue = &prGlueInfo->rCmdQueue;
  2110. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  2111. QUEUE_MOVE_ALL(prTempCmdQue, prCmdQue);
  2112. QUEUE_REMOVE_HEAD(prTempCmdQue, prQueueEntry, P_QUE_ENTRY_T);
  2113. while (prQueueEntry) {
  2114. if (((P_CMD_INFO_T) prQueueEntry)->fgIsOid) {
  2115. prCmdInfo = (P_CMD_INFO_T) prQueueEntry;
  2116. break;
  2117. }
  2118. QUEUE_INSERT_TAIL(prCmdQue, prQueueEntry);
  2119. QUEUE_REMOVE_HEAD(prTempCmdQue, prQueueEntry, P_QUE_ENTRY_T);
  2120. }
  2121. QUEUE_CONCATENATE_QUEUES(prCmdQue, prTempCmdQue);
  2122. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  2123. if (prCmdInfo) {
  2124. if (prCmdInfo->pfCmdTimeoutHandler)
  2125. prCmdInfo->pfCmdTimeoutHandler(prGlueInfo->prAdapter, prCmdInfo);
  2126. else
  2127. kalOidComplete(prGlueInfo, prCmdInfo->fgSetQuery, 0, WLAN_STATUS_NOT_ACCEPTED);
  2128. prGlueInfo->u4OidCompleteFlag = 1;
  2129. cmdBufFreeCmdInfo(prGlueInfo->prAdapter, prCmdInfo);
  2130. }
  2131. }
  2132. /*----------------------------------------------------------------------------*/
  2133. /*!
  2134. * \brief This routine is used to insert command into prCmdQueue
  2135. *
  2136. * \param prGlueInfo Pointer of GLUE Data Structure
  2137. * prQueueEntry Pointer of queue entry to be inserted
  2138. *
  2139. * \retval none
  2140. */
  2141. /*----------------------------------------------------------------------------*/
  2142. VOID kalEnqueueCommand(IN P_GLUE_INFO_T prGlueInfo, IN P_QUE_ENTRY_T prQueueEntry)
  2143. {
  2144. P_QUE_T prCmdQue;
  2145. P_CMD_INFO_T prCmdInfo;
  2146. P_MSDU_INFO_T prMsduInfo;
  2147. GLUE_SPIN_LOCK_DECLARATION();
  2148. ASSERT(prGlueInfo);
  2149. ASSERT(prQueueEntry);
  2150. prCmdQue = &prGlueInfo->rCmdQueue;
  2151. prCmdInfo = (P_CMD_INFO_T) prQueueEntry;
  2152. if (prCmdInfo->prPacket && prCmdInfo->eCmdType == COMMAND_TYPE_MANAGEMENT_FRAME) {
  2153. prMsduInfo = (P_MSDU_INFO_T) (prCmdInfo->prPacket);
  2154. prMsduInfo->eCmdType = prCmdInfo->eCmdType;
  2155. prMsduInfo->ucCID = prCmdInfo->ucCID;
  2156. prMsduInfo->u4InqueTime = kalGetTimeTick();
  2157. }
  2158. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  2159. QUEUE_INSERT_TAIL(prCmdQue, prQueueEntry);
  2160. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_CMD_QUE);
  2161. }
  2162. /*----------------------------------------------------------------------------*/
  2163. /*!
  2164. * @brief Handle EVENT_ID_ASSOC_INFO event packet by indicating to OS with
  2165. * proper information
  2166. *
  2167. * @param pvGlueInfo Pointer of GLUE Data Structure
  2168. * @param prAssocInfo Pointer of EVENT_ID_ASSOC_INFO Packet
  2169. *
  2170. * @return none
  2171. */
  2172. /*----------------------------------------------------------------------------*/
  2173. VOID kalHandleAssocInfo(IN P_GLUE_INFO_T prGlueInfo, IN P_EVENT_ASSOC_INFO prAssocInfo)
  2174. {
  2175. /* to do */
  2176. }
  2177. /*----------------------------------------------------------------------------*/
  2178. /*!
  2179. * \brief This routine is used to get firmware load address from registry
  2180. *
  2181. * \param prGlueInfo Pointer of GLUE Data Structure
  2182. *
  2183. * \retval
  2184. */
  2185. /*----------------------------------------------------------------------------*/
  2186. UINT_32 kalGetFwLoadAddress(IN P_GLUE_INFO_T prGlueInfo)
  2187. {
  2188. ASSERT(prGlueInfo);
  2189. return prGlueInfo->rRegInfo.u4LoadAddress;
  2190. }
  2191. /*----------------------------------------------------------------------------*/
  2192. /*!
  2193. * \brief This routine is used to get firmware start address from registry
  2194. *
  2195. * \param prGlueInfo Pointer of GLUE Data Structure
  2196. *
  2197. * \retval
  2198. */
  2199. /*----------------------------------------------------------------------------*/
  2200. UINT_32 kalGetFwStartAddress(IN P_GLUE_INFO_T prGlueInfo)
  2201. {
  2202. ASSERT(prGlueInfo);
  2203. return prGlueInfo->rRegInfo.u4StartAddress;
  2204. }
  2205. /*----------------------------------------------------------------------------*/
  2206. /*!
  2207. * * @brief Notify OS with SendComplete event of the specific packet. Linux should
  2208. * * free packets here.
  2209. * *
  2210. * * @param pvGlueInfo Pointer of GLUE Data Structure
  2211. * * @param pvPacket Pointer of Packet Handle
  2212. * * @param status Status Code for OS upper layer
  2213. * *
  2214. * * @return none
  2215. * */
  2216. /*----------------------------------------------------------------------------*/
  2217. /* / Todo */
  2218. VOID kalSecurityFrameSendComplete(IN P_GLUE_INFO_T prGlueInfo, IN PVOID pvPacket, IN WLAN_STATUS rStatus)
  2219. {
  2220. ASSERT(pvPacket);
  2221. dev_kfree_skb((struct sk_buff *)pvPacket);
  2222. GLUE_DEC_REF_CNT(prGlueInfo->i4TxPendingSecurityFrameNum);
  2223. }
  2224. UINT_32 kalGetTxPendingFrameCount(IN P_GLUE_INFO_T prGlueInfo)
  2225. {
  2226. ASSERT(prGlueInfo);
  2227. return (UINT_32) (prGlueInfo->i4TxPendingFrameNum);
  2228. }
  2229. /*----------------------------------------------------------------------------*/
  2230. /*!
  2231. * \brief This routine is used to retrieve the number of pending commands
  2232. * (including MMPDU, 802.1X and command packets)
  2233. *
  2234. * \param prGlueInfo Pointer of GLUE Data Structure
  2235. *
  2236. * \retval
  2237. */
  2238. /*----------------------------------------------------------------------------*/
  2239. UINT_32 kalGetTxPendingCmdCount(IN P_GLUE_INFO_T prGlueInfo)
  2240. {
  2241. P_QUE_T prCmdQue;
  2242. ASSERT(prGlueInfo);
  2243. prCmdQue = &prGlueInfo->rCmdQueue;
  2244. return prCmdQue->u4NumElem;
  2245. }
  2246. /*----------------------------------------------------------------------------*/
  2247. /*!
  2248. * \brief Timer Initialization Procedure
  2249. *
  2250. * \param[in] prGlueInfo Pointer to GLUE Data Structure
  2251. * \param[in] prTimerHandler Pointer to timer handling function, whose only
  2252. * argument is "prAdapter"
  2253. *
  2254. * \retval none
  2255. *
  2256. */
  2257. /*----------------------------------------------------------------------------*/
  2258. /* static struct timer_list tickfn; */
  2259. VOID kalOsTimerInitialize(IN P_GLUE_INFO_T prGlueInfo, IN PVOID prTimerHandler)
  2260. {
  2261. ASSERT(prGlueInfo);
  2262. init_timer(&(prGlueInfo->tickfn));
  2263. prGlueInfo->tickfn.function = prTimerHandler;
  2264. prGlueInfo->tickfn.data = (ULONG) prGlueInfo;
  2265. }
  2266. /* Todo */
  2267. /*----------------------------------------------------------------------------*/
  2268. /*!
  2269. * \brief This routine is called to set the time to do the time out check.
  2270. *
  2271. * \param[in] prGlueInfo Pointer to GLUE Data Structure
  2272. * \param[in] rInterval Time out interval from current time.
  2273. *
  2274. * \retval TRUE Success.
  2275. */
  2276. /*----------------------------------------------------------------------------*/
  2277. BOOLEAN kalSetTimer(IN P_GLUE_INFO_T prGlueInfo, IN UINT_32 u4Interval)
  2278. {
  2279. ASSERT(prGlueInfo);
  2280. del_timer_sync(&(prGlueInfo->tickfn));
  2281. prGlueInfo->tickfn.expires = jiffies + u4Interval * HZ / MSEC_PER_SEC;
  2282. add_timer(&(prGlueInfo->tickfn));
  2283. return TRUE; /* success */
  2284. }
  2285. /*----------------------------------------------------------------------------*/
  2286. /*!
  2287. * \brief This routine is called to cancel
  2288. *
  2289. * \param[in] prGlueInfo Pointer to GLUE Data Structure
  2290. *
  2291. * \retval TRUE : Timer has been canceled
  2292. * FALAE : Timer doens't exist
  2293. */
  2294. /*----------------------------------------------------------------------------*/
  2295. BOOLEAN kalCancelTimer(IN P_GLUE_INFO_T prGlueInfo)
  2296. {
  2297. ASSERT(prGlueInfo);
  2298. clear_bit(GLUE_FLAG_TIMEOUT_BIT, &prGlueInfo->ulFlag);
  2299. if (del_timer_sync(&(prGlueInfo->tickfn)) >= 0)
  2300. return TRUE;
  2301. else
  2302. return FALSE;
  2303. }
  2304. /*----------------------------------------------------------------------------*/
  2305. /*!
  2306. * \brief This routine is a callback function for scanning done
  2307. *
  2308. * \param[in] prGlueInfo Pointer to GLUE Data Structure
  2309. *
  2310. * \retval none
  2311. *
  2312. */
  2313. /*----------------------------------------------------------------------------*/
  2314. VOID kalScanDone(IN P_GLUE_INFO_T prGlueInfo, IN ENUM_KAL_NETWORK_TYPE_INDEX_T eNetTypeIdx, IN WLAN_STATUS status)
  2315. {
  2316. P_AIS_FSM_INFO_T prAisFsmInfo;
  2317. ASSERT(prGlueInfo);
  2318. prAisFsmInfo = &(prGlueInfo->prAdapter->rWifiVar.rAisFsmInfo);
  2319. /* report all queued beacon/probe response frames to upper layer */
  2320. scanReportBss2Cfg80211(prGlueInfo->prAdapter, BSS_TYPE_INFRASTRUCTURE, NULL);
  2321. cnmTimerStopTimer(prGlueInfo->prAdapter, &prAisFsmInfo->rScanDoneTimer);
  2322. /* check for system configuration for generating error message on scan list */
  2323. wlanCheckSystemConfiguration(prGlueInfo->prAdapter);
  2324. kalIndicateStatusAndComplete(prGlueInfo, WLAN_STATUS_SCAN_COMPLETE, NULL, 0);
  2325. }
  2326. /*----------------------------------------------------------------------------*/
  2327. /*!
  2328. * \brief This routine is used to generate a random number
  2329. *
  2330. * \param none
  2331. *
  2332. * \retval UINT_32
  2333. */
  2334. /*----------------------------------------------------------------------------*/
  2335. UINT_32 kalRandomNumber(VOID)
  2336. {
  2337. UINT_32 number = 0;
  2338. get_random_bytes(&number, 4);
  2339. return number;
  2340. }
  2341. /*----------------------------------------------------------------------------*/
  2342. /*!
  2343. * \brief command timeout call-back function
  2344. *
  2345. * \param[in] prGlueInfo Pointer to the GLUE data structure.
  2346. *
  2347. * \retval (none)
  2348. */
  2349. /*----------------------------------------------------------------------------*/
  2350. VOID kalTimeoutHandler(ULONG arg)
  2351. {
  2352. P_GLUE_INFO_T prGlueInfo = (P_GLUE_INFO_T) arg;
  2353. ASSERT(prGlueInfo);
  2354. /* Notify tx thread for timeout event */
  2355. set_bit(GLUE_FLAG_TIMEOUT_BIT, &prGlueInfo->ulFlag);
  2356. wake_up_interruptible(&prGlueInfo->waitq);
  2357. }
  2358. VOID kalSetEvent(P_GLUE_INFO_T pr)
  2359. {
  2360. set_bit(GLUE_FLAG_TXREQ_BIT, &pr->ulFlag);
  2361. wake_up_interruptible(&pr->waitq);
  2362. }
  2363. /*----------------------------------------------------------------------------*/
  2364. /*!
  2365. * \brief to check if configuration file (NVRAM/Registry) exists
  2366. *
  2367. * \param[in]
  2368. * prGlueInfo
  2369. *
  2370. * \return
  2371. * TRUE
  2372. * FALSE
  2373. */
  2374. /*----------------------------------------------------------------------------*/
  2375. BOOLEAN kalIsConfigurationExist(IN P_GLUE_INFO_T prGlueInfo)
  2376. {
  2377. #if !defined(CONFIG_X86)
  2378. ASSERT(prGlueInfo);
  2379. return prGlueInfo->fgNvramAvailable;
  2380. #else
  2381. /* there is no configuration data for x86-linux */
  2382. return FALSE;
  2383. #endif
  2384. }
  2385. /*----------------------------------------------------------------------------*/
  2386. /*!
  2387. * \brief to retrieve Registry information
  2388. *
  2389. * \param[in]
  2390. * prGlueInfo
  2391. *
  2392. * \return
  2393. * Pointer of REG_INFO_T
  2394. */
  2395. /*----------------------------------------------------------------------------*/
  2396. P_REG_INFO_T kalGetConfiguration(IN P_GLUE_INFO_T prGlueInfo)
  2397. {
  2398. ASSERT(prGlueInfo);
  2399. return &(prGlueInfo->rRegInfo);
  2400. }
  2401. /*----------------------------------------------------------------------------*/
  2402. /*!
  2403. * \brief to retrieve version information of corresponding configuration file
  2404. *
  2405. * \param[in]
  2406. * prGlueInfo
  2407. *
  2408. * \param[out]
  2409. * pu2Part1CfgOwnVersion
  2410. * pu2Part1CfgPeerVersion
  2411. * pu2Part2CfgOwnVersion
  2412. * pu2Part2CfgPeerVersion
  2413. *
  2414. * \return
  2415. * NONE
  2416. */
  2417. /*----------------------------------------------------------------------------*/
  2418. VOID
  2419. kalGetConfigurationVersion(IN P_GLUE_INFO_T prGlueInfo,
  2420. OUT PUINT_16 pu2Part1CfgOwnVersion,
  2421. OUT PUINT_16 pu2Part1CfgPeerVersion,
  2422. OUT PUINT_16 pu2Part2CfgOwnVersion, OUT PUINT_16 pu2Part2CfgPeerVersion)
  2423. {
  2424. ASSERT(prGlueInfo);
  2425. ASSERT(pu2Part1CfgOwnVersion);
  2426. ASSERT(pu2Part1CfgPeerVersion);
  2427. ASSERT(pu2Part2CfgOwnVersion);
  2428. ASSERT(pu2Part2CfgPeerVersion);
  2429. kalCfgDataRead16(prGlueInfo, OFFSET_OF(WIFI_CFG_PARAM_STRUCT, u2Part1OwnVersion), pu2Part1CfgOwnVersion);
  2430. kalCfgDataRead16(prGlueInfo, OFFSET_OF(WIFI_CFG_PARAM_STRUCT, u2Part1PeerVersion), pu2Part1CfgPeerVersion);
  2431. kalCfgDataRead16(prGlueInfo, OFFSET_OF(WIFI_CFG_PARAM_STRUCT, u2Part2OwnVersion), pu2Part2CfgOwnVersion);
  2432. kalCfgDataRead16(prGlueInfo, OFFSET_OF(WIFI_CFG_PARAM_STRUCT, u2Part2PeerVersion), pu2Part2CfgPeerVersion);
  2433. }
  2434. /*----------------------------------------------------------------------------*/
  2435. /*!
  2436. * \brief to check if the WPS is active or not
  2437. *
  2438. * \param[in]
  2439. * prGlueInfo
  2440. *
  2441. * \return
  2442. * TRUE
  2443. * FALSE
  2444. */
  2445. /*----------------------------------------------------------------------------*/
  2446. BOOLEAN kalWSCGetActiveState(IN P_GLUE_INFO_T prGlueInfo)
  2447. {
  2448. ASSERT(prGlueInfo);
  2449. return prGlueInfo->fgWpsActive;
  2450. }
  2451. /*----------------------------------------------------------------------------*/
  2452. /*!
  2453. * \brief update RSSI and LinkQuality to GLUE layer
  2454. *
  2455. * \param[in]
  2456. * prGlueInfo
  2457. * eNetTypeIdx
  2458. * cRssi
  2459. * cLinkQuality
  2460. *
  2461. * \return
  2462. * None
  2463. */
  2464. /*----------------------------------------------------------------------------*/
  2465. VOID
  2466. kalUpdateRSSI(IN P_GLUE_INFO_T prGlueInfo,
  2467. IN ENUM_KAL_NETWORK_TYPE_INDEX_T eNetTypeIdx, IN INT_8 cRssi, IN INT_8 cLinkQuality)
  2468. {
  2469. struct iw_statistics *pStats = (struct iw_statistics *)NULL;
  2470. ASSERT(prGlueInfo);
  2471. switch (eNetTypeIdx) {
  2472. case KAL_NETWORK_TYPE_AIS_INDEX:
  2473. pStats = (struct iw_statistics *)(&(prGlueInfo->rIwStats));
  2474. break;
  2475. #if CFG_ENABLE_WIFI_DIRECT
  2476. #if CFG_SUPPORT_P2P_RSSI_QUERY
  2477. case KAL_NETWORK_TYPE_P2P_INDEX:
  2478. pStats = (struct iw_statistics *)(&(prGlueInfo->rP2pIwStats));
  2479. break;
  2480. #endif
  2481. #endif
  2482. default:
  2483. break;
  2484. }
  2485. if (pStats) {
  2486. pStats->qual.qual = cLinkQuality;
  2487. pStats->qual.noise = 0;
  2488. pStats->qual.updated = IW_QUAL_QUAL_UPDATED | IW_QUAL_NOISE_UPDATED | IW_QUAL_DBM;
  2489. pStats->qual.level = 0x100 + cRssi;
  2490. pStats->qual.updated |= IW_QUAL_LEVEL_UPDATED;
  2491. }
  2492. }
  2493. /*----------------------------------------------------------------------------*/
  2494. /*!
  2495. * \brief Pre-allocate I/O buffer
  2496. *
  2497. * \param[in]
  2498. * none
  2499. *
  2500. * \return
  2501. * TRUE
  2502. * FALSE
  2503. */
  2504. /*----------------------------------------------------------------------------*/
  2505. BOOLEAN kalInitIOBuffer(VOID)
  2506. {
  2507. UINT_32 u4Size;
  2508. if (CFG_COALESCING_BUFFER_SIZE >= CFG_RX_COALESCING_BUFFER_SIZE)
  2509. u4Size = CFG_COALESCING_BUFFER_SIZE + sizeof(ENHANCE_MODE_DATA_STRUCT_T);
  2510. else
  2511. u4Size = CFG_RX_COALESCING_BUFFER_SIZE + sizeof(ENHANCE_MODE_DATA_STRUCT_T);
  2512. #ifdef MTK_DMA_BUF_MEMCPY_SUP
  2513. pvDmaBuffer = dma_alloc_coherent(NULL, CFG_RX_MAX_PKT_SIZE, &pvDmaPhyBuf, GFP_KERNEL);
  2514. if (pvDmaBuffer == NULL)
  2515. return FALSE;
  2516. #endif /* MTK_DMA_BUF_MEMCPY_SUP */
  2517. pvIoBuffer = kmalloc(u4Size, GFP_KERNEL);
  2518. /* pvIoBuffer = dma_alloc_coherent(NULL, u4Size, &pvIoPhyBuf, GFP_KERNEL); */
  2519. if (pvIoBuffer) {
  2520. pvIoBufferSize = u4Size;
  2521. pvIoBufferUsage = 0;
  2522. return TRUE;
  2523. }
  2524. return FALSE;
  2525. }
  2526. /*----------------------------------------------------------------------------*/
  2527. /*!
  2528. * \brief Free pre-allocated I/O buffer
  2529. *
  2530. * \param[in]
  2531. * none
  2532. *
  2533. * \return
  2534. * none
  2535. */
  2536. /*----------------------------------------------------------------------------*/
  2537. VOID kalUninitIOBuffer(VOID)
  2538. {
  2539. kfree(pvIoBuffer);
  2540. #ifdef MTK_DMA_BUF_MEMCPY_SUP
  2541. dma_free_coherent(NULL, CFG_RX_MAX_PKT_SIZE, pvDmaBuffer, pvDmaPhyBuf);
  2542. #endif /* MTK_DMA_BUF_MEMCPY_SUP */
  2543. /* dma_free_coherent(NULL, pvIoBufferSize, pvIoBuffer, pvIoPhyBuf); */
  2544. pvIoBuffer = (PVOID) NULL;
  2545. pvIoBufferSize = 0;
  2546. pvIoBufferUsage = 0;
  2547. }
  2548. /*----------------------------------------------------------------------------*/
  2549. /*!
  2550. * \brief Dispatch pre-allocated I/O buffer
  2551. *
  2552. * \param[in]
  2553. * u4AllocSize
  2554. *
  2555. * \return
  2556. * PVOID for pointer of pre-allocated I/O buffer
  2557. */
  2558. /*----------------------------------------------------------------------------*/
  2559. PVOID kalAllocateIOBuffer(IN UINT_32 u4AllocSize)
  2560. {
  2561. PVOID ret = (PVOID) NULL;
  2562. if (pvIoBuffer) {
  2563. if (u4AllocSize <= (pvIoBufferSize - pvIoBufferUsage)) {
  2564. ret = (PVOID) &(((PUINT_8) (pvIoBuffer))[pvIoBufferUsage]);
  2565. pvIoBufferUsage += u4AllocSize;
  2566. }
  2567. } else {
  2568. /* fault tolerance */
  2569. ret = (PVOID) kalMemAlloc(u4AllocSize, PHY_MEM_TYPE);
  2570. }
  2571. return ret;
  2572. }
  2573. /*----------------------------------------------------------------------------*/
  2574. /*!
  2575. * \brief Release all dispatched I/O buffer
  2576. *
  2577. * \param[in]
  2578. * none
  2579. *
  2580. * \return
  2581. * none
  2582. */
  2583. /*----------------------------------------------------------------------------*/
  2584. VOID kalReleaseIOBuffer(IN PVOID pvAddr, IN UINT_32 u4Size)
  2585. {
  2586. if (pvIoBuffer) {
  2587. pvIoBufferUsage -= u4Size;
  2588. } else {
  2589. /* fault tolerance */
  2590. kalMemFree(pvAddr, PHY_MEM_TYPE, u4Size);
  2591. }
  2592. }
  2593. /*----------------------------------------------------------------------------*/
  2594. /*!
  2595. * \brief
  2596. *
  2597. * \param[in] prAdapter Pointer of ADAPTER_T
  2598. *
  2599. * \return none
  2600. */
  2601. /*----------------------------------------------------------------------------*/
  2602. VOID
  2603. kalGetChannelList(IN P_GLUE_INFO_T prGlueInfo,
  2604. IN ENUM_BAND_T eSpecificBand,
  2605. IN UINT_8 ucMaxChannelNum, IN PUINT_8 pucNumOfChannel, IN P_RF_CHANNEL_INFO_T paucChannelList)
  2606. {
  2607. rlmDomainGetChnlList(prGlueInfo->prAdapter, eSpecificBand, ucMaxChannelNum, pucNumOfChannel, paucChannelList);
  2608. }
  2609. /*----------------------------------------------------------------------------*/
  2610. /*!
  2611. * \brief
  2612. *
  2613. * \param[in] prAdapter Pointer of ADAPTER_T
  2614. *
  2615. * \return none
  2616. */
  2617. /*----------------------------------------------------------------------------*/
  2618. BOOLEAN kalIsAPmode(IN P_GLUE_INFO_T prGlueInfo)
  2619. {
  2620. #if CFG_ENABLE_WIFI_DIRECT
  2621. if (IS_NET_ACTIVE(prGlueInfo->prAdapter, NETWORK_TYPE_P2P_INDEX) &&
  2622. p2pFuncIsAPMode(prGlueInfo->prAdapter->rWifiVar.prP2pFsmInfo))
  2623. return TRUE;
  2624. #endif
  2625. return FALSE;
  2626. }
  2627. #ifdef MTK_DMA_BUF_MEMCPY_SUP
  2628. /*----------------------------------------------------------------------------*/
  2629. /*!
  2630. * \brief This function gets the physical address for Pre-allocate I/O buffer.
  2631. *
  2632. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  2633. * \param[in] rLockCategory Specify which SPIN_LOCK
  2634. * \param[out] pu4Flags Pointer of a variable for saving IRQ flags
  2635. *
  2636. * \return physical addr
  2637. */
  2638. /*----------------------------------------------------------------------------*/
  2639. ULONG kalIOPhyAddrGet(IN ULONG VirtAddr)
  2640. {
  2641. ULONG PhyAddr;
  2642. if ((VirtAddr >= (ULONG) pvIoBuffer) && (VirtAddr <= ((ULONG) (pvIoBuffer) + pvIoBufferSize))) {
  2643. PhyAddr = (ULONG) pvIoPhyBuf;
  2644. PhyAddr += (VirtAddr - (ULONG) (pvIoBuffer));
  2645. return PhyAddr;
  2646. }
  2647. return 0;
  2648. }
  2649. /*----------------------------------------------------------------------------*/
  2650. /*!
  2651. * \brief This function gets the physical address for Pre-allocate I/O buffer.
  2652. *
  2653. * \param[in] prGlueInfo Pointer of GLUE Data Structure
  2654. * \param[in] rLockCategory Specify which SPIN_LOCK
  2655. * \param[out] pu4Flags Pointer of a variable for saving IRQ flags
  2656. *
  2657. * \return physical addr
  2658. */
  2659. /*----------------------------------------------------------------------------*/
  2660. VOID kalDmaBufGet(OUT VOID **VirtAddr, OUT VOID **PhyAddr)
  2661. {
  2662. *VirtAddr = pvDmaBuffer;
  2663. *PhyAddr = pvDmaPhyBuf;
  2664. }
  2665. #endif /* MTK_DMA_BUF_MEMCPY_SUP */
  2666. #if CFG_SUPPORT_802_11W
  2667. /*----------------------------------------------------------------------------*/
  2668. /*!
  2669. * \brief to check if the MFP is active or not
  2670. *
  2671. * \param[in]
  2672. * prGlueInfo
  2673. *
  2674. * \return
  2675. * TRUE
  2676. * FALSE
  2677. */
  2678. /*----------------------------------------------------------------------------*/
  2679. UINT_32 kalGetMfpSetting(IN P_GLUE_INFO_T prGlueInfo)
  2680. {
  2681. ASSERT(prGlueInfo);
  2682. return prGlueInfo->rWpaInfo.u4Mfp;
  2683. }
  2684. #endif
  2685. struct file *kalFileOpen(const char *path, int flags, int rights)
  2686. {
  2687. struct file *filp = NULL;
  2688. mm_segment_t oldfs;
  2689. int err = 0;
  2690. oldfs = get_fs();
  2691. set_fs(get_ds());
  2692. filp = filp_open(path, flags, rights);
  2693. set_fs(oldfs);
  2694. if (IS_ERR(filp)) {
  2695. err = PTR_ERR(filp);
  2696. return NULL;
  2697. }
  2698. return filp;
  2699. }
  2700. VOID kalFileClose(struct file *file)
  2701. {
  2702. filp_close(file, NULL);
  2703. }
  2704. UINT_32 kalFileRead(struct file *file, UINT_64 offset, UINT_8 *data, UINT_32 size)
  2705. {
  2706. mm_segment_t oldfs;
  2707. INT_32 ret;
  2708. oldfs = get_fs();
  2709. set_fs(get_ds());
  2710. ret = vfs_read(file, data, size, &offset);
  2711. set_fs(oldfs);
  2712. return ret;
  2713. }
  2714. UINT_32 kalFileWrite(struct file *file, UINT_64 offset, UINT_8 *data, UINT_32 size)
  2715. {
  2716. mm_segment_t oldfs;
  2717. INT_32 ret;
  2718. oldfs = get_fs();
  2719. set_fs(get_ds());
  2720. ret = vfs_write(file, data, size, &offset);
  2721. set_fs(oldfs);
  2722. return ret;
  2723. }
  2724. UINT_32 kalWriteToFile(const PUINT_8 pucPath, BOOLEAN fgDoAppend, PUINT_8 pucData, UINT_32 u4Size)
  2725. {
  2726. struct file *file = NULL;
  2727. UINT_32 ret = -1;
  2728. UINT_32 u4Flags = 0;
  2729. if (fgDoAppend)
  2730. u4Flags = O_APPEND;
  2731. file = kalFileOpen(pucPath, O_WRONLY | O_CREAT | u4Flags, S_IRWXU);
  2732. if (file) {
  2733. ret = kalFileWrite(file, 0, pucData, u4Size);
  2734. kalFileClose(file);
  2735. }
  2736. return ret;
  2737. }
  2738. INT_32 kalReadToFile(const PUINT_8 pucPath, PUINT_8 pucData, UINT_32 u4Size, PUINT_32 pu4ReadSize)
  2739. {
  2740. struct file *file = NULL;
  2741. INT_32 ret = -1;
  2742. UINT_32 u4ReadSize = 0;
  2743. DBGLOG(INIT, LOUD, "kalReadToFile() path %s\n", pucPath);
  2744. file = kalFileOpen(pucPath, O_RDONLY, 0);
  2745. if ((file != NULL) && !IS_ERR(file)) {
  2746. u4ReadSize = kalFileRead(file, 0, pucData, u4Size);
  2747. kalFileClose(file);
  2748. if (pu4ReadSize)
  2749. *pu4ReadSize = u4ReadSize;
  2750. ret = 0;
  2751. }
  2752. return ret;
  2753. }
  2754. /*----------------------------------------------------------------------------*/
  2755. /*!
  2756. * \brief To indicate BSS-INFO to NL80211 as scanning result
  2757. *
  2758. * \param[in]
  2759. * prGlueInfo
  2760. * pucBeaconProbeResp
  2761. * u4FrameLen
  2762. *
  2763. *
  2764. *
  2765. * \return
  2766. * none
  2767. */
  2768. /*----------------------------------------------------------------------------*/
  2769. VOID
  2770. kalIndicateBssInfo(IN P_GLUE_INFO_T prGlueInfo,
  2771. IN PUINT_8 pucBeaconProbeResp,
  2772. IN UINT_32 u4FrameLen, IN UINT_8 ucChannelNum, IN INT_32 i4SignalStrength)
  2773. {
  2774. struct wiphy *wiphy;
  2775. struct ieee80211_channel *prChannel = NULL;
  2776. ASSERT(prGlueInfo);
  2777. wiphy = priv_to_wiphy(prGlueInfo);
  2778. /* search through channel entries */
  2779. if (ucChannelNum <= 14) {
  2780. prChannel =
  2781. ieee80211_get_channel(wiphy, ieee80211_channel_to_frequency(ucChannelNum, IEEE80211_BAND_2GHZ));
  2782. } else {
  2783. prChannel =
  2784. ieee80211_get_channel(wiphy, ieee80211_channel_to_frequency(ucChannelNum, IEEE80211_BAND_5GHZ));
  2785. }
  2786. if (prChannel != NULL && prGlueInfo->fgIsRegistered == TRUE) {
  2787. struct cfg80211_bss *bss;
  2788. #if CFG_SUPPORT_TSF_USING_BOOTTIME
  2789. struct ieee80211_mgmt *prMgmtFrame = (struct ieee80211_mgmt *)pucBeaconProbeResp;
  2790. prMgmtFrame->u.beacon.timestamp = kalGetBootTime();
  2791. #endif
  2792. ScanCnt++;
  2793. /* indicate to NL80211 subsystem */
  2794. bss = cfg80211_inform_bss_frame(wiphy,
  2795. prChannel,
  2796. (struct ieee80211_mgmt *)pucBeaconProbeResp,
  2797. u4FrameLen, i4SignalStrength * 100, GFP_KERNEL);
  2798. if (!bss) {
  2799. ScanDoneFailCnt++;
  2800. DBGLOG(SCN, WARN, "inform bss to cfg80211 failed, bss channel %d, rcpi %d\n",
  2801. ucChannelNum, i4SignalStrength);
  2802. } else {
  2803. cfg80211_put_bss(wiphy, bss);
  2804. DBGLOG(SCN, TRACE, "inform bss to cfg80211, bss channel %d, rcpi %d\n",
  2805. ucChannelNum, i4SignalStrength);
  2806. }
  2807. }
  2808. }
  2809. /*----------------------------------------------------------------------------*/
  2810. /*!
  2811. * \brief To indicate channel ready
  2812. *
  2813. * \param[in]
  2814. * prGlueInfo
  2815. *
  2816. * \return
  2817. * none
  2818. */
  2819. /*----------------------------------------------------------------------------*/
  2820. VOID
  2821. kalReadyOnChannel(IN P_GLUE_INFO_T prGlueInfo,
  2822. IN UINT_64 u8Cookie,
  2823. IN ENUM_BAND_T eBand, IN ENUM_CHNL_EXT_T eSco, IN UINT_8 ucChannelNum, IN UINT_32 u4DurationMs)
  2824. {
  2825. struct ieee80211_channel *prChannel = NULL;
  2826. enum nl80211_channel_type rChannelType;
  2827. /* ucChannelNum = wlanGetChannelNumberByNetwork(prGlueInfo->prAdapter, NETWORK_TYPE_AIS_INDEX); */
  2828. if (prGlueInfo->fgIsRegistered == TRUE) {
  2829. if (ucChannelNum <= 14) {
  2830. prChannel =
  2831. ieee80211_get_channel(priv_to_wiphy(prGlueInfo),
  2832. ieee80211_channel_to_frequency(ucChannelNum, IEEE80211_BAND_2GHZ));
  2833. } else {
  2834. prChannel =
  2835. ieee80211_get_channel(priv_to_wiphy(prGlueInfo),
  2836. ieee80211_channel_to_frequency(ucChannelNum, IEEE80211_BAND_5GHZ));
  2837. }
  2838. switch (eSco) {
  2839. case CHNL_EXT_SCN:
  2840. rChannelType = NL80211_CHAN_NO_HT;
  2841. break;
  2842. case CHNL_EXT_SCA:
  2843. rChannelType = NL80211_CHAN_HT40MINUS;
  2844. break;
  2845. case CHNL_EXT_SCB:
  2846. rChannelType = NL80211_CHAN_HT40PLUS;
  2847. break;
  2848. case CHNL_EXT_RES:
  2849. default:
  2850. rChannelType = NL80211_CHAN_HT20;
  2851. break;
  2852. }
  2853. cfg80211_ready_on_channel(prGlueInfo->prDevHandler->ieee80211_ptr, u8Cookie, prChannel, u4DurationMs,
  2854. GFP_KERNEL);
  2855. }
  2856. }
  2857. /*----------------------------------------------------------------------------*/
  2858. /*!
  2859. * \brief To indicate channel expiration
  2860. *
  2861. * \param[in]
  2862. * prGlueInfo
  2863. *
  2864. * \return
  2865. * none
  2866. */
  2867. /*----------------------------------------------------------------------------*/
  2868. VOID
  2869. kalRemainOnChannelExpired(IN P_GLUE_INFO_T prGlueInfo,
  2870. IN UINT_64 u8Cookie, IN ENUM_BAND_T eBand, IN ENUM_CHNL_EXT_T eSco, IN UINT_8 ucChannelNum)
  2871. {
  2872. struct ieee80211_channel *prChannel = NULL;
  2873. enum nl80211_channel_type rChannelType;
  2874. ucChannelNum = wlanGetChannelNumberByNetwork(prGlueInfo->prAdapter, NETWORK_TYPE_AIS_INDEX);
  2875. if (prGlueInfo->fgIsRegistered == TRUE) {
  2876. if (ucChannelNum <= 14) {
  2877. prChannel =
  2878. ieee80211_get_channel(priv_to_wiphy(prGlueInfo),
  2879. ieee80211_channel_to_frequency(ucChannelNum, IEEE80211_BAND_2GHZ));
  2880. } else {
  2881. prChannel =
  2882. ieee80211_get_channel(priv_to_wiphy(prGlueInfo),
  2883. ieee80211_channel_to_frequency(ucChannelNum, IEEE80211_BAND_5GHZ));
  2884. }
  2885. switch (eSco) {
  2886. case CHNL_EXT_SCN:
  2887. rChannelType = NL80211_CHAN_NO_HT;
  2888. break;
  2889. case CHNL_EXT_SCA:
  2890. rChannelType = NL80211_CHAN_HT40MINUS;
  2891. break;
  2892. case CHNL_EXT_SCB:
  2893. rChannelType = NL80211_CHAN_HT40PLUS;
  2894. break;
  2895. case CHNL_EXT_RES:
  2896. default:
  2897. rChannelType = NL80211_CHAN_HT20;
  2898. break;
  2899. }
  2900. cfg80211_remain_on_channel_expired(prGlueInfo->prDevHandler->ieee80211_ptr, u8Cookie, prChannel,
  2901. GFP_KERNEL);
  2902. }
  2903. }
  2904. /*----------------------------------------------------------------------------*/
  2905. /*!
  2906. * \brief To indicate Mgmt tx status
  2907. *
  2908. * \param[in]
  2909. * prGlueInfo
  2910. *
  2911. * \return
  2912. * none
  2913. */
  2914. /*----------------------------------------------------------------------------*/
  2915. VOID
  2916. kalIndicateMgmtTxStatus(IN P_GLUE_INFO_T prGlueInfo,
  2917. IN UINT_64 u8Cookie, IN BOOLEAN fgIsAck, IN PUINT_8 pucFrameBuf, IN UINT_32 u4FrameLen)
  2918. {
  2919. do {
  2920. if ((prGlueInfo == NULL) || (pucFrameBuf == NULL) || (u4FrameLen == 0)) {
  2921. DBGLOG(AIS, TRACE, "Unexpected pointer PARAM. %p, %p, %u.",
  2922. prGlueInfo, pucFrameBuf, u4FrameLen);
  2923. ASSERT(FALSE);
  2924. break;
  2925. }
  2926. cfg80211_mgmt_tx_status(prGlueInfo->prDevHandler->ieee80211_ptr,
  2927. u8Cookie, pucFrameBuf, u4FrameLen, fgIsAck, GFP_KERNEL);
  2928. } while (FALSE);
  2929. } /* kalIndicateMgmtTxStatus */
  2930. VOID kalIndicateRxMgmtFrame(IN P_GLUE_INFO_T prGlueInfo, IN P_SW_RFB_T prSwRfb)
  2931. {
  2932. #define DBG_MGMT_FRAME_INDICATION 1
  2933. INT_32 i4Freq = 0;
  2934. UINT_8 ucChnlNum = 0;
  2935. #if DBG_MGMT_FRAME_INDICATION
  2936. P_WLAN_MAC_HEADER_T prWlanHeader = (P_WLAN_MAC_HEADER_T) NULL;
  2937. #endif
  2938. do {
  2939. if ((prGlueInfo == NULL) || (prSwRfb == NULL)) {
  2940. ASSERT(FALSE);
  2941. break;
  2942. }
  2943. ucChnlNum = prSwRfb->prHifRxHdr->ucHwChannelNum;
  2944. #if DBG_MGMT_FRAME_INDICATION
  2945. prWlanHeader = (P_WLAN_MAC_HEADER_T) prSwRfb->pvHeader;
  2946. switch (prWlanHeader->u2FrameCtrl) {
  2947. case MAC_FRAME_PROBE_REQ:
  2948. DBGLOG(AIS, TRACE, "RX Probe Req at channel %d ", ucChnlNum);
  2949. break;
  2950. case MAC_FRAME_PROBE_RSP:
  2951. DBGLOG(AIS, TRACE, "RX Probe Rsp at channel %d ", ucChnlNum);
  2952. break;
  2953. case MAC_FRAME_ACTION:
  2954. DBGLOG(AIS, TRACE, "RX Action frame at channel %d ", ucChnlNum);
  2955. break;
  2956. default:
  2957. DBGLOG(AIS, TRACE, "RX Packet:%d at channel %d ", prWlanHeader->u2FrameCtrl, ucChnlNum);
  2958. break;
  2959. }
  2960. #endif
  2961. i4Freq = nicChannelNum2Freq(ucChnlNum) / 1000;
  2962. cfg80211_rx_mgmt(prGlueInfo->prDevHandler->ieee80211_ptr, /* struct net_device * dev, */
  2963. i4Freq,
  2964. RCPI_TO_dBm(prSwRfb->prHifRxHdr->ucRcpi),
  2965. prSwRfb->pvHeader, prSwRfb->u2PacketLen, GFP_KERNEL);
  2966. } while (FALSE);
  2967. } /* kalIndicateRxMgmtFrame */
  2968. #if CFG_SUPPORT_AGPS_ASSIST
  2969. BOOLEAN kalIndicateAgpsNotify(P_ADAPTER_T prAdapter, UINT_8 cmd, PUINT_8 data, UINT_16 dataLen)
  2970. {
  2971. P_GLUE_INFO_T prGlueInfo = prAdapter->prGlueInfo;
  2972. struct sk_buff *skb = cfg80211_testmode_alloc_event_skb(priv_to_wiphy(prGlueInfo),
  2973. dataLen, GFP_KERNEL);
  2974. if (!skb) {
  2975. DBGLOG(AIS, ERROR, "kalIndicateAgpsNotify: alloc skb failed\n");
  2976. return FALSE;
  2977. }
  2978. /* DBGLOG(CCX, INFO, ("WLAN_STATUS_AGPS_NOTIFY, cmd=%d\n", cmd)); */
  2979. if (unlikely(nla_put(skb, MTK_ATTR_AGPS_CMD, sizeof(cmd), &cmd) < 0))
  2980. goto nla_put_failure;
  2981. if (dataLen > 0 && data && unlikely(nla_put(skb, MTK_ATTR_AGPS_DATA, dataLen, data) < 0))
  2982. goto nla_put_failure;
  2983. if (unlikely(nla_put(skb, MTK_ATTR_AGPS_IFINDEX, sizeof(UINT_32), &prGlueInfo->prDevHandler->ifindex) < 0))
  2984. goto nla_put_failure;
  2985. /* currently, the ifname maybe wlan0, p2p0, so the maximum name length will be 5 bytes */
  2986. if (unlikely(nla_put(skb, MTK_ATTR_AGPS_IFNAME, 5, prGlueInfo->prDevHandler->name) < 0))
  2987. goto nla_put_failure;
  2988. cfg80211_testmode_event(skb, GFP_KERNEL);
  2989. return TRUE;
  2990. nla_put_failure:
  2991. kfree_skb(skb);
  2992. return FALSE;
  2993. }
  2994. #endif
  2995. #if (CFG_SUPPORT_MET_PROFILING == 1)
  2996. #define PROC_MET_PROF_CTRL "met_ctrl"
  2997. #define PROC_MET_PROF_PORT "met_port"
  2998. struct proc_dir_entry *pMetProcDir;
  2999. void *pMetGlobalData = NULL;
  3000. static unsigned long __read_mostly tracing_mark_write_addr;
  3001. static inline void __mt_update_tracing_mark_write_addr(void)
  3002. {
  3003. if (unlikely(0 == tracing_mark_write_addr))
  3004. tracing_mark_write_addr = kallsyms_lookup_name("tracing_mark_write");
  3005. }
  3006. VOID kalMetProfilingStart(IN P_GLUE_INFO_T prGlueInfo, IN struct sk_buff *prSkb)
  3007. {
  3008. UINT_8 ucIpVersion;
  3009. UINT_16 u2UdpSrcPort;
  3010. UINT_16 u2RtpSn;
  3011. PUINT_8 pucEthHdr = prSkb->data;
  3012. PUINT_8 pucIpHdr, pucUdpHdr, pucRtpHdr;
  3013. /* | Ethernet(14) | IP(20) | UDP(8)| RTP(12) | */
  3014. /* UDP==> |SRC_PORT(2)|DST_PORT(2)|LEN(2)|CHKSUM(2)| */
  3015. /* RTP==> |CTRL(2)|SEQ(2)|TimeStamp(4)|... */
  3016. /* printk("MET_PROF: MET enable=%d(HardXmit)\n", prGlueInfo->u8MetProfEnable); */
  3017. if (prGlueInfo->u8MetProfEnable == 1) {
  3018. u2UdpSrcPort = prGlueInfo->u16MetUdpPort;
  3019. if ((*(pucEthHdr + 12) == 0x08) && (*(pucEthHdr + 13) == 0x00)) {
  3020. /* IP */
  3021. pucIpHdr = pucEthHdr + ETH_HLEN;
  3022. ucIpVersion = (*pucIpHdr & IPVH_VERSION_MASK) >> IPVH_VERSION_OFFSET;
  3023. if ((ucIpVersion == IPVERSION) && (pucIpHdr[IPV4_HDR_IP_PROTOCOL_OFFSET] == IP_PROTOCOL_UDP)) {
  3024. /* UDP */
  3025. pucUdpHdr = pucIpHdr + IP_HEADER_LEN;
  3026. /* check UDP port number */
  3027. if (((UINT_16) pucUdpHdr[0] << 8 | (UINT_16) pucUdpHdr[1]) == u2UdpSrcPort) {
  3028. /* RTP */
  3029. pucRtpHdr = pucUdpHdr + 8;
  3030. u2RtpSn = (UINT_16) pucRtpHdr[2] << 8 | pucRtpHdr[3];
  3031. /* trace_printk("S|%d|%s|%d\n", current->tgid, "WIFI-CHIP", u2RtpSn);
  3032. //frm_sequence); */
  3033. #ifdef CONFIG_TRACING
  3034. __mt_update_tracing_mark_write_addr();
  3035. if (tracing_mark_write_addr != 0) {
  3036. event_trace_printk(tracing_mark_write_addr, "S|%d|%s|%d\n",
  3037. current->tgid, "WIFI-CHIP", u2RtpSn);
  3038. }
  3039. #endif
  3040. }
  3041. }
  3042. }
  3043. }
  3044. }
  3045. VOID kalMetProfilingFinish(IN P_ADAPTER_T prAdapter, IN P_MSDU_INFO_T prMsduInfo)
  3046. {
  3047. UINT_8 ucIpVersion;
  3048. UINT_16 u2UdpSrcPort;
  3049. UINT_16 u2RtpSn;
  3050. struct sk_buff *prSkb = (struct sk_buff *)prMsduInfo->prPacket;
  3051. PUINT_8 pucEthHdr = prSkb->data;
  3052. PUINT_8 pucIpHdr, pucUdpHdr, pucRtpHdr;
  3053. P_GLUE_INFO_T prGlueInfo = prAdapter->prGlueInfo;
  3054. /* | Ethernet(14) | IP(20) | UDP(8)| RTP(12) | */
  3055. /* UDP==> |SRC_PORT(2)|DST_PORT(2)|LEN(2)|CHKSUM(2)| */
  3056. /* RTP==> |CTRL(2)|SEQ(2)|TimeStamp(4)|... */
  3057. /* printk("MET_PROF: MET enable=%d(TxMsdu)\n", prGlueInfo->u8MetProfEnable); */
  3058. if (prGlueInfo->u8MetProfEnable == 1) {
  3059. u2UdpSrcPort = prGlueInfo->u16MetUdpPort;
  3060. if ((*(pucEthHdr + 12) == 0x08) && (*(pucEthHdr + 13) == 0x00)) {
  3061. /* IP */
  3062. pucIpHdr = pucEthHdr + ETH_HLEN;
  3063. ucIpVersion = (*pucIpHdr & IPVH_VERSION_MASK) >> IPVH_VERSION_OFFSET;
  3064. if ((ucIpVersion == IPVERSION) && (pucIpHdr[IPV4_HDR_IP_PROTOCOL_OFFSET] == IP_PROTOCOL_UDP)) {
  3065. /* UDP */
  3066. pucUdpHdr = pucIpHdr + IP_HEADER_LEN;
  3067. /* check UDP port number */
  3068. if (((UINT_16) pucUdpHdr[0] << 8 | (UINT_16) pucUdpHdr[1]) == u2UdpSrcPort) {
  3069. /* RTP */
  3070. pucRtpHdr = pucUdpHdr + 8;
  3071. u2RtpSn = (UINT_16) pucRtpHdr[2] << 8 | pucRtpHdr[3];
  3072. /* trace_printk("F|%d|%s|%d\n", current->tgid, "WIFI-CHIP", u2RtpSn);
  3073. //frm_sequence); */
  3074. #ifdef CONFIG_TRACING
  3075. __mt_update_tracing_mark_write_addr();
  3076. if (tracing_mark_write_addr != 0) {
  3077. event_trace_printk(tracing_mark_write_addr, "F|%d|%s|%d\n",
  3078. current->tgid, "WIFI-CHIP", u2RtpSn);
  3079. }
  3080. #endif
  3081. }
  3082. }
  3083. }
  3084. }
  3085. }
  3086. /*----------------------------------------------------------------------------*/
  3087. /*!
  3088. * \brief The PROC function for adjusting Debug Level to turn on/off debugging message.
  3089. *
  3090. * \param[in] file pointer to file.
  3091. * \param[in] buffer Buffer from user space.
  3092. * \param[in] count Number of characters to write
  3093. * \param[in] data Pointer to the private data structure.
  3094. *
  3095. * \return number of characters write from User Space.
  3096. */
  3097. /*----------------------------------------------------------------------------*/
  3098. static ssize_t kalMetCtrlWriteProcfs(struct file *file, const char __user *buffer, size_t count, loff_t *off)
  3099. {
  3100. char acBuf[128 + 1]; /* + 1 for "\0" */
  3101. UINT_32 u4CopySize;
  3102. int u8MetProfEnable;
  3103. IN P_GLUE_INFO_T prGlueInfo;
  3104. u4CopySize = (count < (sizeof(acBuf) - 1)) ? count : (sizeof(acBuf) - 1);
  3105. if (copy_from_user(acBuf, buffer, u4CopySize))
  3106. return -1;
  3107. acBuf[u4CopySize] = '\0';
  3108. if (sscanf(acBuf, " %d", &u8MetProfEnable) == 1)
  3109. DBGLOG(INIT, INFO, "MET_PROF: Write MET PROC Enable=%d\n", u8MetProfEnable);
  3110. if (pMetGlobalData != NULL) {
  3111. prGlueInfo = (P_GLUE_INFO_T) pMetGlobalData;
  3112. prGlueInfo->u8MetProfEnable = (UINT_8) u8MetProfEnable;
  3113. }
  3114. return count;
  3115. }
  3116. /*----------------------------------------------------------------------------*/
  3117. /*!
  3118. * \brief The PROC function for adjusting Debug Level to turn on/off debugging message.
  3119. *
  3120. * \param[in] file pointer to file.
  3121. * \param[in] buffer Buffer from user space.
  3122. * \param[in] count Number of characters to write
  3123. * \param[in] data Pointer to the private data structure.
  3124. *
  3125. * \return number of characters write from User Space.
  3126. */
  3127. /*----------------------------------------------------------------------------*/
  3128. static ssize_t kalMetPortWriteProcfs(struct file *file, const char __user *buffer, size_t count, loff_t *off)
  3129. {
  3130. char acBuf[128 + 1]; /* + 1 for "\0" */
  3131. UINT_32 u4CopySize;
  3132. int u16MetUdpPort;
  3133. IN P_GLUE_INFO_T prGlueInfo;
  3134. u4CopySize = (count < (sizeof(acBuf) - 1)) ? count : (sizeof(acBuf) - 1);
  3135. if (copy_from_user(acBuf, buffer, u4CopySize))
  3136. return -1;
  3137. acBuf[u4CopySize] = '\0';
  3138. if (sscanf(acBuf, " %d", &u16MetUdpPort) == 1)
  3139. DBGLOG(INIT, INFO, "MET_PROF: Write MET PROC UDP_PORT=%d\n", u16MetUdpPort);
  3140. if (pMetGlobalData != NULL) {
  3141. prGlueInfo = (P_GLUE_INFO_T) pMetGlobalData;
  3142. prGlueInfo->u16MetUdpPort = (UINT_16) u16MetUdpPort;
  3143. }
  3144. return count;
  3145. }
  3146. const struct file_operations rMetProcCtrlFops = {
  3147. .write = kalMetCtrlWriteProcfs
  3148. };
  3149. const struct file_operations rMetProcPortFops = {
  3150. .write = kalMetPortWriteProcfs
  3151. };
  3152. int kalMetInitProcfs(IN P_GLUE_INFO_T prGlueInfo)
  3153. {
  3154. /* struct proc_dir_entry *pMetProcDir; */
  3155. if (init_net.proc_net == (struct proc_dir_entry *)NULL) {
  3156. DBGLOG(INIT, INFO, "init proc fs fail: proc_net == NULL\n");
  3157. return -ENOENT;
  3158. }
  3159. /*
  3160. * Directory: Root (/proc/net/wlan0)
  3161. */
  3162. pMetProcDir = proc_mkdir("wlan0", init_net.proc_net);
  3163. if (pMetProcDir == NULL)
  3164. return -ENOENT;
  3165. /*
  3166. /proc/net/wlan0
  3167. |-- met_ctrl (PROC_MET_PROF_CTRL)
  3168. |-- met_port (PROC_MET_PROF_PORT)
  3169. */
  3170. /* proc_create(PROC_MET_PROF_CTRL, 0x0644, pMetProcDir, &rMetProcFops); */
  3171. proc_create(PROC_MET_PROF_CTRL, 0, pMetProcDir, &rMetProcCtrlFops);
  3172. proc_create(PROC_MET_PROF_PORT, 0, pMetProcDir, &rMetProcPortFops);
  3173. pMetGlobalData = (void *)prGlueInfo;
  3174. return 0;
  3175. }
  3176. int kalMetRemoveProcfs(void)
  3177. {
  3178. if (init_net.proc_net == (struct proc_dir_entry *)NULL) {
  3179. DBGLOG(INIT, WARN, "remove proc fs fail: proc_net == NULL\n");
  3180. return -ENOENT;
  3181. }
  3182. remove_proc_entry(PROC_MET_PROF_CTRL, pMetProcDir);
  3183. remove_proc_entry(PROC_MET_PROF_PORT, pMetProcDir);
  3184. /* remove root directory (proc/net/wlan0) */
  3185. remove_proc_entry("wlan0", init_net.proc_net);
  3186. /* clear MetGlobalData */
  3187. pMetGlobalData = NULL;
  3188. return 0;
  3189. }
  3190. #endif
  3191. UINT_64 kalGetBootTime(void)
  3192. {
  3193. struct timespec ts;
  3194. UINT_64 bootTime = 0;
  3195. get_monotonic_boottime(&ts);
  3196. /* we assign ts.tv_sec to bootTime first, then multiply USEC_PER_SEC
  3197. this will prevent multiply result turn to a negative value on 32bit system */
  3198. bootTime = ts.tv_sec;
  3199. bootTime *= USEC_PER_SEC;
  3200. bootTime += ts.tv_nsec / NSEC_PER_USEC;
  3201. return bootTime;
  3202. }
  3203. /*----------------------------------------------------------------------------*/
  3204. /*!
  3205. * \brief To indicate scheduled scan results are avilable
  3206. *
  3207. * \param[in]
  3208. * prGlueInfo
  3209. *
  3210. * \return
  3211. * None
  3212. */
  3213. /*----------------------------------------------------------------------------*/
  3214. VOID kalSchedScanResults(IN P_GLUE_INFO_T prGlueInfo)
  3215. {
  3216. ASSERT(prGlueInfo);
  3217. cfg80211_sched_scan_results(priv_to_wiphy(prGlueInfo));
  3218. }
  3219. /*----------------------------------------------------------------------------*/
  3220. /*!
  3221. * \brief To indicate scheduled scan has been stopped
  3222. *
  3223. * \param[in]
  3224. * prGlueInfo
  3225. *
  3226. * \return
  3227. * None
  3228. */
  3229. /*----------------------------------------------------------------------------*/
  3230. VOID kalSchedScanStopped(IN P_GLUE_INFO_T prGlueInfo)
  3231. {
  3232. GLUE_SPIN_LOCK_DECLARATION();
  3233. ASSERT(prGlueInfo);
  3234. /* 1. reset first for newly incoming request */
  3235. GLUE_ACQUIRE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_NET_DEV);
  3236. if (prGlueInfo->prSchedScanRequest != NULL)
  3237. prGlueInfo->prSchedScanRequest = NULL;
  3238. GLUE_RELEASE_SPIN_LOCK(prGlueInfo, SPIN_LOCK_NET_DEV);
  3239. DBGLOG(SCN, INFO, "cfg80211_sched_scan_stopped send event\n");
  3240. /* 2. indication to cfg80211 */
  3241. /* 20150205 change cfg80211_sched_scan_stopped to work queue to use K thread to send event instead of Tx thread
  3242. due to sched_scan_mtx dead lock issue by Tx thread serves oid cmds and send event in the same time */
  3243. DBGLOG(SCN, TRACE, "start work queue to send event\n");
  3244. schedule_delayed_work(&sched_workq, 0);
  3245. DBGLOG(SCN, TRACE, "tx_thread return from kalSchedScanStoppped\n");
  3246. }
  3247. #if CFG_SUPPORT_WAKEUP_REASON_DEBUG
  3248. /* if SPM is not implement this function, we will use this default one */
  3249. wake_reason_t __weak slp_get_wake_reason(VOID)
  3250. {
  3251. return WR_NONE;
  3252. }
  3253. /* if SPM is not implement this function, we will use this default one */
  3254. UINT_32 __weak spm_get_last_wakeup_src(VOID)
  3255. {
  3256. return 0;
  3257. }
  3258. /*----------------------------------------------------------------------------*/
  3259. /*!
  3260. * \brief To check if device if wake up by wlan
  3261. *
  3262. * \param[in]
  3263. * prAdapter
  3264. *
  3265. * \return
  3266. * TRUE: wake up by wlan; otherwise, FALSE
  3267. */
  3268. /*----------------------------------------------------------------------------*/
  3269. BOOLEAN kalIsWakeupByWlan(P_ADAPTER_T prAdapter)
  3270. {
  3271. /* SUSPEND_FLAG_FOR_WAKEUP_REASON is set means system has suspended, but may be failed
  3272. duo to some driver suspend failed. so we need help of function slp_get_wake_reason */
  3273. if (test_and_clear_bit(SUSPEND_FLAG_FOR_WAKEUP_REASON, &prAdapter->ulSuspendFlag) == 0)
  3274. return FALSE;
  3275. /* if slp_get_wake_reason or spm_get_last_wakeup_src is NULL, it means SPM module didn't implement
  3276. it. then we should return FALSE always. otherwise, if slp_get_wake_reason returns WR_WAKE_SRC,
  3277. then it means the host is suspend successfully. */
  3278. if (slp_get_wake_reason() != WR_WAKE_SRC)
  3279. return FALSE;
  3280. /* spm_get_last_wakeup_src will returns the last wakeup source,
  3281. WAKE_SRC_CONN2AP is connsys */
  3282. return !!(spm_get_last_wakeup_src() & WAKE_SRC_CONN2AP);
  3283. }
  3284. #endif
  3285. INT_32 kalHaltLock(UINT_32 waitMs)
  3286. {
  3287. INT_32 i4Ret = 0;
  3288. if (waitMs) {
  3289. i4Ret = down_timeout(&rHaltCtrl.lock, MSEC_TO_JIFFIES(waitMs));
  3290. if (!i4Ret)
  3291. goto success;
  3292. if (i4Ret != -ETIME)
  3293. return i4Ret;
  3294. if (rHaltCtrl.fgHeldByKalIoctl) {
  3295. P_GLUE_INFO_T prGlueInfo = NULL;
  3296. wlanExportGlueInfo(&prGlueInfo);
  3297. DBGLOG(INIT, ERROR,
  3298. "kalIoctl was executed longer than %u ms, show backtrace of tx_thread!\n",
  3299. kalGetTimeTick() - rHaltCtrl.u4HoldStart);
  3300. if (prGlueInfo)
  3301. show_stack(prGlueInfo->main_thread, NULL);
  3302. } else {
  3303. DBGLOG(INIT, ERROR, "halt lock held by %s pid %d longer than %u ms!\n",
  3304. rHaltCtrl.owner->comm, rHaltCtrl.owner->pid,
  3305. kalGetTimeTick() - rHaltCtrl.u4HoldStart);
  3306. show_stack(rHaltCtrl.owner, NULL);
  3307. }
  3308. return i4Ret;
  3309. }
  3310. down(&rHaltCtrl.lock);
  3311. success:
  3312. rHaltCtrl.owner = current;
  3313. rHaltCtrl.u4HoldStart = kalGetTimeTick();
  3314. return 0;
  3315. }
  3316. INT_32 kalHaltTryLock(VOID)
  3317. {
  3318. INT_32 i4Ret = 0;
  3319. i4Ret = down_trylock(&rHaltCtrl.lock);
  3320. if (i4Ret)
  3321. return i4Ret;
  3322. rHaltCtrl.owner = current;
  3323. rHaltCtrl.u4HoldStart = kalGetTimeTick();
  3324. return 0;
  3325. }
  3326. VOID kalHaltUnlock(VOID)
  3327. {
  3328. if (kalGetTimeTick() - rHaltCtrl.u4HoldStart > WLAN_OID_TIMEOUT_THRESHOLD * 2 &&
  3329. rHaltCtrl.owner)
  3330. DBGLOG(INIT, ERROR, "process %s pid %d hold halt lock longer than 4s!\n",
  3331. rHaltCtrl.owner->comm, rHaltCtrl.owner->pid);
  3332. rHaltCtrl.owner = NULL;
  3333. up(&rHaltCtrl.lock);
  3334. }
  3335. VOID kalSetHalted(BOOLEAN fgHalt)
  3336. {
  3337. rHaltCtrl.fgHalt = fgHalt;
  3338. }
  3339. BOOLEAN kalIsHalted(VOID)
  3340. {
  3341. return rHaltCtrl.fgHalt;
  3342. }
  3343. VOID kalPerMonDump(IN P_GLUE_INFO_T prGlueInfo)
  3344. {
  3345. struct PERF_MONITOR_T *prPerMonitor;
  3346. prPerMonitor = &prGlueInfo->prAdapter->rPerMonitor;
  3347. DBGLOG(SW4, WARN, "ulPerfMonFlag:0x%lx\n", prPerMonitor->ulPerfMonFlag);
  3348. DBGLOG(SW4, WARN, "ulLastTxBytes:%ld\n", prPerMonitor->ulLastTxBytes);
  3349. DBGLOG(SW4, WARN, "ulLastRxBytes:%ld\n", prPerMonitor->ulLastRxBytes);
  3350. DBGLOG(SW4, WARN, "ulP2PLastTxBytes:%ld\n", prPerMonitor->ulP2PLastTxBytes);
  3351. DBGLOG(SW4, WARN, "ulP2PLastRxBytes:%ld\n", prPerMonitor->ulP2PLastRxBytes);
  3352. DBGLOG(SW4, WARN, "ulThroughput:%ld\n", prPerMonitor->ulThroughput);
  3353. DBGLOG(SW4, WARN, "u4UpdatePeriod:%d\n", prPerMonitor->u4UpdatePeriod);
  3354. DBGLOG(SW4, WARN, "u4TarPerfLevel:%d\n", prPerMonitor->u4TarPerfLevel);
  3355. DBGLOG(SW4, WARN, "u4CurrPerfLevel:%d\n", prPerMonitor->u4CurrPerfLevel);
  3356. DBGLOG(SW4, WARN, "netStats tx_bytes:%ld\n", prGlueInfo->rNetDevStats.tx_bytes);
  3357. DBGLOG(SW4, WARN, "netStats tx_bytes:%ld\n", prGlueInfo->rNetDevStats.rx_bytes);
  3358. DBGLOG(SW4, WARN, "p2p netStats tx_bytes:%ld\n", prGlueInfo->prP2PInfo->rNetDevStats.tx_bytes);
  3359. DBGLOG(SW4, WARN, "p2p netStats tx_bytes:%ld\n", prGlueInfo->prP2PInfo->rNetDevStats.rx_bytes);
  3360. }
  3361. inline INT_32 kalPerMonInit(IN P_GLUE_INFO_T prGlueInfo)
  3362. {
  3363. struct PERF_MONITOR_T *prPerMonitor;
  3364. prPerMonitor = &prGlueInfo->prAdapter->rPerMonitor;
  3365. DBGLOG(SW4, INFO, "enter %s\n", __func__);
  3366. if (KAL_TEST_BIT(PERF_MON_RUNNING_BIT, prPerMonitor->ulPerfMonFlag))
  3367. DBGLOG(SW4, WARN, "abnormal, perf monitory already running\n");
  3368. KAL_CLR_BIT(PERF_MON_RUNNING_BIT, prPerMonitor->ulPerfMonFlag);
  3369. KAL_CLR_BIT(PERF_MON_DISABLE_BIT, prPerMonitor->ulPerfMonFlag);
  3370. KAL_SET_BIT(PERF_MON_STOP_BIT, prPerMonitor->ulPerfMonFlag);
  3371. prPerMonitor->u4UpdatePeriod = 1000;
  3372. cnmTimerInitTimer(prGlueInfo->prAdapter,
  3373. &prPerMonitor->rPerfMonTimer,
  3374. (PFN_MGMT_TIMEOUT_FUNC) kalPerMonHandler, (ULONG) NULL);
  3375. DBGLOG(SW4, INFO, "exit %s\n", __func__);
  3376. return 0;
  3377. }
  3378. inline INT_32 kalPerMonDisable(IN P_GLUE_INFO_T prGlueInfo)
  3379. {
  3380. struct PERF_MONITOR_T *prPerMonitor;
  3381. prPerMonitor = &prGlueInfo->prAdapter->rPerMonitor;
  3382. DBGLOG(SW4, INFO, "enter %s\n", __func__);
  3383. if (KAL_TEST_BIT(PERF_MON_RUNNING_BIT, prPerMonitor->ulPerfMonFlag)) {
  3384. DBGLOG(SW4, TRACE, "need to stop before disable\n");
  3385. kalPerMonStop(prGlueInfo);
  3386. }
  3387. KAL_SET_BIT(PERF_MON_DISABLE_BIT, prPerMonitor->ulPerfMonFlag);
  3388. DBGLOG(SW4, TRACE, "exit %s\n", __func__);
  3389. return 0;
  3390. }
  3391. inline INT_32 kalPerMonEnable(IN P_GLUE_INFO_T prGlueInfo)
  3392. {
  3393. struct PERF_MONITOR_T *prPerMonitor;
  3394. prPerMonitor = &prGlueInfo->prAdapter->rPerMonitor;
  3395. DBGLOG(SW4, INFO, "enter %s\n", __func__);
  3396. KAL_CLR_BIT(PERF_MON_DISABLE_BIT, prPerMonitor->ulPerfMonFlag);
  3397. DBGLOG(SW4, TRACE, "exit %s\n", __func__);
  3398. return 0;
  3399. }
  3400. inline INT_32 kalPerMonStart(IN P_GLUE_INFO_T prGlueInfo)
  3401. {
  3402. struct PERF_MONITOR_T *prPerMonitor;
  3403. prPerMonitor = &prGlueInfo->prAdapter->rPerMonitor;
  3404. DBGLOG(SW4, TRACE, "enter %s\n", __func__);
  3405. if ((wlan_fb_power_down || fgIsUnderSuspend) &&
  3406. !KAL_TEST_BIT(PERF_MON_DISABLE_BIT, prPerMonitor->ulPerfMonFlag)) {
  3407. /* Remove this to prevent KE, kalPerMonStart might be called in soft irq
  3408. kalBoostCpu might call flush_work which will use wait_for_completion
  3409. then KE will happen in this case
  3410. Simply don't start performance monitor here
  3411. */
  3412. /*kalPerMonDisable(prGlueInfo);*/
  3413. return 0;
  3414. }
  3415. if (KAL_TEST_BIT(PERF_MON_DISABLE_BIT, prPerMonitor->ulPerfMonFlag) ||
  3416. KAL_TEST_BIT(PERF_MON_RUNNING_BIT, prPerMonitor->ulPerfMonFlag))
  3417. return 0;
  3418. prPerMonitor->ulLastRxBytes = 0;
  3419. prPerMonitor->ulLastTxBytes = 0;
  3420. prPerMonitor->ulP2PLastRxBytes = 0;
  3421. prPerMonitor->ulP2PLastTxBytes = 0;
  3422. prPerMonitor->ulThroughput = 0;
  3423. prPerMonitor->u4CurrPerfLevel = 0;
  3424. prPerMonitor->u4TarPerfLevel = 0;
  3425. cnmTimerStartTimer(prGlueInfo->prAdapter, &prPerMonitor->rPerfMonTimer, prPerMonitor->u4UpdatePeriod);
  3426. KAL_SET_BIT(PERF_MON_RUNNING_BIT, prPerMonitor->ulPerfMonFlag);
  3427. KAL_CLR_BIT(PERF_MON_STOP_BIT, prPerMonitor->ulPerfMonFlag);
  3428. DBGLOG(SW4, INFO, "perf monitor started\n");
  3429. return 0;
  3430. }
  3431. inline INT_32 kalPerMonStop(IN P_GLUE_INFO_T prGlueInfo)
  3432. {
  3433. struct PERF_MONITOR_T *prPerMonitor;
  3434. prPerMonitor = &prGlueInfo->prAdapter->rPerMonitor;
  3435. DBGLOG(SW4, TRACE, "enter %s\n", __func__);
  3436. if (KAL_TEST_BIT(PERF_MON_DISABLE_BIT, prPerMonitor->ulPerfMonFlag)) {
  3437. DBGLOG(SW4, TRACE, "perf monitory disabled\n");
  3438. return 0;
  3439. }
  3440. if (KAL_TEST_BIT(PERF_MON_STOP_BIT, prPerMonitor->ulPerfMonFlag)) {
  3441. DBGLOG(SW4, TRACE, "perf monitory already stopped\n");
  3442. return 0;
  3443. }
  3444. KAL_SET_BIT(PERF_MON_STOP_BIT, prPerMonitor->ulPerfMonFlag);
  3445. if (KAL_TEST_BIT(PERF_MON_RUNNING_BIT, prPerMonitor->ulPerfMonFlag)) {
  3446. cnmTimerStopTimer(prGlueInfo->prAdapter, &prPerMonitor->rPerfMonTimer);
  3447. KAL_CLR_BIT(PERF_MON_RUNNING_BIT, prPerMonitor->ulPerfMonFlag);
  3448. prPerMonitor->ulLastRxBytes = 0;
  3449. prPerMonitor->ulLastTxBytes = 0;
  3450. prPerMonitor->ulP2PLastRxBytes = 0;
  3451. prPerMonitor->ulP2PLastTxBytes = 0;
  3452. prPerMonitor->ulThroughput = 0;
  3453. prPerMonitor->u4CurrPerfLevel = 0;
  3454. prPerMonitor->u4TarPerfLevel = 0;
  3455. /*Cancel CPU performance mode request*/
  3456. kalBoostCpu(0);
  3457. }
  3458. DBGLOG(SW4, TRACE, "exit %s\n", __func__);
  3459. return 0;
  3460. }
  3461. inline INT_32 kalPerMonDestroy(IN P_GLUE_INFO_T prGlueInfo)
  3462. {
  3463. kalPerMonDisable(prGlueInfo);
  3464. return 0;
  3465. }
  3466. VOID kalPerMonHandler(IN P_ADAPTER_T prAdapter, ULONG ulParam)
  3467. {
  3468. /*Calculate current throughput*/
  3469. struct PERF_MONITOR_T *prPerMonitor;
  3470. struct net_device *prNetDev = NULL;
  3471. P_BSS_INFO_T prP2pBssInfo = (P_BSS_INFO_T) NULL;
  3472. LONG latestTxBytes, latestRxBytes, txDiffBytes, rxDiffBytes;
  3473. LONG p2pLatestTxBytes, p2pLatestRxBytes, p2pTxDiffBytes, p2pRxDiffBytes;
  3474. P_GLUE_INFO_T prGlueInfo = prAdapter->prGlueInfo;
  3475. if ((prGlueInfo->ulFlag & GLUE_FLAG_HALT) || (!prAdapter->fgIsP2PRegistered))
  3476. return;
  3477. prNetDev = prGlueInfo->prDevHandler;
  3478. prP2pBssInfo = &prGlueInfo->prAdapter->rWifiVar.arBssInfo[NETWORK_TYPE_P2P_INDEX];
  3479. prPerMonitor = &prAdapter->rPerMonitor;
  3480. DBGLOG(SW4, TRACE, "enter kalPerMonHandler\n");
  3481. latestTxBytes = prGlueInfo->rNetDevStats.tx_bytes;
  3482. latestRxBytes = prGlueInfo->rNetDevStats.rx_bytes;
  3483. p2pLatestTxBytes = prGlueInfo->prP2PInfo->rNetDevStats.tx_bytes;
  3484. p2pLatestRxBytes = prGlueInfo->prP2PInfo->rNetDevStats.rx_bytes;
  3485. if (0 == prPerMonitor->ulLastRxBytes &&
  3486. 0 == prPerMonitor->ulLastTxBytes &&
  3487. 0 == prPerMonitor->ulP2PLastRxBytes &&
  3488. 0 == prPerMonitor->ulP2PLastTxBytes) {
  3489. prPerMonitor->ulThroughput = 0;
  3490. } else {
  3491. txDiffBytes = latestTxBytes - prPerMonitor->ulLastTxBytes;
  3492. rxDiffBytes = latestRxBytes - prPerMonitor->ulLastRxBytes;
  3493. if (0 > txDiffBytes)
  3494. txDiffBytes = -(txDiffBytes);
  3495. if (0 > rxDiffBytes)
  3496. rxDiffBytes = -(rxDiffBytes);
  3497. p2pTxDiffBytes = p2pLatestTxBytes - prPerMonitor->ulP2PLastTxBytes;
  3498. p2pRxDiffBytes = p2pLatestRxBytes - prPerMonitor->ulP2PLastRxBytes;
  3499. if (0 > p2pTxDiffBytes)
  3500. p2pTxDiffBytes = -(p2pTxDiffBytes);
  3501. if (0 > p2pRxDiffBytes)
  3502. p2pRxDiffBytes = -(p2pRxDiffBytes);
  3503. prPerMonitor->ulThroughput = txDiffBytes + rxDiffBytes + p2pTxDiffBytes + p2pRxDiffBytes;
  3504. prPerMonitor->ulThroughput *= 1000;
  3505. prPerMonitor->ulThroughput /= prPerMonitor->u4UpdatePeriod;
  3506. prPerMonitor->ulThroughput <<= 3;
  3507. }
  3508. prPerMonitor->ulLastTxBytes = latestTxBytes;
  3509. prPerMonitor->ulLastRxBytes = latestRxBytes;
  3510. prPerMonitor->ulP2PLastTxBytes = p2pLatestTxBytes;
  3511. prPerMonitor->ulP2PLastRxBytes = p2pLatestRxBytes;
  3512. if (prPerMonitor->ulThroughput < THROUGHPUT_L1_THRESHOLD)
  3513. prPerMonitor->u4TarPerfLevel = 0;
  3514. else if (prPerMonitor->ulThroughput < THROUGHPUT_L2_THRESHOLD)
  3515. prPerMonitor->u4TarPerfLevel = 1;
  3516. else if (prPerMonitor->ulThroughput < THROUGHPUT_L3_THRESHOLD)
  3517. prPerMonitor->u4TarPerfLevel = 2;
  3518. else
  3519. prPerMonitor->u4TarPerfLevel = 3;
  3520. if (fgIsUnderSuspend ||
  3521. wlan_fb_power_down ||
  3522. !(netif_carrier_ok(prNetDev) ||
  3523. (prP2pBssInfo->eConnectionState == PARAM_MEDIA_STATE_CONNECTED) ||
  3524. (prP2pBssInfo->rStaRecOfClientList.u4NumElem > 0)))
  3525. kalPerMonStop(prGlueInfo);
  3526. else {
  3527. DBGLOG(SW4, TRACE, "throughput:%ld bps\n", prPerMonitor->ulThroughput);
  3528. if (prPerMonitor->u4TarPerfLevel != prPerMonitor->u4CurrPerfLevel) {
  3529. /* if tar level = 0; core_number=prPerMonitor->u4TarPerfLevel+1*/
  3530. if (prPerMonitor->u4TarPerfLevel)
  3531. kalBoostCpu(prPerMonitor->u4TarPerfLevel+1);
  3532. else
  3533. kalBoostCpu(0);
  3534. }
  3535. cnmTimerStartTimer(prGlueInfo->prAdapter, &prPerMonitor->rPerfMonTimer, prPerMonitor->u4UpdatePeriod);
  3536. }
  3537. prPerMonitor->u4CurrPerfLevel = prPerMonitor->u4TarPerfLevel;
  3538. DBGLOG(SW4, TRACE, "exit kalPerMonHandler\n");
  3539. }
  3540. INT32 __weak kalBoostCpu(UINT_32 core_num)
  3541. {
  3542. DBGLOG(SW4, WARN, "enter weak kalBoostCpu, core_num:%d\n", core_num);
  3543. return 0;
  3544. }
  3545. static int wlan_fb_notifier_callback(struct notifier_block *self, unsigned long event, void *data)
  3546. {
  3547. struct fb_event *evdata = data;
  3548. INT_32 blank;
  3549. P_GLUE_INFO_T prGlueInfo = (P_GLUE_INFO_T)wlan_fb_notifier_priv_data;
  3550. /* If we aren't interested in this event, skip it immediately ... */
  3551. if (event != FB_EVENT_BLANK)
  3552. return 0;
  3553. if (prGlueInfo == NULL)
  3554. return 0;
  3555. if (kalHaltTryLock())
  3556. return 0;
  3557. if (kalIsHalted())
  3558. goto end;
  3559. blank = *(INT_32 *)evdata->data;
  3560. switch (blank) {
  3561. case FB_BLANK_UNBLANK:
  3562. if (!kalIsHalted())
  3563. kalPerMonEnable(prGlueInfo);
  3564. wlan_fb_power_down = FALSE;
  3565. break;
  3566. case FB_BLANK_POWERDOWN:
  3567. wlan_fb_power_down = TRUE;
  3568. if (!kalIsHalted())
  3569. kalPerMonDisable(prGlueInfo);
  3570. break;
  3571. default:
  3572. break;
  3573. }
  3574. end:
  3575. kalHaltUnlock();
  3576. return 0;
  3577. }
  3578. INT_32 kalFbNotifierReg(IN P_GLUE_INFO_T prGlueInfo)
  3579. {
  3580. INT_32 i4Ret;
  3581. wlan_fb_notifier_priv_data = prGlueInfo;
  3582. wlan_fb_notifier.notifier_call = wlan_fb_notifier_callback;
  3583. i4Ret = fb_register_client(&wlan_fb_notifier);
  3584. if (i4Ret)
  3585. DBGLOG(SW4, WARN, "Register wlan_fb_notifier failed:%d\n", i4Ret);
  3586. else
  3587. DBGLOG(SW4, TRACE, "Register wlan_fb_notifier succeed\n");
  3588. return i4Ret;
  3589. }
  3590. VOID kalFbNotifierUnReg(VOID)
  3591. {
  3592. fb_unregister_client(&wlan_fb_notifier);
  3593. wlan_fb_notifier_priv_data = NULL;
  3594. }