iwl-agn.c 124 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011301230133014301530163017301830193020302130223023302430253026302730283029303030313032303330343035303630373038303930403041304230433044304530463047304830493050305130523053305430553056305730583059306030613062306330643065306630673068306930703071307230733074307530763077307830793080308130823083308430853086308730883089309030913092309330943095309630973098309931003101310231033104310531063107310831093110311131123113311431153116311731183119312031213122312331243125312631273128312931303131313231333134313531363137313831393140314131423143314431453146314731483149315031513152315331543155315631573158315931603161316231633164316531663167316831693170317131723173317431753176317731783179318031813182318331843185318631873188318931903191319231933194319531963197319831993200320132023203320432053206320732083209321032113212321332143215321632173218321932203221322232233224322532263227322832293230323132323233323432353236323732383239324032413242324332443245324632473248324932503251325232533254325532563257325832593260326132623263326432653266326732683269327032713272327332743275327632773278327932803281328232833284328532863287328832893290329132923293329432953296329732983299330033013302330333043305330633073308330933103311331233133314331533163317331833193320332133223323332433253326332733283329333033313332333333343335333633373338333933403341334233433344334533463347334833493350335133523353335433553356335733583359336033613362336333643365336633673368336933703371337233733374337533763377337833793380338133823383338433853386338733883389339033913392339333943395339633973398339934003401340234033404340534063407340834093410341134123413341434153416341734183419342034213422342334243425342634273428342934303431343234333434343534363437343834393440344134423443344434453446344734483449345034513452345334543455345634573458345934603461346234633464346534663467346834693470347134723473347434753476347734783479348034813482348334843485348634873488348934903491349234933494349534963497349834993500350135023503350435053506350735083509351035113512351335143515351635173518351935203521352235233524352535263527352835293530353135323533353435353536353735383539354035413542354335443545354635473548354935503551355235533554355535563557355835593560356135623563356435653566356735683569357035713572357335743575357635773578357935803581358235833584358535863587358835893590359135923593359435953596359735983599360036013602360336043605360636073608360936103611361236133614361536163617361836193620362136223623362436253626362736283629363036313632363336343635363636373638363936403641364236433644364536463647364836493650365136523653365436553656365736583659366036613662366336643665366636673668366936703671367236733674367536763677367836793680368136823683368436853686368736883689369036913692369336943695369636973698369937003701370237033704370537063707370837093710371137123713371437153716371737183719372037213722372337243725372637273728372937303731373237333734373537363737373837393740374137423743374437453746374737483749375037513752375337543755375637573758375937603761376237633764376537663767376837693770377137723773377437753776377737783779378037813782378337843785378637873788378937903791379237933794379537963797379837993800380138023803380438053806380738083809381038113812381338143815381638173818381938203821382238233824382538263827382838293830383138323833383438353836383738383839384038413842384338443845384638473848384938503851385238533854385538563857385838593860386138623863386438653866386738683869387038713872387338743875387638773878387938803881388238833884388538863887388838893890389138923893389438953896389738983899390039013902390339043905390639073908390939103911391239133914391539163917391839193920392139223923392439253926392739283929393039313932393339343935393639373938393939403941394239433944394539463947394839493950395139523953395439553956395739583959396039613962396339643965396639673968396939703971397239733974397539763977397839793980398139823983398439853986398739883989399039913992399339943995399639973998399940004001400240034004400540064007400840094010401140124013401440154016401740184019402040214022402340244025402640274028402940304031403240334034403540364037403840394040404140424043404440454046404740484049405040514052405340544055405640574058405940604061406240634064406540664067406840694070407140724073407440754076407740784079408040814082408340844085408640874088408940904091409240934094409540964097409840994100410141024103410441054106410741084109411041114112411341144115411641174118411941204121412241234124412541264127412841294130413141324133413441354136413741384139414041414142414341444145414641474148414941504151415241534154415541564157415841594160416141624163416441654166416741684169417041714172417341744175417641774178417941804181418241834184418541864187418841894190419141924193419441954196419741984199420042014202420342044205420642074208420942104211421242134214421542164217421842194220422142224223422442254226422742284229423042314232423342344235423642374238423942404241424242434244424542464247424842494250425142524253425442554256425742584259426042614262426342644265426642674268426942704271427242734274427542764277427842794280428142824283428442854286428742884289429042914292429342944295429642974298429943004301430243034304430543064307430843094310431143124313431443154316431743184319432043214322432343244325432643274328432943304331433243334334433543364337433843394340434143424343434443454346434743484349435043514352435343544355435643574358435943604361436243634364436543664367436843694370437143724373437443754376437743784379438043814382438343844385438643874388438943904391
  1. /******************************************************************************
  2. *
  3. * Copyright(c) 2003 - 2011 Intel Corporation. All rights reserved.
  4. *
  5. * Portions of this file are derived from the ipw3945 project, as well
  6. * as portions of the ieee80211 subsystem header files.
  7. *
  8. * This program is free software; you can redistribute it and/or modify it
  9. * under the terms of version 2 of the GNU General Public License as
  10. * published by the Free Software Foundation.
  11. *
  12. * This program is distributed in the hope that it will be useful, but WITHOUT
  13. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  14. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  15. * more details.
  16. *
  17. * You should have received a copy of the GNU General Public License along with
  18. * this program; if not, write to the Free Software Foundation, Inc.,
  19. * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  20. *
  21. * The full GNU General Public License is included in this distribution in the
  22. * file called LICENSE.
  23. *
  24. * Contact Information:
  25. * Intel Linux Wireless <ilw@linux.intel.com>
  26. * Intel Corporation, 5200 N.E. Elam Young Parkway, Hillsboro, OR 97124-6497
  27. *
  28. *****************************************************************************/
  29. #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  30. #include <linux/kernel.h>
  31. #include <linux/module.h>
  32. #include <linux/init.h>
  33. #include <linux/pci.h>
  34. #include <linux/pci-aspm.h>
  35. #include <linux/slab.h>
  36. #include <linux/dma-mapping.h>
  37. #include <linux/delay.h>
  38. #include <linux/sched.h>
  39. #include <linux/skbuff.h>
  40. #include <linux/netdevice.h>
  41. #include <linux/wireless.h>
  42. #include <linux/firmware.h>
  43. #include <linux/etherdevice.h>
  44. #include <linux/if_arp.h>
  45. #include <net/mac80211.h>
  46. #include <asm/div64.h>
  47. #define DRV_NAME "iwlagn"
  48. #include "iwl-eeprom.h"
  49. #include "iwl-dev.h"
  50. #include "iwl-core.h"
  51. #include "iwl-io.h"
  52. #include "iwl-helpers.h"
  53. #include "iwl-sta.h"
  54. #include "iwl-agn-calib.h"
  55. #include "iwl-agn.h"
  56. #include "iwl-agn-led.h"
  57. /******************************************************************************
  58. *
  59. * module boiler plate
  60. *
  61. ******************************************************************************/
  62. /*
  63. * module name, copyright, version, etc.
  64. */
  65. #define DRV_DESCRIPTION "Intel(R) Wireless WiFi Link AGN driver for Linux"
  66. #ifdef CONFIG_IWLWIFI_DEBUG
  67. #define VD "d"
  68. #else
  69. #define VD
  70. #endif
  71. #define DRV_VERSION IWLWIFI_VERSION VD
  72. MODULE_DESCRIPTION(DRV_DESCRIPTION);
  73. MODULE_VERSION(DRV_VERSION);
  74. MODULE_AUTHOR(DRV_COPYRIGHT " " DRV_AUTHOR);
  75. MODULE_LICENSE("GPL");
  76. static int iwlagn_ant_coupling;
  77. static bool iwlagn_bt_ch_announce = 1;
  78. void iwl_update_chain_flags(struct iwl_priv *priv)
  79. {
  80. struct iwl_rxon_context *ctx;
  81. if (priv->cfg->ops->hcmd->set_rxon_chain) {
  82. for_each_context(priv, ctx) {
  83. priv->cfg->ops->hcmd->set_rxon_chain(priv, ctx);
  84. if (ctx->active.rx_chain != ctx->staging.rx_chain)
  85. iwlcore_commit_rxon(priv, ctx);
  86. }
  87. }
  88. }
  89. static void iwl_clear_free_frames(struct iwl_priv *priv)
  90. {
  91. struct list_head *element;
  92. IWL_DEBUG_INFO(priv, "%d frames on pre-allocated heap on clear.\n",
  93. priv->frames_count);
  94. while (!list_empty(&priv->free_frames)) {
  95. element = priv->free_frames.next;
  96. list_del(element);
  97. kfree(list_entry(element, struct iwl_frame, list));
  98. priv->frames_count--;
  99. }
  100. if (priv->frames_count) {
  101. IWL_WARN(priv, "%d frames still in use. Did we lose one?\n",
  102. priv->frames_count);
  103. priv->frames_count = 0;
  104. }
  105. }
  106. static struct iwl_frame *iwl_get_free_frame(struct iwl_priv *priv)
  107. {
  108. struct iwl_frame *frame;
  109. struct list_head *element;
  110. if (list_empty(&priv->free_frames)) {
  111. frame = kzalloc(sizeof(*frame), GFP_KERNEL);
  112. if (!frame) {
  113. IWL_ERR(priv, "Could not allocate frame!\n");
  114. return NULL;
  115. }
  116. priv->frames_count++;
  117. return frame;
  118. }
  119. element = priv->free_frames.next;
  120. list_del(element);
  121. return list_entry(element, struct iwl_frame, list);
  122. }
  123. static void iwl_free_frame(struct iwl_priv *priv, struct iwl_frame *frame)
  124. {
  125. memset(frame, 0, sizeof(*frame));
  126. list_add(&frame->list, &priv->free_frames);
  127. }
  128. static u32 iwl_fill_beacon_frame(struct iwl_priv *priv,
  129. struct ieee80211_hdr *hdr,
  130. int left)
  131. {
  132. lockdep_assert_held(&priv->mutex);
  133. if (!priv->beacon_skb)
  134. return 0;
  135. if (priv->beacon_skb->len > left)
  136. return 0;
  137. memcpy(hdr, priv->beacon_skb->data, priv->beacon_skb->len);
  138. return priv->beacon_skb->len;
  139. }
  140. /* Parse the beacon frame to find the TIM element and set tim_idx & tim_size */
  141. static void iwl_set_beacon_tim(struct iwl_priv *priv,
  142. struct iwl_tx_beacon_cmd *tx_beacon_cmd,
  143. u8 *beacon, u32 frame_size)
  144. {
  145. u16 tim_idx;
  146. struct ieee80211_mgmt *mgmt = (struct ieee80211_mgmt *)beacon;
  147. /*
  148. * The index is relative to frame start but we start looking at the
  149. * variable-length part of the beacon.
  150. */
  151. tim_idx = mgmt->u.beacon.variable - beacon;
  152. /* Parse variable-length elements of beacon to find WLAN_EID_TIM */
  153. while ((tim_idx < (frame_size - 2)) &&
  154. (beacon[tim_idx] != WLAN_EID_TIM))
  155. tim_idx += beacon[tim_idx+1] + 2;
  156. /* If TIM field was found, set variables */
  157. if ((tim_idx < (frame_size - 1)) && (beacon[tim_idx] == WLAN_EID_TIM)) {
  158. tx_beacon_cmd->tim_idx = cpu_to_le16(tim_idx);
  159. tx_beacon_cmd->tim_size = beacon[tim_idx+1];
  160. } else
  161. IWL_WARN(priv, "Unable to find TIM Element in beacon\n");
  162. }
  163. static unsigned int iwl_hw_get_beacon_cmd(struct iwl_priv *priv,
  164. struct iwl_frame *frame)
  165. {
  166. struct iwl_tx_beacon_cmd *tx_beacon_cmd;
  167. u32 frame_size;
  168. u32 rate_flags;
  169. u32 rate;
  170. /*
  171. * We have to set up the TX command, the TX Beacon command, and the
  172. * beacon contents.
  173. */
  174. lockdep_assert_held(&priv->mutex);
  175. if (!priv->beacon_ctx) {
  176. IWL_ERR(priv, "trying to build beacon w/o beacon context!\n");
  177. return 0;
  178. }
  179. /* Initialize memory */
  180. tx_beacon_cmd = &frame->u.beacon;
  181. memset(tx_beacon_cmd, 0, sizeof(*tx_beacon_cmd));
  182. /* Set up TX beacon contents */
  183. frame_size = iwl_fill_beacon_frame(priv, tx_beacon_cmd->frame,
  184. sizeof(frame->u) - sizeof(*tx_beacon_cmd));
  185. if (WARN_ON_ONCE(frame_size > MAX_MPDU_SIZE))
  186. return 0;
  187. if (!frame_size)
  188. return 0;
  189. /* Set up TX command fields */
  190. tx_beacon_cmd->tx.len = cpu_to_le16((u16)frame_size);
  191. tx_beacon_cmd->tx.sta_id = priv->beacon_ctx->bcast_sta_id;
  192. tx_beacon_cmd->tx.stop_time.life_time = TX_CMD_LIFE_TIME_INFINITE;
  193. tx_beacon_cmd->tx.tx_flags = TX_CMD_FLG_SEQ_CTL_MSK |
  194. TX_CMD_FLG_TSF_MSK | TX_CMD_FLG_STA_RATE_MSK;
  195. /* Set up TX beacon command fields */
  196. iwl_set_beacon_tim(priv, tx_beacon_cmd, (u8 *)tx_beacon_cmd->frame,
  197. frame_size);
  198. /* Set up packet rate and flags */
  199. rate = iwl_rate_get_lowest_plcp(priv, priv->beacon_ctx);
  200. priv->mgmt_tx_ant = iwl_toggle_tx_ant(priv, priv->mgmt_tx_ant,
  201. priv->hw_params.valid_tx_ant);
  202. rate_flags = iwl_ant_idx_to_flags(priv->mgmt_tx_ant);
  203. if ((rate >= IWL_FIRST_CCK_RATE) && (rate <= IWL_LAST_CCK_RATE))
  204. rate_flags |= RATE_MCS_CCK_MSK;
  205. tx_beacon_cmd->tx.rate_n_flags = iwl_hw_set_rate_n_flags(rate,
  206. rate_flags);
  207. return sizeof(*tx_beacon_cmd) + frame_size;
  208. }
  209. int iwlagn_send_beacon_cmd(struct iwl_priv *priv)
  210. {
  211. struct iwl_frame *frame;
  212. unsigned int frame_size;
  213. int rc;
  214. frame = iwl_get_free_frame(priv);
  215. if (!frame) {
  216. IWL_ERR(priv, "Could not obtain free frame buffer for beacon "
  217. "command.\n");
  218. return -ENOMEM;
  219. }
  220. frame_size = iwl_hw_get_beacon_cmd(priv, frame);
  221. if (!frame_size) {
  222. IWL_ERR(priv, "Error configuring the beacon command\n");
  223. iwl_free_frame(priv, frame);
  224. return -EINVAL;
  225. }
  226. rc = iwl_send_cmd_pdu(priv, REPLY_TX_BEACON, frame_size,
  227. &frame->u.cmd[0]);
  228. iwl_free_frame(priv, frame);
  229. return rc;
  230. }
  231. static inline dma_addr_t iwl_tfd_tb_get_addr(struct iwl_tfd *tfd, u8 idx)
  232. {
  233. struct iwl_tfd_tb *tb = &tfd->tbs[idx];
  234. dma_addr_t addr = get_unaligned_le32(&tb->lo);
  235. if (sizeof(dma_addr_t) > sizeof(u32))
  236. addr |=
  237. ((dma_addr_t)(le16_to_cpu(tb->hi_n_len) & 0xF) << 16) << 16;
  238. return addr;
  239. }
  240. static inline u16 iwl_tfd_tb_get_len(struct iwl_tfd *tfd, u8 idx)
  241. {
  242. struct iwl_tfd_tb *tb = &tfd->tbs[idx];
  243. return le16_to_cpu(tb->hi_n_len) >> 4;
  244. }
  245. static inline void iwl_tfd_set_tb(struct iwl_tfd *tfd, u8 idx,
  246. dma_addr_t addr, u16 len)
  247. {
  248. struct iwl_tfd_tb *tb = &tfd->tbs[idx];
  249. u16 hi_n_len = len << 4;
  250. put_unaligned_le32(addr, &tb->lo);
  251. if (sizeof(dma_addr_t) > sizeof(u32))
  252. hi_n_len |= ((addr >> 16) >> 16) & 0xF;
  253. tb->hi_n_len = cpu_to_le16(hi_n_len);
  254. tfd->num_tbs = idx + 1;
  255. }
  256. static inline u8 iwl_tfd_get_num_tbs(struct iwl_tfd *tfd)
  257. {
  258. return tfd->num_tbs & 0x1f;
  259. }
  260. /**
  261. * iwl_hw_txq_free_tfd - Free all chunks referenced by TFD [txq->q.read_ptr]
  262. * @priv - driver private data
  263. * @txq - tx queue
  264. *
  265. * Does NOT advance any TFD circular buffer read/write indexes
  266. * Does NOT free the TFD itself (which is within circular buffer)
  267. */
  268. void iwl_hw_txq_free_tfd(struct iwl_priv *priv, struct iwl_tx_queue *txq)
  269. {
  270. struct iwl_tfd *tfd_tmp = (struct iwl_tfd *)txq->tfds;
  271. struct iwl_tfd *tfd;
  272. struct pci_dev *dev = priv->pci_dev;
  273. int index = txq->q.read_ptr;
  274. int i;
  275. int num_tbs;
  276. tfd = &tfd_tmp[index];
  277. /* Sanity check on number of chunks */
  278. num_tbs = iwl_tfd_get_num_tbs(tfd);
  279. if (num_tbs >= IWL_NUM_OF_TBS) {
  280. IWL_ERR(priv, "Too many chunks: %i\n", num_tbs);
  281. /* @todo issue fatal error, it is quite serious situation */
  282. return;
  283. }
  284. /* Unmap tx_cmd */
  285. if (num_tbs)
  286. pci_unmap_single(dev,
  287. dma_unmap_addr(&txq->meta[index], mapping),
  288. dma_unmap_len(&txq->meta[index], len),
  289. PCI_DMA_BIDIRECTIONAL);
  290. /* Unmap chunks, if any. */
  291. for (i = 1; i < num_tbs; i++)
  292. pci_unmap_single(dev, iwl_tfd_tb_get_addr(tfd, i),
  293. iwl_tfd_tb_get_len(tfd, i), PCI_DMA_TODEVICE);
  294. /* free SKB */
  295. if (txq->txb) {
  296. struct sk_buff *skb;
  297. skb = txq->txb[txq->q.read_ptr].skb;
  298. /* can be called from irqs-disabled context */
  299. if (skb) {
  300. dev_kfree_skb_any(skb);
  301. txq->txb[txq->q.read_ptr].skb = NULL;
  302. }
  303. }
  304. }
  305. int iwl_hw_txq_attach_buf_to_tfd(struct iwl_priv *priv,
  306. struct iwl_tx_queue *txq,
  307. dma_addr_t addr, u16 len,
  308. u8 reset, u8 pad)
  309. {
  310. struct iwl_queue *q;
  311. struct iwl_tfd *tfd, *tfd_tmp;
  312. u32 num_tbs;
  313. q = &txq->q;
  314. tfd_tmp = (struct iwl_tfd *)txq->tfds;
  315. tfd = &tfd_tmp[q->write_ptr];
  316. if (reset)
  317. memset(tfd, 0, sizeof(*tfd));
  318. num_tbs = iwl_tfd_get_num_tbs(tfd);
  319. /* Each TFD can point to a maximum 20 Tx buffers */
  320. if (num_tbs >= IWL_NUM_OF_TBS) {
  321. IWL_ERR(priv, "Error can not send more than %d chunks\n",
  322. IWL_NUM_OF_TBS);
  323. return -EINVAL;
  324. }
  325. BUG_ON(addr & ~DMA_BIT_MASK(36));
  326. if (unlikely(addr & ~IWL_TX_DMA_MASK))
  327. IWL_ERR(priv, "Unaligned address = %llx\n",
  328. (unsigned long long)addr);
  329. iwl_tfd_set_tb(tfd, num_tbs, addr, len);
  330. return 0;
  331. }
  332. /*
  333. * Tell nic where to find circular buffer of Tx Frame Descriptors for
  334. * given Tx queue, and enable the DMA channel used for that queue.
  335. *
  336. * supports up to 16 Tx queues in DRAM, mapped to up to 8 Tx DMA
  337. * channels supported in hardware.
  338. */
  339. int iwl_hw_tx_queue_init(struct iwl_priv *priv,
  340. struct iwl_tx_queue *txq)
  341. {
  342. int txq_id = txq->q.id;
  343. /* Circular buffer (TFD queue in DRAM) physical base address */
  344. iwl_write_direct32(priv, FH_MEM_CBBC_QUEUE(txq_id),
  345. txq->q.dma_addr >> 8);
  346. return 0;
  347. }
  348. static void iwl_bg_beacon_update(struct work_struct *work)
  349. {
  350. struct iwl_priv *priv =
  351. container_of(work, struct iwl_priv, beacon_update);
  352. struct sk_buff *beacon;
  353. mutex_lock(&priv->mutex);
  354. if (!priv->beacon_ctx) {
  355. IWL_ERR(priv, "updating beacon w/o beacon context!\n");
  356. goto out;
  357. }
  358. if (priv->beacon_ctx->vif->type != NL80211_IFTYPE_AP) {
  359. /*
  360. * The ucode will send beacon notifications even in
  361. * IBSS mode, but we don't want to process them. But
  362. * we need to defer the type check to here due to
  363. * requiring locking around the beacon_ctx access.
  364. */
  365. goto out;
  366. }
  367. /* Pull updated AP beacon from mac80211. will fail if not in AP mode */
  368. beacon = ieee80211_beacon_get(priv->hw, priv->beacon_ctx->vif);
  369. if (!beacon) {
  370. IWL_ERR(priv, "update beacon failed -- keeping old\n");
  371. goto out;
  372. }
  373. /* new beacon skb is allocated every time; dispose previous.*/
  374. dev_kfree_skb(priv->beacon_skb);
  375. priv->beacon_skb = beacon;
  376. iwlagn_send_beacon_cmd(priv);
  377. out:
  378. mutex_unlock(&priv->mutex);
  379. }
  380. static void iwl_bg_bt_runtime_config(struct work_struct *work)
  381. {
  382. struct iwl_priv *priv =
  383. container_of(work, struct iwl_priv, bt_runtime_config);
  384. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  385. return;
  386. /* dont send host command if rf-kill is on */
  387. if (!iwl_is_ready_rf(priv))
  388. return;
  389. priv->cfg->ops->hcmd->send_bt_config(priv);
  390. }
  391. static void iwl_bg_bt_full_concurrency(struct work_struct *work)
  392. {
  393. struct iwl_priv *priv =
  394. container_of(work, struct iwl_priv, bt_full_concurrency);
  395. struct iwl_rxon_context *ctx;
  396. mutex_lock(&priv->mutex);
  397. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  398. goto out;
  399. /* dont send host command if rf-kill is on */
  400. if (!iwl_is_ready_rf(priv))
  401. goto out;
  402. IWL_DEBUG_INFO(priv, "BT coex in %s mode\n",
  403. priv->bt_full_concurrent ?
  404. "full concurrency" : "3-wire");
  405. /*
  406. * LQ & RXON updated cmds must be sent before BT Config cmd
  407. * to avoid 3-wire collisions
  408. */
  409. for_each_context(priv, ctx) {
  410. if (priv->cfg->ops->hcmd->set_rxon_chain)
  411. priv->cfg->ops->hcmd->set_rxon_chain(priv, ctx);
  412. iwlcore_commit_rxon(priv, ctx);
  413. }
  414. priv->cfg->ops->hcmd->send_bt_config(priv);
  415. out:
  416. mutex_unlock(&priv->mutex);
  417. }
  418. /**
  419. * iwl_bg_statistics_periodic - Timer callback to queue statistics
  420. *
  421. * This callback is provided in order to send a statistics request.
  422. *
  423. * This timer function is continually reset to execute within
  424. * REG_RECALIB_PERIOD seconds since the last STATISTICS_NOTIFICATION
  425. * was received. We need to ensure we receive the statistics in order
  426. * to update the temperature used for calibrating the TXPOWER.
  427. */
  428. static void iwl_bg_statistics_periodic(unsigned long data)
  429. {
  430. struct iwl_priv *priv = (struct iwl_priv *)data;
  431. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  432. return;
  433. /* dont send host command if rf-kill is on */
  434. if (!iwl_is_ready_rf(priv))
  435. return;
  436. iwl_send_statistics_request(priv, CMD_ASYNC, false);
  437. }
  438. static void iwl_print_cont_event_trace(struct iwl_priv *priv, u32 base,
  439. u32 start_idx, u32 num_events,
  440. u32 mode)
  441. {
  442. u32 i;
  443. u32 ptr; /* SRAM byte address of log data */
  444. u32 ev, time, data; /* event log data */
  445. unsigned long reg_flags;
  446. if (mode == 0)
  447. ptr = base + (4 * sizeof(u32)) + (start_idx * 2 * sizeof(u32));
  448. else
  449. ptr = base + (4 * sizeof(u32)) + (start_idx * 3 * sizeof(u32));
  450. /* Make sure device is powered up for SRAM reads */
  451. spin_lock_irqsave(&priv->reg_lock, reg_flags);
  452. if (iwl_grab_nic_access(priv)) {
  453. spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
  454. return;
  455. }
  456. /* Set starting address; reads will auto-increment */
  457. _iwl_write_direct32(priv, HBUS_TARG_MEM_RADDR, ptr);
  458. rmb();
  459. /*
  460. * "time" is actually "data" for mode 0 (no timestamp).
  461. * place event id # at far right for easier visual parsing.
  462. */
  463. for (i = 0; i < num_events; i++) {
  464. ev = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
  465. time = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
  466. if (mode == 0) {
  467. trace_iwlwifi_dev_ucode_cont_event(priv,
  468. 0, time, ev);
  469. } else {
  470. data = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
  471. trace_iwlwifi_dev_ucode_cont_event(priv,
  472. time, data, ev);
  473. }
  474. }
  475. /* Allow device to power down */
  476. iwl_release_nic_access(priv);
  477. spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
  478. }
  479. static void iwl_continuous_event_trace(struct iwl_priv *priv)
  480. {
  481. u32 capacity; /* event log capacity in # entries */
  482. u32 base; /* SRAM byte address of event log header */
  483. u32 mode; /* 0 - no timestamp, 1 - timestamp recorded */
  484. u32 num_wraps; /* # times uCode wrapped to top of log */
  485. u32 next_entry; /* index of next entry to be written by uCode */
  486. base = priv->device_pointers.error_event_table;
  487. if (priv->cfg->ops->lib->is_valid_rtc_data_addr(base)) {
  488. capacity = iwl_read_targ_mem(priv, base);
  489. num_wraps = iwl_read_targ_mem(priv, base + (2 * sizeof(u32)));
  490. mode = iwl_read_targ_mem(priv, base + (1 * sizeof(u32)));
  491. next_entry = iwl_read_targ_mem(priv, base + (3 * sizeof(u32)));
  492. } else
  493. return;
  494. if (num_wraps == priv->event_log.num_wraps) {
  495. iwl_print_cont_event_trace(priv,
  496. base, priv->event_log.next_entry,
  497. next_entry - priv->event_log.next_entry,
  498. mode);
  499. priv->event_log.non_wraps_count++;
  500. } else {
  501. if ((num_wraps - priv->event_log.num_wraps) > 1)
  502. priv->event_log.wraps_more_count++;
  503. else
  504. priv->event_log.wraps_once_count++;
  505. trace_iwlwifi_dev_ucode_wrap_event(priv,
  506. num_wraps - priv->event_log.num_wraps,
  507. next_entry, priv->event_log.next_entry);
  508. if (next_entry < priv->event_log.next_entry) {
  509. iwl_print_cont_event_trace(priv, base,
  510. priv->event_log.next_entry,
  511. capacity - priv->event_log.next_entry,
  512. mode);
  513. iwl_print_cont_event_trace(priv, base, 0,
  514. next_entry, mode);
  515. } else {
  516. iwl_print_cont_event_trace(priv, base,
  517. next_entry, capacity - next_entry,
  518. mode);
  519. iwl_print_cont_event_trace(priv, base, 0,
  520. next_entry, mode);
  521. }
  522. }
  523. priv->event_log.num_wraps = num_wraps;
  524. priv->event_log.next_entry = next_entry;
  525. }
  526. /**
  527. * iwl_bg_ucode_trace - Timer callback to log ucode event
  528. *
  529. * The timer is continually set to execute every
  530. * UCODE_TRACE_PERIOD milliseconds after the last timer expired
  531. * this function is to perform continuous uCode event logging operation
  532. * if enabled
  533. */
  534. static void iwl_bg_ucode_trace(unsigned long data)
  535. {
  536. struct iwl_priv *priv = (struct iwl_priv *)data;
  537. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  538. return;
  539. if (priv->event_log.ucode_trace) {
  540. iwl_continuous_event_trace(priv);
  541. /* Reschedule the timer to occur in UCODE_TRACE_PERIOD */
  542. mod_timer(&priv->ucode_trace,
  543. jiffies + msecs_to_jiffies(UCODE_TRACE_PERIOD));
  544. }
  545. }
  546. static void iwl_bg_tx_flush(struct work_struct *work)
  547. {
  548. struct iwl_priv *priv =
  549. container_of(work, struct iwl_priv, tx_flush);
  550. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  551. return;
  552. /* do nothing if rf-kill is on */
  553. if (!iwl_is_ready_rf(priv))
  554. return;
  555. if (priv->cfg->ops->lib->txfifo_flush) {
  556. IWL_DEBUG_INFO(priv, "device request: flush all tx frames\n");
  557. iwlagn_dev_txfifo_flush(priv, IWL_DROP_ALL);
  558. }
  559. }
  560. /**
  561. * iwl_rx_handle - Main entry function for receiving responses from uCode
  562. *
  563. * Uses the priv->rx_handlers callback function array to invoke
  564. * the appropriate handlers, including command responses,
  565. * frame-received notifications, and other notifications.
  566. */
  567. static void iwl_rx_handle(struct iwl_priv *priv)
  568. {
  569. struct iwl_rx_mem_buffer *rxb;
  570. struct iwl_rx_packet *pkt;
  571. struct iwl_rx_queue *rxq = &priv->rxq;
  572. u32 r, i;
  573. int reclaim;
  574. unsigned long flags;
  575. u8 fill_rx = 0;
  576. u32 count = 8;
  577. int total_empty;
  578. /* uCode's read index (stored in shared DRAM) indicates the last Rx
  579. * buffer that the driver may process (last buffer filled by ucode). */
  580. r = le16_to_cpu(rxq->rb_stts->closed_rb_num) & 0x0FFF;
  581. i = rxq->read;
  582. /* Rx interrupt, but nothing sent from uCode */
  583. if (i == r)
  584. IWL_DEBUG_RX(priv, "r = %d, i = %d\n", r, i);
  585. /* calculate total frames need to be restock after handling RX */
  586. total_empty = r - rxq->write_actual;
  587. if (total_empty < 0)
  588. total_empty += RX_QUEUE_SIZE;
  589. if (total_empty > (RX_QUEUE_SIZE / 2))
  590. fill_rx = 1;
  591. while (i != r) {
  592. int len;
  593. rxb = rxq->queue[i];
  594. /* If an RXB doesn't have a Rx queue slot associated with it,
  595. * then a bug has been introduced in the queue refilling
  596. * routines -- catch it here */
  597. BUG_ON(rxb == NULL);
  598. rxq->queue[i] = NULL;
  599. pci_unmap_page(priv->pci_dev, rxb->page_dma,
  600. PAGE_SIZE << priv->hw_params.rx_page_order,
  601. PCI_DMA_FROMDEVICE);
  602. pkt = rxb_addr(rxb);
  603. len = le32_to_cpu(pkt->len_n_flags) & FH_RSCSR_FRAME_SIZE_MSK;
  604. len += sizeof(u32); /* account for status word */
  605. trace_iwlwifi_dev_rx(priv, pkt, len);
  606. /* Reclaim a command buffer only if this packet is a response
  607. * to a (driver-originated) command.
  608. * If the packet (e.g. Rx frame) originated from uCode,
  609. * there is no command buffer to reclaim.
  610. * Ucode should set SEQ_RX_FRAME bit if ucode-originated,
  611. * but apparently a few don't get set; catch them here. */
  612. reclaim = !(pkt->hdr.sequence & SEQ_RX_FRAME) &&
  613. (pkt->hdr.cmd != REPLY_RX_PHY_CMD) &&
  614. (pkt->hdr.cmd != REPLY_RX) &&
  615. (pkt->hdr.cmd != REPLY_RX_MPDU_CMD) &&
  616. (pkt->hdr.cmd != REPLY_COMPRESSED_BA) &&
  617. (pkt->hdr.cmd != STATISTICS_NOTIFICATION) &&
  618. (pkt->hdr.cmd != REPLY_TX);
  619. /*
  620. * Do the notification wait before RX handlers so
  621. * even if the RX handler consumes the RXB we have
  622. * access to it in the notification wait entry.
  623. */
  624. if (!list_empty(&priv->_agn.notif_waits)) {
  625. struct iwl_notification_wait *w;
  626. spin_lock(&priv->_agn.notif_wait_lock);
  627. list_for_each_entry(w, &priv->_agn.notif_waits, list) {
  628. if (w->cmd == pkt->hdr.cmd) {
  629. w->triggered = true;
  630. if (w->fn)
  631. w->fn(priv, pkt);
  632. }
  633. }
  634. spin_unlock(&priv->_agn.notif_wait_lock);
  635. wake_up_all(&priv->_agn.notif_waitq);
  636. }
  637. /* Based on type of command response or notification,
  638. * handle those that need handling via function in
  639. * rx_handlers table. See iwl_setup_rx_handlers() */
  640. if (priv->rx_handlers[pkt->hdr.cmd]) {
  641. IWL_DEBUG_RX(priv, "r = %d, i = %d, %s, 0x%02x\n", r,
  642. i, get_cmd_string(pkt->hdr.cmd), pkt->hdr.cmd);
  643. priv->isr_stats.rx_handlers[pkt->hdr.cmd]++;
  644. priv->rx_handlers[pkt->hdr.cmd] (priv, rxb);
  645. } else {
  646. /* No handling needed */
  647. IWL_DEBUG_RX(priv,
  648. "r %d i %d No handler needed for %s, 0x%02x\n",
  649. r, i, get_cmd_string(pkt->hdr.cmd),
  650. pkt->hdr.cmd);
  651. }
  652. /*
  653. * XXX: After here, we should always check rxb->page
  654. * against NULL before touching it or its virtual
  655. * memory (pkt). Because some rx_handler might have
  656. * already taken or freed the pages.
  657. */
  658. if (reclaim) {
  659. /* Invoke any callbacks, transfer the buffer to caller,
  660. * and fire off the (possibly) blocking iwl_send_cmd()
  661. * as we reclaim the driver command queue */
  662. if (rxb->page)
  663. iwl_tx_cmd_complete(priv, rxb);
  664. else
  665. IWL_WARN(priv, "Claim null rxb?\n");
  666. }
  667. /* Reuse the page if possible. For notification packets and
  668. * SKBs that fail to Rx correctly, add them back into the
  669. * rx_free list for reuse later. */
  670. spin_lock_irqsave(&rxq->lock, flags);
  671. if (rxb->page != NULL) {
  672. rxb->page_dma = pci_map_page(priv->pci_dev, rxb->page,
  673. 0, PAGE_SIZE << priv->hw_params.rx_page_order,
  674. PCI_DMA_FROMDEVICE);
  675. list_add_tail(&rxb->list, &rxq->rx_free);
  676. rxq->free_count++;
  677. } else
  678. list_add_tail(&rxb->list, &rxq->rx_used);
  679. spin_unlock_irqrestore(&rxq->lock, flags);
  680. i = (i + 1) & RX_QUEUE_MASK;
  681. /* If there are a lot of unused frames,
  682. * restock the Rx queue so ucode wont assert. */
  683. if (fill_rx) {
  684. count++;
  685. if (count >= 8) {
  686. rxq->read = i;
  687. iwlagn_rx_replenish_now(priv);
  688. count = 0;
  689. }
  690. }
  691. }
  692. /* Backtrack one entry */
  693. rxq->read = i;
  694. if (fill_rx)
  695. iwlagn_rx_replenish_now(priv);
  696. else
  697. iwlagn_rx_queue_restock(priv);
  698. }
  699. /* call this function to flush any scheduled tasklet */
  700. static inline void iwl_synchronize_irq(struct iwl_priv *priv)
  701. {
  702. /* wait to make sure we flush pending tasklet*/
  703. synchronize_irq(priv->pci_dev->irq);
  704. tasklet_kill(&priv->irq_tasklet);
  705. }
  706. /* tasklet for iwlagn interrupt */
  707. static void iwl_irq_tasklet(struct iwl_priv *priv)
  708. {
  709. u32 inta = 0;
  710. u32 handled = 0;
  711. unsigned long flags;
  712. u32 i;
  713. #ifdef CONFIG_IWLWIFI_DEBUG
  714. u32 inta_mask;
  715. #endif
  716. spin_lock_irqsave(&priv->lock, flags);
  717. /* Ack/clear/reset pending uCode interrupts.
  718. * Note: Some bits in CSR_INT are "OR" of bits in CSR_FH_INT_STATUS,
  719. */
  720. /* There is a hardware bug in the interrupt mask function that some
  721. * interrupts (i.e. CSR_INT_BIT_SCD) can still be generated even if
  722. * they are disabled in the CSR_INT_MASK register. Furthermore the
  723. * ICT interrupt handling mechanism has another bug that might cause
  724. * these unmasked interrupts fail to be detected. We workaround the
  725. * hardware bugs here by ACKing all the possible interrupts so that
  726. * interrupt coalescing can still be achieved.
  727. */
  728. iwl_write32(priv, CSR_INT, priv->_agn.inta | ~priv->inta_mask);
  729. inta = priv->_agn.inta;
  730. #ifdef CONFIG_IWLWIFI_DEBUG
  731. if (iwl_get_debug_level(priv) & IWL_DL_ISR) {
  732. /* just for debug */
  733. inta_mask = iwl_read32(priv, CSR_INT_MASK);
  734. IWL_DEBUG_ISR(priv, "inta 0x%08x, enabled 0x%08x\n ",
  735. inta, inta_mask);
  736. }
  737. #endif
  738. spin_unlock_irqrestore(&priv->lock, flags);
  739. /* saved interrupt in inta variable now we can reset priv->_agn.inta */
  740. priv->_agn.inta = 0;
  741. /* Now service all interrupt bits discovered above. */
  742. if (inta & CSR_INT_BIT_HW_ERR) {
  743. IWL_ERR(priv, "Hardware error detected. Restarting.\n");
  744. /* Tell the device to stop sending interrupts */
  745. iwl_disable_interrupts(priv);
  746. priv->isr_stats.hw++;
  747. iwl_irq_handle_error(priv);
  748. handled |= CSR_INT_BIT_HW_ERR;
  749. return;
  750. }
  751. #ifdef CONFIG_IWLWIFI_DEBUG
  752. if (iwl_get_debug_level(priv) & (IWL_DL_ISR)) {
  753. /* NIC fires this, but we don't use it, redundant with WAKEUP */
  754. if (inta & CSR_INT_BIT_SCD) {
  755. IWL_DEBUG_ISR(priv, "Scheduler finished to transmit "
  756. "the frame/frames.\n");
  757. priv->isr_stats.sch++;
  758. }
  759. /* Alive notification via Rx interrupt will do the real work */
  760. if (inta & CSR_INT_BIT_ALIVE) {
  761. IWL_DEBUG_ISR(priv, "Alive interrupt\n");
  762. priv->isr_stats.alive++;
  763. }
  764. }
  765. #endif
  766. /* Safely ignore these bits for debug checks below */
  767. inta &= ~(CSR_INT_BIT_SCD | CSR_INT_BIT_ALIVE);
  768. /* HW RF KILL switch toggled */
  769. if (inta & CSR_INT_BIT_RF_KILL) {
  770. int hw_rf_kill = 0;
  771. if (!(iwl_read32(priv, CSR_GP_CNTRL) &
  772. CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW))
  773. hw_rf_kill = 1;
  774. IWL_WARN(priv, "RF_KILL bit toggled to %s.\n",
  775. hw_rf_kill ? "disable radio" : "enable radio");
  776. priv->isr_stats.rfkill++;
  777. /* driver only loads ucode once setting the interface up.
  778. * the driver allows loading the ucode even if the radio
  779. * is killed. Hence update the killswitch state here. The
  780. * rfkill handler will care about restarting if needed.
  781. */
  782. if (!test_bit(STATUS_ALIVE, &priv->status)) {
  783. if (hw_rf_kill)
  784. set_bit(STATUS_RF_KILL_HW, &priv->status);
  785. else
  786. clear_bit(STATUS_RF_KILL_HW, &priv->status);
  787. wiphy_rfkill_set_hw_state(priv->hw->wiphy, hw_rf_kill);
  788. }
  789. handled |= CSR_INT_BIT_RF_KILL;
  790. }
  791. /* Chip got too hot and stopped itself */
  792. if (inta & CSR_INT_BIT_CT_KILL) {
  793. IWL_ERR(priv, "Microcode CT kill error detected.\n");
  794. priv->isr_stats.ctkill++;
  795. handled |= CSR_INT_BIT_CT_KILL;
  796. }
  797. /* Error detected by uCode */
  798. if (inta & CSR_INT_BIT_SW_ERR) {
  799. IWL_ERR(priv, "Microcode SW error detected. "
  800. " Restarting 0x%X.\n", inta);
  801. priv->isr_stats.sw++;
  802. iwl_irq_handle_error(priv);
  803. handled |= CSR_INT_BIT_SW_ERR;
  804. }
  805. /* uCode wakes up after power-down sleep */
  806. if (inta & CSR_INT_BIT_WAKEUP) {
  807. IWL_DEBUG_ISR(priv, "Wakeup interrupt\n");
  808. iwl_rx_queue_update_write_ptr(priv, &priv->rxq);
  809. for (i = 0; i < priv->hw_params.max_txq_num; i++)
  810. iwl_txq_update_write_ptr(priv, &priv->txq[i]);
  811. priv->isr_stats.wakeup++;
  812. handled |= CSR_INT_BIT_WAKEUP;
  813. }
  814. /* All uCode command responses, including Tx command responses,
  815. * Rx "responses" (frame-received notification), and other
  816. * notifications from uCode come through here*/
  817. if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX |
  818. CSR_INT_BIT_RX_PERIODIC)) {
  819. IWL_DEBUG_ISR(priv, "Rx interrupt\n");
  820. if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX)) {
  821. handled |= (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX);
  822. iwl_write32(priv, CSR_FH_INT_STATUS,
  823. CSR_FH_INT_RX_MASK);
  824. }
  825. if (inta & CSR_INT_BIT_RX_PERIODIC) {
  826. handled |= CSR_INT_BIT_RX_PERIODIC;
  827. iwl_write32(priv, CSR_INT, CSR_INT_BIT_RX_PERIODIC);
  828. }
  829. /* Sending RX interrupt require many steps to be done in the
  830. * the device:
  831. * 1- write interrupt to current index in ICT table.
  832. * 2- dma RX frame.
  833. * 3- update RX shared data to indicate last write index.
  834. * 4- send interrupt.
  835. * This could lead to RX race, driver could receive RX interrupt
  836. * but the shared data changes does not reflect this;
  837. * periodic interrupt will detect any dangling Rx activity.
  838. */
  839. /* Disable periodic interrupt; we use it as just a one-shot. */
  840. iwl_write8(priv, CSR_INT_PERIODIC_REG,
  841. CSR_INT_PERIODIC_DIS);
  842. iwl_rx_handle(priv);
  843. /*
  844. * Enable periodic interrupt in 8 msec only if we received
  845. * real RX interrupt (instead of just periodic int), to catch
  846. * any dangling Rx interrupt. If it was just the periodic
  847. * interrupt, there was no dangling Rx activity, and no need
  848. * to extend the periodic interrupt; one-shot is enough.
  849. */
  850. if (inta & (CSR_INT_BIT_FH_RX | CSR_INT_BIT_SW_RX))
  851. iwl_write8(priv, CSR_INT_PERIODIC_REG,
  852. CSR_INT_PERIODIC_ENA);
  853. priv->isr_stats.rx++;
  854. }
  855. /* This "Tx" DMA channel is used only for loading uCode */
  856. if (inta & CSR_INT_BIT_FH_TX) {
  857. iwl_write32(priv, CSR_FH_INT_STATUS, CSR_FH_INT_TX_MASK);
  858. IWL_DEBUG_ISR(priv, "uCode load interrupt\n");
  859. priv->isr_stats.tx++;
  860. handled |= CSR_INT_BIT_FH_TX;
  861. /* Wake up uCode load routine, now that load is complete */
  862. priv->ucode_write_complete = 1;
  863. wake_up_interruptible(&priv->wait_command_queue);
  864. }
  865. if (inta & ~handled) {
  866. IWL_ERR(priv, "Unhandled INTA bits 0x%08x\n", inta & ~handled);
  867. priv->isr_stats.unhandled++;
  868. }
  869. if (inta & ~(priv->inta_mask)) {
  870. IWL_WARN(priv, "Disabled INTA bits 0x%08x were pending\n",
  871. inta & ~priv->inta_mask);
  872. }
  873. /* Re-enable all interrupts */
  874. /* only Re-enable if disabled by irq */
  875. if (test_bit(STATUS_INT_ENABLED, &priv->status))
  876. iwl_enable_interrupts(priv);
  877. /* Re-enable RF_KILL if it occurred */
  878. else if (handled & CSR_INT_BIT_RF_KILL)
  879. iwl_enable_rfkill_int(priv);
  880. }
  881. /*****************************************************************************
  882. *
  883. * sysfs attributes
  884. *
  885. *****************************************************************************/
  886. #ifdef CONFIG_IWLWIFI_DEBUG
  887. /*
  888. * The following adds a new attribute to the sysfs representation
  889. * of this device driver (i.e. a new file in /sys/class/net/wlan0/device/)
  890. * used for controlling the debug level.
  891. *
  892. * See the level definitions in iwl for details.
  893. *
  894. * The debug_level being managed using sysfs below is a per device debug
  895. * level that is used instead of the global debug level if it (the per
  896. * device debug level) is set.
  897. */
  898. static ssize_t show_debug_level(struct device *d,
  899. struct device_attribute *attr, char *buf)
  900. {
  901. struct iwl_priv *priv = dev_get_drvdata(d);
  902. return sprintf(buf, "0x%08X\n", iwl_get_debug_level(priv));
  903. }
  904. static ssize_t store_debug_level(struct device *d,
  905. struct device_attribute *attr,
  906. const char *buf, size_t count)
  907. {
  908. struct iwl_priv *priv = dev_get_drvdata(d);
  909. unsigned long val;
  910. int ret;
  911. ret = strict_strtoul(buf, 0, &val);
  912. if (ret)
  913. IWL_ERR(priv, "%s is not in hex or decimal form.\n", buf);
  914. else {
  915. priv->debug_level = val;
  916. if (iwl_alloc_traffic_mem(priv))
  917. IWL_ERR(priv,
  918. "Not enough memory to generate traffic log\n");
  919. }
  920. return strnlen(buf, count);
  921. }
  922. static DEVICE_ATTR(debug_level, S_IWUSR | S_IRUGO,
  923. show_debug_level, store_debug_level);
  924. #endif /* CONFIG_IWLWIFI_DEBUG */
  925. static ssize_t show_temperature(struct device *d,
  926. struct device_attribute *attr, char *buf)
  927. {
  928. struct iwl_priv *priv = dev_get_drvdata(d);
  929. if (!iwl_is_alive(priv))
  930. return -EAGAIN;
  931. return sprintf(buf, "%d\n", priv->temperature);
  932. }
  933. static DEVICE_ATTR(temperature, S_IRUGO, show_temperature, NULL);
  934. static ssize_t show_tx_power(struct device *d,
  935. struct device_attribute *attr, char *buf)
  936. {
  937. struct iwl_priv *priv = dev_get_drvdata(d);
  938. if (!iwl_is_ready_rf(priv))
  939. return sprintf(buf, "off\n");
  940. else
  941. return sprintf(buf, "%d\n", priv->tx_power_user_lmt);
  942. }
  943. static ssize_t store_tx_power(struct device *d,
  944. struct device_attribute *attr,
  945. const char *buf, size_t count)
  946. {
  947. struct iwl_priv *priv = dev_get_drvdata(d);
  948. unsigned long val;
  949. int ret;
  950. ret = strict_strtoul(buf, 10, &val);
  951. if (ret)
  952. IWL_INFO(priv, "%s is not in decimal form.\n", buf);
  953. else {
  954. ret = iwl_set_tx_power(priv, val, false);
  955. if (ret)
  956. IWL_ERR(priv, "failed setting tx power (0x%d).\n",
  957. ret);
  958. else
  959. ret = count;
  960. }
  961. return ret;
  962. }
  963. static DEVICE_ATTR(tx_power, S_IWUSR | S_IRUGO, show_tx_power, store_tx_power);
  964. static struct attribute *iwl_sysfs_entries[] = {
  965. &dev_attr_temperature.attr,
  966. &dev_attr_tx_power.attr,
  967. #ifdef CONFIG_IWLWIFI_DEBUG
  968. &dev_attr_debug_level.attr,
  969. #endif
  970. NULL
  971. };
  972. static struct attribute_group iwl_attribute_group = {
  973. .name = NULL, /* put in device directory */
  974. .attrs = iwl_sysfs_entries,
  975. };
  976. /******************************************************************************
  977. *
  978. * uCode download functions
  979. *
  980. ******************************************************************************/
  981. static void iwl_dealloc_ucode_pci(struct iwl_priv *priv)
  982. {
  983. iwl_free_fw_desc(priv->pci_dev, &priv->ucode_code);
  984. iwl_free_fw_desc(priv->pci_dev, &priv->ucode_data);
  985. iwl_free_fw_desc(priv->pci_dev, &priv->ucode_init);
  986. iwl_free_fw_desc(priv->pci_dev, &priv->ucode_init_data);
  987. }
  988. static void iwl_nic_start(struct iwl_priv *priv)
  989. {
  990. /* Remove all resets to allow NIC to operate */
  991. iwl_write32(priv, CSR_RESET, 0);
  992. }
  993. struct iwlagn_ucode_capabilities {
  994. u32 max_probe_length;
  995. u32 standard_phy_calibration_size;
  996. u32 flags;
  997. };
  998. static void iwl_ucode_callback(const struct firmware *ucode_raw, void *context);
  999. static int iwl_mac_setup_register(struct iwl_priv *priv,
  1000. struct iwlagn_ucode_capabilities *capa);
  1001. #define UCODE_EXPERIMENTAL_INDEX 100
  1002. #define UCODE_EXPERIMENTAL_TAG "exp"
  1003. static int __must_check iwl_request_firmware(struct iwl_priv *priv, bool first)
  1004. {
  1005. const char *name_pre = priv->cfg->fw_name_pre;
  1006. char tag[8];
  1007. if (first) {
  1008. #ifdef CONFIG_IWLWIFI_DEBUG_EXPERIMENTAL_UCODE
  1009. priv->fw_index = UCODE_EXPERIMENTAL_INDEX;
  1010. strcpy(tag, UCODE_EXPERIMENTAL_TAG);
  1011. } else if (priv->fw_index == UCODE_EXPERIMENTAL_INDEX) {
  1012. #endif
  1013. priv->fw_index = priv->cfg->ucode_api_max;
  1014. sprintf(tag, "%d", priv->fw_index);
  1015. } else {
  1016. priv->fw_index--;
  1017. sprintf(tag, "%d", priv->fw_index);
  1018. }
  1019. if (priv->fw_index < priv->cfg->ucode_api_min) {
  1020. IWL_ERR(priv, "no suitable firmware found!\n");
  1021. return -ENOENT;
  1022. }
  1023. sprintf(priv->firmware_name, "%s%s%s", name_pre, tag, ".ucode");
  1024. IWL_DEBUG_INFO(priv, "attempting to load firmware %s'%s'\n",
  1025. (priv->fw_index == UCODE_EXPERIMENTAL_INDEX)
  1026. ? "EXPERIMENTAL " : "",
  1027. priv->firmware_name);
  1028. return request_firmware_nowait(THIS_MODULE, 1, priv->firmware_name,
  1029. &priv->pci_dev->dev, GFP_KERNEL, priv,
  1030. iwl_ucode_callback);
  1031. }
  1032. struct iwlagn_firmware_pieces {
  1033. const void *inst, *data, *init, *init_data;
  1034. size_t inst_size, data_size, init_size, init_data_size;
  1035. u32 build;
  1036. u32 init_evtlog_ptr, init_evtlog_size, init_errlog_ptr;
  1037. u32 inst_evtlog_ptr, inst_evtlog_size, inst_errlog_ptr;
  1038. };
  1039. static int iwlagn_load_legacy_firmware(struct iwl_priv *priv,
  1040. const struct firmware *ucode_raw,
  1041. struct iwlagn_firmware_pieces *pieces)
  1042. {
  1043. struct iwl_ucode_header *ucode = (void *)ucode_raw->data;
  1044. u32 api_ver, hdr_size;
  1045. const u8 *src;
  1046. priv->ucode_ver = le32_to_cpu(ucode->ver);
  1047. api_ver = IWL_UCODE_API(priv->ucode_ver);
  1048. switch (api_ver) {
  1049. default:
  1050. hdr_size = 28;
  1051. if (ucode_raw->size < hdr_size) {
  1052. IWL_ERR(priv, "File size too small!\n");
  1053. return -EINVAL;
  1054. }
  1055. pieces->build = le32_to_cpu(ucode->u.v2.build);
  1056. pieces->inst_size = le32_to_cpu(ucode->u.v2.inst_size);
  1057. pieces->data_size = le32_to_cpu(ucode->u.v2.data_size);
  1058. pieces->init_size = le32_to_cpu(ucode->u.v2.init_size);
  1059. pieces->init_data_size = le32_to_cpu(ucode->u.v2.init_data_size);
  1060. src = ucode->u.v2.data;
  1061. break;
  1062. case 0:
  1063. case 1:
  1064. case 2:
  1065. hdr_size = 24;
  1066. if (ucode_raw->size < hdr_size) {
  1067. IWL_ERR(priv, "File size too small!\n");
  1068. return -EINVAL;
  1069. }
  1070. pieces->build = 0;
  1071. pieces->inst_size = le32_to_cpu(ucode->u.v1.inst_size);
  1072. pieces->data_size = le32_to_cpu(ucode->u.v1.data_size);
  1073. pieces->init_size = le32_to_cpu(ucode->u.v1.init_size);
  1074. pieces->init_data_size = le32_to_cpu(ucode->u.v1.init_data_size);
  1075. src = ucode->u.v1.data;
  1076. break;
  1077. }
  1078. /* Verify size of file vs. image size info in file's header */
  1079. if (ucode_raw->size != hdr_size + pieces->inst_size +
  1080. pieces->data_size + pieces->init_size +
  1081. pieces->init_data_size) {
  1082. IWL_ERR(priv,
  1083. "uCode file size %d does not match expected size\n",
  1084. (int)ucode_raw->size);
  1085. return -EINVAL;
  1086. }
  1087. pieces->inst = src;
  1088. src += pieces->inst_size;
  1089. pieces->data = src;
  1090. src += pieces->data_size;
  1091. pieces->init = src;
  1092. src += pieces->init_size;
  1093. pieces->init_data = src;
  1094. src += pieces->init_data_size;
  1095. return 0;
  1096. }
  1097. static int iwlagn_wanted_ucode_alternative = 1;
  1098. static int iwlagn_load_firmware(struct iwl_priv *priv,
  1099. const struct firmware *ucode_raw,
  1100. struct iwlagn_firmware_pieces *pieces,
  1101. struct iwlagn_ucode_capabilities *capa)
  1102. {
  1103. struct iwl_tlv_ucode_header *ucode = (void *)ucode_raw->data;
  1104. struct iwl_ucode_tlv *tlv;
  1105. size_t len = ucode_raw->size;
  1106. const u8 *data;
  1107. int wanted_alternative = iwlagn_wanted_ucode_alternative, tmp;
  1108. u64 alternatives;
  1109. u32 tlv_len;
  1110. enum iwl_ucode_tlv_type tlv_type;
  1111. const u8 *tlv_data;
  1112. if (len < sizeof(*ucode)) {
  1113. IWL_ERR(priv, "uCode has invalid length: %zd\n", len);
  1114. return -EINVAL;
  1115. }
  1116. if (ucode->magic != cpu_to_le32(IWL_TLV_UCODE_MAGIC)) {
  1117. IWL_ERR(priv, "invalid uCode magic: 0X%x\n",
  1118. le32_to_cpu(ucode->magic));
  1119. return -EINVAL;
  1120. }
  1121. /*
  1122. * Check which alternatives are present, and "downgrade"
  1123. * when the chosen alternative is not present, warning
  1124. * the user when that happens. Some files may not have
  1125. * any alternatives, so don't warn in that case.
  1126. */
  1127. alternatives = le64_to_cpu(ucode->alternatives);
  1128. tmp = wanted_alternative;
  1129. if (wanted_alternative > 63)
  1130. wanted_alternative = 63;
  1131. while (wanted_alternative && !(alternatives & BIT(wanted_alternative)))
  1132. wanted_alternative--;
  1133. if (wanted_alternative && wanted_alternative != tmp)
  1134. IWL_WARN(priv,
  1135. "uCode alternative %d not available, choosing %d\n",
  1136. tmp, wanted_alternative);
  1137. priv->ucode_ver = le32_to_cpu(ucode->ver);
  1138. pieces->build = le32_to_cpu(ucode->build);
  1139. data = ucode->data;
  1140. len -= sizeof(*ucode);
  1141. while (len >= sizeof(*tlv)) {
  1142. u16 tlv_alt;
  1143. len -= sizeof(*tlv);
  1144. tlv = (void *)data;
  1145. tlv_len = le32_to_cpu(tlv->length);
  1146. tlv_type = le16_to_cpu(tlv->type);
  1147. tlv_alt = le16_to_cpu(tlv->alternative);
  1148. tlv_data = tlv->data;
  1149. if (len < tlv_len) {
  1150. IWL_ERR(priv, "invalid TLV len: %zd/%u\n",
  1151. len, tlv_len);
  1152. return -EINVAL;
  1153. }
  1154. len -= ALIGN(tlv_len, 4);
  1155. data += sizeof(*tlv) + ALIGN(tlv_len, 4);
  1156. /*
  1157. * Alternative 0 is always valid.
  1158. *
  1159. * Skip alternative TLVs that are not selected.
  1160. */
  1161. if (tlv_alt != 0 && tlv_alt != wanted_alternative)
  1162. continue;
  1163. switch (tlv_type) {
  1164. case IWL_UCODE_TLV_INST:
  1165. pieces->inst = tlv_data;
  1166. pieces->inst_size = tlv_len;
  1167. break;
  1168. case IWL_UCODE_TLV_DATA:
  1169. pieces->data = tlv_data;
  1170. pieces->data_size = tlv_len;
  1171. break;
  1172. case IWL_UCODE_TLV_INIT:
  1173. pieces->init = tlv_data;
  1174. pieces->init_size = tlv_len;
  1175. break;
  1176. case IWL_UCODE_TLV_INIT_DATA:
  1177. pieces->init_data = tlv_data;
  1178. pieces->init_data_size = tlv_len;
  1179. break;
  1180. case IWL_UCODE_TLV_BOOT:
  1181. IWL_ERR(priv, "Found unexpected BOOT ucode\n");
  1182. break;
  1183. case IWL_UCODE_TLV_PROBE_MAX_LEN:
  1184. if (tlv_len != sizeof(u32))
  1185. goto invalid_tlv_len;
  1186. capa->max_probe_length =
  1187. le32_to_cpup((__le32 *)tlv_data);
  1188. break;
  1189. case IWL_UCODE_TLV_PAN:
  1190. if (tlv_len)
  1191. goto invalid_tlv_len;
  1192. capa->flags |= IWL_UCODE_TLV_FLAGS_PAN;
  1193. break;
  1194. case IWL_UCODE_TLV_FLAGS:
  1195. /* must be at least one u32 */
  1196. if (tlv_len < sizeof(u32))
  1197. goto invalid_tlv_len;
  1198. /* and a proper number of u32s */
  1199. if (tlv_len % sizeof(u32))
  1200. goto invalid_tlv_len;
  1201. /*
  1202. * This driver only reads the first u32 as
  1203. * right now no more features are defined,
  1204. * if that changes then either the driver
  1205. * will not work with the new firmware, or
  1206. * it'll not take advantage of new features.
  1207. */
  1208. capa->flags = le32_to_cpup((__le32 *)tlv_data);
  1209. break;
  1210. case IWL_UCODE_TLV_INIT_EVTLOG_PTR:
  1211. if (tlv_len != sizeof(u32))
  1212. goto invalid_tlv_len;
  1213. pieces->init_evtlog_ptr =
  1214. le32_to_cpup((__le32 *)tlv_data);
  1215. break;
  1216. case IWL_UCODE_TLV_INIT_EVTLOG_SIZE:
  1217. if (tlv_len != sizeof(u32))
  1218. goto invalid_tlv_len;
  1219. pieces->init_evtlog_size =
  1220. le32_to_cpup((__le32 *)tlv_data);
  1221. break;
  1222. case IWL_UCODE_TLV_INIT_ERRLOG_PTR:
  1223. if (tlv_len != sizeof(u32))
  1224. goto invalid_tlv_len;
  1225. pieces->init_errlog_ptr =
  1226. le32_to_cpup((__le32 *)tlv_data);
  1227. break;
  1228. case IWL_UCODE_TLV_RUNT_EVTLOG_PTR:
  1229. if (tlv_len != sizeof(u32))
  1230. goto invalid_tlv_len;
  1231. pieces->inst_evtlog_ptr =
  1232. le32_to_cpup((__le32 *)tlv_data);
  1233. break;
  1234. case IWL_UCODE_TLV_RUNT_EVTLOG_SIZE:
  1235. if (tlv_len != sizeof(u32))
  1236. goto invalid_tlv_len;
  1237. pieces->inst_evtlog_size =
  1238. le32_to_cpup((__le32 *)tlv_data);
  1239. break;
  1240. case IWL_UCODE_TLV_RUNT_ERRLOG_PTR:
  1241. if (tlv_len != sizeof(u32))
  1242. goto invalid_tlv_len;
  1243. pieces->inst_errlog_ptr =
  1244. le32_to_cpup((__le32 *)tlv_data);
  1245. break;
  1246. case IWL_UCODE_TLV_ENHANCE_SENS_TBL:
  1247. if (tlv_len)
  1248. goto invalid_tlv_len;
  1249. priv->enhance_sensitivity_table = true;
  1250. break;
  1251. case IWL_UCODE_TLV_PHY_CALIBRATION_SIZE:
  1252. if (tlv_len != sizeof(u32))
  1253. goto invalid_tlv_len;
  1254. capa->standard_phy_calibration_size =
  1255. le32_to_cpup((__le32 *)tlv_data);
  1256. break;
  1257. default:
  1258. IWL_WARN(priv, "unknown TLV: %d\n", tlv_type);
  1259. break;
  1260. }
  1261. }
  1262. if (len) {
  1263. IWL_ERR(priv, "invalid TLV after parsing: %zd\n", len);
  1264. iwl_print_hex_dump(priv, IWL_DL_FW, (u8 *)data, len);
  1265. return -EINVAL;
  1266. }
  1267. return 0;
  1268. invalid_tlv_len:
  1269. IWL_ERR(priv, "TLV %d has invalid size: %u\n", tlv_type, tlv_len);
  1270. iwl_print_hex_dump(priv, IWL_DL_FW, tlv_data, tlv_len);
  1271. return -EINVAL;
  1272. }
  1273. /**
  1274. * iwl_ucode_callback - callback when firmware was loaded
  1275. *
  1276. * If loaded successfully, copies the firmware into buffers
  1277. * for the card to fetch (via DMA).
  1278. */
  1279. static void iwl_ucode_callback(const struct firmware *ucode_raw, void *context)
  1280. {
  1281. struct iwl_priv *priv = context;
  1282. struct iwl_ucode_header *ucode;
  1283. int err;
  1284. struct iwlagn_firmware_pieces pieces;
  1285. const unsigned int api_max = priv->cfg->ucode_api_max;
  1286. const unsigned int api_min = priv->cfg->ucode_api_min;
  1287. u32 api_ver;
  1288. char buildstr[25];
  1289. u32 build;
  1290. struct iwlagn_ucode_capabilities ucode_capa = {
  1291. .max_probe_length = 200,
  1292. .standard_phy_calibration_size =
  1293. IWL_DEFAULT_STANDARD_PHY_CALIBRATE_TBL_SIZE,
  1294. };
  1295. memset(&pieces, 0, sizeof(pieces));
  1296. if (!ucode_raw) {
  1297. if (priv->fw_index <= priv->cfg->ucode_api_max)
  1298. IWL_ERR(priv,
  1299. "request for firmware file '%s' failed.\n",
  1300. priv->firmware_name);
  1301. goto try_again;
  1302. }
  1303. IWL_DEBUG_INFO(priv, "Loaded firmware file '%s' (%zd bytes).\n",
  1304. priv->firmware_name, ucode_raw->size);
  1305. /* Make sure that we got at least the API version number */
  1306. if (ucode_raw->size < 4) {
  1307. IWL_ERR(priv, "File size way too small!\n");
  1308. goto try_again;
  1309. }
  1310. /* Data from ucode file: header followed by uCode images */
  1311. ucode = (struct iwl_ucode_header *)ucode_raw->data;
  1312. if (ucode->ver)
  1313. err = iwlagn_load_legacy_firmware(priv, ucode_raw, &pieces);
  1314. else
  1315. err = iwlagn_load_firmware(priv, ucode_raw, &pieces,
  1316. &ucode_capa);
  1317. if (err)
  1318. goto try_again;
  1319. api_ver = IWL_UCODE_API(priv->ucode_ver);
  1320. build = pieces.build;
  1321. /*
  1322. * api_ver should match the api version forming part of the
  1323. * firmware filename ... but we don't check for that and only rely
  1324. * on the API version read from firmware header from here on forward
  1325. */
  1326. /* no api version check required for experimental uCode */
  1327. if (priv->fw_index != UCODE_EXPERIMENTAL_INDEX) {
  1328. if (api_ver < api_min || api_ver > api_max) {
  1329. IWL_ERR(priv,
  1330. "Driver unable to support your firmware API. "
  1331. "Driver supports v%u, firmware is v%u.\n",
  1332. api_max, api_ver);
  1333. goto try_again;
  1334. }
  1335. if (api_ver != api_max)
  1336. IWL_ERR(priv,
  1337. "Firmware has old API version. Expected v%u, "
  1338. "got v%u. New firmware can be obtained "
  1339. "from http://www.intellinuxwireless.org.\n",
  1340. api_max, api_ver);
  1341. }
  1342. if (build)
  1343. sprintf(buildstr, " build %u%s", build,
  1344. (priv->fw_index == UCODE_EXPERIMENTAL_INDEX)
  1345. ? " (EXP)" : "");
  1346. else
  1347. buildstr[0] = '\0';
  1348. IWL_INFO(priv, "loaded firmware version %u.%u.%u.%u%s\n",
  1349. IWL_UCODE_MAJOR(priv->ucode_ver),
  1350. IWL_UCODE_MINOR(priv->ucode_ver),
  1351. IWL_UCODE_API(priv->ucode_ver),
  1352. IWL_UCODE_SERIAL(priv->ucode_ver),
  1353. buildstr);
  1354. snprintf(priv->hw->wiphy->fw_version,
  1355. sizeof(priv->hw->wiphy->fw_version),
  1356. "%u.%u.%u.%u%s",
  1357. IWL_UCODE_MAJOR(priv->ucode_ver),
  1358. IWL_UCODE_MINOR(priv->ucode_ver),
  1359. IWL_UCODE_API(priv->ucode_ver),
  1360. IWL_UCODE_SERIAL(priv->ucode_ver),
  1361. buildstr);
  1362. /*
  1363. * For any of the failures below (before allocating pci memory)
  1364. * we will try to load a version with a smaller API -- maybe the
  1365. * user just got a corrupted version of the latest API.
  1366. */
  1367. IWL_DEBUG_INFO(priv, "f/w package hdr ucode version raw = 0x%x\n",
  1368. priv->ucode_ver);
  1369. IWL_DEBUG_INFO(priv, "f/w package hdr runtime inst size = %Zd\n",
  1370. pieces.inst_size);
  1371. IWL_DEBUG_INFO(priv, "f/w package hdr runtime data size = %Zd\n",
  1372. pieces.data_size);
  1373. IWL_DEBUG_INFO(priv, "f/w package hdr init inst size = %Zd\n",
  1374. pieces.init_size);
  1375. IWL_DEBUG_INFO(priv, "f/w package hdr init data size = %Zd\n",
  1376. pieces.init_data_size);
  1377. /* Verify that uCode images will fit in card's SRAM */
  1378. if (pieces.inst_size > priv->hw_params.max_inst_size) {
  1379. IWL_ERR(priv, "uCode instr len %Zd too large to fit in\n",
  1380. pieces.inst_size);
  1381. goto try_again;
  1382. }
  1383. if (pieces.data_size > priv->hw_params.max_data_size) {
  1384. IWL_ERR(priv, "uCode data len %Zd too large to fit in\n",
  1385. pieces.data_size);
  1386. goto try_again;
  1387. }
  1388. if (pieces.init_size > priv->hw_params.max_inst_size) {
  1389. IWL_ERR(priv, "uCode init instr len %Zd too large to fit in\n",
  1390. pieces.init_size);
  1391. goto try_again;
  1392. }
  1393. if (pieces.init_data_size > priv->hw_params.max_data_size) {
  1394. IWL_ERR(priv, "uCode init data len %Zd too large to fit in\n",
  1395. pieces.init_data_size);
  1396. goto try_again;
  1397. }
  1398. /* Allocate ucode buffers for card's bus-master loading ... */
  1399. /* Runtime instructions and 2 copies of data:
  1400. * 1) unmodified from disk
  1401. * 2) backup cache for save/restore during power-downs */
  1402. priv->ucode_code.len = pieces.inst_size;
  1403. iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_code);
  1404. priv->ucode_data.len = pieces.data_size;
  1405. iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_data);
  1406. if (!priv->ucode_code.v_addr || !priv->ucode_data.v_addr)
  1407. goto err_pci_alloc;
  1408. /* Initialization instructions and data */
  1409. if (pieces.init_size && pieces.init_data_size) {
  1410. priv->ucode_init.len = pieces.init_size;
  1411. iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_init);
  1412. priv->ucode_init_data.len = pieces.init_data_size;
  1413. iwl_alloc_fw_desc(priv->pci_dev, &priv->ucode_init_data);
  1414. if (!priv->ucode_init.v_addr || !priv->ucode_init_data.v_addr)
  1415. goto err_pci_alloc;
  1416. }
  1417. /* Now that we can no longer fail, copy information */
  1418. /*
  1419. * The (size - 16) / 12 formula is based on the information recorded
  1420. * for each event, which is of mode 1 (including timestamp) for all
  1421. * new microcodes that include this information.
  1422. */
  1423. priv->_agn.init_evtlog_ptr = pieces.init_evtlog_ptr;
  1424. if (pieces.init_evtlog_size)
  1425. priv->_agn.init_evtlog_size = (pieces.init_evtlog_size - 16)/12;
  1426. else
  1427. priv->_agn.init_evtlog_size =
  1428. priv->cfg->base_params->max_event_log_size;
  1429. priv->_agn.init_errlog_ptr = pieces.init_errlog_ptr;
  1430. priv->_agn.inst_evtlog_ptr = pieces.inst_evtlog_ptr;
  1431. if (pieces.inst_evtlog_size)
  1432. priv->_agn.inst_evtlog_size = (pieces.inst_evtlog_size - 16)/12;
  1433. else
  1434. priv->_agn.inst_evtlog_size =
  1435. priv->cfg->base_params->max_event_log_size;
  1436. priv->_agn.inst_errlog_ptr = pieces.inst_errlog_ptr;
  1437. if (ucode_capa.flags & IWL_UCODE_TLV_FLAGS_PAN) {
  1438. priv->valid_contexts |= BIT(IWL_RXON_CTX_PAN);
  1439. priv->sta_key_max_num = STA_KEY_MAX_NUM_PAN;
  1440. } else
  1441. priv->sta_key_max_num = STA_KEY_MAX_NUM;
  1442. if (priv->valid_contexts != BIT(IWL_RXON_CTX_BSS))
  1443. priv->cmd_queue = IWL_IPAN_CMD_QUEUE_NUM;
  1444. else
  1445. priv->cmd_queue = IWL_DEFAULT_CMD_QUEUE_NUM;
  1446. if (ucode_capa.flags & IWL_UCODE_TLV_FLAGS_BTSTATS ||
  1447. (priv->cfg->bt_params && priv->cfg->bt_params->bt_statistics))
  1448. priv->bt_statistics = true;
  1449. /* Copy images into buffers for card's bus-master reads ... */
  1450. /* Runtime instructions (first block of data in file) */
  1451. IWL_DEBUG_INFO(priv, "Copying (but not loading) uCode instr len %Zd\n",
  1452. pieces.inst_size);
  1453. memcpy(priv->ucode_code.v_addr, pieces.inst, pieces.inst_size);
  1454. IWL_DEBUG_INFO(priv, "uCode instr buf vaddr = 0x%p, paddr = 0x%08x\n",
  1455. priv->ucode_code.v_addr, (u32)priv->ucode_code.p_addr);
  1456. /*
  1457. * Runtime data
  1458. * NOTE: Copy into backup buffer will be done in iwl_up()
  1459. */
  1460. IWL_DEBUG_INFO(priv, "Copying (but not loading) uCode data len %Zd\n",
  1461. pieces.data_size);
  1462. memcpy(priv->ucode_data.v_addr, pieces.data, pieces.data_size);
  1463. /* Initialization instructions */
  1464. if (pieces.init_size) {
  1465. IWL_DEBUG_INFO(priv, "Copying (but not loading) init instr len %Zd\n",
  1466. pieces.init_size);
  1467. memcpy(priv->ucode_init.v_addr, pieces.init, pieces.init_size);
  1468. }
  1469. /* Initialization data */
  1470. if (pieces.init_data_size) {
  1471. IWL_DEBUG_INFO(priv, "Copying (but not loading) init data len %Zd\n",
  1472. pieces.init_data_size);
  1473. memcpy(priv->ucode_init_data.v_addr, pieces.init_data,
  1474. pieces.init_data_size);
  1475. }
  1476. /*
  1477. * figure out the offset of chain noise reset and gain commands
  1478. * base on the size of standard phy calibration commands table size
  1479. */
  1480. if (ucode_capa.standard_phy_calibration_size >
  1481. IWL_MAX_PHY_CALIBRATE_TBL_SIZE)
  1482. ucode_capa.standard_phy_calibration_size =
  1483. IWL_MAX_STANDARD_PHY_CALIBRATE_TBL_SIZE;
  1484. priv->_agn.phy_calib_chain_noise_reset_cmd =
  1485. ucode_capa.standard_phy_calibration_size;
  1486. priv->_agn.phy_calib_chain_noise_gain_cmd =
  1487. ucode_capa.standard_phy_calibration_size + 1;
  1488. /**************************************************
  1489. * This is still part of probe() in a sense...
  1490. *
  1491. * 9. Setup and register with mac80211 and debugfs
  1492. **************************************************/
  1493. err = iwl_mac_setup_register(priv, &ucode_capa);
  1494. if (err)
  1495. goto out_unbind;
  1496. err = iwl_dbgfs_register(priv, DRV_NAME);
  1497. if (err)
  1498. IWL_ERR(priv, "failed to create debugfs files. Ignoring error: %d\n", err);
  1499. err = sysfs_create_group(&priv->pci_dev->dev.kobj,
  1500. &iwl_attribute_group);
  1501. if (err) {
  1502. IWL_ERR(priv, "failed to create sysfs device attributes\n");
  1503. goto out_unbind;
  1504. }
  1505. /* We have our copies now, allow OS release its copies */
  1506. release_firmware(ucode_raw);
  1507. complete(&priv->_agn.firmware_loading_complete);
  1508. return;
  1509. try_again:
  1510. /* try next, if any */
  1511. if (iwl_request_firmware(priv, false))
  1512. goto out_unbind;
  1513. release_firmware(ucode_raw);
  1514. return;
  1515. err_pci_alloc:
  1516. IWL_ERR(priv, "failed to allocate pci memory\n");
  1517. iwl_dealloc_ucode_pci(priv);
  1518. out_unbind:
  1519. complete(&priv->_agn.firmware_loading_complete);
  1520. device_release_driver(&priv->pci_dev->dev);
  1521. release_firmware(ucode_raw);
  1522. }
  1523. static const char *desc_lookup_text[] = {
  1524. "OK",
  1525. "FAIL",
  1526. "BAD_PARAM",
  1527. "BAD_CHECKSUM",
  1528. "NMI_INTERRUPT_WDG",
  1529. "SYSASSERT",
  1530. "FATAL_ERROR",
  1531. "BAD_COMMAND",
  1532. "HW_ERROR_TUNE_LOCK",
  1533. "HW_ERROR_TEMPERATURE",
  1534. "ILLEGAL_CHAN_FREQ",
  1535. "VCC_NOT_STABLE",
  1536. "FH_ERROR",
  1537. "NMI_INTERRUPT_HOST",
  1538. "NMI_INTERRUPT_ACTION_PT",
  1539. "NMI_INTERRUPT_UNKNOWN",
  1540. "UCODE_VERSION_MISMATCH",
  1541. "HW_ERROR_ABS_LOCK",
  1542. "HW_ERROR_CAL_LOCK_FAIL",
  1543. "NMI_INTERRUPT_INST_ACTION_PT",
  1544. "NMI_INTERRUPT_DATA_ACTION_PT",
  1545. "NMI_TRM_HW_ER",
  1546. "NMI_INTERRUPT_TRM",
  1547. "NMI_INTERRUPT_BREAK_POINT"
  1548. "DEBUG_0",
  1549. "DEBUG_1",
  1550. "DEBUG_2",
  1551. "DEBUG_3",
  1552. };
  1553. static struct { char *name; u8 num; } advanced_lookup[] = {
  1554. { "NMI_INTERRUPT_WDG", 0x34 },
  1555. { "SYSASSERT", 0x35 },
  1556. { "UCODE_VERSION_MISMATCH", 0x37 },
  1557. { "BAD_COMMAND", 0x38 },
  1558. { "NMI_INTERRUPT_DATA_ACTION_PT", 0x3C },
  1559. { "FATAL_ERROR", 0x3D },
  1560. { "NMI_TRM_HW_ERR", 0x46 },
  1561. { "NMI_INTERRUPT_TRM", 0x4C },
  1562. { "NMI_INTERRUPT_BREAK_POINT", 0x54 },
  1563. { "NMI_INTERRUPT_WDG_RXF_FULL", 0x5C },
  1564. { "NMI_INTERRUPT_WDG_NO_RBD_RXF_FULL", 0x64 },
  1565. { "NMI_INTERRUPT_HOST", 0x66 },
  1566. { "NMI_INTERRUPT_ACTION_PT", 0x7C },
  1567. { "NMI_INTERRUPT_UNKNOWN", 0x84 },
  1568. { "NMI_INTERRUPT_INST_ACTION_PT", 0x86 },
  1569. { "ADVANCED_SYSASSERT", 0 },
  1570. };
  1571. static const char *desc_lookup(u32 num)
  1572. {
  1573. int i;
  1574. int max = ARRAY_SIZE(desc_lookup_text);
  1575. if (num < max)
  1576. return desc_lookup_text[num];
  1577. max = ARRAY_SIZE(advanced_lookup) - 1;
  1578. for (i = 0; i < max; i++) {
  1579. if (advanced_lookup[i].num == num)
  1580. break;;
  1581. }
  1582. return advanced_lookup[i].name;
  1583. }
  1584. #define ERROR_START_OFFSET (1 * sizeof(u32))
  1585. #define ERROR_ELEM_SIZE (7 * sizeof(u32))
  1586. void iwl_dump_nic_error_log(struct iwl_priv *priv)
  1587. {
  1588. u32 data2, line;
  1589. u32 desc, time, count, base, data1;
  1590. u32 blink1, blink2, ilink1, ilink2;
  1591. u32 pc, hcmd;
  1592. base = priv->device_pointers.error_event_table;
  1593. if (priv->ucode_type == UCODE_INIT) {
  1594. if (!base)
  1595. base = priv->_agn.init_errlog_ptr;
  1596. } else {
  1597. if (!base)
  1598. base = priv->_agn.inst_errlog_ptr;
  1599. }
  1600. if (!priv->cfg->ops->lib->is_valid_rtc_data_addr(base)) {
  1601. IWL_ERR(priv,
  1602. "Not valid error log pointer 0x%08X for %s uCode\n",
  1603. base, (priv->ucode_type == UCODE_INIT) ? "Init" : "RT");
  1604. return;
  1605. }
  1606. count = iwl_read_targ_mem(priv, base);
  1607. if (ERROR_START_OFFSET <= count * ERROR_ELEM_SIZE) {
  1608. IWL_ERR(priv, "Start IWL Error Log Dump:\n");
  1609. IWL_ERR(priv, "Status: 0x%08lX, count: %d\n",
  1610. priv->status, count);
  1611. }
  1612. desc = iwl_read_targ_mem(priv, base + 1 * sizeof(u32));
  1613. priv->isr_stats.err_code = desc;
  1614. pc = iwl_read_targ_mem(priv, base + 2 * sizeof(u32));
  1615. blink1 = iwl_read_targ_mem(priv, base + 3 * sizeof(u32));
  1616. blink2 = iwl_read_targ_mem(priv, base + 4 * sizeof(u32));
  1617. ilink1 = iwl_read_targ_mem(priv, base + 5 * sizeof(u32));
  1618. ilink2 = iwl_read_targ_mem(priv, base + 6 * sizeof(u32));
  1619. data1 = iwl_read_targ_mem(priv, base + 7 * sizeof(u32));
  1620. data2 = iwl_read_targ_mem(priv, base + 8 * sizeof(u32));
  1621. line = iwl_read_targ_mem(priv, base + 9 * sizeof(u32));
  1622. time = iwl_read_targ_mem(priv, base + 11 * sizeof(u32));
  1623. hcmd = iwl_read_targ_mem(priv, base + 22 * sizeof(u32));
  1624. trace_iwlwifi_dev_ucode_error(priv, desc, time, data1, data2, line,
  1625. blink1, blink2, ilink1, ilink2);
  1626. IWL_ERR(priv, "Desc Time "
  1627. "data1 data2 line\n");
  1628. IWL_ERR(priv, "%-28s (0x%04X) %010u 0x%08X 0x%08X %u\n",
  1629. desc_lookup(desc), desc, time, data1, data2, line);
  1630. IWL_ERR(priv, "pc blink1 blink2 ilink1 ilink2 hcmd\n");
  1631. IWL_ERR(priv, "0x%05X 0x%05X 0x%05X 0x%05X 0x%05X 0x%05X\n",
  1632. pc, blink1, blink2, ilink1, ilink2, hcmd);
  1633. }
  1634. #define EVENT_START_OFFSET (4 * sizeof(u32))
  1635. /**
  1636. * iwl_print_event_log - Dump error event log to syslog
  1637. *
  1638. */
  1639. static int iwl_print_event_log(struct iwl_priv *priv, u32 start_idx,
  1640. u32 num_events, u32 mode,
  1641. int pos, char **buf, size_t bufsz)
  1642. {
  1643. u32 i;
  1644. u32 base; /* SRAM byte address of event log header */
  1645. u32 event_size; /* 2 u32s, or 3 u32s if timestamp recorded */
  1646. u32 ptr; /* SRAM byte address of log data */
  1647. u32 ev, time, data; /* event log data */
  1648. unsigned long reg_flags;
  1649. if (num_events == 0)
  1650. return pos;
  1651. base = priv->device_pointers.log_event_table;
  1652. if (priv->ucode_type == UCODE_INIT) {
  1653. if (!base)
  1654. base = priv->_agn.init_evtlog_ptr;
  1655. } else {
  1656. if (!base)
  1657. base = priv->_agn.inst_evtlog_ptr;
  1658. }
  1659. if (mode == 0)
  1660. event_size = 2 * sizeof(u32);
  1661. else
  1662. event_size = 3 * sizeof(u32);
  1663. ptr = base + EVENT_START_OFFSET + (start_idx * event_size);
  1664. /* Make sure device is powered up for SRAM reads */
  1665. spin_lock_irqsave(&priv->reg_lock, reg_flags);
  1666. iwl_grab_nic_access(priv);
  1667. /* Set starting address; reads will auto-increment */
  1668. _iwl_write_direct32(priv, HBUS_TARG_MEM_RADDR, ptr);
  1669. rmb();
  1670. /* "time" is actually "data" for mode 0 (no timestamp).
  1671. * place event id # at far right for easier visual parsing. */
  1672. for (i = 0; i < num_events; i++) {
  1673. ev = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
  1674. time = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
  1675. if (mode == 0) {
  1676. /* data, ev */
  1677. if (bufsz) {
  1678. pos += scnprintf(*buf + pos, bufsz - pos,
  1679. "EVT_LOG:0x%08x:%04u\n",
  1680. time, ev);
  1681. } else {
  1682. trace_iwlwifi_dev_ucode_event(priv, 0,
  1683. time, ev);
  1684. IWL_ERR(priv, "EVT_LOG:0x%08x:%04u\n",
  1685. time, ev);
  1686. }
  1687. } else {
  1688. data = _iwl_read_direct32(priv, HBUS_TARG_MEM_RDAT);
  1689. if (bufsz) {
  1690. pos += scnprintf(*buf + pos, bufsz - pos,
  1691. "EVT_LOGT:%010u:0x%08x:%04u\n",
  1692. time, data, ev);
  1693. } else {
  1694. IWL_ERR(priv, "EVT_LOGT:%010u:0x%08x:%04u\n",
  1695. time, data, ev);
  1696. trace_iwlwifi_dev_ucode_event(priv, time,
  1697. data, ev);
  1698. }
  1699. }
  1700. }
  1701. /* Allow device to power down */
  1702. iwl_release_nic_access(priv);
  1703. spin_unlock_irqrestore(&priv->reg_lock, reg_flags);
  1704. return pos;
  1705. }
  1706. /**
  1707. * iwl_print_last_event_logs - Dump the newest # of event log to syslog
  1708. */
  1709. static int iwl_print_last_event_logs(struct iwl_priv *priv, u32 capacity,
  1710. u32 num_wraps, u32 next_entry,
  1711. u32 size, u32 mode,
  1712. int pos, char **buf, size_t bufsz)
  1713. {
  1714. /*
  1715. * display the newest DEFAULT_LOG_ENTRIES entries
  1716. * i.e the entries just before the next ont that uCode would fill.
  1717. */
  1718. if (num_wraps) {
  1719. if (next_entry < size) {
  1720. pos = iwl_print_event_log(priv,
  1721. capacity - (size - next_entry),
  1722. size - next_entry, mode,
  1723. pos, buf, bufsz);
  1724. pos = iwl_print_event_log(priv, 0,
  1725. next_entry, mode,
  1726. pos, buf, bufsz);
  1727. } else
  1728. pos = iwl_print_event_log(priv, next_entry - size,
  1729. size, mode, pos, buf, bufsz);
  1730. } else {
  1731. if (next_entry < size) {
  1732. pos = iwl_print_event_log(priv, 0, next_entry,
  1733. mode, pos, buf, bufsz);
  1734. } else {
  1735. pos = iwl_print_event_log(priv, next_entry - size,
  1736. size, mode, pos, buf, bufsz);
  1737. }
  1738. }
  1739. return pos;
  1740. }
  1741. #define DEFAULT_DUMP_EVENT_LOG_ENTRIES (20)
  1742. int iwl_dump_nic_event_log(struct iwl_priv *priv, bool full_log,
  1743. char **buf, bool display)
  1744. {
  1745. u32 base; /* SRAM byte address of event log header */
  1746. u32 capacity; /* event log capacity in # entries */
  1747. u32 mode; /* 0 - no timestamp, 1 - timestamp recorded */
  1748. u32 num_wraps; /* # times uCode wrapped to top of log */
  1749. u32 next_entry; /* index of next entry to be written by uCode */
  1750. u32 size; /* # entries that we'll print */
  1751. u32 logsize;
  1752. int pos = 0;
  1753. size_t bufsz = 0;
  1754. base = priv->device_pointers.log_event_table;
  1755. if (priv->ucode_type == UCODE_INIT) {
  1756. logsize = priv->_agn.init_evtlog_size;
  1757. if (!base)
  1758. base = priv->_agn.init_evtlog_ptr;
  1759. } else {
  1760. logsize = priv->_agn.inst_evtlog_size;
  1761. if (!base)
  1762. base = priv->_agn.inst_evtlog_ptr;
  1763. }
  1764. if (!priv->cfg->ops->lib->is_valid_rtc_data_addr(base)) {
  1765. IWL_ERR(priv,
  1766. "Invalid event log pointer 0x%08X for %s uCode\n",
  1767. base, (priv->ucode_type == UCODE_INIT) ? "Init" : "RT");
  1768. return -EINVAL;
  1769. }
  1770. /* event log header */
  1771. capacity = iwl_read_targ_mem(priv, base);
  1772. mode = iwl_read_targ_mem(priv, base + (1 * sizeof(u32)));
  1773. num_wraps = iwl_read_targ_mem(priv, base + (2 * sizeof(u32)));
  1774. next_entry = iwl_read_targ_mem(priv, base + (3 * sizeof(u32)));
  1775. if (capacity > logsize) {
  1776. IWL_ERR(priv, "Log capacity %d is bogus, limit to %d entries\n",
  1777. capacity, logsize);
  1778. capacity = logsize;
  1779. }
  1780. if (next_entry > logsize) {
  1781. IWL_ERR(priv, "Log write index %d is bogus, limit to %d\n",
  1782. next_entry, logsize);
  1783. next_entry = logsize;
  1784. }
  1785. size = num_wraps ? capacity : next_entry;
  1786. /* bail out if nothing in log */
  1787. if (size == 0) {
  1788. IWL_ERR(priv, "Start IWL Event Log Dump: nothing in log\n");
  1789. return pos;
  1790. }
  1791. /* enable/disable bt channel inhibition */
  1792. priv->bt_ch_announce = iwlagn_bt_ch_announce;
  1793. #ifdef CONFIG_IWLWIFI_DEBUG
  1794. if (!(iwl_get_debug_level(priv) & IWL_DL_FW_ERRORS) && !full_log)
  1795. size = (size > DEFAULT_DUMP_EVENT_LOG_ENTRIES)
  1796. ? DEFAULT_DUMP_EVENT_LOG_ENTRIES : size;
  1797. #else
  1798. size = (size > DEFAULT_DUMP_EVENT_LOG_ENTRIES)
  1799. ? DEFAULT_DUMP_EVENT_LOG_ENTRIES : size;
  1800. #endif
  1801. IWL_ERR(priv, "Start IWL Event Log Dump: display last %u entries\n",
  1802. size);
  1803. #ifdef CONFIG_IWLWIFI_DEBUG
  1804. if (display) {
  1805. if (full_log)
  1806. bufsz = capacity * 48;
  1807. else
  1808. bufsz = size * 48;
  1809. *buf = kmalloc(bufsz, GFP_KERNEL);
  1810. if (!*buf)
  1811. return -ENOMEM;
  1812. }
  1813. if ((iwl_get_debug_level(priv) & IWL_DL_FW_ERRORS) || full_log) {
  1814. /*
  1815. * if uCode has wrapped back to top of log,
  1816. * start at the oldest entry,
  1817. * i.e the next one that uCode would fill.
  1818. */
  1819. if (num_wraps)
  1820. pos = iwl_print_event_log(priv, next_entry,
  1821. capacity - next_entry, mode,
  1822. pos, buf, bufsz);
  1823. /* (then/else) start at top of log */
  1824. pos = iwl_print_event_log(priv, 0,
  1825. next_entry, mode, pos, buf, bufsz);
  1826. } else
  1827. pos = iwl_print_last_event_logs(priv, capacity, num_wraps,
  1828. next_entry, size, mode,
  1829. pos, buf, bufsz);
  1830. #else
  1831. pos = iwl_print_last_event_logs(priv, capacity, num_wraps,
  1832. next_entry, size, mode,
  1833. pos, buf, bufsz);
  1834. #endif
  1835. return pos;
  1836. }
  1837. static void iwl_rf_kill_ct_config(struct iwl_priv *priv)
  1838. {
  1839. struct iwl_ct_kill_config cmd;
  1840. struct iwl_ct_kill_throttling_config adv_cmd;
  1841. unsigned long flags;
  1842. int ret = 0;
  1843. spin_lock_irqsave(&priv->lock, flags);
  1844. iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR,
  1845. CSR_UCODE_DRV_GP1_REG_BIT_CT_KILL_EXIT);
  1846. spin_unlock_irqrestore(&priv->lock, flags);
  1847. priv->thermal_throttle.ct_kill_toggle = false;
  1848. if (priv->cfg->base_params->support_ct_kill_exit) {
  1849. adv_cmd.critical_temperature_enter =
  1850. cpu_to_le32(priv->hw_params.ct_kill_threshold);
  1851. adv_cmd.critical_temperature_exit =
  1852. cpu_to_le32(priv->hw_params.ct_kill_exit_threshold);
  1853. ret = iwl_send_cmd_pdu(priv, REPLY_CT_KILL_CONFIG_CMD,
  1854. sizeof(adv_cmd), &adv_cmd);
  1855. if (ret)
  1856. IWL_ERR(priv, "REPLY_CT_KILL_CONFIG_CMD failed\n");
  1857. else
  1858. IWL_DEBUG_INFO(priv, "REPLY_CT_KILL_CONFIG_CMD "
  1859. "succeeded, "
  1860. "critical temperature enter is %d,"
  1861. "exit is %d\n",
  1862. priv->hw_params.ct_kill_threshold,
  1863. priv->hw_params.ct_kill_exit_threshold);
  1864. } else {
  1865. cmd.critical_temperature_R =
  1866. cpu_to_le32(priv->hw_params.ct_kill_threshold);
  1867. ret = iwl_send_cmd_pdu(priv, REPLY_CT_KILL_CONFIG_CMD,
  1868. sizeof(cmd), &cmd);
  1869. if (ret)
  1870. IWL_ERR(priv, "REPLY_CT_KILL_CONFIG_CMD failed\n");
  1871. else
  1872. IWL_DEBUG_INFO(priv, "REPLY_CT_KILL_CONFIG_CMD "
  1873. "succeeded, "
  1874. "critical temperature is %d\n",
  1875. priv->hw_params.ct_kill_threshold);
  1876. }
  1877. }
  1878. static int iwlagn_send_calib_cfg_rt(struct iwl_priv *priv, u32 cfg)
  1879. {
  1880. struct iwl_calib_cfg_cmd calib_cfg_cmd;
  1881. struct iwl_host_cmd cmd = {
  1882. .id = CALIBRATION_CFG_CMD,
  1883. .len = sizeof(struct iwl_calib_cfg_cmd),
  1884. .data = &calib_cfg_cmd,
  1885. };
  1886. memset(&calib_cfg_cmd, 0, sizeof(calib_cfg_cmd));
  1887. calib_cfg_cmd.ucd_calib_cfg.once.is_enable = IWL_CALIB_INIT_CFG_ALL;
  1888. calib_cfg_cmd.ucd_calib_cfg.once.start = cpu_to_le32(cfg);
  1889. return iwl_send_cmd(priv, &cmd);
  1890. }
  1891. /**
  1892. * iwl_alive_start - called after REPLY_ALIVE notification received
  1893. * from protocol/runtime uCode (initialization uCode's
  1894. * Alive gets handled by iwl_init_alive_start()).
  1895. */
  1896. static void iwl_alive_start(struct iwl_priv *priv)
  1897. {
  1898. int ret = 0;
  1899. struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
  1900. IWL_DEBUG_INFO(priv, "Runtime Alive received.\n");
  1901. /* Initialize uCode has loaded Runtime uCode ... verify inst image.
  1902. * This is a paranoid check, because we would not have gotten the
  1903. * "runtime" alive if code weren't properly loaded. */
  1904. if (iwl_verify_ucode(priv, &priv->ucode_code)) {
  1905. /* Runtime instruction load was bad;
  1906. * take it all the way back down so we can try again */
  1907. IWL_DEBUG_INFO(priv, "Bad runtime uCode load.\n");
  1908. goto restart;
  1909. }
  1910. ret = iwlagn_alive_notify(priv);
  1911. if (ret) {
  1912. IWL_WARN(priv,
  1913. "Could not complete ALIVE transition [ntf]: %d\n", ret);
  1914. goto restart;
  1915. }
  1916. /* After the ALIVE response, we can send host commands to the uCode */
  1917. set_bit(STATUS_ALIVE, &priv->status);
  1918. /* Enable watchdog to monitor the driver tx queues */
  1919. iwl_setup_watchdog(priv);
  1920. if (iwl_is_rfkill(priv))
  1921. return;
  1922. /* download priority table before any calibration request */
  1923. if (priv->cfg->bt_params &&
  1924. priv->cfg->bt_params->advanced_bt_coexist) {
  1925. /* Configure Bluetooth device coexistence support */
  1926. priv->bt_valid = IWLAGN_BT_ALL_VALID_MSK;
  1927. priv->kill_ack_mask = IWLAGN_BT_KILL_ACK_MASK_DEFAULT;
  1928. priv->kill_cts_mask = IWLAGN_BT_KILL_CTS_MASK_DEFAULT;
  1929. priv->cfg->ops->hcmd->send_bt_config(priv);
  1930. priv->bt_valid = IWLAGN_BT_VALID_ENABLE_FLAGS;
  1931. iwlagn_send_prio_tbl(priv);
  1932. /* FIXME: w/a to force change uCode BT state machine */
  1933. iwlagn_send_bt_env(priv, IWL_BT_COEX_ENV_OPEN,
  1934. BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
  1935. iwlagn_send_bt_env(priv, IWL_BT_COEX_ENV_CLOSE,
  1936. BT_COEX_PRIO_TBL_EVT_INIT_CALIB2);
  1937. }
  1938. if (priv->hw_params.calib_rt_cfg)
  1939. iwlagn_send_calib_cfg_rt(priv, priv->hw_params.calib_rt_cfg);
  1940. ieee80211_wake_queues(priv->hw);
  1941. priv->active_rate = IWL_RATES_MASK;
  1942. /* Configure Tx antenna selection based on H/W config */
  1943. if (priv->cfg->ops->hcmd->set_tx_ant)
  1944. priv->cfg->ops->hcmd->set_tx_ant(priv, priv->cfg->valid_tx_ant);
  1945. if (iwl_is_associated_ctx(ctx)) {
  1946. struct iwl_rxon_cmd *active_rxon =
  1947. (struct iwl_rxon_cmd *)&ctx->active;
  1948. /* apply any changes in staging */
  1949. ctx->staging.filter_flags |= RXON_FILTER_ASSOC_MSK;
  1950. active_rxon->filter_flags &= ~RXON_FILTER_ASSOC_MSK;
  1951. } else {
  1952. struct iwl_rxon_context *tmp;
  1953. /* Initialize our rx_config data */
  1954. for_each_context(priv, tmp)
  1955. iwl_connection_init_rx_config(priv, tmp);
  1956. if (priv->cfg->ops->hcmd->set_rxon_chain)
  1957. priv->cfg->ops->hcmd->set_rxon_chain(priv, ctx);
  1958. }
  1959. if (!priv->cfg->bt_params || (priv->cfg->bt_params &&
  1960. !priv->cfg->bt_params->advanced_bt_coexist)) {
  1961. /*
  1962. * default is 2-wire BT coexexistence support
  1963. */
  1964. priv->cfg->ops->hcmd->send_bt_config(priv);
  1965. }
  1966. iwl_reset_run_time_calib(priv);
  1967. set_bit(STATUS_READY, &priv->status);
  1968. /* Configure the adapter for unassociated operation */
  1969. iwlcore_commit_rxon(priv, ctx);
  1970. /* At this point, the NIC is initialized and operational */
  1971. iwl_rf_kill_ct_config(priv);
  1972. IWL_DEBUG_INFO(priv, "ALIVE processing complete.\n");
  1973. wake_up_interruptible(&priv->wait_command_queue);
  1974. iwl_power_update_mode(priv, true);
  1975. IWL_DEBUG_INFO(priv, "Updated power mode\n");
  1976. return;
  1977. restart:
  1978. queue_work(priv->workqueue, &priv->restart);
  1979. }
  1980. static void iwl_cancel_deferred_work(struct iwl_priv *priv);
  1981. static void __iwl_down(struct iwl_priv *priv)
  1982. {
  1983. unsigned long flags;
  1984. int exit_pending;
  1985. IWL_DEBUG_INFO(priv, DRV_NAME " is going down\n");
  1986. iwl_scan_cancel_timeout(priv, 200);
  1987. exit_pending = test_and_set_bit(STATUS_EXIT_PENDING, &priv->status);
  1988. /* Stop TX queues watchdog. We need to have STATUS_EXIT_PENDING bit set
  1989. * to prevent rearm timer */
  1990. del_timer_sync(&priv->watchdog);
  1991. iwl_clear_ucode_stations(priv, NULL);
  1992. iwl_dealloc_bcast_stations(priv);
  1993. iwl_clear_driver_stations(priv);
  1994. /* reset BT coex data */
  1995. priv->bt_status = 0;
  1996. if (priv->cfg->bt_params)
  1997. priv->bt_traffic_load =
  1998. priv->cfg->bt_params->bt_init_traffic_load;
  1999. else
  2000. priv->bt_traffic_load = 0;
  2001. priv->bt_full_concurrent = false;
  2002. priv->bt_ci_compliance = 0;
  2003. /* Wipe out the EXIT_PENDING status bit if we are not actually
  2004. * exiting the module */
  2005. if (!exit_pending)
  2006. clear_bit(STATUS_EXIT_PENDING, &priv->status);
  2007. /* stop and reset the on-board processor */
  2008. iwl_write32(priv, CSR_RESET, CSR_RESET_REG_FLAG_NEVO_RESET);
  2009. /* tell the device to stop sending interrupts */
  2010. spin_lock_irqsave(&priv->lock, flags);
  2011. iwl_disable_interrupts(priv);
  2012. spin_unlock_irqrestore(&priv->lock, flags);
  2013. iwl_synchronize_irq(priv);
  2014. if (priv->mac80211_registered)
  2015. ieee80211_stop_queues(priv->hw);
  2016. /* If we have not previously called iwl_init() then
  2017. * clear all bits but the RF Kill bit and return */
  2018. if (!iwl_is_init(priv)) {
  2019. priv->status = test_bit(STATUS_RF_KILL_HW, &priv->status) <<
  2020. STATUS_RF_KILL_HW |
  2021. test_bit(STATUS_GEO_CONFIGURED, &priv->status) <<
  2022. STATUS_GEO_CONFIGURED |
  2023. test_bit(STATUS_EXIT_PENDING, &priv->status) <<
  2024. STATUS_EXIT_PENDING;
  2025. goto exit;
  2026. }
  2027. /* ...otherwise clear out all the status bits but the RF Kill
  2028. * bit and continue taking the NIC down. */
  2029. priv->status &= test_bit(STATUS_RF_KILL_HW, &priv->status) <<
  2030. STATUS_RF_KILL_HW |
  2031. test_bit(STATUS_GEO_CONFIGURED, &priv->status) <<
  2032. STATUS_GEO_CONFIGURED |
  2033. test_bit(STATUS_FW_ERROR, &priv->status) <<
  2034. STATUS_FW_ERROR |
  2035. test_bit(STATUS_EXIT_PENDING, &priv->status) <<
  2036. STATUS_EXIT_PENDING;
  2037. /* device going down, Stop using ICT table */
  2038. if (priv->cfg->ops->lib->isr_ops.disable)
  2039. priv->cfg->ops->lib->isr_ops.disable(priv);
  2040. iwlagn_txq_ctx_stop(priv);
  2041. iwlagn_rxq_stop(priv);
  2042. /* Power-down device's busmaster DMA clocks */
  2043. iwl_write_prph(priv, APMG_CLK_DIS_REG, APMG_CLK_VAL_DMA_CLK_RQT);
  2044. udelay(5);
  2045. /* Make sure (redundant) we've released our request to stay awake */
  2046. iwl_clear_bit(priv, CSR_GP_CNTRL, CSR_GP_CNTRL_REG_FLAG_MAC_ACCESS_REQ);
  2047. /* Stop the device, and put it in low power state */
  2048. iwl_apm_stop(priv);
  2049. exit:
  2050. dev_kfree_skb(priv->beacon_skb);
  2051. priv->beacon_skb = NULL;
  2052. /* clear out any free frames */
  2053. iwl_clear_free_frames(priv);
  2054. }
  2055. static void iwl_down(struct iwl_priv *priv)
  2056. {
  2057. mutex_lock(&priv->mutex);
  2058. __iwl_down(priv);
  2059. mutex_unlock(&priv->mutex);
  2060. iwl_cancel_deferred_work(priv);
  2061. }
  2062. #define HW_READY_TIMEOUT (50)
  2063. static int iwl_set_hw_ready(struct iwl_priv *priv)
  2064. {
  2065. int ret = 0;
  2066. iwl_set_bit(priv, CSR_HW_IF_CONFIG_REG,
  2067. CSR_HW_IF_CONFIG_REG_BIT_NIC_READY);
  2068. /* See if we got it */
  2069. ret = iwl_poll_bit(priv, CSR_HW_IF_CONFIG_REG,
  2070. CSR_HW_IF_CONFIG_REG_BIT_NIC_READY,
  2071. CSR_HW_IF_CONFIG_REG_BIT_NIC_READY,
  2072. HW_READY_TIMEOUT);
  2073. if (ret != -ETIMEDOUT)
  2074. priv->hw_ready = true;
  2075. else
  2076. priv->hw_ready = false;
  2077. IWL_DEBUG_INFO(priv, "hardware %s\n",
  2078. (priv->hw_ready == 1) ? "ready" : "not ready");
  2079. return ret;
  2080. }
  2081. static int iwl_prepare_card_hw(struct iwl_priv *priv)
  2082. {
  2083. int ret = 0;
  2084. IWL_DEBUG_INFO(priv, "iwl_prepare_card_hw enter\n");
  2085. ret = iwl_set_hw_ready(priv);
  2086. if (priv->hw_ready)
  2087. return ret;
  2088. /* If HW is not ready, prepare the conditions to check again */
  2089. iwl_set_bit(priv, CSR_HW_IF_CONFIG_REG,
  2090. CSR_HW_IF_CONFIG_REG_PREPARE);
  2091. ret = iwl_poll_bit(priv, CSR_HW_IF_CONFIG_REG,
  2092. ~CSR_HW_IF_CONFIG_REG_BIT_NIC_PREPARE_DONE,
  2093. CSR_HW_IF_CONFIG_REG_BIT_NIC_PREPARE_DONE, 150000);
  2094. /* HW should be ready by now, check again. */
  2095. if (ret != -ETIMEDOUT)
  2096. iwl_set_hw_ready(priv);
  2097. return ret;
  2098. }
  2099. #define MAX_HW_RESTARTS 5
  2100. static int __iwl_up(struct iwl_priv *priv)
  2101. {
  2102. struct iwl_rxon_context *ctx;
  2103. int i;
  2104. int ret;
  2105. if (test_bit(STATUS_EXIT_PENDING, &priv->status)) {
  2106. IWL_WARN(priv, "Exit pending; will not bring the NIC up\n");
  2107. return -EIO;
  2108. }
  2109. for_each_context(priv, ctx) {
  2110. ret = iwlagn_alloc_bcast_station(priv, ctx);
  2111. if (ret) {
  2112. iwl_dealloc_bcast_stations(priv);
  2113. return ret;
  2114. }
  2115. }
  2116. iwl_prepare_card_hw(priv);
  2117. if (!priv->hw_ready) {
  2118. IWL_WARN(priv, "Exit HW not ready\n");
  2119. return -EIO;
  2120. }
  2121. /* If platform's RF_KILL switch is NOT set to KILL */
  2122. if (iwl_read32(priv, CSR_GP_CNTRL) & CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW)
  2123. clear_bit(STATUS_RF_KILL_HW, &priv->status);
  2124. else
  2125. set_bit(STATUS_RF_KILL_HW, &priv->status);
  2126. if (iwl_is_rfkill(priv)) {
  2127. wiphy_rfkill_set_hw_state(priv->hw->wiphy, true);
  2128. iwl_enable_interrupts(priv);
  2129. IWL_WARN(priv, "Radio disabled by HW RF Kill switch\n");
  2130. return 0;
  2131. }
  2132. iwl_write32(priv, CSR_INT, 0xFFFFFFFF);
  2133. ret = iwlagn_hw_nic_init(priv);
  2134. if (ret) {
  2135. IWL_ERR(priv, "Unable to init nic\n");
  2136. return ret;
  2137. }
  2138. /* make sure rfkill handshake bits are cleared */
  2139. iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
  2140. iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR,
  2141. CSR_UCODE_DRV_GP1_BIT_CMD_BLOCKED);
  2142. /* clear (again), then enable host interrupts */
  2143. iwl_write32(priv, CSR_INT, 0xFFFFFFFF);
  2144. iwl_enable_interrupts(priv);
  2145. /* really make sure rfkill handshake bits are cleared */
  2146. iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
  2147. iwl_write32(priv, CSR_UCODE_DRV_GP1_CLR, CSR_UCODE_SW_BIT_RFKILL);
  2148. for (i = 0; i < MAX_HW_RESTARTS; i++) {
  2149. /* load bootstrap state machine,
  2150. * load bootstrap program into processor's memory,
  2151. * prepare to load the "initialize" uCode */
  2152. ret = iwlagn_load_ucode(priv);
  2153. if (ret) {
  2154. IWL_ERR(priv, "Unable to set up bootstrap uCode: %d\n",
  2155. ret);
  2156. continue;
  2157. }
  2158. /* start card; "initialize" will load runtime ucode */
  2159. iwl_nic_start(priv);
  2160. IWL_DEBUG_INFO(priv, DRV_NAME " is coming up\n");
  2161. return 0;
  2162. }
  2163. set_bit(STATUS_EXIT_PENDING, &priv->status);
  2164. __iwl_down(priv);
  2165. clear_bit(STATUS_EXIT_PENDING, &priv->status);
  2166. /* tried to restart and config the device for as long as our
  2167. * patience could withstand */
  2168. IWL_ERR(priv, "Unable to initialize device after %d attempts.\n", i);
  2169. return -EIO;
  2170. }
  2171. /*****************************************************************************
  2172. *
  2173. * Workqueue callbacks
  2174. *
  2175. *****************************************************************************/
  2176. static void iwl_bg_init_alive_start(struct work_struct *data)
  2177. {
  2178. struct iwl_priv *priv =
  2179. container_of(data, struct iwl_priv, init_alive_start.work);
  2180. mutex_lock(&priv->mutex);
  2181. if (test_bit(STATUS_EXIT_PENDING, &priv->status)) {
  2182. mutex_unlock(&priv->mutex);
  2183. return;
  2184. }
  2185. iwlagn_init_alive_start(priv);
  2186. mutex_unlock(&priv->mutex);
  2187. }
  2188. static void iwl_bg_alive_start(struct work_struct *data)
  2189. {
  2190. struct iwl_priv *priv =
  2191. container_of(data, struct iwl_priv, alive_start.work);
  2192. mutex_lock(&priv->mutex);
  2193. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  2194. goto unlock;
  2195. /* enable dram interrupt */
  2196. if (priv->cfg->ops->lib->isr_ops.reset)
  2197. priv->cfg->ops->lib->isr_ops.reset(priv);
  2198. iwl_alive_start(priv);
  2199. unlock:
  2200. mutex_unlock(&priv->mutex);
  2201. }
  2202. static void iwl_bg_run_time_calib_work(struct work_struct *work)
  2203. {
  2204. struct iwl_priv *priv = container_of(work, struct iwl_priv,
  2205. run_time_calib_work);
  2206. mutex_lock(&priv->mutex);
  2207. if (test_bit(STATUS_EXIT_PENDING, &priv->status) ||
  2208. test_bit(STATUS_SCANNING, &priv->status)) {
  2209. mutex_unlock(&priv->mutex);
  2210. return;
  2211. }
  2212. if (priv->start_calib) {
  2213. if (iwl_bt_statistics(priv)) {
  2214. iwl_chain_noise_calibration(priv,
  2215. (void *)&priv->_agn.statistics_bt);
  2216. iwl_sensitivity_calibration(priv,
  2217. (void *)&priv->_agn.statistics_bt);
  2218. } else {
  2219. iwl_chain_noise_calibration(priv,
  2220. (void *)&priv->_agn.statistics);
  2221. iwl_sensitivity_calibration(priv,
  2222. (void *)&priv->_agn.statistics);
  2223. }
  2224. }
  2225. mutex_unlock(&priv->mutex);
  2226. }
  2227. static void iwl_bg_restart(struct work_struct *data)
  2228. {
  2229. struct iwl_priv *priv = container_of(data, struct iwl_priv, restart);
  2230. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  2231. return;
  2232. if (test_and_clear_bit(STATUS_FW_ERROR, &priv->status)) {
  2233. struct iwl_rxon_context *ctx;
  2234. bool bt_full_concurrent;
  2235. u8 bt_ci_compliance;
  2236. u8 bt_load;
  2237. u8 bt_status;
  2238. mutex_lock(&priv->mutex);
  2239. for_each_context(priv, ctx)
  2240. ctx->vif = NULL;
  2241. priv->is_open = 0;
  2242. /*
  2243. * __iwl_down() will clear the BT status variables,
  2244. * which is correct, but when we restart we really
  2245. * want to keep them so restore them afterwards.
  2246. *
  2247. * The restart process will later pick them up and
  2248. * re-configure the hw when we reconfigure the BT
  2249. * command.
  2250. */
  2251. bt_full_concurrent = priv->bt_full_concurrent;
  2252. bt_ci_compliance = priv->bt_ci_compliance;
  2253. bt_load = priv->bt_traffic_load;
  2254. bt_status = priv->bt_status;
  2255. __iwl_down(priv);
  2256. priv->bt_full_concurrent = bt_full_concurrent;
  2257. priv->bt_ci_compliance = bt_ci_compliance;
  2258. priv->bt_traffic_load = bt_load;
  2259. priv->bt_status = bt_status;
  2260. mutex_unlock(&priv->mutex);
  2261. iwl_cancel_deferred_work(priv);
  2262. ieee80211_restart_hw(priv->hw);
  2263. } else {
  2264. iwl_down(priv);
  2265. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  2266. return;
  2267. mutex_lock(&priv->mutex);
  2268. __iwl_up(priv);
  2269. mutex_unlock(&priv->mutex);
  2270. }
  2271. }
  2272. static void iwl_bg_rx_replenish(struct work_struct *data)
  2273. {
  2274. struct iwl_priv *priv =
  2275. container_of(data, struct iwl_priv, rx_replenish);
  2276. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  2277. return;
  2278. mutex_lock(&priv->mutex);
  2279. iwlagn_rx_replenish(priv);
  2280. mutex_unlock(&priv->mutex);
  2281. }
  2282. static int iwl_mac_offchannel_tx(struct ieee80211_hw *hw, struct sk_buff *skb,
  2283. struct ieee80211_channel *chan,
  2284. enum nl80211_channel_type channel_type,
  2285. unsigned int wait)
  2286. {
  2287. struct iwl_priv *priv = hw->priv;
  2288. int ret;
  2289. /* Not supported if we don't have PAN */
  2290. if (!(priv->valid_contexts & BIT(IWL_RXON_CTX_PAN))) {
  2291. ret = -EOPNOTSUPP;
  2292. goto free;
  2293. }
  2294. /* Not supported on pre-P2P firmware */
  2295. if (!(priv->contexts[IWL_RXON_CTX_PAN].interface_modes &
  2296. BIT(NL80211_IFTYPE_P2P_CLIENT))) {
  2297. ret = -EOPNOTSUPP;
  2298. goto free;
  2299. }
  2300. mutex_lock(&priv->mutex);
  2301. if (!priv->contexts[IWL_RXON_CTX_PAN].is_active) {
  2302. /*
  2303. * If the PAN context is free, use the normal
  2304. * way of doing remain-on-channel offload + TX.
  2305. */
  2306. ret = 1;
  2307. goto out;
  2308. }
  2309. /* TODO: queue up if scanning? */
  2310. if (test_bit(STATUS_SCANNING, &priv->status) ||
  2311. priv->_agn.offchan_tx_skb) {
  2312. ret = -EBUSY;
  2313. goto out;
  2314. }
  2315. /*
  2316. * max_scan_ie_len doesn't include the blank SSID or the header,
  2317. * so need to add that again here.
  2318. */
  2319. if (skb->len > hw->wiphy->max_scan_ie_len + 24 + 2) {
  2320. ret = -ENOBUFS;
  2321. goto out;
  2322. }
  2323. priv->_agn.offchan_tx_skb = skb;
  2324. priv->_agn.offchan_tx_timeout = wait;
  2325. priv->_agn.offchan_tx_chan = chan;
  2326. ret = iwl_scan_initiate(priv, priv->contexts[IWL_RXON_CTX_PAN].vif,
  2327. IWL_SCAN_OFFCH_TX, chan->band);
  2328. if (ret)
  2329. priv->_agn.offchan_tx_skb = NULL;
  2330. out:
  2331. mutex_unlock(&priv->mutex);
  2332. free:
  2333. if (ret < 0)
  2334. kfree_skb(skb);
  2335. return ret;
  2336. }
  2337. static int iwl_mac_offchannel_tx_cancel_wait(struct ieee80211_hw *hw)
  2338. {
  2339. struct iwl_priv *priv = hw->priv;
  2340. int ret;
  2341. mutex_lock(&priv->mutex);
  2342. if (!priv->_agn.offchan_tx_skb) {
  2343. ret = -EINVAL;
  2344. goto unlock;
  2345. }
  2346. priv->_agn.offchan_tx_skb = NULL;
  2347. ret = iwl_scan_cancel_timeout(priv, 200);
  2348. if (ret)
  2349. ret = -EIO;
  2350. unlock:
  2351. mutex_unlock(&priv->mutex);
  2352. return ret;
  2353. }
  2354. /*****************************************************************************
  2355. *
  2356. * mac80211 entry point functions
  2357. *
  2358. *****************************************************************************/
  2359. #define UCODE_READY_TIMEOUT (4 * HZ)
  2360. /*
  2361. * Not a mac80211 entry point function, but it fits in with all the
  2362. * other mac80211 functions grouped here.
  2363. */
  2364. static int iwl_mac_setup_register(struct iwl_priv *priv,
  2365. struct iwlagn_ucode_capabilities *capa)
  2366. {
  2367. int ret;
  2368. struct ieee80211_hw *hw = priv->hw;
  2369. struct iwl_rxon_context *ctx;
  2370. hw->rate_control_algorithm = "iwl-agn-rs";
  2371. /* Tell mac80211 our characteristics */
  2372. hw->flags = IEEE80211_HW_SIGNAL_DBM |
  2373. IEEE80211_HW_AMPDU_AGGREGATION |
  2374. IEEE80211_HW_NEED_DTIM_PERIOD |
  2375. IEEE80211_HW_SPECTRUM_MGMT |
  2376. IEEE80211_HW_REPORTS_TX_ACK_STATUS;
  2377. hw->max_tx_aggregation_subframes = LINK_QUAL_AGG_FRAME_LIMIT_DEF;
  2378. if (!priv->cfg->base_params->broken_powersave)
  2379. hw->flags |= IEEE80211_HW_SUPPORTS_PS |
  2380. IEEE80211_HW_SUPPORTS_DYNAMIC_PS;
  2381. if (priv->cfg->sku & IWL_SKU_N)
  2382. hw->flags |= IEEE80211_HW_SUPPORTS_DYNAMIC_SMPS |
  2383. IEEE80211_HW_SUPPORTS_STATIC_SMPS;
  2384. if (capa->flags & IWL_UCODE_TLV_FLAGS_MFP)
  2385. hw->flags |= IEEE80211_HW_MFP_CAPABLE;
  2386. hw->sta_data_size = sizeof(struct iwl_station_priv);
  2387. hw->vif_data_size = sizeof(struct iwl_vif_priv);
  2388. for_each_context(priv, ctx) {
  2389. hw->wiphy->interface_modes |= ctx->interface_modes;
  2390. hw->wiphy->interface_modes |= ctx->exclusive_interface_modes;
  2391. }
  2392. hw->wiphy->max_remain_on_channel_duration = 1000;
  2393. hw->wiphy->flags |= WIPHY_FLAG_CUSTOM_REGULATORY |
  2394. WIPHY_FLAG_DISABLE_BEACON_HINTS |
  2395. WIPHY_FLAG_IBSS_RSN;
  2396. /*
  2397. * For now, disable PS by default because it affects
  2398. * RX performance significantly.
  2399. */
  2400. hw->wiphy->flags &= ~WIPHY_FLAG_PS_ON_BY_DEFAULT;
  2401. hw->wiphy->max_scan_ssids = PROBE_OPTION_MAX;
  2402. /* we create the 802.11 header and a zero-length SSID element */
  2403. hw->wiphy->max_scan_ie_len = capa->max_probe_length - 24 - 2;
  2404. /* Default value; 4 EDCA QOS priorities */
  2405. hw->queues = 4;
  2406. hw->max_listen_interval = IWL_CONN_MAX_LISTEN_INTERVAL;
  2407. if (priv->bands[IEEE80211_BAND_2GHZ].n_channels)
  2408. priv->hw->wiphy->bands[IEEE80211_BAND_2GHZ] =
  2409. &priv->bands[IEEE80211_BAND_2GHZ];
  2410. if (priv->bands[IEEE80211_BAND_5GHZ].n_channels)
  2411. priv->hw->wiphy->bands[IEEE80211_BAND_5GHZ] =
  2412. &priv->bands[IEEE80211_BAND_5GHZ];
  2413. iwl_leds_init(priv);
  2414. ret = ieee80211_register_hw(priv->hw);
  2415. if (ret) {
  2416. IWL_ERR(priv, "Failed to register hw (error %d)\n", ret);
  2417. return ret;
  2418. }
  2419. priv->mac80211_registered = 1;
  2420. return 0;
  2421. }
  2422. static int iwlagn_mac_start(struct ieee80211_hw *hw)
  2423. {
  2424. struct iwl_priv *priv = hw->priv;
  2425. int ret;
  2426. IWL_DEBUG_MAC80211(priv, "enter\n");
  2427. /* we should be verifying the device is ready to be opened */
  2428. mutex_lock(&priv->mutex);
  2429. ret = __iwl_up(priv);
  2430. mutex_unlock(&priv->mutex);
  2431. if (ret)
  2432. return ret;
  2433. if (iwl_is_rfkill(priv))
  2434. goto out;
  2435. IWL_DEBUG_INFO(priv, "Start UP work done.\n");
  2436. /* Wait for START_ALIVE from Run Time ucode. Otherwise callbacks from
  2437. * mac80211 will not be run successfully. */
  2438. ret = wait_event_interruptible_timeout(priv->wait_command_queue,
  2439. test_bit(STATUS_READY, &priv->status),
  2440. UCODE_READY_TIMEOUT);
  2441. if (!ret) {
  2442. if (!test_bit(STATUS_READY, &priv->status)) {
  2443. IWL_ERR(priv, "START_ALIVE timeout after %dms.\n",
  2444. jiffies_to_msecs(UCODE_READY_TIMEOUT));
  2445. return -ETIMEDOUT;
  2446. }
  2447. }
  2448. iwlagn_led_enable(priv);
  2449. out:
  2450. priv->is_open = 1;
  2451. IWL_DEBUG_MAC80211(priv, "leave\n");
  2452. return 0;
  2453. }
  2454. static void iwlagn_mac_stop(struct ieee80211_hw *hw)
  2455. {
  2456. struct iwl_priv *priv = hw->priv;
  2457. IWL_DEBUG_MAC80211(priv, "enter\n");
  2458. if (!priv->is_open)
  2459. return;
  2460. priv->is_open = 0;
  2461. iwl_down(priv);
  2462. flush_workqueue(priv->workqueue);
  2463. /* User space software may expect getting rfkill changes
  2464. * even if interface is down */
  2465. iwl_write32(priv, CSR_INT, 0xFFFFFFFF);
  2466. iwl_enable_rfkill_int(priv);
  2467. IWL_DEBUG_MAC80211(priv, "leave\n");
  2468. }
  2469. static void iwlagn_mac_tx(struct ieee80211_hw *hw, struct sk_buff *skb)
  2470. {
  2471. struct iwl_priv *priv = hw->priv;
  2472. IWL_DEBUG_MACDUMP(priv, "enter\n");
  2473. IWL_DEBUG_TX(priv, "dev->xmit(%d bytes) at rate 0x%02x\n", skb->len,
  2474. ieee80211_get_tx_rate(hw, IEEE80211_SKB_CB(skb))->bitrate);
  2475. if (iwlagn_tx_skb(priv, skb))
  2476. dev_kfree_skb_any(skb);
  2477. IWL_DEBUG_MACDUMP(priv, "leave\n");
  2478. }
  2479. static void iwlagn_mac_update_tkip_key(struct ieee80211_hw *hw,
  2480. struct ieee80211_vif *vif,
  2481. struct ieee80211_key_conf *keyconf,
  2482. struct ieee80211_sta *sta,
  2483. u32 iv32, u16 *phase1key)
  2484. {
  2485. struct iwl_priv *priv = hw->priv;
  2486. struct iwl_vif_priv *vif_priv = (void *)vif->drv_priv;
  2487. IWL_DEBUG_MAC80211(priv, "enter\n");
  2488. iwl_update_tkip_key(priv, vif_priv->ctx, keyconf, sta,
  2489. iv32, phase1key);
  2490. IWL_DEBUG_MAC80211(priv, "leave\n");
  2491. }
  2492. static int iwlagn_mac_set_key(struct ieee80211_hw *hw, enum set_key_cmd cmd,
  2493. struct ieee80211_vif *vif,
  2494. struct ieee80211_sta *sta,
  2495. struct ieee80211_key_conf *key)
  2496. {
  2497. struct iwl_priv *priv = hw->priv;
  2498. struct iwl_vif_priv *vif_priv = (void *)vif->drv_priv;
  2499. struct iwl_rxon_context *ctx = vif_priv->ctx;
  2500. int ret;
  2501. u8 sta_id;
  2502. bool is_default_wep_key = false;
  2503. IWL_DEBUG_MAC80211(priv, "enter\n");
  2504. if (priv->cfg->mod_params->sw_crypto) {
  2505. IWL_DEBUG_MAC80211(priv, "leave - hwcrypto disabled\n");
  2506. return -EOPNOTSUPP;
  2507. }
  2508. /*
  2509. * To support IBSS RSN, don't program group keys in IBSS, the
  2510. * hardware will then not attempt to decrypt the frames.
  2511. */
  2512. if (vif->type == NL80211_IFTYPE_ADHOC &&
  2513. !(key->flags & IEEE80211_KEY_FLAG_PAIRWISE))
  2514. return -EOPNOTSUPP;
  2515. sta_id = iwl_sta_id_or_broadcast(priv, vif_priv->ctx, sta);
  2516. if (sta_id == IWL_INVALID_STATION)
  2517. return -EINVAL;
  2518. mutex_lock(&priv->mutex);
  2519. iwl_scan_cancel_timeout(priv, 100);
  2520. /*
  2521. * If we are getting WEP group key and we didn't receive any key mapping
  2522. * so far, we are in legacy wep mode (group key only), otherwise we are
  2523. * in 1X mode.
  2524. * In legacy wep mode, we use another host command to the uCode.
  2525. */
  2526. if ((key->cipher == WLAN_CIPHER_SUITE_WEP40 ||
  2527. key->cipher == WLAN_CIPHER_SUITE_WEP104) &&
  2528. !sta) {
  2529. if (cmd == SET_KEY)
  2530. is_default_wep_key = !ctx->key_mapping_keys;
  2531. else
  2532. is_default_wep_key =
  2533. (key->hw_key_idx == HW_KEY_DEFAULT);
  2534. }
  2535. switch (cmd) {
  2536. case SET_KEY:
  2537. if (is_default_wep_key)
  2538. ret = iwl_set_default_wep_key(priv, vif_priv->ctx, key);
  2539. else
  2540. ret = iwl_set_dynamic_key(priv, vif_priv->ctx,
  2541. key, sta_id);
  2542. IWL_DEBUG_MAC80211(priv, "enable hwcrypto key\n");
  2543. break;
  2544. case DISABLE_KEY:
  2545. if (is_default_wep_key)
  2546. ret = iwl_remove_default_wep_key(priv, ctx, key);
  2547. else
  2548. ret = iwl_remove_dynamic_key(priv, ctx, key, sta_id);
  2549. IWL_DEBUG_MAC80211(priv, "disable hwcrypto key\n");
  2550. break;
  2551. default:
  2552. ret = -EINVAL;
  2553. }
  2554. mutex_unlock(&priv->mutex);
  2555. IWL_DEBUG_MAC80211(priv, "leave\n");
  2556. return ret;
  2557. }
  2558. static int iwlagn_mac_ampdu_action(struct ieee80211_hw *hw,
  2559. struct ieee80211_vif *vif,
  2560. enum ieee80211_ampdu_mlme_action action,
  2561. struct ieee80211_sta *sta, u16 tid, u16 *ssn,
  2562. u8 buf_size)
  2563. {
  2564. struct iwl_priv *priv = hw->priv;
  2565. int ret = -EINVAL;
  2566. struct iwl_station_priv *sta_priv = (void *) sta->drv_priv;
  2567. IWL_DEBUG_HT(priv, "A-MPDU action on addr %pM tid %d\n",
  2568. sta->addr, tid);
  2569. if (!(priv->cfg->sku & IWL_SKU_N))
  2570. return -EACCES;
  2571. mutex_lock(&priv->mutex);
  2572. switch (action) {
  2573. case IEEE80211_AMPDU_RX_START:
  2574. IWL_DEBUG_HT(priv, "start Rx\n");
  2575. ret = iwl_sta_rx_agg_start(priv, sta, tid, *ssn);
  2576. break;
  2577. case IEEE80211_AMPDU_RX_STOP:
  2578. IWL_DEBUG_HT(priv, "stop Rx\n");
  2579. ret = iwl_sta_rx_agg_stop(priv, sta, tid);
  2580. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  2581. ret = 0;
  2582. break;
  2583. case IEEE80211_AMPDU_TX_START:
  2584. IWL_DEBUG_HT(priv, "start Tx\n");
  2585. ret = iwlagn_tx_agg_start(priv, vif, sta, tid, ssn);
  2586. if (ret == 0) {
  2587. priv->_agn.agg_tids_count++;
  2588. IWL_DEBUG_HT(priv, "priv->_agn.agg_tids_count = %u\n",
  2589. priv->_agn.agg_tids_count);
  2590. }
  2591. break;
  2592. case IEEE80211_AMPDU_TX_STOP:
  2593. IWL_DEBUG_HT(priv, "stop Tx\n");
  2594. ret = iwlagn_tx_agg_stop(priv, vif, sta, tid);
  2595. if ((ret == 0) && (priv->_agn.agg_tids_count > 0)) {
  2596. priv->_agn.agg_tids_count--;
  2597. IWL_DEBUG_HT(priv, "priv->_agn.agg_tids_count = %u\n",
  2598. priv->_agn.agg_tids_count);
  2599. }
  2600. if (test_bit(STATUS_EXIT_PENDING, &priv->status))
  2601. ret = 0;
  2602. if (priv->cfg->ht_params &&
  2603. priv->cfg->ht_params->use_rts_for_aggregation) {
  2604. struct iwl_station_priv *sta_priv =
  2605. (void *) sta->drv_priv;
  2606. /*
  2607. * switch off RTS/CTS if it was previously enabled
  2608. */
  2609. sta_priv->lq_sta.lq.general_params.flags &=
  2610. ~LINK_QUAL_FLAGS_SET_STA_TLC_RTS_MSK;
  2611. iwl_send_lq_cmd(priv, iwl_rxon_ctx_from_vif(vif),
  2612. &sta_priv->lq_sta.lq, CMD_ASYNC, false);
  2613. }
  2614. break;
  2615. case IEEE80211_AMPDU_TX_OPERATIONAL:
  2616. buf_size = min_t(int, buf_size, LINK_QUAL_AGG_FRAME_LIMIT_DEF);
  2617. iwlagn_txq_agg_queue_setup(priv, sta, tid, buf_size);
  2618. /*
  2619. * If the limit is 0, then it wasn't initialised yet,
  2620. * use the default. We can do that since we take the
  2621. * minimum below, and we don't want to go above our
  2622. * default due to hardware restrictions.
  2623. */
  2624. if (sta_priv->max_agg_bufsize == 0)
  2625. sta_priv->max_agg_bufsize =
  2626. LINK_QUAL_AGG_FRAME_LIMIT_DEF;
  2627. /*
  2628. * Even though in theory the peer could have different
  2629. * aggregation reorder buffer sizes for different sessions,
  2630. * our ucode doesn't allow for that and has a global limit
  2631. * for each station. Therefore, use the minimum of all the
  2632. * aggregation sessions and our default value.
  2633. */
  2634. sta_priv->max_agg_bufsize =
  2635. min(sta_priv->max_agg_bufsize, buf_size);
  2636. if (priv->cfg->ht_params &&
  2637. priv->cfg->ht_params->use_rts_for_aggregation) {
  2638. /*
  2639. * switch to RTS/CTS if it is the prefer protection
  2640. * method for HT traffic
  2641. */
  2642. sta_priv->lq_sta.lq.general_params.flags |=
  2643. LINK_QUAL_FLAGS_SET_STA_TLC_RTS_MSK;
  2644. }
  2645. sta_priv->lq_sta.lq.agg_params.agg_frame_cnt_limit =
  2646. sta_priv->max_agg_bufsize;
  2647. iwl_send_lq_cmd(priv, iwl_rxon_ctx_from_vif(vif),
  2648. &sta_priv->lq_sta.lq, CMD_ASYNC, false);
  2649. ret = 0;
  2650. break;
  2651. }
  2652. mutex_unlock(&priv->mutex);
  2653. return ret;
  2654. }
  2655. static int iwlagn_mac_sta_add(struct ieee80211_hw *hw,
  2656. struct ieee80211_vif *vif,
  2657. struct ieee80211_sta *sta)
  2658. {
  2659. struct iwl_priv *priv = hw->priv;
  2660. struct iwl_station_priv *sta_priv = (void *)sta->drv_priv;
  2661. struct iwl_vif_priv *vif_priv = (void *)vif->drv_priv;
  2662. bool is_ap = vif->type == NL80211_IFTYPE_STATION;
  2663. int ret;
  2664. u8 sta_id;
  2665. IWL_DEBUG_INFO(priv, "received request to add station %pM\n",
  2666. sta->addr);
  2667. mutex_lock(&priv->mutex);
  2668. IWL_DEBUG_INFO(priv, "proceeding to add station %pM\n",
  2669. sta->addr);
  2670. sta_priv->common.sta_id = IWL_INVALID_STATION;
  2671. atomic_set(&sta_priv->pending_frames, 0);
  2672. if (vif->type == NL80211_IFTYPE_AP)
  2673. sta_priv->client = true;
  2674. ret = iwl_add_station_common(priv, vif_priv->ctx, sta->addr,
  2675. is_ap, sta, &sta_id);
  2676. if (ret) {
  2677. IWL_ERR(priv, "Unable to add station %pM (%d)\n",
  2678. sta->addr, ret);
  2679. /* Should we return success if return code is EEXIST ? */
  2680. mutex_unlock(&priv->mutex);
  2681. return ret;
  2682. }
  2683. sta_priv->common.sta_id = sta_id;
  2684. /* Initialize rate scaling */
  2685. IWL_DEBUG_INFO(priv, "Initializing rate scaling for station %pM\n",
  2686. sta->addr);
  2687. iwl_rs_rate_init(priv, sta, sta_id);
  2688. mutex_unlock(&priv->mutex);
  2689. return 0;
  2690. }
  2691. static void iwlagn_mac_channel_switch(struct ieee80211_hw *hw,
  2692. struct ieee80211_channel_switch *ch_switch)
  2693. {
  2694. struct iwl_priv *priv = hw->priv;
  2695. const struct iwl_channel_info *ch_info;
  2696. struct ieee80211_conf *conf = &hw->conf;
  2697. struct ieee80211_channel *channel = ch_switch->channel;
  2698. struct iwl_ht_config *ht_conf = &priv->current_ht_config;
  2699. /*
  2700. * MULTI-FIXME
  2701. * When we add support for multiple interfaces, we need to
  2702. * revisit this. The channel switch command in the device
  2703. * only affects the BSS context, but what does that really
  2704. * mean? And what if we get a CSA on the second interface?
  2705. * This needs a lot of work.
  2706. */
  2707. struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_BSS];
  2708. u16 ch;
  2709. unsigned long flags = 0;
  2710. IWL_DEBUG_MAC80211(priv, "enter\n");
  2711. mutex_lock(&priv->mutex);
  2712. if (iwl_is_rfkill(priv))
  2713. goto out;
  2714. if (test_bit(STATUS_EXIT_PENDING, &priv->status) ||
  2715. test_bit(STATUS_SCANNING, &priv->status))
  2716. goto out;
  2717. if (!iwl_is_associated_ctx(ctx))
  2718. goto out;
  2719. /* channel switch in progress */
  2720. if (priv->switch_rxon.switch_in_progress == true)
  2721. goto out;
  2722. if (priv->cfg->ops->lib->set_channel_switch) {
  2723. ch = channel->hw_value;
  2724. if (le16_to_cpu(ctx->active.channel) != ch) {
  2725. ch_info = iwl_get_channel_info(priv,
  2726. channel->band,
  2727. ch);
  2728. if (!is_channel_valid(ch_info)) {
  2729. IWL_DEBUG_MAC80211(priv, "invalid channel\n");
  2730. goto out;
  2731. }
  2732. spin_lock_irqsave(&priv->lock, flags);
  2733. priv->current_ht_config.smps = conf->smps_mode;
  2734. /* Configure HT40 channels */
  2735. ctx->ht.enabled = conf_is_ht(conf);
  2736. if (ctx->ht.enabled) {
  2737. if (conf_is_ht40_minus(conf)) {
  2738. ctx->ht.extension_chan_offset =
  2739. IEEE80211_HT_PARAM_CHA_SEC_BELOW;
  2740. ctx->ht.is_40mhz = true;
  2741. } else if (conf_is_ht40_plus(conf)) {
  2742. ctx->ht.extension_chan_offset =
  2743. IEEE80211_HT_PARAM_CHA_SEC_ABOVE;
  2744. ctx->ht.is_40mhz = true;
  2745. } else {
  2746. ctx->ht.extension_chan_offset =
  2747. IEEE80211_HT_PARAM_CHA_SEC_NONE;
  2748. ctx->ht.is_40mhz = false;
  2749. }
  2750. } else
  2751. ctx->ht.is_40mhz = false;
  2752. if ((le16_to_cpu(ctx->staging.channel) != ch))
  2753. ctx->staging.flags = 0;
  2754. iwl_set_rxon_channel(priv, channel, ctx);
  2755. iwl_set_rxon_ht(priv, ht_conf);
  2756. iwl_set_flags_for_band(priv, ctx, channel->band,
  2757. ctx->vif);
  2758. spin_unlock_irqrestore(&priv->lock, flags);
  2759. iwl_set_rate(priv);
  2760. /*
  2761. * at this point, staging_rxon has the
  2762. * configuration for channel switch
  2763. */
  2764. if (priv->cfg->ops->lib->set_channel_switch(priv,
  2765. ch_switch))
  2766. priv->switch_rxon.switch_in_progress = false;
  2767. }
  2768. }
  2769. out:
  2770. mutex_unlock(&priv->mutex);
  2771. if (!priv->switch_rxon.switch_in_progress)
  2772. ieee80211_chswitch_done(ctx->vif, false);
  2773. IWL_DEBUG_MAC80211(priv, "leave\n");
  2774. }
  2775. static void iwlagn_configure_filter(struct ieee80211_hw *hw,
  2776. unsigned int changed_flags,
  2777. unsigned int *total_flags,
  2778. u64 multicast)
  2779. {
  2780. struct iwl_priv *priv = hw->priv;
  2781. __le32 filter_or = 0, filter_nand = 0;
  2782. struct iwl_rxon_context *ctx;
  2783. #define CHK(test, flag) do { \
  2784. if (*total_flags & (test)) \
  2785. filter_or |= (flag); \
  2786. else \
  2787. filter_nand |= (flag); \
  2788. } while (0)
  2789. IWL_DEBUG_MAC80211(priv, "Enter: changed: 0x%x, total: 0x%x\n",
  2790. changed_flags, *total_flags);
  2791. CHK(FIF_OTHER_BSS | FIF_PROMISC_IN_BSS, RXON_FILTER_PROMISC_MSK);
  2792. /* Setting _just_ RXON_FILTER_CTL2HOST_MSK causes FH errors */
  2793. CHK(FIF_CONTROL, RXON_FILTER_CTL2HOST_MSK | RXON_FILTER_PROMISC_MSK);
  2794. CHK(FIF_BCN_PRBRESP_PROMISC, RXON_FILTER_BCON_AWARE_MSK);
  2795. #undef CHK
  2796. mutex_lock(&priv->mutex);
  2797. for_each_context(priv, ctx) {
  2798. ctx->staging.filter_flags &= ~filter_nand;
  2799. ctx->staging.filter_flags |= filter_or;
  2800. /*
  2801. * Not committing directly because hardware can perform a scan,
  2802. * but we'll eventually commit the filter flags change anyway.
  2803. */
  2804. }
  2805. mutex_unlock(&priv->mutex);
  2806. /*
  2807. * Receiving all multicast frames is always enabled by the
  2808. * default flags setup in iwl_connection_init_rx_config()
  2809. * since we currently do not support programming multicast
  2810. * filters into the device.
  2811. */
  2812. *total_flags &= FIF_OTHER_BSS | FIF_ALLMULTI | FIF_PROMISC_IN_BSS |
  2813. FIF_BCN_PRBRESP_PROMISC | FIF_CONTROL;
  2814. }
  2815. static void iwlagn_mac_flush(struct ieee80211_hw *hw, bool drop)
  2816. {
  2817. struct iwl_priv *priv = hw->priv;
  2818. mutex_lock(&priv->mutex);
  2819. IWL_DEBUG_MAC80211(priv, "enter\n");
  2820. /* do not support "flush" */
  2821. if (!priv->cfg->ops->lib->txfifo_flush)
  2822. goto done;
  2823. if (test_bit(STATUS_EXIT_PENDING, &priv->status)) {
  2824. IWL_DEBUG_TX(priv, "Aborting flush due to device shutdown\n");
  2825. goto done;
  2826. }
  2827. if (iwl_is_rfkill(priv)) {
  2828. IWL_DEBUG_TX(priv, "Aborting flush due to RF Kill\n");
  2829. goto done;
  2830. }
  2831. /*
  2832. * mac80211 will not push any more frames for transmit
  2833. * until the flush is completed
  2834. */
  2835. if (drop) {
  2836. IWL_DEBUG_MAC80211(priv, "send flush command\n");
  2837. if (priv->cfg->ops->lib->txfifo_flush(priv, IWL_DROP_ALL)) {
  2838. IWL_ERR(priv, "flush request fail\n");
  2839. goto done;
  2840. }
  2841. }
  2842. IWL_DEBUG_MAC80211(priv, "wait transmit/flush all frames\n");
  2843. iwlagn_wait_tx_queue_empty(priv);
  2844. done:
  2845. mutex_unlock(&priv->mutex);
  2846. IWL_DEBUG_MAC80211(priv, "leave\n");
  2847. }
  2848. static void iwlagn_disable_roc(struct iwl_priv *priv)
  2849. {
  2850. struct iwl_rxon_context *ctx = &priv->contexts[IWL_RXON_CTX_PAN];
  2851. struct ieee80211_channel *chan = ACCESS_ONCE(priv->hw->conf.channel);
  2852. lockdep_assert_held(&priv->mutex);
  2853. if (!ctx->is_active)
  2854. return;
  2855. ctx->staging.dev_type = RXON_DEV_TYPE_2STA;
  2856. ctx->staging.filter_flags &= ~RXON_FILTER_ASSOC_MSK;
  2857. iwl_set_rxon_channel(priv, chan, ctx);
  2858. iwl_set_flags_for_band(priv, ctx, chan->band, NULL);
  2859. priv->_agn.hw_roc_channel = NULL;
  2860. iwlcore_commit_rxon(priv, ctx);
  2861. ctx->is_active = false;
  2862. }
  2863. static void iwlagn_bg_roc_done(struct work_struct *work)
  2864. {
  2865. struct iwl_priv *priv = container_of(work, struct iwl_priv,
  2866. _agn.hw_roc_work.work);
  2867. mutex_lock(&priv->mutex);
  2868. ieee80211_remain_on_channel_expired(priv->hw);
  2869. iwlagn_disable_roc(priv);
  2870. mutex_unlock(&priv->mutex);
  2871. }
  2872. static int iwl_mac_remain_on_channel(struct ieee80211_hw *hw,
  2873. struct ieee80211_channel *channel,
  2874. enum nl80211_channel_type channel_type,
  2875. int duration)
  2876. {
  2877. struct iwl_priv *priv = hw->priv;
  2878. int err = 0;
  2879. if (!(priv->valid_contexts & BIT(IWL_RXON_CTX_PAN)))
  2880. return -EOPNOTSUPP;
  2881. if (!(priv->contexts[IWL_RXON_CTX_PAN].interface_modes &
  2882. BIT(NL80211_IFTYPE_P2P_CLIENT)))
  2883. return -EOPNOTSUPP;
  2884. mutex_lock(&priv->mutex);
  2885. if (priv->contexts[IWL_RXON_CTX_PAN].is_active ||
  2886. test_bit(STATUS_SCAN_HW, &priv->status)) {
  2887. err = -EBUSY;
  2888. goto out;
  2889. }
  2890. priv->contexts[IWL_RXON_CTX_PAN].is_active = true;
  2891. priv->_agn.hw_roc_channel = channel;
  2892. priv->_agn.hw_roc_chantype = channel_type;
  2893. priv->_agn.hw_roc_duration = DIV_ROUND_UP(duration * 1000, 1024);
  2894. iwlcore_commit_rxon(priv, &priv->contexts[IWL_RXON_CTX_PAN]);
  2895. queue_delayed_work(priv->workqueue, &priv->_agn.hw_roc_work,
  2896. msecs_to_jiffies(duration + 20));
  2897. msleep(IWL_MIN_SLOT_TIME); /* TU is almost ms */
  2898. ieee80211_ready_on_channel(priv->hw);
  2899. out:
  2900. mutex_unlock(&priv->mutex);
  2901. return err;
  2902. }
  2903. static int iwl_mac_cancel_remain_on_channel(struct ieee80211_hw *hw)
  2904. {
  2905. struct iwl_priv *priv = hw->priv;
  2906. if (!(priv->valid_contexts & BIT(IWL_RXON_CTX_PAN)))
  2907. return -EOPNOTSUPP;
  2908. cancel_delayed_work_sync(&priv->_agn.hw_roc_work);
  2909. mutex_lock(&priv->mutex);
  2910. iwlagn_disable_roc(priv);
  2911. mutex_unlock(&priv->mutex);
  2912. return 0;
  2913. }
  2914. /*****************************************************************************
  2915. *
  2916. * driver setup and teardown
  2917. *
  2918. *****************************************************************************/
  2919. static void iwl_setup_deferred_work(struct iwl_priv *priv)
  2920. {
  2921. priv->workqueue = create_singlethread_workqueue(DRV_NAME);
  2922. init_waitqueue_head(&priv->wait_command_queue);
  2923. INIT_WORK(&priv->restart, iwl_bg_restart);
  2924. INIT_WORK(&priv->rx_replenish, iwl_bg_rx_replenish);
  2925. INIT_WORK(&priv->beacon_update, iwl_bg_beacon_update);
  2926. INIT_WORK(&priv->run_time_calib_work, iwl_bg_run_time_calib_work);
  2927. INIT_WORK(&priv->tx_flush, iwl_bg_tx_flush);
  2928. INIT_WORK(&priv->bt_full_concurrency, iwl_bg_bt_full_concurrency);
  2929. INIT_WORK(&priv->bt_runtime_config, iwl_bg_bt_runtime_config);
  2930. INIT_DELAYED_WORK(&priv->init_alive_start, iwl_bg_init_alive_start);
  2931. INIT_DELAYED_WORK(&priv->alive_start, iwl_bg_alive_start);
  2932. INIT_DELAYED_WORK(&priv->_agn.hw_roc_work, iwlagn_bg_roc_done);
  2933. iwl_setup_scan_deferred_work(priv);
  2934. if (priv->cfg->ops->lib->setup_deferred_work)
  2935. priv->cfg->ops->lib->setup_deferred_work(priv);
  2936. init_timer(&priv->statistics_periodic);
  2937. priv->statistics_periodic.data = (unsigned long)priv;
  2938. priv->statistics_periodic.function = iwl_bg_statistics_periodic;
  2939. init_timer(&priv->ucode_trace);
  2940. priv->ucode_trace.data = (unsigned long)priv;
  2941. priv->ucode_trace.function = iwl_bg_ucode_trace;
  2942. init_timer(&priv->watchdog);
  2943. priv->watchdog.data = (unsigned long)priv;
  2944. priv->watchdog.function = iwl_bg_watchdog;
  2945. tasklet_init(&priv->irq_tasklet, (void (*)(unsigned long))
  2946. iwl_irq_tasklet, (unsigned long)priv);
  2947. }
  2948. static void iwl_cancel_deferred_work(struct iwl_priv *priv)
  2949. {
  2950. if (priv->cfg->ops->lib->cancel_deferred_work)
  2951. priv->cfg->ops->lib->cancel_deferred_work(priv);
  2952. cancel_delayed_work_sync(&priv->init_alive_start);
  2953. cancel_delayed_work(&priv->alive_start);
  2954. cancel_work_sync(&priv->run_time_calib_work);
  2955. cancel_work_sync(&priv->beacon_update);
  2956. iwl_cancel_scan_deferred_work(priv);
  2957. cancel_work_sync(&priv->bt_full_concurrency);
  2958. cancel_work_sync(&priv->bt_runtime_config);
  2959. del_timer_sync(&priv->statistics_periodic);
  2960. del_timer_sync(&priv->ucode_trace);
  2961. }
  2962. static void iwl_init_hw_rates(struct iwl_priv *priv,
  2963. struct ieee80211_rate *rates)
  2964. {
  2965. int i;
  2966. for (i = 0; i < IWL_RATE_COUNT_LEGACY; i++) {
  2967. rates[i].bitrate = iwl_rates[i].ieee * 5;
  2968. rates[i].hw_value = i; /* Rate scaling will work on indexes */
  2969. rates[i].hw_value_short = i;
  2970. rates[i].flags = 0;
  2971. if ((i >= IWL_FIRST_CCK_RATE) && (i <= IWL_LAST_CCK_RATE)) {
  2972. /*
  2973. * If CCK != 1M then set short preamble rate flag.
  2974. */
  2975. rates[i].flags |=
  2976. (iwl_rates[i].plcp == IWL_RATE_1M_PLCP) ?
  2977. 0 : IEEE80211_RATE_SHORT_PREAMBLE;
  2978. }
  2979. }
  2980. }
  2981. static int iwl_init_drv(struct iwl_priv *priv)
  2982. {
  2983. int ret;
  2984. spin_lock_init(&priv->sta_lock);
  2985. spin_lock_init(&priv->hcmd_lock);
  2986. INIT_LIST_HEAD(&priv->free_frames);
  2987. mutex_init(&priv->mutex);
  2988. priv->ieee_channels = NULL;
  2989. priv->ieee_rates = NULL;
  2990. priv->band = IEEE80211_BAND_2GHZ;
  2991. priv->iw_mode = NL80211_IFTYPE_STATION;
  2992. priv->current_ht_config.smps = IEEE80211_SMPS_STATIC;
  2993. priv->missed_beacon_threshold = IWL_MISSED_BEACON_THRESHOLD_DEF;
  2994. priv->_agn.agg_tids_count = 0;
  2995. /* initialize force reset */
  2996. priv->force_reset[IWL_RF_RESET].reset_duration =
  2997. IWL_DELAY_NEXT_FORCE_RF_RESET;
  2998. priv->force_reset[IWL_FW_RESET].reset_duration =
  2999. IWL_DELAY_NEXT_FORCE_FW_RELOAD;
  3000. priv->rx_statistics_jiffies = jiffies;
  3001. /* Choose which receivers/antennas to use */
  3002. if (priv->cfg->ops->hcmd->set_rxon_chain)
  3003. priv->cfg->ops->hcmd->set_rxon_chain(priv,
  3004. &priv->contexts[IWL_RXON_CTX_BSS]);
  3005. iwl_init_scan_params(priv);
  3006. /* init bt coex */
  3007. if (priv->cfg->bt_params &&
  3008. priv->cfg->bt_params->advanced_bt_coexist) {
  3009. priv->kill_ack_mask = IWLAGN_BT_KILL_ACK_MASK_DEFAULT;
  3010. priv->kill_cts_mask = IWLAGN_BT_KILL_CTS_MASK_DEFAULT;
  3011. priv->bt_valid = IWLAGN_BT_ALL_VALID_MSK;
  3012. priv->bt_on_thresh = BT_ON_THRESHOLD_DEF;
  3013. priv->bt_duration = BT_DURATION_LIMIT_DEF;
  3014. priv->dynamic_frag_thresh = BT_FRAG_THRESHOLD_DEF;
  3015. }
  3016. /* Set the tx_power_user_lmt to the lowest power level
  3017. * this value will get overwritten by channel max power avg
  3018. * from eeprom */
  3019. priv->tx_power_user_lmt = IWLAGN_TX_POWER_TARGET_POWER_MIN;
  3020. priv->tx_power_next = IWLAGN_TX_POWER_TARGET_POWER_MIN;
  3021. ret = iwl_init_channel_map(priv);
  3022. if (ret) {
  3023. IWL_ERR(priv, "initializing regulatory failed: %d\n", ret);
  3024. goto err;
  3025. }
  3026. ret = iwlcore_init_geos(priv);
  3027. if (ret) {
  3028. IWL_ERR(priv, "initializing geos failed: %d\n", ret);
  3029. goto err_free_channel_map;
  3030. }
  3031. iwl_init_hw_rates(priv, priv->ieee_rates);
  3032. return 0;
  3033. err_free_channel_map:
  3034. iwl_free_channel_map(priv);
  3035. err:
  3036. return ret;
  3037. }
  3038. static void iwl_uninit_drv(struct iwl_priv *priv)
  3039. {
  3040. iwl_calib_free_results(priv);
  3041. iwlcore_free_geos(priv);
  3042. iwl_free_channel_map(priv);
  3043. kfree(priv->scan_cmd);
  3044. }
  3045. struct ieee80211_ops iwlagn_hw_ops = {
  3046. .tx = iwlagn_mac_tx,
  3047. .start = iwlagn_mac_start,
  3048. .stop = iwlagn_mac_stop,
  3049. .add_interface = iwl_mac_add_interface,
  3050. .remove_interface = iwl_mac_remove_interface,
  3051. .change_interface = iwl_mac_change_interface,
  3052. .config = iwlagn_mac_config,
  3053. .configure_filter = iwlagn_configure_filter,
  3054. .set_key = iwlagn_mac_set_key,
  3055. .update_tkip_key = iwlagn_mac_update_tkip_key,
  3056. .conf_tx = iwl_mac_conf_tx,
  3057. .bss_info_changed = iwlagn_bss_info_changed,
  3058. .ampdu_action = iwlagn_mac_ampdu_action,
  3059. .hw_scan = iwl_mac_hw_scan,
  3060. .sta_notify = iwlagn_mac_sta_notify,
  3061. .sta_add = iwlagn_mac_sta_add,
  3062. .sta_remove = iwl_mac_sta_remove,
  3063. .channel_switch = iwlagn_mac_channel_switch,
  3064. .flush = iwlagn_mac_flush,
  3065. .tx_last_beacon = iwl_mac_tx_last_beacon,
  3066. .remain_on_channel = iwl_mac_remain_on_channel,
  3067. .cancel_remain_on_channel = iwl_mac_cancel_remain_on_channel,
  3068. .offchannel_tx = iwl_mac_offchannel_tx,
  3069. .offchannel_tx_cancel_wait = iwl_mac_offchannel_tx_cancel_wait,
  3070. };
  3071. static u32 iwl_hw_detect(struct iwl_priv *priv)
  3072. {
  3073. priv->rev_id = priv->pci_dev->revision;
  3074. IWL_DEBUG_INFO(priv, "HW Revision ID = 0x%X\n", priv->rev_id);
  3075. return _iwl_read32(priv, CSR_HW_REV);
  3076. }
  3077. static int iwl_set_hw_params(struct iwl_priv *priv)
  3078. {
  3079. priv->hw_params.max_rxq_size = RX_QUEUE_SIZE;
  3080. priv->hw_params.max_rxq_log = RX_QUEUE_SIZE_LOG;
  3081. if (priv->cfg->mod_params->amsdu_size_8K)
  3082. priv->hw_params.rx_page_order = get_order(IWL_RX_BUF_SIZE_8K);
  3083. else
  3084. priv->hw_params.rx_page_order = get_order(IWL_RX_BUF_SIZE_4K);
  3085. priv->hw_params.max_beacon_itrvl = IWL_MAX_UCODE_BEACON_INTERVAL;
  3086. if (priv->cfg->mod_params->disable_11n)
  3087. priv->cfg->sku &= ~IWL_SKU_N;
  3088. /* Device-specific setup */
  3089. return priv->cfg->ops->lib->set_hw_params(priv);
  3090. }
  3091. static const u8 iwlagn_bss_ac_to_fifo[] = {
  3092. IWL_TX_FIFO_VO,
  3093. IWL_TX_FIFO_VI,
  3094. IWL_TX_FIFO_BE,
  3095. IWL_TX_FIFO_BK,
  3096. };
  3097. static const u8 iwlagn_bss_ac_to_queue[] = {
  3098. 0, 1, 2, 3,
  3099. };
  3100. static const u8 iwlagn_pan_ac_to_fifo[] = {
  3101. IWL_TX_FIFO_VO_IPAN,
  3102. IWL_TX_FIFO_VI_IPAN,
  3103. IWL_TX_FIFO_BE_IPAN,
  3104. IWL_TX_FIFO_BK_IPAN,
  3105. };
  3106. static const u8 iwlagn_pan_ac_to_queue[] = {
  3107. 7, 6, 5, 4,
  3108. };
  3109. static int iwl_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
  3110. {
  3111. int err = 0, i;
  3112. struct iwl_priv *priv;
  3113. struct ieee80211_hw *hw;
  3114. struct iwl_cfg *cfg = (struct iwl_cfg *)(ent->driver_data);
  3115. unsigned long flags;
  3116. u16 pci_cmd, num_mac;
  3117. u32 hw_rev;
  3118. /************************
  3119. * 1. Allocating HW data
  3120. ************************/
  3121. hw = iwl_alloc_all(cfg);
  3122. if (!hw) {
  3123. err = -ENOMEM;
  3124. goto out;
  3125. }
  3126. priv = hw->priv;
  3127. /* At this point both hw and priv are allocated. */
  3128. /*
  3129. * The default context is always valid,
  3130. * more may be discovered when firmware
  3131. * is loaded.
  3132. */
  3133. priv->valid_contexts = BIT(IWL_RXON_CTX_BSS);
  3134. for (i = 0; i < NUM_IWL_RXON_CTX; i++)
  3135. priv->contexts[i].ctxid = i;
  3136. priv->contexts[IWL_RXON_CTX_BSS].always_active = true;
  3137. priv->contexts[IWL_RXON_CTX_BSS].is_active = true;
  3138. priv->contexts[IWL_RXON_CTX_BSS].rxon_cmd = REPLY_RXON;
  3139. priv->contexts[IWL_RXON_CTX_BSS].rxon_timing_cmd = REPLY_RXON_TIMING;
  3140. priv->contexts[IWL_RXON_CTX_BSS].rxon_assoc_cmd = REPLY_RXON_ASSOC;
  3141. priv->contexts[IWL_RXON_CTX_BSS].qos_cmd = REPLY_QOS_PARAM;
  3142. priv->contexts[IWL_RXON_CTX_BSS].ap_sta_id = IWL_AP_ID;
  3143. priv->contexts[IWL_RXON_CTX_BSS].wep_key_cmd = REPLY_WEPKEY;
  3144. priv->contexts[IWL_RXON_CTX_BSS].ac_to_fifo = iwlagn_bss_ac_to_fifo;
  3145. priv->contexts[IWL_RXON_CTX_BSS].ac_to_queue = iwlagn_bss_ac_to_queue;
  3146. priv->contexts[IWL_RXON_CTX_BSS].exclusive_interface_modes =
  3147. BIT(NL80211_IFTYPE_ADHOC);
  3148. priv->contexts[IWL_RXON_CTX_BSS].interface_modes =
  3149. BIT(NL80211_IFTYPE_STATION);
  3150. priv->contexts[IWL_RXON_CTX_BSS].ap_devtype = RXON_DEV_TYPE_AP;
  3151. priv->contexts[IWL_RXON_CTX_BSS].ibss_devtype = RXON_DEV_TYPE_IBSS;
  3152. priv->contexts[IWL_RXON_CTX_BSS].station_devtype = RXON_DEV_TYPE_ESS;
  3153. priv->contexts[IWL_RXON_CTX_BSS].unused_devtype = RXON_DEV_TYPE_ESS;
  3154. priv->contexts[IWL_RXON_CTX_PAN].rxon_cmd = REPLY_WIPAN_RXON;
  3155. priv->contexts[IWL_RXON_CTX_PAN].rxon_timing_cmd = REPLY_WIPAN_RXON_TIMING;
  3156. priv->contexts[IWL_RXON_CTX_PAN].rxon_assoc_cmd = REPLY_WIPAN_RXON_ASSOC;
  3157. priv->contexts[IWL_RXON_CTX_PAN].qos_cmd = REPLY_WIPAN_QOS_PARAM;
  3158. priv->contexts[IWL_RXON_CTX_PAN].ap_sta_id = IWL_AP_ID_PAN;
  3159. priv->contexts[IWL_RXON_CTX_PAN].wep_key_cmd = REPLY_WIPAN_WEPKEY;
  3160. priv->contexts[IWL_RXON_CTX_PAN].bcast_sta_id = IWLAGN_PAN_BCAST_ID;
  3161. priv->contexts[IWL_RXON_CTX_PAN].station_flags = STA_FLG_PAN_STATION;
  3162. priv->contexts[IWL_RXON_CTX_PAN].ac_to_fifo = iwlagn_pan_ac_to_fifo;
  3163. priv->contexts[IWL_RXON_CTX_PAN].ac_to_queue = iwlagn_pan_ac_to_queue;
  3164. priv->contexts[IWL_RXON_CTX_PAN].mcast_queue = IWL_IPAN_MCAST_QUEUE;
  3165. priv->contexts[IWL_RXON_CTX_PAN].interface_modes =
  3166. BIT(NL80211_IFTYPE_STATION) | BIT(NL80211_IFTYPE_AP);
  3167. #ifdef CONFIG_IWL_P2P
  3168. priv->contexts[IWL_RXON_CTX_PAN].interface_modes |=
  3169. BIT(NL80211_IFTYPE_P2P_CLIENT) | BIT(NL80211_IFTYPE_P2P_GO);
  3170. #endif
  3171. priv->contexts[IWL_RXON_CTX_PAN].ap_devtype = RXON_DEV_TYPE_CP;
  3172. priv->contexts[IWL_RXON_CTX_PAN].station_devtype = RXON_DEV_TYPE_2STA;
  3173. priv->contexts[IWL_RXON_CTX_PAN].unused_devtype = RXON_DEV_TYPE_P2P;
  3174. BUILD_BUG_ON(NUM_IWL_RXON_CTX != 2);
  3175. SET_IEEE80211_DEV(hw, &pdev->dev);
  3176. IWL_DEBUG_INFO(priv, "*** LOAD DRIVER ***\n");
  3177. priv->cfg = cfg;
  3178. priv->pci_dev = pdev;
  3179. priv->inta_mask = CSR_INI_SET_MASK;
  3180. /* is antenna coupling more than 35dB ? */
  3181. priv->bt_ant_couple_ok =
  3182. (iwlagn_ant_coupling > IWL_BT_ANTENNA_COUPLING_THRESHOLD) ?
  3183. true : false;
  3184. /* enable/disable bt channel inhibition */
  3185. priv->bt_ch_announce = iwlagn_bt_ch_announce;
  3186. IWL_DEBUG_INFO(priv, "BT channel inhibition is %s\n",
  3187. (priv->bt_ch_announce) ? "On" : "Off");
  3188. if (iwl_alloc_traffic_mem(priv))
  3189. IWL_ERR(priv, "Not enough memory to generate traffic log\n");
  3190. /**************************
  3191. * 2. Initializing PCI bus
  3192. **************************/
  3193. pci_disable_link_state(pdev, PCIE_LINK_STATE_L0S | PCIE_LINK_STATE_L1 |
  3194. PCIE_LINK_STATE_CLKPM);
  3195. if (pci_enable_device(pdev)) {
  3196. err = -ENODEV;
  3197. goto out_ieee80211_free_hw;
  3198. }
  3199. pci_set_master(pdev);
  3200. err = pci_set_dma_mask(pdev, DMA_BIT_MASK(36));
  3201. if (!err)
  3202. err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(36));
  3203. if (err) {
  3204. err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
  3205. if (!err)
  3206. err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32));
  3207. /* both attempts failed: */
  3208. if (err) {
  3209. IWL_WARN(priv, "No suitable DMA available.\n");
  3210. goto out_pci_disable_device;
  3211. }
  3212. }
  3213. err = pci_request_regions(pdev, DRV_NAME);
  3214. if (err)
  3215. goto out_pci_disable_device;
  3216. pci_set_drvdata(pdev, priv);
  3217. /***********************
  3218. * 3. Read REV register
  3219. ***********************/
  3220. priv->hw_base = pci_iomap(pdev, 0, 0);
  3221. if (!priv->hw_base) {
  3222. err = -ENODEV;
  3223. goto out_pci_release_regions;
  3224. }
  3225. IWL_DEBUG_INFO(priv, "pci_resource_len = 0x%08llx\n",
  3226. (unsigned long long) pci_resource_len(pdev, 0));
  3227. IWL_DEBUG_INFO(priv, "pci_resource_base = %p\n", priv->hw_base);
  3228. /* these spin locks will be used in apm_ops.init and EEPROM access
  3229. * we should init now
  3230. */
  3231. spin_lock_init(&priv->reg_lock);
  3232. spin_lock_init(&priv->lock);
  3233. /*
  3234. * stop and reset the on-board processor just in case it is in a
  3235. * strange state ... like being left stranded by a primary kernel
  3236. * and this is now the kdump kernel trying to start up
  3237. */
  3238. iwl_write32(priv, CSR_RESET, CSR_RESET_REG_FLAG_NEVO_RESET);
  3239. hw_rev = iwl_hw_detect(priv);
  3240. IWL_INFO(priv, "Detected %s, REV=0x%X\n",
  3241. priv->cfg->name, hw_rev);
  3242. /* We disable the RETRY_TIMEOUT register (0x41) to keep
  3243. * PCI Tx retries from interfering with C3 CPU state */
  3244. pci_write_config_byte(pdev, PCI_CFG_RETRY_TIMEOUT, 0x00);
  3245. iwl_prepare_card_hw(priv);
  3246. if (!priv->hw_ready) {
  3247. IWL_WARN(priv, "Failed, HW not ready\n");
  3248. goto out_iounmap;
  3249. }
  3250. /*****************
  3251. * 4. Read EEPROM
  3252. *****************/
  3253. /* Read the EEPROM */
  3254. err = iwl_eeprom_init(priv, hw_rev);
  3255. if (err) {
  3256. IWL_ERR(priv, "Unable to init EEPROM\n");
  3257. goto out_iounmap;
  3258. }
  3259. err = iwl_eeprom_check_version(priv);
  3260. if (err)
  3261. goto out_free_eeprom;
  3262. err = iwl_eeprom_check_sku(priv);
  3263. if (err)
  3264. goto out_free_eeprom;
  3265. /* extract MAC Address */
  3266. iwl_eeprom_get_mac(priv, priv->addresses[0].addr);
  3267. IWL_DEBUG_INFO(priv, "MAC address: %pM\n", priv->addresses[0].addr);
  3268. priv->hw->wiphy->addresses = priv->addresses;
  3269. priv->hw->wiphy->n_addresses = 1;
  3270. num_mac = iwl_eeprom_query16(priv, EEPROM_NUM_MAC_ADDRESS);
  3271. if (num_mac > 1) {
  3272. memcpy(priv->addresses[1].addr, priv->addresses[0].addr,
  3273. ETH_ALEN);
  3274. priv->addresses[1].addr[5]++;
  3275. priv->hw->wiphy->n_addresses++;
  3276. }
  3277. /************************
  3278. * 5. Setup HW constants
  3279. ************************/
  3280. if (iwl_set_hw_params(priv)) {
  3281. IWL_ERR(priv, "failed to set hw parameters\n");
  3282. goto out_free_eeprom;
  3283. }
  3284. /*******************
  3285. * 6. Setup priv
  3286. *******************/
  3287. err = iwl_init_drv(priv);
  3288. if (err)
  3289. goto out_free_eeprom;
  3290. /* At this point both hw and priv are initialized. */
  3291. /********************
  3292. * 7. Setup services
  3293. ********************/
  3294. spin_lock_irqsave(&priv->lock, flags);
  3295. iwl_disable_interrupts(priv);
  3296. spin_unlock_irqrestore(&priv->lock, flags);
  3297. pci_enable_msi(priv->pci_dev);
  3298. if (priv->cfg->ops->lib->isr_ops.alloc)
  3299. priv->cfg->ops->lib->isr_ops.alloc(priv);
  3300. err = request_irq(priv->pci_dev->irq, priv->cfg->ops->lib->isr_ops.isr,
  3301. IRQF_SHARED, DRV_NAME, priv);
  3302. if (err) {
  3303. IWL_ERR(priv, "Error allocating IRQ %d\n", priv->pci_dev->irq);
  3304. goto out_disable_msi;
  3305. }
  3306. iwl_setup_deferred_work(priv);
  3307. iwl_setup_rx_handlers(priv);
  3308. /*********************************************
  3309. * 8. Enable interrupts and read RFKILL state
  3310. *********************************************/
  3311. /* enable rfkill interrupt: hw bug w/a */
  3312. pci_read_config_word(priv->pci_dev, PCI_COMMAND, &pci_cmd);
  3313. if (pci_cmd & PCI_COMMAND_INTX_DISABLE) {
  3314. pci_cmd &= ~PCI_COMMAND_INTX_DISABLE;
  3315. pci_write_config_word(priv->pci_dev, PCI_COMMAND, pci_cmd);
  3316. }
  3317. iwl_enable_rfkill_int(priv);
  3318. /* If platform's RF_KILL switch is NOT set to KILL */
  3319. if (iwl_read32(priv, CSR_GP_CNTRL) & CSR_GP_CNTRL_REG_FLAG_HW_RF_KILL_SW)
  3320. clear_bit(STATUS_RF_KILL_HW, &priv->status);
  3321. else
  3322. set_bit(STATUS_RF_KILL_HW, &priv->status);
  3323. wiphy_rfkill_set_hw_state(priv->hw->wiphy,
  3324. test_bit(STATUS_RF_KILL_HW, &priv->status));
  3325. iwl_power_initialize(priv);
  3326. iwl_tt_initialize(priv);
  3327. init_completion(&priv->_agn.firmware_loading_complete);
  3328. err = iwl_request_firmware(priv, true);
  3329. if (err)
  3330. goto out_destroy_workqueue;
  3331. return 0;
  3332. out_destroy_workqueue:
  3333. destroy_workqueue(priv->workqueue);
  3334. priv->workqueue = NULL;
  3335. free_irq(priv->pci_dev->irq, priv);
  3336. if (priv->cfg->ops->lib->isr_ops.free)
  3337. priv->cfg->ops->lib->isr_ops.free(priv);
  3338. out_disable_msi:
  3339. pci_disable_msi(priv->pci_dev);
  3340. iwl_uninit_drv(priv);
  3341. out_free_eeprom:
  3342. iwl_eeprom_free(priv);
  3343. out_iounmap:
  3344. pci_iounmap(pdev, priv->hw_base);
  3345. out_pci_release_regions:
  3346. pci_set_drvdata(pdev, NULL);
  3347. pci_release_regions(pdev);
  3348. out_pci_disable_device:
  3349. pci_disable_device(pdev);
  3350. out_ieee80211_free_hw:
  3351. iwl_free_traffic_mem(priv);
  3352. ieee80211_free_hw(priv->hw);
  3353. out:
  3354. return err;
  3355. }
  3356. static void __devexit iwl_pci_remove(struct pci_dev *pdev)
  3357. {
  3358. struct iwl_priv *priv = pci_get_drvdata(pdev);
  3359. unsigned long flags;
  3360. if (!priv)
  3361. return;
  3362. wait_for_completion(&priv->_agn.firmware_loading_complete);
  3363. IWL_DEBUG_INFO(priv, "*** UNLOAD DRIVER ***\n");
  3364. iwl_dbgfs_unregister(priv);
  3365. sysfs_remove_group(&pdev->dev.kobj, &iwl_attribute_group);
  3366. /* ieee80211_unregister_hw call wil cause iwl_mac_stop to
  3367. * to be called and iwl_down since we are removing the device
  3368. * we need to set STATUS_EXIT_PENDING bit.
  3369. */
  3370. set_bit(STATUS_EXIT_PENDING, &priv->status);
  3371. iwl_leds_exit(priv);
  3372. if (priv->mac80211_registered) {
  3373. ieee80211_unregister_hw(priv->hw);
  3374. priv->mac80211_registered = 0;
  3375. } else {
  3376. iwl_down(priv);
  3377. }
  3378. /*
  3379. * Make sure device is reset to low power before unloading driver.
  3380. * This may be redundant with iwl_down(), but there are paths to
  3381. * run iwl_down() without calling apm_ops.stop(), and there are
  3382. * paths to avoid running iwl_down() at all before leaving driver.
  3383. * This (inexpensive) call *makes sure* device is reset.
  3384. */
  3385. iwl_apm_stop(priv);
  3386. iwl_tt_exit(priv);
  3387. /* make sure we flush any pending irq or
  3388. * tasklet for the driver
  3389. */
  3390. spin_lock_irqsave(&priv->lock, flags);
  3391. iwl_disable_interrupts(priv);
  3392. spin_unlock_irqrestore(&priv->lock, flags);
  3393. iwl_synchronize_irq(priv);
  3394. iwl_dealloc_ucode_pci(priv);
  3395. if (priv->rxq.bd)
  3396. iwlagn_rx_queue_free(priv, &priv->rxq);
  3397. iwlagn_hw_txq_ctx_free(priv);
  3398. iwl_eeprom_free(priv);
  3399. /*netif_stop_queue(dev); */
  3400. flush_workqueue(priv->workqueue);
  3401. /* ieee80211_unregister_hw calls iwl_mac_stop, which flushes
  3402. * priv->workqueue... so we can't take down the workqueue
  3403. * until now... */
  3404. destroy_workqueue(priv->workqueue);
  3405. priv->workqueue = NULL;
  3406. iwl_free_traffic_mem(priv);
  3407. free_irq(priv->pci_dev->irq, priv);
  3408. pci_disable_msi(priv->pci_dev);
  3409. pci_iounmap(pdev, priv->hw_base);
  3410. pci_release_regions(pdev);
  3411. pci_disable_device(pdev);
  3412. pci_set_drvdata(pdev, NULL);
  3413. iwl_uninit_drv(priv);
  3414. if (priv->cfg->ops->lib->isr_ops.free)
  3415. priv->cfg->ops->lib->isr_ops.free(priv);
  3416. dev_kfree_skb(priv->beacon_skb);
  3417. ieee80211_free_hw(priv->hw);
  3418. }
  3419. /*****************************************************************************
  3420. *
  3421. * driver and module entry point
  3422. *
  3423. *****************************************************************************/
  3424. /* Hardware specific file defines the PCI IDs table for that hardware module */
  3425. static DEFINE_PCI_DEVICE_TABLE(iwl_hw_card_ids) = {
  3426. {IWL_PCI_DEVICE(0x4232, 0x1201, iwl5100_agn_cfg)}, /* Mini Card */
  3427. {IWL_PCI_DEVICE(0x4232, 0x1301, iwl5100_agn_cfg)}, /* Half Mini Card */
  3428. {IWL_PCI_DEVICE(0x4232, 0x1204, iwl5100_agn_cfg)}, /* Mini Card */
  3429. {IWL_PCI_DEVICE(0x4232, 0x1304, iwl5100_agn_cfg)}, /* Half Mini Card */
  3430. {IWL_PCI_DEVICE(0x4232, 0x1205, iwl5100_bgn_cfg)}, /* Mini Card */
  3431. {IWL_PCI_DEVICE(0x4232, 0x1305, iwl5100_bgn_cfg)}, /* Half Mini Card */
  3432. {IWL_PCI_DEVICE(0x4232, 0x1206, iwl5100_abg_cfg)}, /* Mini Card */
  3433. {IWL_PCI_DEVICE(0x4232, 0x1306, iwl5100_abg_cfg)}, /* Half Mini Card */
  3434. {IWL_PCI_DEVICE(0x4232, 0x1221, iwl5100_agn_cfg)}, /* Mini Card */
  3435. {IWL_PCI_DEVICE(0x4232, 0x1321, iwl5100_agn_cfg)}, /* Half Mini Card */
  3436. {IWL_PCI_DEVICE(0x4232, 0x1224, iwl5100_agn_cfg)}, /* Mini Card */
  3437. {IWL_PCI_DEVICE(0x4232, 0x1324, iwl5100_agn_cfg)}, /* Half Mini Card */
  3438. {IWL_PCI_DEVICE(0x4232, 0x1225, iwl5100_bgn_cfg)}, /* Mini Card */
  3439. {IWL_PCI_DEVICE(0x4232, 0x1325, iwl5100_bgn_cfg)}, /* Half Mini Card */
  3440. {IWL_PCI_DEVICE(0x4232, 0x1226, iwl5100_abg_cfg)}, /* Mini Card */
  3441. {IWL_PCI_DEVICE(0x4232, 0x1326, iwl5100_abg_cfg)}, /* Half Mini Card */
  3442. {IWL_PCI_DEVICE(0x4237, 0x1211, iwl5100_agn_cfg)}, /* Mini Card */
  3443. {IWL_PCI_DEVICE(0x4237, 0x1311, iwl5100_agn_cfg)}, /* Half Mini Card */
  3444. {IWL_PCI_DEVICE(0x4237, 0x1214, iwl5100_agn_cfg)}, /* Mini Card */
  3445. {IWL_PCI_DEVICE(0x4237, 0x1314, iwl5100_agn_cfg)}, /* Half Mini Card */
  3446. {IWL_PCI_DEVICE(0x4237, 0x1215, iwl5100_bgn_cfg)}, /* Mini Card */
  3447. {IWL_PCI_DEVICE(0x4237, 0x1315, iwl5100_bgn_cfg)}, /* Half Mini Card */
  3448. {IWL_PCI_DEVICE(0x4237, 0x1216, iwl5100_abg_cfg)}, /* Mini Card */
  3449. {IWL_PCI_DEVICE(0x4237, 0x1316, iwl5100_abg_cfg)}, /* Half Mini Card */
  3450. /* 5300 Series WiFi */
  3451. {IWL_PCI_DEVICE(0x4235, 0x1021, iwl5300_agn_cfg)}, /* Mini Card */
  3452. {IWL_PCI_DEVICE(0x4235, 0x1121, iwl5300_agn_cfg)}, /* Half Mini Card */
  3453. {IWL_PCI_DEVICE(0x4235, 0x1024, iwl5300_agn_cfg)}, /* Mini Card */
  3454. {IWL_PCI_DEVICE(0x4235, 0x1124, iwl5300_agn_cfg)}, /* Half Mini Card */
  3455. {IWL_PCI_DEVICE(0x4235, 0x1001, iwl5300_agn_cfg)}, /* Mini Card */
  3456. {IWL_PCI_DEVICE(0x4235, 0x1101, iwl5300_agn_cfg)}, /* Half Mini Card */
  3457. {IWL_PCI_DEVICE(0x4235, 0x1004, iwl5300_agn_cfg)}, /* Mini Card */
  3458. {IWL_PCI_DEVICE(0x4235, 0x1104, iwl5300_agn_cfg)}, /* Half Mini Card */
  3459. {IWL_PCI_DEVICE(0x4236, 0x1011, iwl5300_agn_cfg)}, /* Mini Card */
  3460. {IWL_PCI_DEVICE(0x4236, 0x1111, iwl5300_agn_cfg)}, /* Half Mini Card */
  3461. {IWL_PCI_DEVICE(0x4236, 0x1014, iwl5300_agn_cfg)}, /* Mini Card */
  3462. {IWL_PCI_DEVICE(0x4236, 0x1114, iwl5300_agn_cfg)}, /* Half Mini Card */
  3463. /* 5350 Series WiFi/WiMax */
  3464. {IWL_PCI_DEVICE(0x423A, 0x1001, iwl5350_agn_cfg)}, /* Mini Card */
  3465. {IWL_PCI_DEVICE(0x423A, 0x1021, iwl5350_agn_cfg)}, /* Mini Card */
  3466. {IWL_PCI_DEVICE(0x423B, 0x1011, iwl5350_agn_cfg)}, /* Mini Card */
  3467. /* 5150 Series Wifi/WiMax */
  3468. {IWL_PCI_DEVICE(0x423C, 0x1201, iwl5150_agn_cfg)}, /* Mini Card */
  3469. {IWL_PCI_DEVICE(0x423C, 0x1301, iwl5150_agn_cfg)}, /* Half Mini Card */
  3470. {IWL_PCI_DEVICE(0x423C, 0x1206, iwl5150_abg_cfg)}, /* Mini Card */
  3471. {IWL_PCI_DEVICE(0x423C, 0x1306, iwl5150_abg_cfg)}, /* Half Mini Card */
  3472. {IWL_PCI_DEVICE(0x423C, 0x1221, iwl5150_agn_cfg)}, /* Mini Card */
  3473. {IWL_PCI_DEVICE(0x423C, 0x1321, iwl5150_agn_cfg)}, /* Half Mini Card */
  3474. {IWL_PCI_DEVICE(0x423D, 0x1211, iwl5150_agn_cfg)}, /* Mini Card */
  3475. {IWL_PCI_DEVICE(0x423D, 0x1311, iwl5150_agn_cfg)}, /* Half Mini Card */
  3476. {IWL_PCI_DEVICE(0x423D, 0x1216, iwl5150_abg_cfg)}, /* Mini Card */
  3477. {IWL_PCI_DEVICE(0x423D, 0x1316, iwl5150_abg_cfg)}, /* Half Mini Card */
  3478. /* 6x00 Series */
  3479. {IWL_PCI_DEVICE(0x422B, 0x1101, iwl6000_3agn_cfg)},
  3480. {IWL_PCI_DEVICE(0x422B, 0x1121, iwl6000_3agn_cfg)},
  3481. {IWL_PCI_DEVICE(0x422C, 0x1301, iwl6000i_2agn_cfg)},
  3482. {IWL_PCI_DEVICE(0x422C, 0x1306, iwl6000i_2abg_cfg)},
  3483. {IWL_PCI_DEVICE(0x422C, 0x1307, iwl6000i_2bg_cfg)},
  3484. {IWL_PCI_DEVICE(0x422C, 0x1321, iwl6000i_2agn_cfg)},
  3485. {IWL_PCI_DEVICE(0x422C, 0x1326, iwl6000i_2abg_cfg)},
  3486. {IWL_PCI_DEVICE(0x4238, 0x1111, iwl6000_3agn_cfg)},
  3487. {IWL_PCI_DEVICE(0x4239, 0x1311, iwl6000i_2agn_cfg)},
  3488. {IWL_PCI_DEVICE(0x4239, 0x1316, iwl6000i_2abg_cfg)},
  3489. /* 6x05 Series */
  3490. {IWL_PCI_DEVICE(0x0082, 0x1301, iwl6005_2agn_cfg)},
  3491. {IWL_PCI_DEVICE(0x0082, 0x1306, iwl6005_2abg_cfg)},
  3492. {IWL_PCI_DEVICE(0x0082, 0x1307, iwl6005_2bg_cfg)},
  3493. {IWL_PCI_DEVICE(0x0082, 0x1321, iwl6005_2agn_cfg)},
  3494. {IWL_PCI_DEVICE(0x0082, 0x1326, iwl6005_2abg_cfg)},
  3495. {IWL_PCI_DEVICE(0x0085, 0x1311, iwl6005_2agn_cfg)},
  3496. {IWL_PCI_DEVICE(0x0085, 0x1316, iwl6005_2abg_cfg)},
  3497. /* 6x30 Series */
  3498. {IWL_PCI_DEVICE(0x008A, 0x5305, iwl1030_bgn_cfg)},
  3499. {IWL_PCI_DEVICE(0x008A, 0x5307, iwl1030_bg_cfg)},
  3500. {IWL_PCI_DEVICE(0x008A, 0x5325, iwl1030_bgn_cfg)},
  3501. {IWL_PCI_DEVICE(0x008A, 0x5327, iwl1030_bg_cfg)},
  3502. {IWL_PCI_DEVICE(0x008B, 0x5315, iwl1030_bgn_cfg)},
  3503. {IWL_PCI_DEVICE(0x008B, 0x5317, iwl1030_bg_cfg)},
  3504. {IWL_PCI_DEVICE(0x0090, 0x5211, iwl6030_2agn_cfg)},
  3505. {IWL_PCI_DEVICE(0x0090, 0x5215, iwl6030_2bgn_cfg)},
  3506. {IWL_PCI_DEVICE(0x0090, 0x5216, iwl6030_2abg_cfg)},
  3507. {IWL_PCI_DEVICE(0x0091, 0x5201, iwl6030_2agn_cfg)},
  3508. {IWL_PCI_DEVICE(0x0091, 0x5205, iwl6030_2bgn_cfg)},
  3509. {IWL_PCI_DEVICE(0x0091, 0x5206, iwl6030_2abg_cfg)},
  3510. {IWL_PCI_DEVICE(0x0091, 0x5207, iwl6030_2bg_cfg)},
  3511. {IWL_PCI_DEVICE(0x0091, 0x5221, iwl6030_2agn_cfg)},
  3512. {IWL_PCI_DEVICE(0x0091, 0x5225, iwl6030_2bgn_cfg)},
  3513. {IWL_PCI_DEVICE(0x0091, 0x5226, iwl6030_2abg_cfg)},
  3514. /* 6x50 WiFi/WiMax Series */
  3515. {IWL_PCI_DEVICE(0x0087, 0x1301, iwl6050_2agn_cfg)},
  3516. {IWL_PCI_DEVICE(0x0087, 0x1306, iwl6050_2abg_cfg)},
  3517. {IWL_PCI_DEVICE(0x0087, 0x1321, iwl6050_2agn_cfg)},
  3518. {IWL_PCI_DEVICE(0x0087, 0x1326, iwl6050_2abg_cfg)},
  3519. {IWL_PCI_DEVICE(0x0089, 0x1311, iwl6050_2agn_cfg)},
  3520. {IWL_PCI_DEVICE(0x0089, 0x1316, iwl6050_2abg_cfg)},
  3521. /* 6150 WiFi/WiMax Series */
  3522. {IWL_PCI_DEVICE(0x0885, 0x1305, iwl6150_bgn_cfg)},
  3523. {IWL_PCI_DEVICE(0x0885, 0x1306, iwl6150_bgn_cfg)},
  3524. {IWL_PCI_DEVICE(0x0885, 0x1325, iwl6150_bgn_cfg)},
  3525. {IWL_PCI_DEVICE(0x0885, 0x1326, iwl6150_bgn_cfg)},
  3526. {IWL_PCI_DEVICE(0x0886, 0x1315, iwl6150_bgn_cfg)},
  3527. {IWL_PCI_DEVICE(0x0886, 0x1316, iwl6150_bgn_cfg)},
  3528. /* 1000 Series WiFi */
  3529. {IWL_PCI_DEVICE(0x0083, 0x1205, iwl1000_bgn_cfg)},
  3530. {IWL_PCI_DEVICE(0x0083, 0x1305, iwl1000_bgn_cfg)},
  3531. {IWL_PCI_DEVICE(0x0083, 0x1225, iwl1000_bgn_cfg)},
  3532. {IWL_PCI_DEVICE(0x0083, 0x1325, iwl1000_bgn_cfg)},
  3533. {IWL_PCI_DEVICE(0x0084, 0x1215, iwl1000_bgn_cfg)},
  3534. {IWL_PCI_DEVICE(0x0084, 0x1315, iwl1000_bgn_cfg)},
  3535. {IWL_PCI_DEVICE(0x0083, 0x1206, iwl1000_bg_cfg)},
  3536. {IWL_PCI_DEVICE(0x0083, 0x1306, iwl1000_bg_cfg)},
  3537. {IWL_PCI_DEVICE(0x0083, 0x1226, iwl1000_bg_cfg)},
  3538. {IWL_PCI_DEVICE(0x0083, 0x1326, iwl1000_bg_cfg)},
  3539. {IWL_PCI_DEVICE(0x0084, 0x1216, iwl1000_bg_cfg)},
  3540. {IWL_PCI_DEVICE(0x0084, 0x1316, iwl1000_bg_cfg)},
  3541. /* 100 Series WiFi */
  3542. {IWL_PCI_DEVICE(0x08AE, 0x1005, iwl100_bgn_cfg)},
  3543. {IWL_PCI_DEVICE(0x08AE, 0x1007, iwl100_bg_cfg)},
  3544. {IWL_PCI_DEVICE(0x08AF, 0x1015, iwl100_bgn_cfg)},
  3545. {IWL_PCI_DEVICE(0x08AF, 0x1017, iwl100_bg_cfg)},
  3546. {IWL_PCI_DEVICE(0x08AE, 0x1025, iwl100_bgn_cfg)},
  3547. {IWL_PCI_DEVICE(0x08AE, 0x1027, iwl100_bg_cfg)},
  3548. /* 130 Series WiFi */
  3549. {IWL_PCI_DEVICE(0x0896, 0x5005, iwl130_bgn_cfg)},
  3550. {IWL_PCI_DEVICE(0x0896, 0x5007, iwl130_bg_cfg)},
  3551. {IWL_PCI_DEVICE(0x0897, 0x5015, iwl130_bgn_cfg)},
  3552. {IWL_PCI_DEVICE(0x0897, 0x5017, iwl130_bg_cfg)},
  3553. {IWL_PCI_DEVICE(0x0896, 0x5025, iwl130_bgn_cfg)},
  3554. {IWL_PCI_DEVICE(0x0896, 0x5027, iwl130_bg_cfg)},
  3555. /* 2x00 Series */
  3556. {IWL_PCI_DEVICE(0x0890, 0x4022, iwl2000_2bgn_cfg)},
  3557. {IWL_PCI_DEVICE(0x0891, 0x4222, iwl2000_2bgn_cfg)},
  3558. {IWL_PCI_DEVICE(0x0890, 0x4422, iwl2000_2bgn_cfg)},
  3559. {IWL_PCI_DEVICE(0x0890, 0x4026, iwl2000_2bg_cfg)},
  3560. {IWL_PCI_DEVICE(0x0891, 0x4226, iwl2000_2bg_cfg)},
  3561. {IWL_PCI_DEVICE(0x0890, 0x4426, iwl2000_2bg_cfg)},
  3562. /* 2x30 Series */
  3563. {IWL_PCI_DEVICE(0x0887, 0x4062, iwl2030_2bgn_cfg)},
  3564. {IWL_PCI_DEVICE(0x0888, 0x4262, iwl2030_2bgn_cfg)},
  3565. {IWL_PCI_DEVICE(0x0887, 0x4462, iwl2030_2bgn_cfg)},
  3566. {IWL_PCI_DEVICE(0x0887, 0x4066, iwl2030_2bg_cfg)},
  3567. {IWL_PCI_DEVICE(0x0888, 0x4266, iwl2030_2bg_cfg)},
  3568. {IWL_PCI_DEVICE(0x0887, 0x4466, iwl2030_2bg_cfg)},
  3569. /* 6x35 Series */
  3570. {IWL_PCI_DEVICE(0x088E, 0x4060, iwl6035_2agn_cfg)},
  3571. {IWL_PCI_DEVICE(0x088F, 0x4260, iwl6035_2agn_cfg)},
  3572. {IWL_PCI_DEVICE(0x088E, 0x4460, iwl6035_2agn_cfg)},
  3573. {IWL_PCI_DEVICE(0x088E, 0x4064, iwl6035_2abg_cfg)},
  3574. {IWL_PCI_DEVICE(0x088F, 0x4264, iwl6035_2abg_cfg)},
  3575. {IWL_PCI_DEVICE(0x088E, 0x4464, iwl6035_2abg_cfg)},
  3576. {IWL_PCI_DEVICE(0x088E, 0x4066, iwl6035_2bg_cfg)},
  3577. {IWL_PCI_DEVICE(0x088F, 0x4266, iwl6035_2bg_cfg)},
  3578. {IWL_PCI_DEVICE(0x088E, 0x4466, iwl6035_2bg_cfg)},
  3579. /* 200 Series */
  3580. {IWL_PCI_DEVICE(0x0894, 0x0022, iwl200_bgn_cfg)},
  3581. {IWL_PCI_DEVICE(0x0895, 0x0222, iwl200_bgn_cfg)},
  3582. {IWL_PCI_DEVICE(0x0894, 0x0422, iwl200_bgn_cfg)},
  3583. {IWL_PCI_DEVICE(0x0894, 0x0026, iwl200_bg_cfg)},
  3584. {IWL_PCI_DEVICE(0x0895, 0x0226, iwl200_bg_cfg)},
  3585. {IWL_PCI_DEVICE(0x0894, 0x0426, iwl200_bg_cfg)},
  3586. /* 230 Series */
  3587. {IWL_PCI_DEVICE(0x0892, 0x0062, iwl230_bgn_cfg)},
  3588. {IWL_PCI_DEVICE(0x0893, 0x0262, iwl230_bgn_cfg)},
  3589. {IWL_PCI_DEVICE(0x0892, 0x0462, iwl230_bgn_cfg)},
  3590. {IWL_PCI_DEVICE(0x0892, 0x0066, iwl230_bg_cfg)},
  3591. {IWL_PCI_DEVICE(0x0893, 0x0266, iwl230_bg_cfg)},
  3592. {IWL_PCI_DEVICE(0x0892, 0x0466, iwl230_bg_cfg)},
  3593. {0}
  3594. };
  3595. MODULE_DEVICE_TABLE(pci, iwl_hw_card_ids);
  3596. static struct pci_driver iwl_driver = {
  3597. .name = DRV_NAME,
  3598. .id_table = iwl_hw_card_ids,
  3599. .probe = iwl_pci_probe,
  3600. .remove = __devexit_p(iwl_pci_remove),
  3601. .driver.pm = IWL_PM_OPS,
  3602. };
  3603. static int __init iwl_init(void)
  3604. {
  3605. int ret;
  3606. pr_info(DRV_DESCRIPTION ", " DRV_VERSION "\n");
  3607. pr_info(DRV_COPYRIGHT "\n");
  3608. ret = iwlagn_rate_control_register();
  3609. if (ret) {
  3610. pr_err("Unable to register rate control algorithm: %d\n", ret);
  3611. return ret;
  3612. }
  3613. ret = pci_register_driver(&iwl_driver);
  3614. if (ret) {
  3615. pr_err("Unable to initialize PCI module\n");
  3616. goto error_register;
  3617. }
  3618. return ret;
  3619. error_register:
  3620. iwlagn_rate_control_unregister();
  3621. return ret;
  3622. }
  3623. static void __exit iwl_exit(void)
  3624. {
  3625. pci_unregister_driver(&iwl_driver);
  3626. iwlagn_rate_control_unregister();
  3627. }
  3628. module_exit(iwl_exit);
  3629. module_init(iwl_init);
  3630. #ifdef CONFIG_IWLWIFI_DEBUG
  3631. module_param_named(debug, iwl_debug_level, uint, S_IRUGO | S_IWUSR);
  3632. MODULE_PARM_DESC(debug, "debug output mask");
  3633. #endif
  3634. module_param_named(swcrypto, iwlagn_mod_params.sw_crypto, int, S_IRUGO);
  3635. MODULE_PARM_DESC(swcrypto, "using crypto in software (default 0 [hardware])");
  3636. module_param_named(queues_num, iwlagn_mod_params.num_of_queues, int, S_IRUGO);
  3637. MODULE_PARM_DESC(queues_num, "number of hw queues.");
  3638. module_param_named(11n_disable, iwlagn_mod_params.disable_11n, int, S_IRUGO);
  3639. MODULE_PARM_DESC(11n_disable, "disable 11n functionality");
  3640. module_param_named(amsdu_size_8K, iwlagn_mod_params.amsdu_size_8K,
  3641. int, S_IRUGO);
  3642. MODULE_PARM_DESC(amsdu_size_8K, "enable 8K amsdu size");
  3643. module_param_named(fw_restart, iwlagn_mod_params.restart_fw, int, S_IRUGO);
  3644. MODULE_PARM_DESC(fw_restart, "restart firmware in case of error");
  3645. module_param_named(ucode_alternative, iwlagn_wanted_ucode_alternative, int,
  3646. S_IRUGO);
  3647. MODULE_PARM_DESC(ucode_alternative,
  3648. "specify ucode alternative to use from ucode file");
  3649. module_param_named(antenna_coupling, iwlagn_ant_coupling, int, S_IRUGO);
  3650. MODULE_PARM_DESC(antenna_coupling,
  3651. "specify antenna coupling in dB (defualt: 0 dB)");
  3652. module_param_named(bt_ch_inhibition, iwlagn_bt_ch_announce, bool, S_IRUGO);
  3653. MODULE_PARM_DESC(bt_ch_inhibition,
  3654. "Disable BT channel inhibition (default: enable)");
  3655. module_param_named(plcp_check, iwlagn_mod_params.plcp_check, bool, S_IRUGO);
  3656. MODULE_PARM_DESC(plcp_check, "Check plcp health (default: 1 [enabled])");
  3657. module_param_named(ack_check, iwlagn_mod_params.ack_check, bool, S_IRUGO);
  3658. MODULE_PARM_DESC(ack_check, "Check ack health (default: 0 [disabled])");