iwl-agn.c 125 KB

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