qlcnic_83xx_hw.c 86 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523252425252526252725282529253025312532253325342535253625372538253925402541254225432544254525462547254825492550255125522553255425552556255725582559256025612562256325642565256625672568256925702571257225732574257525762577257825792580258125822583258425852586258725882589259025912592259325942595259625972598259926002601260226032604260526062607260826092610261126122613261426152616261726182619262026212622262326242625262626272628262926302631263226332634263526362637263826392640264126422643264426452646264726482649265026512652265326542655265626572658265926602661266226632664266526662667266826692670267126722673267426752676267726782679268026812682268326842685268626872688268926902691269226932694269526962697269826992700270127022703270427052706270727082709271027112712271327142715271627172718271927202721272227232724272527262727272827292730273127322733273427352736273727382739274027412742274327442745274627472748274927502751275227532754275527562757275827592760276127622763276427652766276727682769277027712772277327742775277627772778277927802781278227832784278527862787278827892790279127922793279427952796279727982799280028012802280328042805280628072808280928102811281228132814281528162817281828192820282128222823282428252826282728282829283028312832283328342835283628372838283928402841284228432844284528462847284828492850285128522853285428552856285728582859286028612862286328642865286628672868286928702871287228732874287528762877287828792880288128822883288428852886288728882889289028912892289328942895289628972898289929002901290229032904290529062907290829092910291129122913291429152916291729182919292029212922292329242925292629272928292929302931293229332934293529362937293829392940294129422943294429452946294729482949295029512952295329542955295629572958295929602961296229632964296529662967296829692970297129722973297429752976297729782979298029812982298329842985298629872988298929902991299229932994299529962997299829993000300130023003300430053006300730083009301030113012301330143015301630173018301930203021302230233024302530263027302830293030303130323033303430353036303730383039304030413042304330443045304630473048304930503051305230533054305530563057305830593060306130623063306430653066306730683069307030713072307330743075307630773078307930803081308230833084308530863087308830893090309130923093309430953096309730983099310031013102310331043105310631073108310931103111311231133114311531163117311831193120312131223123312431253126312731283129313031313132313331343135313631373138313931403141314231433144314531463147314831493150315131523153315431553156315731583159316031613162316331643165316631673168316931703171317231733174317531763177317831793180318131823183
  1. /*
  2. * QLogic qlcnic NIC Driver
  3. * Copyright (c) 2009-2013 QLogic Corporation
  4. *
  5. * See LICENSE.qlcnic for copyright and licensing details.
  6. */
  7. #include "qlcnic.h"
  8. #include "qlcnic_sriov.h"
  9. #include <linux/if_vlan.h>
  10. #include <linux/ipv6.h>
  11. #include <linux/ethtool.h>
  12. #include <linux/interrupt.h>
  13. #define QLCNIC_MAX_TX_QUEUES 1
  14. #define RSS_HASHTYPE_IP_TCP 0x3
  15. #define QLC_83XX_FW_MBX_CMD 0
  16. static const struct qlcnic_mailbox_metadata qlcnic_83xx_mbx_tbl[] = {
  17. {QLCNIC_CMD_CONFIGURE_IP_ADDR, 6, 1},
  18. {QLCNIC_CMD_CONFIG_INTRPT, 18, 34},
  19. {QLCNIC_CMD_CREATE_RX_CTX, 136, 27},
  20. {QLCNIC_CMD_DESTROY_RX_CTX, 2, 1},
  21. {QLCNIC_CMD_CREATE_TX_CTX, 54, 18},
  22. {QLCNIC_CMD_DESTROY_TX_CTX, 2, 1},
  23. {QLCNIC_CMD_CONFIGURE_MAC_LEARNING, 2, 1},
  24. {QLCNIC_CMD_INTRPT_TEST, 22, 12},
  25. {QLCNIC_CMD_SET_MTU, 3, 1},
  26. {QLCNIC_CMD_READ_PHY, 4, 2},
  27. {QLCNIC_CMD_WRITE_PHY, 5, 1},
  28. {QLCNIC_CMD_READ_HW_REG, 4, 1},
  29. {QLCNIC_CMD_GET_FLOW_CTL, 4, 2},
  30. {QLCNIC_CMD_SET_FLOW_CTL, 4, 1},
  31. {QLCNIC_CMD_READ_MAX_MTU, 4, 2},
  32. {QLCNIC_CMD_READ_MAX_LRO, 4, 2},
  33. {QLCNIC_CMD_MAC_ADDRESS, 4, 3},
  34. {QLCNIC_CMD_GET_PCI_INFO, 1, 66},
  35. {QLCNIC_CMD_GET_NIC_INFO, 2, 19},
  36. {QLCNIC_CMD_SET_NIC_INFO, 32, 1},
  37. {QLCNIC_CMD_GET_ESWITCH_CAPABILITY, 4, 3},
  38. {QLCNIC_CMD_TOGGLE_ESWITCH, 4, 1},
  39. {QLCNIC_CMD_GET_ESWITCH_STATUS, 4, 3},
  40. {QLCNIC_CMD_SET_PORTMIRRORING, 4, 1},
  41. {QLCNIC_CMD_CONFIGURE_ESWITCH, 4, 1},
  42. {QLCNIC_CMD_GET_ESWITCH_PORT_CONFIG, 4, 3},
  43. {QLCNIC_CMD_GET_ESWITCH_STATS, 5, 1},
  44. {QLCNIC_CMD_CONFIG_PORT, 4, 1},
  45. {QLCNIC_CMD_TEMP_SIZE, 1, 4},
  46. {QLCNIC_CMD_GET_TEMP_HDR, 5, 5},
  47. {QLCNIC_CMD_GET_LINK_EVENT, 2, 1},
  48. {QLCNIC_CMD_CONFIG_MAC_VLAN, 4, 3},
  49. {QLCNIC_CMD_CONFIG_INTR_COAL, 6, 1},
  50. {QLCNIC_CMD_CONFIGURE_RSS, 14, 1},
  51. {QLCNIC_CMD_CONFIGURE_LED, 2, 1},
  52. {QLCNIC_CMD_CONFIGURE_MAC_RX_MODE, 2, 1},
  53. {QLCNIC_CMD_CONFIGURE_HW_LRO, 2, 1},
  54. {QLCNIC_CMD_GET_STATISTICS, 2, 80},
  55. {QLCNIC_CMD_SET_PORT_CONFIG, 2, 1},
  56. {QLCNIC_CMD_GET_PORT_CONFIG, 2, 2},
  57. {QLCNIC_CMD_GET_LINK_STATUS, 2, 4},
  58. {QLCNIC_CMD_IDC_ACK, 5, 1},
  59. {QLCNIC_CMD_INIT_NIC_FUNC, 2, 1},
  60. {QLCNIC_CMD_STOP_NIC_FUNC, 2, 1},
  61. {QLCNIC_CMD_SET_LED_CONFIG, 5, 1},
  62. {QLCNIC_CMD_GET_LED_CONFIG, 1, 5},
  63. {QLCNIC_CMD_ADD_RCV_RINGS, 130, 26},
  64. {QLCNIC_CMD_CONFIG_VPORT, 4, 4},
  65. {QLCNIC_CMD_BC_EVENT_SETUP, 2, 1},
  66. };
  67. const u32 qlcnic_83xx_ext_reg_tbl[] = {
  68. 0x38CC, /* Global Reset */
  69. 0x38F0, /* Wildcard */
  70. 0x38FC, /* Informant */
  71. 0x3038, /* Host MBX ctrl */
  72. 0x303C, /* FW MBX ctrl */
  73. 0x355C, /* BOOT LOADER ADDRESS REG */
  74. 0x3560, /* BOOT LOADER SIZE REG */
  75. 0x3564, /* FW IMAGE ADDR REG */
  76. 0x1000, /* MBX intr enable */
  77. 0x1200, /* Default Intr mask */
  78. 0x1204, /* Default Interrupt ID */
  79. 0x3780, /* QLC_83XX_IDC_MAJ_VERSION */
  80. 0x3784, /* QLC_83XX_IDC_DEV_STATE */
  81. 0x3788, /* QLC_83XX_IDC_DRV_PRESENCE */
  82. 0x378C, /* QLC_83XX_IDC_DRV_ACK */
  83. 0x3790, /* QLC_83XX_IDC_CTRL */
  84. 0x3794, /* QLC_83XX_IDC_DRV_AUDIT */
  85. 0x3798, /* QLC_83XX_IDC_MIN_VERSION */
  86. 0x379C, /* QLC_83XX_RECOVER_DRV_LOCK */
  87. 0x37A0, /* QLC_83XX_IDC_PF_0 */
  88. 0x37A4, /* QLC_83XX_IDC_PF_1 */
  89. 0x37A8, /* QLC_83XX_IDC_PF_2 */
  90. 0x37AC, /* QLC_83XX_IDC_PF_3 */
  91. 0x37B0, /* QLC_83XX_IDC_PF_4 */
  92. 0x37B4, /* QLC_83XX_IDC_PF_5 */
  93. 0x37B8, /* QLC_83XX_IDC_PF_6 */
  94. 0x37BC, /* QLC_83XX_IDC_PF_7 */
  95. 0x37C0, /* QLC_83XX_IDC_PF_8 */
  96. 0x37C4, /* QLC_83XX_IDC_PF_9 */
  97. 0x37C8, /* QLC_83XX_IDC_PF_10 */
  98. 0x37CC, /* QLC_83XX_IDC_PF_11 */
  99. 0x37D0, /* QLC_83XX_IDC_PF_12 */
  100. 0x37D4, /* QLC_83XX_IDC_PF_13 */
  101. 0x37D8, /* QLC_83XX_IDC_PF_14 */
  102. 0x37DC, /* QLC_83XX_IDC_PF_15 */
  103. 0x37E0, /* QLC_83XX_IDC_DEV_PARTITION_INFO_1 */
  104. 0x37E4, /* QLC_83XX_IDC_DEV_PARTITION_INFO_2 */
  105. 0x37F0, /* QLC_83XX_DRV_OP_MODE */
  106. 0x37F4, /* QLC_83XX_VNIC_STATE */
  107. 0x3868, /* QLC_83XX_DRV_LOCK */
  108. 0x386C, /* QLC_83XX_DRV_UNLOCK */
  109. 0x3504, /* QLC_83XX_DRV_LOCK_ID */
  110. 0x34A4, /* QLC_83XX_ASIC_TEMP */
  111. };
  112. const u32 qlcnic_83xx_reg_tbl[] = {
  113. 0x34A8, /* PEG_HALT_STAT1 */
  114. 0x34AC, /* PEG_HALT_STAT2 */
  115. 0x34B0, /* FW_HEARTBEAT */
  116. 0x3500, /* FLASH LOCK_ID */
  117. 0x3528, /* FW_CAPABILITIES */
  118. 0x3538, /* Driver active, DRV_REG0 */
  119. 0x3540, /* Device state, DRV_REG1 */
  120. 0x3544, /* Driver state, DRV_REG2 */
  121. 0x3548, /* Driver scratch, DRV_REG3 */
  122. 0x354C, /* Device partiton info, DRV_REG4 */
  123. 0x3524, /* Driver IDC ver, DRV_REG5 */
  124. 0x3550, /* FW_VER_MAJOR */
  125. 0x3554, /* FW_VER_MINOR */
  126. 0x3558, /* FW_VER_SUB */
  127. 0x359C, /* NPAR STATE */
  128. 0x35FC, /* FW_IMG_VALID */
  129. 0x3650, /* CMD_PEG_STATE */
  130. 0x373C, /* RCV_PEG_STATE */
  131. 0x37B4, /* ASIC TEMP */
  132. 0x356C, /* FW API */
  133. 0x3570, /* DRV OP MODE */
  134. 0x3850, /* FLASH LOCK */
  135. 0x3854, /* FLASH UNLOCK */
  136. };
  137. static struct qlcnic_hardware_ops qlcnic_83xx_hw_ops = {
  138. .read_crb = qlcnic_83xx_read_crb,
  139. .write_crb = qlcnic_83xx_write_crb,
  140. .read_reg = qlcnic_83xx_rd_reg_indirect,
  141. .write_reg = qlcnic_83xx_wrt_reg_indirect,
  142. .get_mac_address = qlcnic_83xx_get_mac_address,
  143. .setup_intr = qlcnic_83xx_setup_intr,
  144. .alloc_mbx_args = qlcnic_83xx_alloc_mbx_args,
  145. .mbx_cmd = qlcnic_83xx_mbx_op,
  146. .get_func_no = qlcnic_83xx_get_func_no,
  147. .api_lock = qlcnic_83xx_cam_lock,
  148. .api_unlock = qlcnic_83xx_cam_unlock,
  149. .add_sysfs = qlcnic_83xx_add_sysfs,
  150. .remove_sysfs = qlcnic_83xx_remove_sysfs,
  151. .process_lb_rcv_ring_diag = qlcnic_83xx_process_rcv_ring_diag,
  152. .create_rx_ctx = qlcnic_83xx_create_rx_ctx,
  153. .create_tx_ctx = qlcnic_83xx_create_tx_ctx,
  154. .del_rx_ctx = qlcnic_83xx_del_rx_ctx,
  155. .del_tx_ctx = qlcnic_83xx_del_tx_ctx,
  156. .setup_link_event = qlcnic_83xx_setup_link_event,
  157. .get_nic_info = qlcnic_83xx_get_nic_info,
  158. .get_pci_info = qlcnic_83xx_get_pci_info,
  159. .set_nic_info = qlcnic_83xx_set_nic_info,
  160. .change_macvlan = qlcnic_83xx_sre_macaddr_change,
  161. .napi_enable = qlcnic_83xx_napi_enable,
  162. .napi_disable = qlcnic_83xx_napi_disable,
  163. .config_intr_coal = qlcnic_83xx_config_intr_coal,
  164. .config_rss = qlcnic_83xx_config_rss,
  165. .config_hw_lro = qlcnic_83xx_config_hw_lro,
  166. .config_promisc_mode = qlcnic_83xx_nic_set_promisc,
  167. .change_l2_filter = qlcnic_83xx_change_l2_filter,
  168. .get_board_info = qlcnic_83xx_get_port_info,
  169. .free_mac_list = qlcnic_82xx_free_mac_list,
  170. };
  171. static struct qlcnic_nic_template qlcnic_83xx_ops = {
  172. .config_bridged_mode = qlcnic_config_bridged_mode,
  173. .config_led = qlcnic_config_led,
  174. .request_reset = qlcnic_83xx_idc_request_reset,
  175. .cancel_idc_work = qlcnic_83xx_idc_exit,
  176. .napi_add = qlcnic_83xx_napi_add,
  177. .napi_del = qlcnic_83xx_napi_del,
  178. .config_ipaddr = qlcnic_83xx_config_ipaddr,
  179. .clear_legacy_intr = qlcnic_83xx_clear_legacy_intr,
  180. };
  181. void qlcnic_83xx_register_map(struct qlcnic_hardware_context *ahw)
  182. {
  183. ahw->hw_ops = &qlcnic_83xx_hw_ops;
  184. ahw->reg_tbl = (u32 *)qlcnic_83xx_reg_tbl;
  185. ahw->ext_reg_tbl = (u32 *)qlcnic_83xx_ext_reg_tbl;
  186. }
  187. int qlcnic_83xx_get_fw_version(struct qlcnic_adapter *adapter)
  188. {
  189. u32 fw_major, fw_minor, fw_build;
  190. struct pci_dev *pdev = adapter->pdev;
  191. fw_major = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MAJOR);
  192. fw_minor = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MINOR);
  193. fw_build = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_SUB);
  194. adapter->fw_version = QLCNIC_VERSION_CODE(fw_major, fw_minor, fw_build);
  195. dev_info(&pdev->dev, "Driver v%s, firmware version %d.%d.%d\n",
  196. QLCNIC_LINUX_VERSIONID, fw_major, fw_minor, fw_build);
  197. return adapter->fw_version;
  198. }
  199. static int __qlcnic_set_win_base(struct qlcnic_adapter *adapter, u32 addr)
  200. {
  201. void __iomem *base;
  202. u32 val;
  203. base = adapter->ahw->pci_base0 +
  204. QLC_83XX_CRB_WIN_FUNC(adapter->ahw->pci_func);
  205. writel(addr, base);
  206. val = readl(base);
  207. if (val != addr)
  208. return -EIO;
  209. return 0;
  210. }
  211. int qlcnic_83xx_rd_reg_indirect(struct qlcnic_adapter *adapter, ulong addr)
  212. {
  213. int ret;
  214. struct qlcnic_hardware_context *ahw = adapter->ahw;
  215. ret = __qlcnic_set_win_base(adapter, (u32) addr);
  216. if (!ret) {
  217. return QLCRDX(ahw, QLCNIC_WILDCARD);
  218. } else {
  219. dev_err(&adapter->pdev->dev,
  220. "%s failed, addr = 0x%x\n", __func__, (int)addr);
  221. return -EIO;
  222. }
  223. }
  224. int qlcnic_83xx_wrt_reg_indirect(struct qlcnic_adapter *adapter, ulong addr,
  225. u32 data)
  226. {
  227. int err;
  228. struct qlcnic_hardware_context *ahw = adapter->ahw;
  229. err = __qlcnic_set_win_base(adapter, (u32) addr);
  230. if (!err) {
  231. QLCWRX(ahw, QLCNIC_WILDCARD, data);
  232. return 0;
  233. } else {
  234. dev_err(&adapter->pdev->dev,
  235. "%s failed, addr = 0x%x data = 0x%x\n",
  236. __func__, (int)addr, data);
  237. return err;
  238. }
  239. }
  240. int qlcnic_83xx_setup_intr(struct qlcnic_adapter *adapter, u8 num_intr)
  241. {
  242. int err, i, num_msix;
  243. struct qlcnic_hardware_context *ahw = adapter->ahw;
  244. if (!num_intr)
  245. num_intr = QLCNIC_DEF_NUM_STS_DESC_RINGS;
  246. num_msix = rounddown_pow_of_two(min_t(int, num_online_cpus(),
  247. num_intr));
  248. /* account for AEN interrupt MSI-X based interrupts */
  249. num_msix += 1;
  250. if (!(adapter->flags & QLCNIC_TX_INTR_SHARED))
  251. num_msix += adapter->max_drv_tx_rings;
  252. err = qlcnic_enable_msix(adapter, num_msix);
  253. if (err == -ENOMEM)
  254. return err;
  255. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  256. num_msix = adapter->ahw->num_msix;
  257. else {
  258. if (qlcnic_sriov_vf_check(adapter))
  259. return -EINVAL;
  260. num_msix = 1;
  261. }
  262. /* setup interrupt mapping table for fw */
  263. ahw->intr_tbl = vzalloc(num_msix *
  264. sizeof(struct qlcnic_intrpt_config));
  265. if (!ahw->intr_tbl)
  266. return -ENOMEM;
  267. if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) {
  268. /* MSI-X enablement failed, use legacy interrupt */
  269. adapter->tgt_status_reg = ahw->pci_base0 + QLC_83XX_INTX_PTR;
  270. adapter->tgt_mask_reg = ahw->pci_base0 + QLC_83XX_INTX_MASK;
  271. adapter->isr_int_vec = ahw->pci_base0 + QLC_83XX_INTX_TRGR;
  272. adapter->msix_entries[0].vector = adapter->pdev->irq;
  273. dev_info(&adapter->pdev->dev, "using legacy interrupt\n");
  274. }
  275. for (i = 0; i < num_msix; i++) {
  276. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  277. ahw->intr_tbl[i].type = QLCNIC_INTRPT_MSIX;
  278. else
  279. ahw->intr_tbl[i].type = QLCNIC_INTRPT_INTX;
  280. ahw->intr_tbl[i].id = i;
  281. ahw->intr_tbl[i].src = 0;
  282. }
  283. return 0;
  284. }
  285. inline void qlcnic_83xx_clear_legacy_intr_mask(struct qlcnic_adapter *adapter)
  286. {
  287. writel(0, adapter->tgt_mask_reg);
  288. }
  289. /* Enable MSI-x and INT-x interrupts */
  290. void qlcnic_83xx_enable_intr(struct qlcnic_adapter *adapter,
  291. struct qlcnic_host_sds_ring *sds_ring)
  292. {
  293. writel(0, sds_ring->crb_intr_mask);
  294. }
  295. /* Disable MSI-x and INT-x interrupts */
  296. void qlcnic_83xx_disable_intr(struct qlcnic_adapter *adapter,
  297. struct qlcnic_host_sds_ring *sds_ring)
  298. {
  299. writel(1, sds_ring->crb_intr_mask);
  300. }
  301. inline void qlcnic_83xx_enable_legacy_msix_mbx_intr(struct qlcnic_adapter
  302. *adapter)
  303. {
  304. u32 mask;
  305. /* Mailbox in MSI-x mode and Legacy Interrupt share the same
  306. * source register. We could be here before contexts are created
  307. * and sds_ring->crb_intr_mask has not been initialized, calculate
  308. * BAR offset for Interrupt Source Register
  309. */
  310. mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);
  311. writel(0, adapter->ahw->pci_base0 + mask);
  312. }
  313. void qlcnic_83xx_disable_mbx_intr(struct qlcnic_adapter *adapter)
  314. {
  315. u32 mask;
  316. mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);
  317. writel(1, adapter->ahw->pci_base0 + mask);
  318. QLCWRX(adapter->ahw, QLCNIC_MBX_INTR_ENBL, 0);
  319. }
  320. static inline void qlcnic_83xx_get_mbx_data(struct qlcnic_adapter *adapter,
  321. struct qlcnic_cmd_args *cmd)
  322. {
  323. int i;
  324. for (i = 0; i < cmd->rsp.num; i++)
  325. cmd->rsp.arg[i] = readl(QLCNIC_MBX_FW(adapter->ahw, i));
  326. }
  327. irqreturn_t qlcnic_83xx_clear_legacy_intr(struct qlcnic_adapter *adapter)
  328. {
  329. u32 intr_val;
  330. struct qlcnic_hardware_context *ahw = adapter->ahw;
  331. int retries = 0;
  332. intr_val = readl(adapter->tgt_status_reg);
  333. if (!QLC_83XX_VALID_INTX_BIT31(intr_val))
  334. return IRQ_NONE;
  335. if (QLC_83XX_INTX_FUNC(intr_val) != adapter->ahw->pci_func) {
  336. adapter->stats.spurious_intr++;
  337. return IRQ_NONE;
  338. }
  339. /* The barrier is required to ensure writes to the registers */
  340. wmb();
  341. /* clear the interrupt trigger control register */
  342. writel(0, adapter->isr_int_vec);
  343. intr_val = readl(adapter->isr_int_vec);
  344. do {
  345. intr_val = readl(adapter->tgt_status_reg);
  346. if (QLC_83XX_INTX_FUNC(intr_val) != ahw->pci_func)
  347. break;
  348. retries++;
  349. } while (QLC_83XX_VALID_INTX_BIT30(intr_val) &&
  350. (retries < QLC_83XX_LEGACY_INTX_MAX_RETRY));
  351. return IRQ_HANDLED;
  352. }
  353. static void qlcnic_83xx_poll_process_aen(struct qlcnic_adapter *adapter)
  354. {
  355. u32 resp, event;
  356. unsigned long flags;
  357. spin_lock_irqsave(&adapter->ahw->mbx_lock, flags);
  358. resp = QLCRDX(adapter->ahw, QLCNIC_FW_MBX_CTRL);
  359. if (!(resp & QLCNIC_SET_OWNER))
  360. goto out;
  361. event = readl(QLCNIC_MBX_FW(adapter->ahw, 0));
  362. if (event & QLCNIC_MBX_ASYNC_EVENT)
  363. __qlcnic_83xx_process_aen(adapter);
  364. out:
  365. qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
  366. spin_unlock_irqrestore(&adapter->ahw->mbx_lock, flags);
  367. }
  368. irqreturn_t qlcnic_83xx_intr(int irq, void *data)
  369. {
  370. struct qlcnic_adapter *adapter = data;
  371. struct qlcnic_host_sds_ring *sds_ring;
  372. struct qlcnic_hardware_context *ahw = adapter->ahw;
  373. if (qlcnic_83xx_clear_legacy_intr(adapter) == IRQ_NONE)
  374. return IRQ_NONE;
  375. qlcnic_83xx_poll_process_aen(adapter);
  376. if (ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
  377. ahw->diag_cnt++;
  378. qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
  379. return IRQ_HANDLED;
  380. }
  381. if (!test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
  382. qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
  383. } else {
  384. sds_ring = &adapter->recv_ctx->sds_rings[0];
  385. napi_schedule(&sds_ring->napi);
  386. }
  387. return IRQ_HANDLED;
  388. }
  389. irqreturn_t qlcnic_83xx_tmp_intr(int irq, void *data)
  390. {
  391. struct qlcnic_host_sds_ring *sds_ring = data;
  392. struct qlcnic_adapter *adapter = sds_ring->adapter;
  393. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  394. goto done;
  395. if (adapter->nic_ops->clear_legacy_intr(adapter) == IRQ_NONE)
  396. return IRQ_NONE;
  397. done:
  398. adapter->ahw->diag_cnt++;
  399. qlcnic_83xx_enable_intr(adapter, sds_ring);
  400. return IRQ_HANDLED;
  401. }
  402. void qlcnic_83xx_free_mbx_intr(struct qlcnic_adapter *adapter)
  403. {
  404. u32 num_msix;
  405. qlcnic_83xx_disable_mbx_intr(adapter);
  406. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  407. num_msix = adapter->ahw->num_msix - 1;
  408. else
  409. num_msix = 0;
  410. msleep(20);
  411. synchronize_irq(adapter->msix_entries[num_msix].vector);
  412. free_irq(adapter->msix_entries[num_msix].vector, adapter);
  413. }
  414. int qlcnic_83xx_setup_mbx_intr(struct qlcnic_adapter *adapter)
  415. {
  416. irq_handler_t handler;
  417. u32 val;
  418. char name[32];
  419. int err = 0;
  420. unsigned long flags = 0;
  421. if (!(adapter->flags & QLCNIC_MSI_ENABLED) &&
  422. !(adapter->flags & QLCNIC_MSIX_ENABLED))
  423. flags |= IRQF_SHARED;
  424. if (adapter->flags & QLCNIC_MSIX_ENABLED) {
  425. handler = qlcnic_83xx_handle_aen;
  426. val = adapter->msix_entries[adapter->ahw->num_msix - 1].vector;
  427. snprintf(name, (IFNAMSIZ + 4),
  428. "%s[%s]", "qlcnic", "aen");
  429. err = request_irq(val, handler, flags, name, adapter);
  430. if (err) {
  431. dev_err(&adapter->pdev->dev,
  432. "failed to register MBX interrupt\n");
  433. return err;
  434. }
  435. } else {
  436. handler = qlcnic_83xx_intr;
  437. val = adapter->msix_entries[0].vector;
  438. err = request_irq(val, handler, flags, "qlcnic", adapter);
  439. if (err) {
  440. dev_err(&adapter->pdev->dev,
  441. "failed to register INTx interrupt\n");
  442. return err;
  443. }
  444. qlcnic_83xx_clear_legacy_intr_mask(adapter);
  445. }
  446. /* Enable mailbox interrupt */
  447. qlcnic_83xx_enable_mbx_intrpt(adapter);
  448. return err;
  449. }
  450. void qlcnic_83xx_get_func_no(struct qlcnic_adapter *adapter)
  451. {
  452. u32 val = QLCRDX(adapter->ahw, QLCNIC_INFORMANT);
  453. adapter->ahw->pci_func = (val >> 24) & 0xff;
  454. }
  455. int qlcnic_83xx_cam_lock(struct qlcnic_adapter *adapter)
  456. {
  457. void __iomem *addr;
  458. u32 val, limit = 0;
  459. struct qlcnic_hardware_context *ahw = adapter->ahw;
  460. addr = ahw->pci_base0 + QLC_83XX_SEM_LOCK_FUNC(ahw->pci_func);
  461. do {
  462. val = readl(addr);
  463. if (val) {
  464. /* write the function number to register */
  465. QLC_SHARED_REG_WR32(adapter, QLCNIC_FLASH_LOCK_OWNER,
  466. ahw->pci_func);
  467. return 0;
  468. }
  469. usleep_range(1000, 2000);
  470. } while (++limit <= QLCNIC_PCIE_SEM_TIMEOUT);
  471. return -EIO;
  472. }
  473. void qlcnic_83xx_cam_unlock(struct qlcnic_adapter *adapter)
  474. {
  475. void __iomem *addr;
  476. u32 val;
  477. struct qlcnic_hardware_context *ahw = adapter->ahw;
  478. addr = ahw->pci_base0 + QLC_83XX_SEM_UNLOCK_FUNC(ahw->pci_func);
  479. val = readl(addr);
  480. }
  481. void qlcnic_83xx_read_crb(struct qlcnic_adapter *adapter, char *buf,
  482. loff_t offset, size_t size)
  483. {
  484. int ret;
  485. u32 data;
  486. if (qlcnic_api_lock(adapter)) {
  487. dev_err(&adapter->pdev->dev,
  488. "%s: failed to acquire lock. addr offset 0x%x\n",
  489. __func__, (u32)offset);
  490. return;
  491. }
  492. ret = qlcnic_83xx_rd_reg_indirect(adapter, (u32) offset);
  493. qlcnic_api_unlock(adapter);
  494. if (ret == -EIO) {
  495. dev_err(&adapter->pdev->dev,
  496. "%s: failed. addr offset 0x%x\n",
  497. __func__, (u32)offset);
  498. return;
  499. }
  500. data = ret;
  501. memcpy(buf, &data, size);
  502. }
  503. void qlcnic_83xx_write_crb(struct qlcnic_adapter *adapter, char *buf,
  504. loff_t offset, size_t size)
  505. {
  506. u32 data;
  507. memcpy(&data, buf, size);
  508. qlcnic_83xx_wrt_reg_indirect(adapter, (u32) offset, data);
  509. }
  510. int qlcnic_83xx_get_port_info(struct qlcnic_adapter *adapter)
  511. {
  512. int status;
  513. status = qlcnic_83xx_get_port_config(adapter);
  514. if (status) {
  515. dev_err(&adapter->pdev->dev,
  516. "Get Port Info failed\n");
  517. } else {
  518. if (QLC_83XX_SFP_10G_CAPABLE(adapter->ahw->port_config))
  519. adapter->ahw->port_type = QLCNIC_XGBE;
  520. else
  521. adapter->ahw->port_type = QLCNIC_GBE;
  522. if (QLC_83XX_AUTONEG(adapter->ahw->port_config))
  523. adapter->ahw->link_autoneg = AUTONEG_ENABLE;
  524. }
  525. return status;
  526. }
  527. void qlcnic_83xx_enable_mbx_intrpt(struct qlcnic_adapter *adapter)
  528. {
  529. u32 val;
  530. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  531. val = BIT_2 | ((adapter->ahw->num_msix - 1) << 8);
  532. else
  533. val = BIT_2;
  534. QLCWRX(adapter->ahw, QLCNIC_MBX_INTR_ENBL, val);
  535. qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
  536. }
  537. void qlcnic_83xx_check_vf(struct qlcnic_adapter *adapter,
  538. const struct pci_device_id *ent)
  539. {
  540. u32 op_mode, priv_level;
  541. struct qlcnic_hardware_context *ahw = adapter->ahw;
  542. ahw->fw_hal_version = 2;
  543. qlcnic_get_func_no(adapter);
  544. if (qlcnic_sriov_vf_check(adapter)) {
  545. qlcnic_sriov_vf_set_ops(adapter);
  546. return;
  547. }
  548. /* Determine function privilege level */
  549. op_mode = QLCRDX(adapter->ahw, QLC_83XX_DRV_OP_MODE);
  550. if (op_mode == QLC_83XX_DEFAULT_OPMODE)
  551. priv_level = QLCNIC_MGMT_FUNC;
  552. else
  553. priv_level = QLC_83XX_GET_FUNC_PRIVILEGE(op_mode,
  554. ahw->pci_func);
  555. if (priv_level == QLCNIC_NON_PRIV_FUNC) {
  556. ahw->op_mode = QLCNIC_NON_PRIV_FUNC;
  557. dev_info(&adapter->pdev->dev,
  558. "HAL Version: %d Non Privileged function\n",
  559. ahw->fw_hal_version);
  560. adapter->nic_ops = &qlcnic_vf_ops;
  561. } else {
  562. if (pci_find_ext_capability(adapter->pdev,
  563. PCI_EXT_CAP_ID_SRIOV))
  564. set_bit(__QLCNIC_SRIOV_CAPABLE, &adapter->state);
  565. adapter->nic_ops = &qlcnic_83xx_ops;
  566. }
  567. }
  568. static void qlcnic_83xx_handle_link_aen(struct qlcnic_adapter *adapter,
  569. u32 data[]);
  570. static void qlcnic_83xx_handle_idc_comp_aen(struct qlcnic_adapter *adapter,
  571. u32 data[]);
  572. static void qlcnic_dump_mbx(struct qlcnic_adapter *adapter,
  573. struct qlcnic_cmd_args *cmd)
  574. {
  575. int i;
  576. dev_info(&adapter->pdev->dev,
  577. "Host MBX regs(%d)\n", cmd->req.num);
  578. for (i = 0; i < cmd->req.num; i++) {
  579. if (i && !(i % 8))
  580. pr_info("\n");
  581. pr_info("%08x ", cmd->req.arg[i]);
  582. }
  583. pr_info("\n");
  584. dev_info(&adapter->pdev->dev,
  585. "FW MBX regs(%d)\n", cmd->rsp.num);
  586. for (i = 0; i < cmd->rsp.num; i++) {
  587. if (i && !(i % 8))
  588. pr_info("\n");
  589. pr_info("%08x ", cmd->rsp.arg[i]);
  590. }
  591. pr_info("\n");
  592. }
  593. /* Mailbox response for mac rcode */
  594. u32 qlcnic_83xx_mac_rcode(struct qlcnic_adapter *adapter)
  595. {
  596. u32 fw_data;
  597. u8 mac_cmd_rcode;
  598. fw_data = readl(QLCNIC_MBX_FW(adapter->ahw, 2));
  599. mac_cmd_rcode = (u8)fw_data;
  600. if (mac_cmd_rcode == QLC_83XX_NO_NIC_RESOURCE ||
  601. mac_cmd_rcode == QLC_83XX_MAC_PRESENT ||
  602. mac_cmd_rcode == QLC_83XX_MAC_ABSENT)
  603. return QLCNIC_RCODE_SUCCESS;
  604. return 1;
  605. }
  606. u32 qlcnic_83xx_mbx_poll(struct qlcnic_adapter *adapter)
  607. {
  608. u32 data;
  609. unsigned long wait_time = 0;
  610. struct qlcnic_hardware_context *ahw = adapter->ahw;
  611. /* wait for mailbox completion */
  612. do {
  613. data = QLCRDX(ahw, QLCNIC_FW_MBX_CTRL);
  614. if (++wait_time > QLCNIC_MBX_TIMEOUT) {
  615. data = QLCNIC_RCODE_TIMEOUT;
  616. break;
  617. }
  618. mdelay(1);
  619. } while (!data);
  620. return data;
  621. }
  622. int qlcnic_83xx_mbx_op(struct qlcnic_adapter *adapter,
  623. struct qlcnic_cmd_args *cmd)
  624. {
  625. int i;
  626. u16 opcode;
  627. u8 mbx_err_code;
  628. unsigned long flags;
  629. u32 rsp, mbx_val, fw_data, rsp_num, mbx_cmd;
  630. struct qlcnic_hardware_context *ahw = adapter->ahw;
  631. opcode = LSW(cmd->req.arg[0]);
  632. if (!test_bit(QLC_83XX_MBX_READY, &adapter->ahw->idc.status)) {
  633. dev_info(&adapter->pdev->dev,
  634. "Mailbox cmd attempted, 0x%x\n", opcode);
  635. dev_info(&adapter->pdev->dev, "Mailbox detached\n");
  636. return 0;
  637. }
  638. spin_lock_irqsave(&adapter->ahw->mbx_lock, flags);
  639. mbx_val = QLCRDX(ahw, QLCNIC_HOST_MBX_CTRL);
  640. if (mbx_val) {
  641. QLCDB(adapter, DRV,
  642. "Mailbox cmd attempted, 0x%x\n", opcode);
  643. QLCDB(adapter, DRV,
  644. "Mailbox not available, 0x%x, collect FW dump\n",
  645. mbx_val);
  646. cmd->rsp.arg[0] = QLCNIC_RCODE_TIMEOUT;
  647. spin_unlock_irqrestore(&adapter->ahw->mbx_lock, flags);
  648. return cmd->rsp.arg[0];
  649. }
  650. /* Fill in mailbox registers */
  651. mbx_cmd = cmd->req.arg[0];
  652. writel(mbx_cmd, QLCNIC_MBX_HOST(ahw, 0));
  653. for (i = 1; i < cmd->req.num; i++)
  654. writel(cmd->req.arg[i], QLCNIC_MBX_HOST(ahw, i));
  655. /* Signal FW about the impending command */
  656. QLCWRX(ahw, QLCNIC_HOST_MBX_CTRL, QLCNIC_SET_OWNER);
  657. poll:
  658. rsp = qlcnic_83xx_mbx_poll(adapter);
  659. if (rsp != QLCNIC_RCODE_TIMEOUT) {
  660. /* Get the FW response data */
  661. fw_data = readl(QLCNIC_MBX_FW(ahw, 0));
  662. if (fw_data & QLCNIC_MBX_ASYNC_EVENT) {
  663. __qlcnic_83xx_process_aen(adapter);
  664. mbx_val = QLCRDX(ahw, QLCNIC_HOST_MBX_CTRL);
  665. if (mbx_val)
  666. goto poll;
  667. }
  668. mbx_err_code = QLCNIC_MBX_STATUS(fw_data);
  669. rsp_num = QLCNIC_MBX_NUM_REGS(fw_data);
  670. opcode = QLCNIC_MBX_RSP(fw_data);
  671. qlcnic_83xx_get_mbx_data(adapter, cmd);
  672. switch (mbx_err_code) {
  673. case QLCNIC_MBX_RSP_OK:
  674. case QLCNIC_MBX_PORT_RSP_OK:
  675. rsp = QLCNIC_RCODE_SUCCESS;
  676. break;
  677. default:
  678. if (opcode == QLCNIC_CMD_CONFIG_MAC_VLAN) {
  679. rsp = qlcnic_83xx_mac_rcode(adapter);
  680. if (!rsp)
  681. goto out;
  682. }
  683. dev_err(&adapter->pdev->dev,
  684. "MBX command 0x%x failed with err:0x%x\n",
  685. opcode, mbx_err_code);
  686. rsp = mbx_err_code;
  687. qlcnic_dump_mbx(adapter, cmd);
  688. break;
  689. }
  690. goto out;
  691. }
  692. dev_err(&adapter->pdev->dev, "MBX command 0x%x timed out\n",
  693. QLCNIC_MBX_RSP(mbx_cmd));
  694. rsp = QLCNIC_RCODE_TIMEOUT;
  695. out:
  696. /* clear fw mbx control register */
  697. QLCWRX(ahw, QLCNIC_FW_MBX_CTRL, QLCNIC_CLR_OWNER);
  698. spin_unlock_irqrestore(&adapter->ahw->mbx_lock, flags);
  699. return rsp;
  700. }
  701. int qlcnic_83xx_alloc_mbx_args(struct qlcnic_cmd_args *mbx,
  702. struct qlcnic_adapter *adapter, u32 type)
  703. {
  704. int i, size;
  705. u32 temp;
  706. const struct qlcnic_mailbox_metadata *mbx_tbl;
  707. mbx_tbl = qlcnic_83xx_mbx_tbl;
  708. size = ARRAY_SIZE(qlcnic_83xx_mbx_tbl);
  709. for (i = 0; i < size; i++) {
  710. if (type == mbx_tbl[i].cmd) {
  711. mbx->op_type = QLC_83XX_FW_MBX_CMD;
  712. mbx->req.num = mbx_tbl[i].in_args;
  713. mbx->rsp.num = mbx_tbl[i].out_args;
  714. mbx->req.arg = kcalloc(mbx->req.num, sizeof(u32),
  715. GFP_ATOMIC);
  716. if (!mbx->req.arg)
  717. return -ENOMEM;
  718. mbx->rsp.arg = kcalloc(mbx->rsp.num, sizeof(u32),
  719. GFP_ATOMIC);
  720. if (!mbx->rsp.arg) {
  721. kfree(mbx->req.arg);
  722. mbx->req.arg = NULL;
  723. return -ENOMEM;
  724. }
  725. memset(mbx->req.arg, 0, sizeof(u32) * mbx->req.num);
  726. memset(mbx->rsp.arg, 0, sizeof(u32) * mbx->rsp.num);
  727. temp = adapter->ahw->fw_hal_version << 29;
  728. mbx->req.arg[0] = (type | (mbx->req.num << 16) | temp);
  729. return 0;
  730. }
  731. }
  732. return -EINVAL;
  733. }
  734. void qlcnic_83xx_idc_aen_work(struct work_struct *work)
  735. {
  736. struct qlcnic_adapter *adapter;
  737. struct qlcnic_cmd_args cmd;
  738. int i, err = 0;
  739. adapter = container_of(work, struct qlcnic_adapter, idc_aen_work.work);
  740. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_IDC_ACK);
  741. for (i = 1; i < QLC_83XX_MBX_AEN_CNT; i++)
  742. cmd.req.arg[i] = adapter->ahw->mbox_aen[i];
  743. err = qlcnic_issue_cmd(adapter, &cmd);
  744. if (err)
  745. dev_info(&adapter->pdev->dev,
  746. "%s: Mailbox IDC ACK failed.\n", __func__);
  747. qlcnic_free_mbx_args(&cmd);
  748. }
  749. static void qlcnic_83xx_handle_idc_comp_aen(struct qlcnic_adapter *adapter,
  750. u32 data[])
  751. {
  752. dev_dbg(&adapter->pdev->dev, "Completion AEN:0x%x.\n",
  753. QLCNIC_MBX_RSP(data[0]));
  754. clear_bit(QLC_83XX_IDC_COMP_AEN, &adapter->ahw->idc.status);
  755. return;
  756. }
  757. void __qlcnic_83xx_process_aen(struct qlcnic_adapter *adapter)
  758. {
  759. u32 event[QLC_83XX_MBX_AEN_CNT];
  760. int i;
  761. struct qlcnic_hardware_context *ahw = adapter->ahw;
  762. for (i = 0; i < QLC_83XX_MBX_AEN_CNT; i++)
  763. event[i] = readl(QLCNIC_MBX_FW(ahw, i));
  764. switch (QLCNIC_MBX_RSP(event[0])) {
  765. case QLCNIC_MBX_LINK_EVENT:
  766. qlcnic_83xx_handle_link_aen(adapter, event);
  767. break;
  768. case QLCNIC_MBX_COMP_EVENT:
  769. qlcnic_83xx_handle_idc_comp_aen(adapter, event);
  770. break;
  771. case QLCNIC_MBX_REQUEST_EVENT:
  772. for (i = 0; i < QLC_83XX_MBX_AEN_CNT; i++)
  773. adapter->ahw->mbox_aen[i] = QLCNIC_MBX_RSP(event[i]);
  774. queue_delayed_work(adapter->qlcnic_wq,
  775. &adapter->idc_aen_work, 0);
  776. break;
  777. case QLCNIC_MBX_TIME_EXTEND_EVENT:
  778. break;
  779. case QLCNIC_MBX_BC_EVENT:
  780. qlcnic_sriov_handle_bc_event(adapter, event[1]);
  781. break;
  782. case QLCNIC_MBX_SFP_INSERT_EVENT:
  783. dev_info(&adapter->pdev->dev, "SFP+ Insert AEN:0x%x.\n",
  784. QLCNIC_MBX_RSP(event[0]));
  785. break;
  786. case QLCNIC_MBX_SFP_REMOVE_EVENT:
  787. dev_info(&adapter->pdev->dev, "SFP Removed AEN:0x%x.\n",
  788. QLCNIC_MBX_RSP(event[0]));
  789. break;
  790. default:
  791. dev_dbg(&adapter->pdev->dev, "Unsupported AEN:0x%x.\n",
  792. QLCNIC_MBX_RSP(event[0]));
  793. break;
  794. }
  795. QLCWRX(ahw, QLCNIC_FW_MBX_CTRL, QLCNIC_CLR_OWNER);
  796. }
  797. static void qlcnic_83xx_process_aen(struct qlcnic_adapter *adapter)
  798. {
  799. struct qlcnic_hardware_context *ahw = adapter->ahw;
  800. u32 resp, event;
  801. unsigned long flags;
  802. spin_lock_irqsave(&ahw->mbx_lock, flags);
  803. resp = QLCRDX(ahw, QLCNIC_FW_MBX_CTRL);
  804. if (resp & QLCNIC_SET_OWNER) {
  805. event = readl(QLCNIC_MBX_FW(ahw, 0));
  806. if (event & QLCNIC_MBX_ASYNC_EVENT)
  807. __qlcnic_83xx_process_aen(adapter);
  808. }
  809. spin_unlock_irqrestore(&ahw->mbx_lock, flags);
  810. }
  811. static void qlcnic_83xx_mbx_poll_work(struct work_struct *work)
  812. {
  813. struct qlcnic_adapter *adapter;
  814. adapter = container_of(work, struct qlcnic_adapter, mbx_poll_work.work);
  815. if (!test_bit(__QLCNIC_MBX_POLL_ENABLE, &adapter->state))
  816. return;
  817. qlcnic_83xx_process_aen(adapter);
  818. queue_delayed_work(adapter->qlcnic_wq, &adapter->mbx_poll_work,
  819. (HZ / 10));
  820. }
  821. void qlcnic_83xx_enable_mbx_poll(struct qlcnic_adapter *adapter)
  822. {
  823. if (test_and_set_bit(__QLCNIC_MBX_POLL_ENABLE, &adapter->state))
  824. return;
  825. INIT_DELAYED_WORK(&adapter->mbx_poll_work, qlcnic_83xx_mbx_poll_work);
  826. }
  827. void qlcnic_83xx_disable_mbx_poll(struct qlcnic_adapter *adapter)
  828. {
  829. if (!test_and_clear_bit(__QLCNIC_MBX_POLL_ENABLE, &adapter->state))
  830. return;
  831. cancel_delayed_work_sync(&adapter->mbx_poll_work);
  832. }
  833. static int qlcnic_83xx_add_rings(struct qlcnic_adapter *adapter)
  834. {
  835. int index, i, err, sds_mbx_size;
  836. u32 *buf, intrpt_id, intr_mask;
  837. u16 context_id;
  838. u8 num_sds;
  839. struct qlcnic_cmd_args cmd;
  840. struct qlcnic_host_sds_ring *sds;
  841. struct qlcnic_sds_mbx sds_mbx;
  842. struct qlcnic_add_rings_mbx_out *mbx_out;
  843. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  844. struct qlcnic_hardware_context *ahw = adapter->ahw;
  845. sds_mbx_size = sizeof(struct qlcnic_sds_mbx);
  846. context_id = recv_ctx->context_id;
  847. num_sds = (adapter->max_sds_rings - QLCNIC_MAX_RING_SETS);
  848. ahw->hw_ops->alloc_mbx_args(&cmd, adapter,
  849. QLCNIC_CMD_ADD_RCV_RINGS);
  850. cmd.req.arg[1] = 0 | (num_sds << 8) | (context_id << 16);
  851. /* set up status rings, mbx 2-81 */
  852. index = 2;
  853. for (i = 8; i < adapter->max_sds_rings; i++) {
  854. memset(&sds_mbx, 0, sds_mbx_size);
  855. sds = &recv_ctx->sds_rings[i];
  856. sds->consumer = 0;
  857. memset(sds->desc_head, 0, STATUS_DESC_RINGSIZE(sds));
  858. sds_mbx.phy_addr_low = LSD(sds->phys_addr);
  859. sds_mbx.phy_addr_high = MSD(sds->phys_addr);
  860. sds_mbx.sds_ring_size = sds->num_desc;
  861. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  862. intrpt_id = ahw->intr_tbl[i].id;
  863. else
  864. intrpt_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
  865. if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST)
  866. sds_mbx.intrpt_id = intrpt_id;
  867. else
  868. sds_mbx.intrpt_id = 0xffff;
  869. sds_mbx.intrpt_val = 0;
  870. buf = &cmd.req.arg[index];
  871. memcpy(buf, &sds_mbx, sds_mbx_size);
  872. index += sds_mbx_size / sizeof(u32);
  873. }
  874. /* send the mailbox command */
  875. err = ahw->hw_ops->mbx_cmd(adapter, &cmd);
  876. if (err) {
  877. dev_err(&adapter->pdev->dev,
  878. "Failed to add rings %d\n", err);
  879. goto out;
  880. }
  881. mbx_out = (struct qlcnic_add_rings_mbx_out *)&cmd.rsp.arg[1];
  882. index = 0;
  883. /* status descriptor ring */
  884. for (i = 8; i < adapter->max_sds_rings; i++) {
  885. sds = &recv_ctx->sds_rings[i];
  886. sds->crb_sts_consumer = ahw->pci_base0 +
  887. mbx_out->host_csmr[index];
  888. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  889. intr_mask = ahw->intr_tbl[i].src;
  890. else
  891. intr_mask = QLCRDX(ahw, QLCNIC_DEF_INT_MASK);
  892. sds->crb_intr_mask = ahw->pci_base0 + intr_mask;
  893. index++;
  894. }
  895. out:
  896. qlcnic_free_mbx_args(&cmd);
  897. return err;
  898. }
  899. void qlcnic_83xx_del_rx_ctx(struct qlcnic_adapter *adapter)
  900. {
  901. int err;
  902. u32 temp = 0;
  903. struct qlcnic_cmd_args cmd;
  904. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  905. if (qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_DESTROY_RX_CTX))
  906. return;
  907. if (qlcnic_sriov_pf_check(adapter) || qlcnic_sriov_vf_check(adapter))
  908. cmd.req.arg[0] |= (0x3 << 29);
  909. if (qlcnic_sriov_pf_check(adapter))
  910. qlcnic_pf_set_interface_id_del_rx_ctx(adapter, &temp);
  911. cmd.req.arg[1] = recv_ctx->context_id | temp;
  912. err = qlcnic_issue_cmd(adapter, &cmd);
  913. if (err)
  914. dev_err(&adapter->pdev->dev,
  915. "Failed to destroy rx ctx in firmware\n");
  916. recv_ctx->state = QLCNIC_HOST_CTX_STATE_FREED;
  917. qlcnic_free_mbx_args(&cmd);
  918. }
  919. int qlcnic_83xx_create_rx_ctx(struct qlcnic_adapter *adapter)
  920. {
  921. int i, err, index, sds_mbx_size, rds_mbx_size;
  922. u8 num_sds, num_rds;
  923. u32 *buf, intrpt_id, intr_mask, cap = 0;
  924. struct qlcnic_host_sds_ring *sds;
  925. struct qlcnic_host_rds_ring *rds;
  926. struct qlcnic_sds_mbx sds_mbx;
  927. struct qlcnic_rds_mbx rds_mbx;
  928. struct qlcnic_cmd_args cmd;
  929. struct qlcnic_rcv_mbx_out *mbx_out;
  930. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  931. struct qlcnic_hardware_context *ahw = adapter->ahw;
  932. num_rds = adapter->max_rds_rings;
  933. if (adapter->max_sds_rings <= QLCNIC_MAX_RING_SETS)
  934. num_sds = adapter->max_sds_rings;
  935. else
  936. num_sds = QLCNIC_MAX_RING_SETS;
  937. sds_mbx_size = sizeof(struct qlcnic_sds_mbx);
  938. rds_mbx_size = sizeof(struct qlcnic_rds_mbx);
  939. cap = QLCNIC_CAP0_LEGACY_CONTEXT;
  940. if (adapter->flags & QLCNIC_FW_LRO_MSS_CAP)
  941. cap |= QLC_83XX_FW_CAP_LRO_MSS;
  942. /* set mailbox hdr and capabilities */
  943. qlcnic_alloc_mbx_args(&cmd, adapter,
  944. QLCNIC_CMD_CREATE_RX_CTX);
  945. if (qlcnic_sriov_pf_check(adapter) || qlcnic_sriov_vf_check(adapter))
  946. cmd.req.arg[0] |= (0x3 << 29);
  947. cmd.req.arg[1] = cap;
  948. cmd.req.arg[5] = 1 | (num_rds << 5) | (num_sds << 8) |
  949. (QLC_83XX_HOST_RDS_MODE_UNIQUE << 16);
  950. if (qlcnic_sriov_pf_check(adapter))
  951. qlcnic_pf_set_interface_id_create_rx_ctx(adapter,
  952. &cmd.req.arg[6]);
  953. /* set up status rings, mbx 8-57/87 */
  954. index = QLC_83XX_HOST_SDS_MBX_IDX;
  955. for (i = 0; i < num_sds; i++) {
  956. memset(&sds_mbx, 0, sds_mbx_size);
  957. sds = &recv_ctx->sds_rings[i];
  958. sds->consumer = 0;
  959. memset(sds->desc_head, 0, STATUS_DESC_RINGSIZE(sds));
  960. sds_mbx.phy_addr_low = LSD(sds->phys_addr);
  961. sds_mbx.phy_addr_high = MSD(sds->phys_addr);
  962. sds_mbx.sds_ring_size = sds->num_desc;
  963. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  964. intrpt_id = ahw->intr_tbl[i].id;
  965. else
  966. intrpt_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
  967. if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST)
  968. sds_mbx.intrpt_id = intrpt_id;
  969. else
  970. sds_mbx.intrpt_id = 0xffff;
  971. sds_mbx.intrpt_val = 0;
  972. buf = &cmd.req.arg[index];
  973. memcpy(buf, &sds_mbx, sds_mbx_size);
  974. index += sds_mbx_size / sizeof(u32);
  975. }
  976. /* set up receive rings, mbx 88-111/135 */
  977. index = QLCNIC_HOST_RDS_MBX_IDX;
  978. rds = &recv_ctx->rds_rings[0];
  979. rds->producer = 0;
  980. memset(&rds_mbx, 0, rds_mbx_size);
  981. rds_mbx.phy_addr_reg_low = LSD(rds->phys_addr);
  982. rds_mbx.phy_addr_reg_high = MSD(rds->phys_addr);
  983. rds_mbx.reg_ring_sz = rds->dma_size;
  984. rds_mbx.reg_ring_len = rds->num_desc;
  985. /* Jumbo ring */
  986. rds = &recv_ctx->rds_rings[1];
  987. rds->producer = 0;
  988. rds_mbx.phy_addr_jmb_low = LSD(rds->phys_addr);
  989. rds_mbx.phy_addr_jmb_high = MSD(rds->phys_addr);
  990. rds_mbx.jmb_ring_sz = rds->dma_size;
  991. rds_mbx.jmb_ring_len = rds->num_desc;
  992. buf = &cmd.req.arg[index];
  993. memcpy(buf, &rds_mbx, rds_mbx_size);
  994. /* send the mailbox command */
  995. err = ahw->hw_ops->mbx_cmd(adapter, &cmd);
  996. if (err) {
  997. dev_err(&adapter->pdev->dev,
  998. "Failed to create Rx ctx in firmware%d\n", err);
  999. goto out;
  1000. }
  1001. mbx_out = (struct qlcnic_rcv_mbx_out *)&cmd.rsp.arg[1];
  1002. recv_ctx->context_id = mbx_out->ctx_id;
  1003. recv_ctx->state = mbx_out->state;
  1004. recv_ctx->virt_port = mbx_out->vport_id;
  1005. dev_info(&adapter->pdev->dev, "Rx Context[%d] Created, state:0x%x\n",
  1006. recv_ctx->context_id, recv_ctx->state);
  1007. /* Receive descriptor ring */
  1008. /* Standard ring */
  1009. rds = &recv_ctx->rds_rings[0];
  1010. rds->crb_rcv_producer = ahw->pci_base0 +
  1011. mbx_out->host_prod[0].reg_buf;
  1012. /* Jumbo ring */
  1013. rds = &recv_ctx->rds_rings[1];
  1014. rds->crb_rcv_producer = ahw->pci_base0 +
  1015. mbx_out->host_prod[0].jmb_buf;
  1016. /* status descriptor ring */
  1017. for (i = 0; i < num_sds; i++) {
  1018. sds = &recv_ctx->sds_rings[i];
  1019. sds->crb_sts_consumer = ahw->pci_base0 +
  1020. mbx_out->host_csmr[i];
  1021. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  1022. intr_mask = ahw->intr_tbl[i].src;
  1023. else
  1024. intr_mask = QLCRDX(ahw, QLCNIC_DEF_INT_MASK);
  1025. sds->crb_intr_mask = ahw->pci_base0 + intr_mask;
  1026. }
  1027. if (adapter->max_sds_rings > QLCNIC_MAX_RING_SETS)
  1028. err = qlcnic_83xx_add_rings(adapter);
  1029. out:
  1030. qlcnic_free_mbx_args(&cmd);
  1031. return err;
  1032. }
  1033. void qlcnic_83xx_del_tx_ctx(struct qlcnic_adapter *adapter,
  1034. struct qlcnic_host_tx_ring *tx_ring)
  1035. {
  1036. struct qlcnic_cmd_args cmd;
  1037. u32 temp = 0;
  1038. if (qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_DESTROY_TX_CTX))
  1039. return;
  1040. if (qlcnic_sriov_pf_check(adapter) || qlcnic_sriov_vf_check(adapter))
  1041. cmd.req.arg[0] |= (0x3 << 29);
  1042. if (qlcnic_sriov_pf_check(adapter))
  1043. qlcnic_pf_set_interface_id_del_tx_ctx(adapter, &temp);
  1044. cmd.req.arg[1] = tx_ring->ctx_id | temp;
  1045. if (qlcnic_issue_cmd(adapter, &cmd))
  1046. dev_err(&adapter->pdev->dev,
  1047. "Failed to destroy tx ctx in firmware\n");
  1048. qlcnic_free_mbx_args(&cmd);
  1049. }
  1050. int qlcnic_83xx_create_tx_ctx(struct qlcnic_adapter *adapter,
  1051. struct qlcnic_host_tx_ring *tx, int ring)
  1052. {
  1053. int err;
  1054. u16 msix_id;
  1055. u32 *buf, intr_mask, temp = 0;
  1056. struct qlcnic_cmd_args cmd;
  1057. struct qlcnic_tx_mbx mbx;
  1058. struct qlcnic_tx_mbx_out *mbx_out;
  1059. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1060. u32 msix_vector;
  1061. /* Reset host resources */
  1062. tx->producer = 0;
  1063. tx->sw_consumer = 0;
  1064. *(tx->hw_consumer) = 0;
  1065. memset(&mbx, 0, sizeof(struct qlcnic_tx_mbx));
  1066. /* setup mailbox inbox registerss */
  1067. mbx.phys_addr_low = LSD(tx->phys_addr);
  1068. mbx.phys_addr_high = MSD(tx->phys_addr);
  1069. mbx.cnsmr_index_low = LSD(tx->hw_cons_phys_addr);
  1070. mbx.cnsmr_index_high = MSD(tx->hw_cons_phys_addr);
  1071. mbx.size = tx->num_desc;
  1072. if (adapter->flags & QLCNIC_MSIX_ENABLED) {
  1073. if (!(adapter->flags & QLCNIC_TX_INTR_SHARED))
  1074. msix_vector = adapter->max_sds_rings + ring;
  1075. else
  1076. msix_vector = adapter->max_sds_rings - 1;
  1077. msix_id = ahw->intr_tbl[msix_vector].id;
  1078. } else {
  1079. msix_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
  1080. }
  1081. if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST)
  1082. mbx.intr_id = msix_id;
  1083. else
  1084. mbx.intr_id = 0xffff;
  1085. mbx.src = 0;
  1086. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CREATE_TX_CTX);
  1087. if (qlcnic_sriov_pf_check(adapter) || qlcnic_sriov_vf_check(adapter))
  1088. cmd.req.arg[0] |= (0x3 << 29);
  1089. if (qlcnic_sriov_pf_check(adapter))
  1090. qlcnic_pf_set_interface_id_create_tx_ctx(adapter, &temp);
  1091. cmd.req.arg[1] = QLCNIC_CAP0_LEGACY_CONTEXT;
  1092. cmd.req.arg[5] = QLCNIC_MAX_TX_QUEUES | temp;
  1093. buf = &cmd.req.arg[6];
  1094. memcpy(buf, &mbx, sizeof(struct qlcnic_tx_mbx));
  1095. /* send the mailbox command*/
  1096. err = qlcnic_issue_cmd(adapter, &cmd);
  1097. if (err) {
  1098. dev_err(&adapter->pdev->dev,
  1099. "Failed to create Tx ctx in firmware 0x%x\n", err);
  1100. goto out;
  1101. }
  1102. mbx_out = (struct qlcnic_tx_mbx_out *)&cmd.rsp.arg[2];
  1103. tx->crb_cmd_producer = ahw->pci_base0 + mbx_out->host_prod;
  1104. tx->ctx_id = mbx_out->ctx_id;
  1105. if ((adapter->flags & QLCNIC_MSIX_ENABLED) &&
  1106. !(adapter->flags & QLCNIC_TX_INTR_SHARED)) {
  1107. intr_mask = ahw->intr_tbl[adapter->max_sds_rings + ring].src;
  1108. tx->crb_intr_mask = ahw->pci_base0 + intr_mask;
  1109. }
  1110. dev_info(&adapter->pdev->dev, "Tx Context[0x%x] Created, state:0x%x\n",
  1111. tx->ctx_id, mbx_out->state);
  1112. out:
  1113. qlcnic_free_mbx_args(&cmd);
  1114. return err;
  1115. }
  1116. static int qlcnic_83xx_diag_alloc_res(struct net_device *netdev, int test)
  1117. {
  1118. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  1119. struct qlcnic_host_sds_ring *sds_ring;
  1120. struct qlcnic_host_rds_ring *rds_ring;
  1121. u8 ring;
  1122. int ret;
  1123. netif_device_detach(netdev);
  1124. if (netif_running(netdev))
  1125. __qlcnic_down(adapter, netdev);
  1126. qlcnic_detach(adapter);
  1127. adapter->max_sds_rings = 1;
  1128. adapter->ahw->diag_test = test;
  1129. adapter->ahw->linkup = 0;
  1130. ret = qlcnic_attach(adapter);
  1131. if (ret) {
  1132. netif_device_attach(netdev);
  1133. return ret;
  1134. }
  1135. ret = qlcnic_fw_create_ctx(adapter);
  1136. if (ret) {
  1137. qlcnic_detach(adapter);
  1138. netif_device_attach(netdev);
  1139. return ret;
  1140. }
  1141. for (ring = 0; ring < adapter->max_rds_rings; ring++) {
  1142. rds_ring = &adapter->recv_ctx->rds_rings[ring];
  1143. qlcnic_post_rx_buffers(adapter, rds_ring, ring);
  1144. }
  1145. if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
  1146. for (ring = 0; ring < adapter->max_sds_rings; ring++) {
  1147. sds_ring = &adapter->recv_ctx->sds_rings[ring];
  1148. qlcnic_83xx_enable_intr(adapter, sds_ring);
  1149. }
  1150. }
  1151. if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
  1152. /* disable and free mailbox interrupt */
  1153. if (!(adapter->flags & QLCNIC_MSIX_ENABLED))
  1154. qlcnic_83xx_free_mbx_intr(adapter);
  1155. adapter->ahw->loopback_state = 0;
  1156. adapter->ahw->hw_ops->setup_link_event(adapter, 1);
  1157. }
  1158. set_bit(__QLCNIC_DEV_UP, &adapter->state);
  1159. return 0;
  1160. }
  1161. static void qlcnic_83xx_diag_free_res(struct net_device *netdev,
  1162. int max_sds_rings)
  1163. {
  1164. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  1165. struct qlcnic_host_sds_ring *sds_ring;
  1166. int ring, err;
  1167. clear_bit(__QLCNIC_DEV_UP, &adapter->state);
  1168. if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
  1169. for (ring = 0; ring < adapter->max_sds_rings; ring++) {
  1170. sds_ring = &adapter->recv_ctx->sds_rings[ring];
  1171. qlcnic_83xx_disable_intr(adapter, sds_ring);
  1172. }
  1173. }
  1174. qlcnic_fw_destroy_ctx(adapter);
  1175. qlcnic_detach(adapter);
  1176. if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
  1177. if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) {
  1178. err = qlcnic_83xx_setup_mbx_intr(adapter);
  1179. if (err) {
  1180. dev_err(&adapter->pdev->dev,
  1181. "%s: failed to setup mbx interrupt\n",
  1182. __func__);
  1183. goto out;
  1184. }
  1185. }
  1186. }
  1187. adapter->ahw->diag_test = 0;
  1188. adapter->max_sds_rings = max_sds_rings;
  1189. if (qlcnic_attach(adapter))
  1190. goto out;
  1191. if (netif_running(netdev))
  1192. __qlcnic_up(adapter, netdev);
  1193. out:
  1194. netif_device_attach(netdev);
  1195. }
  1196. int qlcnic_83xx_config_led(struct qlcnic_adapter *adapter, u32 state,
  1197. u32 beacon)
  1198. {
  1199. struct qlcnic_cmd_args cmd;
  1200. u32 mbx_in;
  1201. int i, status = 0;
  1202. if (state) {
  1203. /* Get LED configuration */
  1204. qlcnic_alloc_mbx_args(&cmd, adapter,
  1205. QLCNIC_CMD_GET_LED_CONFIG);
  1206. status = qlcnic_issue_cmd(adapter, &cmd);
  1207. if (status) {
  1208. dev_err(&adapter->pdev->dev,
  1209. "Get led config failed.\n");
  1210. goto mbx_err;
  1211. } else {
  1212. for (i = 0; i < 4; i++)
  1213. adapter->ahw->mbox_reg[i] = cmd.rsp.arg[i+1];
  1214. }
  1215. qlcnic_free_mbx_args(&cmd);
  1216. /* Set LED Configuration */
  1217. mbx_in = (LSW(QLC_83XX_LED_CONFIG) << 16) |
  1218. LSW(QLC_83XX_LED_CONFIG);
  1219. qlcnic_alloc_mbx_args(&cmd, adapter,
  1220. QLCNIC_CMD_SET_LED_CONFIG);
  1221. cmd.req.arg[1] = mbx_in;
  1222. cmd.req.arg[2] = mbx_in;
  1223. cmd.req.arg[3] = mbx_in;
  1224. if (beacon)
  1225. cmd.req.arg[4] = QLC_83XX_ENABLE_BEACON;
  1226. status = qlcnic_issue_cmd(adapter, &cmd);
  1227. if (status) {
  1228. dev_err(&adapter->pdev->dev,
  1229. "Set led config failed.\n");
  1230. }
  1231. mbx_err:
  1232. qlcnic_free_mbx_args(&cmd);
  1233. return status;
  1234. } else {
  1235. /* Restoring default LED configuration */
  1236. qlcnic_alloc_mbx_args(&cmd, adapter,
  1237. QLCNIC_CMD_SET_LED_CONFIG);
  1238. cmd.req.arg[1] = adapter->ahw->mbox_reg[0];
  1239. cmd.req.arg[2] = adapter->ahw->mbox_reg[1];
  1240. cmd.req.arg[3] = adapter->ahw->mbox_reg[2];
  1241. if (beacon)
  1242. cmd.req.arg[4] = adapter->ahw->mbox_reg[3];
  1243. status = qlcnic_issue_cmd(adapter, &cmd);
  1244. if (status)
  1245. dev_err(&adapter->pdev->dev,
  1246. "Restoring led config failed.\n");
  1247. qlcnic_free_mbx_args(&cmd);
  1248. return status;
  1249. }
  1250. }
  1251. int qlcnic_83xx_set_led(struct net_device *netdev,
  1252. enum ethtool_phys_id_state state)
  1253. {
  1254. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  1255. int err = -EIO, active = 1;
  1256. if (adapter->ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
  1257. netdev_warn(netdev,
  1258. "LED test is not supported in non-privileged mode\n");
  1259. return -EOPNOTSUPP;
  1260. }
  1261. switch (state) {
  1262. case ETHTOOL_ID_ACTIVE:
  1263. if (test_and_set_bit(__QLCNIC_LED_ENABLE, &adapter->state))
  1264. return -EBUSY;
  1265. if (test_bit(__QLCNIC_RESETTING, &adapter->state))
  1266. break;
  1267. err = qlcnic_83xx_config_led(adapter, active, 0);
  1268. if (err)
  1269. netdev_err(netdev, "Failed to set LED blink state\n");
  1270. break;
  1271. case ETHTOOL_ID_INACTIVE:
  1272. active = 0;
  1273. if (test_bit(__QLCNIC_RESETTING, &adapter->state))
  1274. break;
  1275. err = qlcnic_83xx_config_led(adapter, active, 0);
  1276. if (err)
  1277. netdev_err(netdev, "Failed to reset LED blink state\n");
  1278. break;
  1279. default:
  1280. return -EINVAL;
  1281. }
  1282. if (!active || err)
  1283. clear_bit(__QLCNIC_LED_ENABLE, &adapter->state);
  1284. return err;
  1285. }
  1286. void qlcnic_83xx_register_nic_idc_func(struct qlcnic_adapter *adapter,
  1287. int enable)
  1288. {
  1289. struct qlcnic_cmd_args cmd;
  1290. int status;
  1291. if (qlcnic_sriov_vf_check(adapter))
  1292. return;
  1293. if (enable) {
  1294. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_INIT_NIC_FUNC);
  1295. cmd.req.arg[1] = BIT_0 | BIT_31;
  1296. } else {
  1297. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_STOP_NIC_FUNC);
  1298. cmd.req.arg[1] = BIT_0 | BIT_31;
  1299. }
  1300. status = qlcnic_issue_cmd(adapter, &cmd);
  1301. if (status)
  1302. dev_err(&adapter->pdev->dev,
  1303. "Failed to %s in NIC IDC function event.\n",
  1304. (enable ? "register" : "unregister"));
  1305. qlcnic_free_mbx_args(&cmd);
  1306. }
  1307. int qlcnic_83xx_set_port_config(struct qlcnic_adapter *adapter)
  1308. {
  1309. struct qlcnic_cmd_args cmd;
  1310. int err;
  1311. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_SET_PORT_CONFIG);
  1312. cmd.req.arg[1] = adapter->ahw->port_config;
  1313. err = qlcnic_issue_cmd(adapter, &cmd);
  1314. if (err)
  1315. dev_info(&adapter->pdev->dev, "Set Port Config failed.\n");
  1316. qlcnic_free_mbx_args(&cmd);
  1317. return err;
  1318. }
  1319. int qlcnic_83xx_get_port_config(struct qlcnic_adapter *adapter)
  1320. {
  1321. struct qlcnic_cmd_args cmd;
  1322. int err;
  1323. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_PORT_CONFIG);
  1324. err = qlcnic_issue_cmd(adapter, &cmd);
  1325. if (err)
  1326. dev_info(&adapter->pdev->dev, "Get Port config failed\n");
  1327. else
  1328. adapter->ahw->port_config = cmd.rsp.arg[1];
  1329. qlcnic_free_mbx_args(&cmd);
  1330. return err;
  1331. }
  1332. int qlcnic_83xx_setup_link_event(struct qlcnic_adapter *adapter, int enable)
  1333. {
  1334. int err;
  1335. u32 temp;
  1336. struct qlcnic_cmd_args cmd;
  1337. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_LINK_EVENT);
  1338. temp = adapter->recv_ctx->context_id << 16;
  1339. cmd.req.arg[1] = (enable ? 1 : 0) | BIT_8 | temp;
  1340. err = qlcnic_issue_cmd(adapter, &cmd);
  1341. if (err)
  1342. dev_info(&adapter->pdev->dev,
  1343. "Setup linkevent mailbox failed\n");
  1344. qlcnic_free_mbx_args(&cmd);
  1345. return err;
  1346. }
  1347. static void qlcnic_83xx_set_interface_id_promisc(struct qlcnic_adapter *adapter,
  1348. u32 *interface_id)
  1349. {
  1350. if (qlcnic_sriov_pf_check(adapter)) {
  1351. qlcnic_pf_set_interface_id_promisc(adapter, interface_id);
  1352. } else {
  1353. if (!qlcnic_sriov_vf_check(adapter))
  1354. *interface_id = adapter->recv_ctx->context_id << 16;
  1355. }
  1356. }
  1357. int qlcnic_83xx_nic_set_promisc(struct qlcnic_adapter *adapter, u32 mode)
  1358. {
  1359. int err;
  1360. u32 temp = 0;
  1361. struct qlcnic_cmd_args cmd;
  1362. if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
  1363. return -EIO;
  1364. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIGURE_MAC_RX_MODE);
  1365. qlcnic_83xx_set_interface_id_promisc(adapter, &temp);
  1366. cmd.req.arg[1] = (mode ? 1 : 0) | temp;
  1367. err = qlcnic_issue_cmd(adapter, &cmd);
  1368. if (err)
  1369. dev_info(&adapter->pdev->dev,
  1370. "Promiscous mode config failed\n");
  1371. qlcnic_free_mbx_args(&cmd);
  1372. return err;
  1373. }
  1374. int qlcnic_83xx_loopback_test(struct net_device *netdev, u8 mode)
  1375. {
  1376. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  1377. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1378. int ret = 0, loop = 0, max_sds_rings = adapter->max_sds_rings;
  1379. QLCDB(adapter, DRV, "%s loopback test in progress\n",
  1380. mode == QLCNIC_ILB_MODE ? "internal" : "external");
  1381. if (ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
  1382. dev_warn(&adapter->pdev->dev,
  1383. "Loopback test not supported for non privilege function\n");
  1384. return ret;
  1385. }
  1386. if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
  1387. return -EBUSY;
  1388. ret = qlcnic_83xx_diag_alloc_res(netdev, QLCNIC_LOOPBACK_TEST);
  1389. if (ret)
  1390. goto fail_diag_alloc;
  1391. ret = qlcnic_83xx_set_lb_mode(adapter, mode);
  1392. if (ret)
  1393. goto free_diag_res;
  1394. /* Poll for link up event before running traffic */
  1395. do {
  1396. msleep(500);
  1397. if (!(adapter->flags & QLCNIC_MSIX_ENABLED))
  1398. qlcnic_83xx_process_aen(adapter);
  1399. if (loop++ > QLCNIC_ILB_MAX_RCV_LOOP) {
  1400. dev_info(&adapter->pdev->dev,
  1401. "Firmware didn't sent link up event to loopback request\n");
  1402. ret = -QLCNIC_FW_NOT_RESPOND;
  1403. qlcnic_83xx_clear_lb_mode(adapter, mode);
  1404. goto free_diag_res;
  1405. }
  1406. } while ((adapter->ahw->linkup && ahw->has_link_events) != 1);
  1407. /* Make sure carrier is off and queue is stopped during loopback */
  1408. if (netif_running(netdev)) {
  1409. netif_carrier_off(netdev);
  1410. netif_stop_queue(netdev);
  1411. }
  1412. ret = qlcnic_do_lb_test(adapter, mode);
  1413. qlcnic_83xx_clear_lb_mode(adapter, mode);
  1414. free_diag_res:
  1415. qlcnic_83xx_diag_free_res(netdev, max_sds_rings);
  1416. fail_diag_alloc:
  1417. adapter->max_sds_rings = max_sds_rings;
  1418. clear_bit(__QLCNIC_RESETTING, &adapter->state);
  1419. return ret;
  1420. }
  1421. int qlcnic_83xx_set_lb_mode(struct qlcnic_adapter *adapter, u8 mode)
  1422. {
  1423. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1424. int status = 0, loop = 0;
  1425. u32 config;
  1426. status = qlcnic_83xx_get_port_config(adapter);
  1427. if (status)
  1428. return status;
  1429. config = ahw->port_config;
  1430. set_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1431. if (mode == QLCNIC_ILB_MODE)
  1432. ahw->port_config |= QLC_83XX_CFG_LOOPBACK_HSS;
  1433. if (mode == QLCNIC_ELB_MODE)
  1434. ahw->port_config |= QLC_83XX_CFG_LOOPBACK_EXT;
  1435. status = qlcnic_83xx_set_port_config(adapter);
  1436. if (status) {
  1437. dev_err(&adapter->pdev->dev,
  1438. "Failed to Set Loopback Mode = 0x%x.\n",
  1439. ahw->port_config);
  1440. ahw->port_config = config;
  1441. clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1442. return status;
  1443. }
  1444. /* Wait for Link and IDC Completion AEN */
  1445. do {
  1446. msleep(300);
  1447. if (!(adapter->flags & QLCNIC_MSIX_ENABLED))
  1448. qlcnic_83xx_process_aen(adapter);
  1449. if (loop++ > QLCNIC_ILB_MAX_RCV_LOOP) {
  1450. dev_err(&adapter->pdev->dev,
  1451. "FW did not generate IDC completion AEN\n");
  1452. clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1453. qlcnic_83xx_clear_lb_mode(adapter, mode);
  1454. return -EIO;
  1455. }
  1456. } while (test_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status));
  1457. qlcnic_sre_macaddr_change(adapter, adapter->mac_addr, 0,
  1458. QLCNIC_MAC_ADD);
  1459. return status;
  1460. }
  1461. int qlcnic_83xx_clear_lb_mode(struct qlcnic_adapter *adapter, u8 mode)
  1462. {
  1463. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1464. int status = 0, loop = 0;
  1465. u32 config = ahw->port_config;
  1466. set_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1467. if (mode == QLCNIC_ILB_MODE)
  1468. ahw->port_config &= ~QLC_83XX_CFG_LOOPBACK_HSS;
  1469. if (mode == QLCNIC_ELB_MODE)
  1470. ahw->port_config &= ~QLC_83XX_CFG_LOOPBACK_EXT;
  1471. status = qlcnic_83xx_set_port_config(adapter);
  1472. if (status) {
  1473. dev_err(&adapter->pdev->dev,
  1474. "Failed to Clear Loopback Mode = 0x%x.\n",
  1475. ahw->port_config);
  1476. ahw->port_config = config;
  1477. clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1478. return status;
  1479. }
  1480. /* Wait for Link and IDC Completion AEN */
  1481. do {
  1482. msleep(300);
  1483. if (!(adapter->flags & QLCNIC_MSIX_ENABLED))
  1484. qlcnic_83xx_process_aen(adapter);
  1485. if (loop++ > QLCNIC_ILB_MAX_RCV_LOOP) {
  1486. dev_err(&adapter->pdev->dev,
  1487. "Firmware didn't sent IDC completion AEN\n");
  1488. clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1489. return -EIO;
  1490. }
  1491. } while (test_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status));
  1492. qlcnic_sre_macaddr_change(adapter, adapter->mac_addr, 0,
  1493. QLCNIC_MAC_DEL);
  1494. return status;
  1495. }
  1496. static void qlcnic_83xx_set_interface_id_ipaddr(struct qlcnic_adapter *adapter,
  1497. u32 *interface_id)
  1498. {
  1499. if (qlcnic_sriov_pf_check(adapter)) {
  1500. qlcnic_pf_set_interface_id_ipaddr(adapter, interface_id);
  1501. } else {
  1502. if (!qlcnic_sriov_vf_check(adapter))
  1503. *interface_id = adapter->recv_ctx->context_id << 16;
  1504. }
  1505. }
  1506. void qlcnic_83xx_config_ipaddr(struct qlcnic_adapter *adapter, __be32 ip,
  1507. int mode)
  1508. {
  1509. int err;
  1510. u32 temp = 0, temp_ip;
  1511. struct qlcnic_cmd_args cmd;
  1512. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIGURE_IP_ADDR);
  1513. qlcnic_83xx_set_interface_id_ipaddr(adapter, &temp);
  1514. if (mode == QLCNIC_IP_UP)
  1515. cmd.req.arg[1] = 1 | temp;
  1516. else
  1517. cmd.req.arg[1] = 2 | temp;
  1518. /*
  1519. * Adapter needs IP address in network byte order.
  1520. * But hardware mailbox registers go through writel(), hence IP address
  1521. * gets swapped on big endian architecture.
  1522. * To negate swapping of writel() on big endian architecture
  1523. * use swab32(value).
  1524. */
  1525. temp_ip = swab32(ntohl(ip));
  1526. memcpy(&cmd.req.arg[2], &temp_ip, sizeof(u32));
  1527. err = qlcnic_issue_cmd(adapter, &cmd);
  1528. if (err != QLCNIC_RCODE_SUCCESS)
  1529. dev_err(&adapter->netdev->dev,
  1530. "could not notify %s IP 0x%x request\n",
  1531. (mode == QLCNIC_IP_UP) ? "Add" : "Remove", ip);
  1532. qlcnic_free_mbx_args(&cmd);
  1533. }
  1534. int qlcnic_83xx_config_hw_lro(struct qlcnic_adapter *adapter, int mode)
  1535. {
  1536. int err;
  1537. u32 temp, arg1;
  1538. struct qlcnic_cmd_args cmd;
  1539. int lro_bit_mask;
  1540. lro_bit_mask = (mode ? (BIT_0 | BIT_1 | BIT_2 | BIT_3) : 0);
  1541. if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
  1542. return 0;
  1543. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIGURE_HW_LRO);
  1544. temp = adapter->recv_ctx->context_id << 16;
  1545. arg1 = lro_bit_mask | temp;
  1546. cmd.req.arg[1] = arg1;
  1547. err = qlcnic_issue_cmd(adapter, &cmd);
  1548. if (err)
  1549. dev_info(&adapter->pdev->dev, "LRO config failed\n");
  1550. qlcnic_free_mbx_args(&cmd);
  1551. return err;
  1552. }
  1553. int qlcnic_83xx_config_rss(struct qlcnic_adapter *adapter, int enable)
  1554. {
  1555. int err;
  1556. u32 word;
  1557. struct qlcnic_cmd_args cmd;
  1558. const u64 key[] = { 0xbeac01fa6a42b73bULL, 0x8030f20c77cb2da3ULL,
  1559. 0xae7b30b4d0ca2bcbULL, 0x43a38fb04167253dULL,
  1560. 0x255b0ec26d5a56daULL };
  1561. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIGURE_RSS);
  1562. /*
  1563. * RSS request:
  1564. * bits 3-0: Rsvd
  1565. * 5-4: hash_type_ipv4
  1566. * 7-6: hash_type_ipv6
  1567. * 8: enable
  1568. * 9: use indirection table
  1569. * 16-31: indirection table mask
  1570. */
  1571. word = ((u32)(RSS_HASHTYPE_IP_TCP & 0x3) << 4) |
  1572. ((u32)(RSS_HASHTYPE_IP_TCP & 0x3) << 6) |
  1573. ((u32)(enable & 0x1) << 8) |
  1574. ((0x7ULL) << 16);
  1575. cmd.req.arg[1] = (adapter->recv_ctx->context_id);
  1576. cmd.req.arg[2] = word;
  1577. memcpy(&cmd.req.arg[4], key, sizeof(key));
  1578. err = qlcnic_issue_cmd(adapter, &cmd);
  1579. if (err)
  1580. dev_info(&adapter->pdev->dev, "RSS config failed\n");
  1581. qlcnic_free_mbx_args(&cmd);
  1582. return err;
  1583. }
  1584. static void qlcnic_83xx_set_interface_id_macaddr(struct qlcnic_adapter *adapter,
  1585. u32 *interface_id)
  1586. {
  1587. if (qlcnic_sriov_pf_check(adapter)) {
  1588. qlcnic_pf_set_interface_id_macaddr(adapter, interface_id);
  1589. } else {
  1590. if (!qlcnic_sriov_vf_check(adapter))
  1591. *interface_id = adapter->recv_ctx->context_id << 16;
  1592. }
  1593. }
  1594. int qlcnic_83xx_sre_macaddr_change(struct qlcnic_adapter *adapter, u8 *addr,
  1595. u16 vlan_id, u8 op)
  1596. {
  1597. int err;
  1598. u32 *buf, temp = 0;
  1599. struct qlcnic_cmd_args cmd;
  1600. struct qlcnic_macvlan_mbx mv;
  1601. if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
  1602. return -EIO;
  1603. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIG_MAC_VLAN);
  1604. if (err)
  1605. return err;
  1606. if (vlan_id)
  1607. op = (op == QLCNIC_MAC_ADD || op == QLCNIC_MAC_VLAN_ADD) ?
  1608. QLCNIC_MAC_VLAN_ADD : QLCNIC_MAC_VLAN_DEL;
  1609. cmd.req.arg[1] = op | (1 << 8);
  1610. qlcnic_83xx_set_interface_id_macaddr(adapter, &temp);
  1611. cmd.req.arg[1] |= temp;
  1612. mv.vlan = vlan_id;
  1613. mv.mac_addr0 = addr[0];
  1614. mv.mac_addr1 = addr[1];
  1615. mv.mac_addr2 = addr[2];
  1616. mv.mac_addr3 = addr[3];
  1617. mv.mac_addr4 = addr[4];
  1618. mv.mac_addr5 = addr[5];
  1619. buf = &cmd.req.arg[2];
  1620. memcpy(buf, &mv, sizeof(struct qlcnic_macvlan_mbx));
  1621. err = qlcnic_issue_cmd(adapter, &cmd);
  1622. if (err)
  1623. dev_err(&adapter->pdev->dev,
  1624. "MAC-VLAN %s to CAM failed, err=%d.\n",
  1625. ((op == 1) ? "add " : "delete "), err);
  1626. qlcnic_free_mbx_args(&cmd);
  1627. return err;
  1628. }
  1629. void qlcnic_83xx_change_l2_filter(struct qlcnic_adapter *adapter, u64 *addr,
  1630. u16 vlan_id)
  1631. {
  1632. u8 mac[ETH_ALEN];
  1633. memcpy(&mac, addr, ETH_ALEN);
  1634. qlcnic_83xx_sre_macaddr_change(adapter, mac, vlan_id, QLCNIC_MAC_ADD);
  1635. }
  1636. void qlcnic_83xx_configure_mac(struct qlcnic_adapter *adapter, u8 *mac,
  1637. u8 type, struct qlcnic_cmd_args *cmd)
  1638. {
  1639. switch (type) {
  1640. case QLCNIC_SET_STATION_MAC:
  1641. case QLCNIC_SET_FAC_DEF_MAC:
  1642. memcpy(&cmd->req.arg[2], mac, sizeof(u32));
  1643. memcpy(&cmd->req.arg[3], &mac[4], sizeof(u16));
  1644. break;
  1645. }
  1646. cmd->req.arg[1] = type;
  1647. }
  1648. int qlcnic_83xx_get_mac_address(struct qlcnic_adapter *adapter, u8 *mac)
  1649. {
  1650. int err, i;
  1651. struct qlcnic_cmd_args cmd;
  1652. u32 mac_low, mac_high;
  1653. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_MAC_ADDRESS);
  1654. qlcnic_83xx_configure_mac(adapter, mac, QLCNIC_GET_CURRENT_MAC, &cmd);
  1655. err = qlcnic_issue_cmd(adapter, &cmd);
  1656. if (err == QLCNIC_RCODE_SUCCESS) {
  1657. mac_low = cmd.rsp.arg[1];
  1658. mac_high = cmd.rsp.arg[2];
  1659. for (i = 0; i < 2; i++)
  1660. mac[i] = (u8) (mac_high >> ((1 - i) * 8));
  1661. for (i = 2; i < 6; i++)
  1662. mac[i] = (u8) (mac_low >> ((5 - i) * 8));
  1663. } else {
  1664. dev_err(&adapter->pdev->dev, "Failed to get mac address%d\n",
  1665. err);
  1666. err = -EIO;
  1667. }
  1668. qlcnic_free_mbx_args(&cmd);
  1669. return err;
  1670. }
  1671. void qlcnic_83xx_config_intr_coal(struct qlcnic_adapter *adapter)
  1672. {
  1673. int err;
  1674. u32 temp;
  1675. struct qlcnic_cmd_args cmd;
  1676. struct qlcnic_nic_intr_coalesce *coal = &adapter->ahw->coal;
  1677. if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
  1678. return;
  1679. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIG_INTR_COAL);
  1680. cmd.req.arg[1] = 1 | (adapter->recv_ctx->context_id << 16);
  1681. cmd.req.arg[3] = coal->flag;
  1682. temp = coal->rx_time_us << 16;
  1683. cmd.req.arg[2] = coal->rx_packets | temp;
  1684. err = qlcnic_issue_cmd(adapter, &cmd);
  1685. if (err != QLCNIC_RCODE_SUCCESS)
  1686. dev_info(&adapter->pdev->dev,
  1687. "Failed to send interrupt coalescence parameters\n");
  1688. qlcnic_free_mbx_args(&cmd);
  1689. }
  1690. static void qlcnic_83xx_handle_link_aen(struct qlcnic_adapter *adapter,
  1691. u32 data[])
  1692. {
  1693. u8 link_status, duplex;
  1694. /* link speed */
  1695. link_status = LSB(data[3]) & 1;
  1696. adapter->ahw->link_speed = MSW(data[2]);
  1697. adapter->ahw->link_autoneg = MSB(MSW(data[3]));
  1698. adapter->ahw->module_type = MSB(LSW(data[3]));
  1699. duplex = LSB(MSW(data[3]));
  1700. if (duplex)
  1701. adapter->ahw->link_duplex = DUPLEX_FULL;
  1702. else
  1703. adapter->ahw->link_duplex = DUPLEX_HALF;
  1704. adapter->ahw->has_link_events = 1;
  1705. qlcnic_advert_link_change(adapter, link_status);
  1706. }
  1707. irqreturn_t qlcnic_83xx_handle_aen(int irq, void *data)
  1708. {
  1709. struct qlcnic_adapter *adapter = data;
  1710. unsigned long flags;
  1711. u32 mask, resp, event;
  1712. spin_lock_irqsave(&adapter->ahw->mbx_lock, flags);
  1713. resp = QLCRDX(adapter->ahw, QLCNIC_FW_MBX_CTRL);
  1714. if (!(resp & QLCNIC_SET_OWNER))
  1715. goto out;
  1716. event = readl(QLCNIC_MBX_FW(adapter->ahw, 0));
  1717. if (event & QLCNIC_MBX_ASYNC_EVENT)
  1718. __qlcnic_83xx_process_aen(adapter);
  1719. out:
  1720. mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);
  1721. writel(0, adapter->ahw->pci_base0 + mask);
  1722. spin_unlock_irqrestore(&adapter->ahw->mbx_lock, flags);
  1723. return IRQ_HANDLED;
  1724. }
  1725. int qlcnic_enable_eswitch(struct qlcnic_adapter *adapter, u8 port, u8 enable)
  1726. {
  1727. int err = -EIO;
  1728. struct qlcnic_cmd_args cmd;
  1729. if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
  1730. dev_err(&adapter->pdev->dev,
  1731. "%s: Error, invoked by non management func\n",
  1732. __func__);
  1733. return err;
  1734. }
  1735. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_TOGGLE_ESWITCH);
  1736. cmd.req.arg[1] = (port & 0xf) | BIT_4;
  1737. err = qlcnic_issue_cmd(adapter, &cmd);
  1738. if (err != QLCNIC_RCODE_SUCCESS) {
  1739. dev_err(&adapter->pdev->dev, "Failed to enable eswitch%d\n",
  1740. err);
  1741. err = -EIO;
  1742. }
  1743. qlcnic_free_mbx_args(&cmd);
  1744. return err;
  1745. }
  1746. int qlcnic_83xx_set_nic_info(struct qlcnic_adapter *adapter,
  1747. struct qlcnic_info *nic)
  1748. {
  1749. int i, err = -EIO;
  1750. struct qlcnic_cmd_args cmd;
  1751. if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
  1752. dev_err(&adapter->pdev->dev,
  1753. "%s: Error, invoked by non management func\n",
  1754. __func__);
  1755. return err;
  1756. }
  1757. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_SET_NIC_INFO);
  1758. cmd.req.arg[1] = (nic->pci_func << 16);
  1759. cmd.req.arg[2] = 0x1 << 16;
  1760. cmd.req.arg[3] = nic->phys_port | (nic->switch_mode << 16);
  1761. cmd.req.arg[4] = nic->capabilities;
  1762. cmd.req.arg[5] = (nic->max_mac_filters & 0xFF) | ((nic->max_mtu) << 16);
  1763. cmd.req.arg[6] = (nic->max_tx_ques) | ((nic->max_rx_ques) << 16);
  1764. cmd.req.arg[7] = (nic->min_tx_bw) | ((nic->max_tx_bw) << 16);
  1765. for (i = 8; i < 32; i++)
  1766. cmd.req.arg[i] = 0;
  1767. err = qlcnic_issue_cmd(adapter, &cmd);
  1768. if (err != QLCNIC_RCODE_SUCCESS) {
  1769. dev_err(&adapter->pdev->dev, "Failed to set nic info%d\n",
  1770. err);
  1771. err = -EIO;
  1772. }
  1773. qlcnic_free_mbx_args(&cmd);
  1774. return err;
  1775. }
  1776. int qlcnic_83xx_get_nic_info(struct qlcnic_adapter *adapter,
  1777. struct qlcnic_info *npar_info, u8 func_id)
  1778. {
  1779. int err;
  1780. u32 temp;
  1781. u8 op = 0;
  1782. struct qlcnic_cmd_args cmd;
  1783. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_NIC_INFO);
  1784. if (func_id != adapter->ahw->pci_func) {
  1785. temp = func_id << 16;
  1786. cmd.req.arg[1] = op | BIT_31 | temp;
  1787. } else {
  1788. cmd.req.arg[1] = adapter->ahw->pci_func << 16;
  1789. }
  1790. err = qlcnic_issue_cmd(adapter, &cmd);
  1791. if (err) {
  1792. dev_info(&adapter->pdev->dev,
  1793. "Failed to get nic info %d\n", err);
  1794. goto out;
  1795. }
  1796. npar_info->op_type = cmd.rsp.arg[1];
  1797. npar_info->pci_func = cmd.rsp.arg[2] & 0xFFFF;
  1798. npar_info->op_mode = (cmd.rsp.arg[2] & 0xFFFF0000) >> 16;
  1799. npar_info->phys_port = cmd.rsp.arg[3] & 0xFFFF;
  1800. npar_info->switch_mode = (cmd.rsp.arg[3] & 0xFFFF0000) >> 16;
  1801. npar_info->capabilities = cmd.rsp.arg[4];
  1802. npar_info->max_mac_filters = cmd.rsp.arg[5] & 0xFF;
  1803. npar_info->max_mtu = (cmd.rsp.arg[5] & 0xFFFF0000) >> 16;
  1804. npar_info->max_tx_ques = cmd.rsp.arg[6] & 0xFFFF;
  1805. npar_info->max_rx_ques = (cmd.rsp.arg[6] & 0xFFFF0000) >> 16;
  1806. npar_info->min_tx_bw = cmd.rsp.arg[7] & 0xFFFF;
  1807. npar_info->max_tx_bw = (cmd.rsp.arg[7] & 0xFFFF0000) >> 16;
  1808. if (cmd.rsp.arg[8] & 0x1)
  1809. npar_info->max_bw_reg_offset = (cmd.rsp.arg[8] & 0x7FFE) >> 1;
  1810. if (cmd.rsp.arg[8] & 0x10000) {
  1811. temp = (cmd.rsp.arg[8] & 0x7FFE0000) >> 17;
  1812. npar_info->max_linkspeed_reg_offset = temp;
  1813. }
  1814. out:
  1815. qlcnic_free_mbx_args(&cmd);
  1816. return err;
  1817. }
  1818. int qlcnic_83xx_get_pci_info(struct qlcnic_adapter *adapter,
  1819. struct qlcnic_pci_info *pci_info)
  1820. {
  1821. int i, err = 0, j = 0;
  1822. u32 temp;
  1823. struct qlcnic_cmd_args cmd;
  1824. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_PCI_INFO);
  1825. err = qlcnic_issue_cmd(adapter, &cmd);
  1826. adapter->ahw->act_pci_func = 0;
  1827. if (err == QLCNIC_RCODE_SUCCESS) {
  1828. pci_info->func_count = cmd.rsp.arg[1] & 0xFF;
  1829. dev_info(&adapter->pdev->dev,
  1830. "%s: total functions = %d\n",
  1831. __func__, pci_info->func_count);
  1832. for (i = 2, j = 0; j < QLCNIC_MAX_PCI_FUNC; j++, pci_info++) {
  1833. pci_info->id = cmd.rsp.arg[i] & 0xFFFF;
  1834. pci_info->active = (cmd.rsp.arg[i] & 0xFFFF0000) >> 16;
  1835. i++;
  1836. pci_info->type = cmd.rsp.arg[i] & 0xFFFF;
  1837. if (pci_info->type == QLCNIC_TYPE_NIC)
  1838. adapter->ahw->act_pci_func++;
  1839. temp = (cmd.rsp.arg[i] & 0xFFFF0000) >> 16;
  1840. pci_info->default_port = temp;
  1841. i++;
  1842. pci_info->tx_min_bw = cmd.rsp.arg[i] & 0xFFFF;
  1843. temp = (cmd.rsp.arg[i] & 0xFFFF0000) >> 16;
  1844. pci_info->tx_max_bw = temp;
  1845. i = i + 2;
  1846. memcpy(pci_info->mac, &cmd.rsp.arg[i], ETH_ALEN - 2);
  1847. i++;
  1848. memcpy(pci_info->mac + sizeof(u32), &cmd.rsp.arg[i], 2);
  1849. i = i + 3;
  1850. dev_info(&adapter->pdev->dev, "%s:\n"
  1851. "\tid = %d active = %d type = %d\n"
  1852. "\tport = %d min bw = %d max bw = %d\n"
  1853. "\tmac_addr = %pM\n", __func__,
  1854. pci_info->id, pci_info->active, pci_info->type,
  1855. pci_info->default_port, pci_info->tx_min_bw,
  1856. pci_info->tx_max_bw, pci_info->mac);
  1857. }
  1858. } else {
  1859. dev_err(&adapter->pdev->dev, "Failed to get PCI Info%d\n",
  1860. err);
  1861. err = -EIO;
  1862. }
  1863. qlcnic_free_mbx_args(&cmd);
  1864. return err;
  1865. }
  1866. int qlcnic_83xx_config_intrpt(struct qlcnic_adapter *adapter, bool op_type)
  1867. {
  1868. int i, index, err;
  1869. u8 max_ints;
  1870. u32 val, temp, type;
  1871. struct qlcnic_cmd_args cmd;
  1872. max_ints = adapter->ahw->num_msix - 1;
  1873. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIG_INTRPT);
  1874. cmd.req.arg[1] = max_ints;
  1875. if (qlcnic_sriov_vf_check(adapter))
  1876. cmd.req.arg[1] |= (adapter->ahw->pci_func << 8) | BIT_16;
  1877. for (i = 0, index = 2; i < max_ints; i++) {
  1878. type = op_type ? QLCNIC_INTRPT_ADD : QLCNIC_INTRPT_DEL;
  1879. val = type | (adapter->ahw->intr_tbl[i].type << 4);
  1880. if (adapter->ahw->intr_tbl[i].type == QLCNIC_INTRPT_MSIX)
  1881. val |= (adapter->ahw->intr_tbl[i].id << 16);
  1882. cmd.req.arg[index++] = val;
  1883. }
  1884. err = qlcnic_issue_cmd(adapter, &cmd);
  1885. if (err) {
  1886. dev_err(&adapter->pdev->dev,
  1887. "Failed to configure interrupts 0x%x\n", err);
  1888. goto out;
  1889. }
  1890. max_ints = cmd.rsp.arg[1];
  1891. for (i = 0, index = 2; i < max_ints; i++, index += 2) {
  1892. val = cmd.rsp.arg[index];
  1893. if (LSB(val)) {
  1894. dev_info(&adapter->pdev->dev,
  1895. "Can't configure interrupt %d\n",
  1896. adapter->ahw->intr_tbl[i].id);
  1897. continue;
  1898. }
  1899. if (op_type) {
  1900. adapter->ahw->intr_tbl[i].id = MSW(val);
  1901. adapter->ahw->intr_tbl[i].enabled = 1;
  1902. temp = cmd.rsp.arg[index + 1];
  1903. adapter->ahw->intr_tbl[i].src = temp;
  1904. } else {
  1905. adapter->ahw->intr_tbl[i].id = i;
  1906. adapter->ahw->intr_tbl[i].enabled = 0;
  1907. adapter->ahw->intr_tbl[i].src = 0;
  1908. }
  1909. }
  1910. out:
  1911. qlcnic_free_mbx_args(&cmd);
  1912. return err;
  1913. }
  1914. int qlcnic_83xx_lock_flash(struct qlcnic_adapter *adapter)
  1915. {
  1916. int id, timeout = 0;
  1917. u32 status = 0;
  1918. while (status == 0) {
  1919. status = QLC_SHARED_REG_RD32(adapter, QLCNIC_FLASH_LOCK);
  1920. if (status)
  1921. break;
  1922. if (++timeout >= QLC_83XX_FLASH_LOCK_TIMEOUT) {
  1923. id = QLC_SHARED_REG_RD32(adapter,
  1924. QLCNIC_FLASH_LOCK_OWNER);
  1925. dev_err(&adapter->pdev->dev,
  1926. "%s: failed, lock held by %d\n", __func__, id);
  1927. return -EIO;
  1928. }
  1929. usleep_range(1000, 2000);
  1930. }
  1931. QLC_SHARED_REG_WR32(adapter, QLCNIC_FLASH_LOCK_OWNER, adapter->portnum);
  1932. return 0;
  1933. }
  1934. void qlcnic_83xx_unlock_flash(struct qlcnic_adapter *adapter)
  1935. {
  1936. QLC_SHARED_REG_RD32(adapter, QLCNIC_FLASH_UNLOCK);
  1937. QLC_SHARED_REG_WR32(adapter, QLCNIC_FLASH_LOCK_OWNER, 0xFF);
  1938. }
  1939. int qlcnic_83xx_lockless_flash_read32(struct qlcnic_adapter *adapter,
  1940. u32 flash_addr, u8 *p_data,
  1941. int count)
  1942. {
  1943. int i, ret;
  1944. u32 word, range, flash_offset, addr = flash_addr;
  1945. ulong indirect_add, direct_window;
  1946. flash_offset = addr & (QLCNIC_FLASH_SECTOR_SIZE - 1);
  1947. if (addr & 0x3) {
  1948. dev_err(&adapter->pdev->dev, "Illegal addr = 0x%x\n", addr);
  1949. return -EIO;
  1950. }
  1951. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_DIRECT_WINDOW,
  1952. (addr));
  1953. range = flash_offset + (count * sizeof(u32));
  1954. /* Check if data is spread across multiple sectors */
  1955. if (range > (QLCNIC_FLASH_SECTOR_SIZE - 1)) {
  1956. /* Multi sector read */
  1957. for (i = 0; i < count; i++) {
  1958. indirect_add = QLC_83XX_FLASH_DIRECT_DATA(addr);
  1959. ret = qlcnic_83xx_rd_reg_indirect(adapter,
  1960. indirect_add);
  1961. if (ret == -EIO)
  1962. return -EIO;
  1963. word = ret;
  1964. *(u32 *)p_data = word;
  1965. p_data = p_data + 4;
  1966. addr = addr + 4;
  1967. flash_offset = flash_offset + 4;
  1968. if (flash_offset > (QLCNIC_FLASH_SECTOR_SIZE - 1)) {
  1969. direct_window = QLC_83XX_FLASH_DIRECT_WINDOW;
  1970. /* This write is needed once for each sector */
  1971. qlcnic_83xx_wrt_reg_indirect(adapter,
  1972. direct_window,
  1973. (addr));
  1974. flash_offset = 0;
  1975. }
  1976. }
  1977. } else {
  1978. /* Single sector read */
  1979. for (i = 0; i < count; i++) {
  1980. indirect_add = QLC_83XX_FLASH_DIRECT_DATA(addr);
  1981. ret = qlcnic_83xx_rd_reg_indirect(adapter,
  1982. indirect_add);
  1983. if (ret == -EIO)
  1984. return -EIO;
  1985. word = ret;
  1986. *(u32 *)p_data = word;
  1987. p_data = p_data + 4;
  1988. addr = addr + 4;
  1989. }
  1990. }
  1991. return 0;
  1992. }
  1993. static int qlcnic_83xx_poll_flash_status_reg(struct qlcnic_adapter *adapter)
  1994. {
  1995. u32 status;
  1996. int retries = QLC_83XX_FLASH_READ_RETRY_COUNT;
  1997. do {
  1998. status = qlcnic_83xx_rd_reg_indirect(adapter,
  1999. QLC_83XX_FLASH_STATUS);
  2000. if ((status & QLC_83XX_FLASH_STATUS_READY) ==
  2001. QLC_83XX_FLASH_STATUS_READY)
  2002. break;
  2003. msleep(QLC_83XX_FLASH_STATUS_REG_POLL_DELAY);
  2004. } while (--retries);
  2005. if (!retries)
  2006. return -EIO;
  2007. return 0;
  2008. }
  2009. int qlcnic_83xx_enable_flash_write(struct qlcnic_adapter *adapter)
  2010. {
  2011. int ret;
  2012. u32 cmd;
  2013. cmd = adapter->ahw->fdt.write_statusreg_cmd;
  2014. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2015. (QLC_83XX_FLASH_FDT_WRITE_DEF_SIG | cmd));
  2016. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
  2017. adapter->ahw->fdt.write_enable_bits);
  2018. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2019. QLC_83XX_FLASH_SECOND_ERASE_MS_VAL);
  2020. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2021. if (ret)
  2022. return -EIO;
  2023. return 0;
  2024. }
  2025. int qlcnic_83xx_disable_flash_write(struct qlcnic_adapter *adapter)
  2026. {
  2027. int ret;
  2028. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2029. (QLC_83XX_FLASH_FDT_WRITE_DEF_SIG |
  2030. adapter->ahw->fdt.write_statusreg_cmd));
  2031. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
  2032. adapter->ahw->fdt.write_disable_bits);
  2033. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2034. QLC_83XX_FLASH_SECOND_ERASE_MS_VAL);
  2035. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2036. if (ret)
  2037. return -EIO;
  2038. return 0;
  2039. }
  2040. int qlcnic_83xx_read_flash_mfg_id(struct qlcnic_adapter *adapter)
  2041. {
  2042. int ret, mfg_id;
  2043. if (qlcnic_83xx_lock_flash(adapter))
  2044. return -EIO;
  2045. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2046. QLC_83XX_FLASH_FDT_READ_MFG_ID_VAL);
  2047. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2048. QLC_83XX_FLASH_READ_CTRL);
  2049. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2050. if (ret) {
  2051. qlcnic_83xx_unlock_flash(adapter);
  2052. return -EIO;
  2053. }
  2054. mfg_id = qlcnic_83xx_rd_reg_indirect(adapter, QLC_83XX_FLASH_RDDATA);
  2055. if (mfg_id == -EIO)
  2056. return -EIO;
  2057. adapter->flash_mfg_id = (mfg_id & 0xFF);
  2058. qlcnic_83xx_unlock_flash(adapter);
  2059. return 0;
  2060. }
  2061. int qlcnic_83xx_read_flash_descriptor_table(struct qlcnic_adapter *adapter)
  2062. {
  2063. int count, fdt_size, ret = 0;
  2064. fdt_size = sizeof(struct qlcnic_fdt);
  2065. count = fdt_size / sizeof(u32);
  2066. if (qlcnic_83xx_lock_flash(adapter))
  2067. return -EIO;
  2068. memset(&adapter->ahw->fdt, 0, fdt_size);
  2069. ret = qlcnic_83xx_lockless_flash_read32(adapter, QLCNIC_FDT_LOCATION,
  2070. (u8 *)&adapter->ahw->fdt,
  2071. count);
  2072. qlcnic_83xx_unlock_flash(adapter);
  2073. return ret;
  2074. }
  2075. int qlcnic_83xx_erase_flash_sector(struct qlcnic_adapter *adapter,
  2076. u32 sector_start_addr)
  2077. {
  2078. u32 reversed_addr, addr1, addr2, cmd;
  2079. int ret = -EIO;
  2080. if (qlcnic_83xx_lock_flash(adapter) != 0)
  2081. return -EIO;
  2082. if (adapter->ahw->fdt.mfg_id == adapter->flash_mfg_id) {
  2083. ret = qlcnic_83xx_enable_flash_write(adapter);
  2084. if (ret) {
  2085. qlcnic_83xx_unlock_flash(adapter);
  2086. dev_err(&adapter->pdev->dev,
  2087. "%s failed at %d\n",
  2088. __func__, __LINE__);
  2089. return ret;
  2090. }
  2091. }
  2092. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2093. if (ret) {
  2094. qlcnic_83xx_unlock_flash(adapter);
  2095. dev_err(&adapter->pdev->dev,
  2096. "%s: failed at %d\n", __func__, __LINE__);
  2097. return -EIO;
  2098. }
  2099. addr1 = (sector_start_addr & 0xFF) << 16;
  2100. addr2 = (sector_start_addr & 0xFF0000) >> 16;
  2101. reversed_addr = addr1 | addr2;
  2102. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
  2103. reversed_addr);
  2104. cmd = QLC_83XX_FLASH_FDT_ERASE_DEF_SIG | adapter->ahw->fdt.erase_cmd;
  2105. if (adapter->ahw->fdt.mfg_id == adapter->flash_mfg_id)
  2106. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR, cmd);
  2107. else
  2108. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2109. QLC_83XX_FLASH_OEM_ERASE_SIG);
  2110. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2111. QLC_83XX_FLASH_LAST_ERASE_MS_VAL);
  2112. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2113. if (ret) {
  2114. qlcnic_83xx_unlock_flash(adapter);
  2115. dev_err(&adapter->pdev->dev,
  2116. "%s: failed at %d\n", __func__, __LINE__);
  2117. return -EIO;
  2118. }
  2119. if (adapter->ahw->fdt.mfg_id == adapter->flash_mfg_id) {
  2120. ret = qlcnic_83xx_disable_flash_write(adapter);
  2121. if (ret) {
  2122. qlcnic_83xx_unlock_flash(adapter);
  2123. dev_err(&adapter->pdev->dev,
  2124. "%s: failed at %d\n", __func__, __LINE__);
  2125. return ret;
  2126. }
  2127. }
  2128. qlcnic_83xx_unlock_flash(adapter);
  2129. return 0;
  2130. }
  2131. int qlcnic_83xx_flash_write32(struct qlcnic_adapter *adapter, u32 addr,
  2132. u32 *p_data)
  2133. {
  2134. int ret = -EIO;
  2135. u32 addr1 = 0x00800000 | (addr >> 2);
  2136. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR, addr1);
  2137. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA, *p_data);
  2138. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2139. QLC_83XX_FLASH_LAST_ERASE_MS_VAL);
  2140. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2141. if (ret) {
  2142. dev_err(&adapter->pdev->dev,
  2143. "%s: failed at %d\n", __func__, __LINE__);
  2144. return -EIO;
  2145. }
  2146. return 0;
  2147. }
  2148. int qlcnic_83xx_flash_bulk_write(struct qlcnic_adapter *adapter, u32 addr,
  2149. u32 *p_data, int count)
  2150. {
  2151. u32 temp;
  2152. int ret = -EIO;
  2153. if ((count < QLC_83XX_FLASH_WRITE_MIN) ||
  2154. (count > QLC_83XX_FLASH_WRITE_MAX)) {
  2155. dev_err(&adapter->pdev->dev,
  2156. "%s: Invalid word count\n", __func__);
  2157. return -EIO;
  2158. }
  2159. temp = qlcnic_83xx_rd_reg_indirect(adapter,
  2160. QLC_83XX_FLASH_SPI_CONTROL);
  2161. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_SPI_CONTROL,
  2162. (temp | QLC_83XX_FLASH_SPI_CTRL));
  2163. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2164. QLC_83XX_FLASH_ADDR_TEMP_VAL);
  2165. /* First DWORD write */
  2166. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA, *p_data++);
  2167. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2168. QLC_83XX_FLASH_FIRST_MS_PATTERN);
  2169. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2170. if (ret) {
  2171. dev_err(&adapter->pdev->dev,
  2172. "%s: failed at %d\n", __func__, __LINE__);
  2173. return -EIO;
  2174. }
  2175. count--;
  2176. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2177. QLC_83XX_FLASH_ADDR_SECOND_TEMP_VAL);
  2178. /* Second to N-1 DWORD writes */
  2179. while (count != 1) {
  2180. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
  2181. *p_data++);
  2182. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2183. QLC_83XX_FLASH_SECOND_MS_PATTERN);
  2184. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2185. if (ret) {
  2186. dev_err(&adapter->pdev->dev,
  2187. "%s: failed at %d\n", __func__, __LINE__);
  2188. return -EIO;
  2189. }
  2190. count--;
  2191. }
  2192. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2193. QLC_83XX_FLASH_ADDR_TEMP_VAL |
  2194. (addr >> 2));
  2195. /* Last DWORD write */
  2196. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA, *p_data++);
  2197. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2198. QLC_83XX_FLASH_LAST_MS_PATTERN);
  2199. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2200. if (ret) {
  2201. dev_err(&adapter->pdev->dev,
  2202. "%s: failed at %d\n", __func__, __LINE__);
  2203. return -EIO;
  2204. }
  2205. ret = qlcnic_83xx_rd_reg_indirect(adapter, QLC_83XX_FLASH_SPI_STATUS);
  2206. if ((ret & QLC_83XX_FLASH_SPI_CTRL) == QLC_83XX_FLASH_SPI_CTRL) {
  2207. dev_err(&adapter->pdev->dev, "%s: failed at %d\n",
  2208. __func__, __LINE__);
  2209. /* Operation failed, clear error bit */
  2210. temp = qlcnic_83xx_rd_reg_indirect(adapter,
  2211. QLC_83XX_FLASH_SPI_CONTROL);
  2212. qlcnic_83xx_wrt_reg_indirect(adapter,
  2213. QLC_83XX_FLASH_SPI_CONTROL,
  2214. (temp | QLC_83XX_FLASH_SPI_CTRL));
  2215. }
  2216. return 0;
  2217. }
  2218. static void qlcnic_83xx_recover_driver_lock(struct qlcnic_adapter *adapter)
  2219. {
  2220. u32 val, id;
  2221. val = QLCRDX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK);
  2222. /* Check if recovery need to be performed by the calling function */
  2223. if ((val & QLC_83XX_DRV_LOCK_RECOVERY_STATUS_MASK) == 0) {
  2224. val = val & ~0x3F;
  2225. val = val | ((adapter->portnum << 2) |
  2226. QLC_83XX_NEED_DRV_LOCK_RECOVERY);
  2227. QLCWRX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK, val);
  2228. dev_info(&adapter->pdev->dev,
  2229. "%s: lock recovery initiated\n", __func__);
  2230. msleep(QLC_83XX_DRV_LOCK_RECOVERY_DELAY);
  2231. val = QLCRDX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK);
  2232. id = ((val >> 2) & 0xF);
  2233. if (id == adapter->portnum) {
  2234. val = val & ~QLC_83XX_DRV_LOCK_RECOVERY_STATUS_MASK;
  2235. val = val | QLC_83XX_DRV_LOCK_RECOVERY_IN_PROGRESS;
  2236. QLCWRX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK, val);
  2237. /* Force release the lock */
  2238. QLCRDX(adapter->ahw, QLC_83XX_DRV_UNLOCK);
  2239. /* Clear recovery bits */
  2240. val = val & ~0x3F;
  2241. QLCWRX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK, val);
  2242. dev_info(&adapter->pdev->dev,
  2243. "%s: lock recovery completed\n", __func__);
  2244. } else {
  2245. dev_info(&adapter->pdev->dev,
  2246. "%s: func %d to resume lock recovery process\n",
  2247. __func__, id);
  2248. }
  2249. } else {
  2250. dev_info(&adapter->pdev->dev,
  2251. "%s: lock recovery initiated by other functions\n",
  2252. __func__);
  2253. }
  2254. }
  2255. int qlcnic_83xx_lock_driver(struct qlcnic_adapter *adapter)
  2256. {
  2257. u32 lock_alive_counter, val, id, i = 0, status = 0, temp = 0;
  2258. int max_attempt = 0;
  2259. while (status == 0) {
  2260. status = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK);
  2261. if (status)
  2262. break;
  2263. msleep(QLC_83XX_DRV_LOCK_WAIT_DELAY);
  2264. i++;
  2265. if (i == 1)
  2266. temp = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
  2267. if (i == QLC_83XX_DRV_LOCK_WAIT_COUNTER) {
  2268. val = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
  2269. if (val == temp) {
  2270. id = val & 0xFF;
  2271. dev_info(&adapter->pdev->dev,
  2272. "%s: lock to be recovered from %d\n",
  2273. __func__, id);
  2274. qlcnic_83xx_recover_driver_lock(adapter);
  2275. i = 0;
  2276. max_attempt++;
  2277. } else {
  2278. dev_err(&adapter->pdev->dev,
  2279. "%s: failed to get lock\n", __func__);
  2280. return -EIO;
  2281. }
  2282. }
  2283. /* Force exit from while loop after few attempts */
  2284. if (max_attempt == QLC_83XX_MAX_DRV_LOCK_RECOVERY_ATTEMPT) {
  2285. dev_err(&adapter->pdev->dev,
  2286. "%s: failed to get lock\n", __func__);
  2287. return -EIO;
  2288. }
  2289. }
  2290. val = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
  2291. lock_alive_counter = val >> 8;
  2292. lock_alive_counter++;
  2293. val = lock_alive_counter << 8 | adapter->portnum;
  2294. QLCWRX(adapter->ahw, QLC_83XX_DRV_LOCK_ID, val);
  2295. return 0;
  2296. }
  2297. void qlcnic_83xx_unlock_driver(struct qlcnic_adapter *adapter)
  2298. {
  2299. u32 val, lock_alive_counter, id;
  2300. val = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
  2301. id = val & 0xFF;
  2302. lock_alive_counter = val >> 8;
  2303. if (id != adapter->portnum)
  2304. dev_err(&adapter->pdev->dev,
  2305. "%s:Warning func %d is unlocking lock owned by %d\n",
  2306. __func__, adapter->portnum, id);
  2307. val = (lock_alive_counter << 8) | 0xFF;
  2308. QLCWRX(adapter->ahw, QLC_83XX_DRV_LOCK_ID, val);
  2309. QLCRDX(adapter->ahw, QLC_83XX_DRV_UNLOCK);
  2310. }
  2311. int qlcnic_83xx_ms_mem_write128(struct qlcnic_adapter *adapter, u64 addr,
  2312. u32 *data, u32 count)
  2313. {
  2314. int i, j, ret = 0;
  2315. u32 temp;
  2316. /* Check alignment */
  2317. if (addr & 0xF)
  2318. return -EIO;
  2319. mutex_lock(&adapter->ahw->mem_lock);
  2320. qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_ADDR_HI, 0);
  2321. for (i = 0; i < count; i++, addr += 16) {
  2322. if (!((ADDR_IN_RANGE(addr, QLCNIC_ADDR_QDR_NET,
  2323. QLCNIC_ADDR_QDR_NET_MAX)) ||
  2324. (ADDR_IN_RANGE(addr, QLCNIC_ADDR_DDR_NET,
  2325. QLCNIC_ADDR_DDR_NET_MAX)))) {
  2326. mutex_unlock(&adapter->ahw->mem_lock);
  2327. return -EIO;
  2328. }
  2329. qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_ADDR_LO, addr);
  2330. qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_WRTDATA_LO,
  2331. *data++);
  2332. qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_WRTDATA_HI,
  2333. *data++);
  2334. qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_WRTDATA_ULO,
  2335. *data++);
  2336. qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_WRTDATA_UHI,
  2337. *data++);
  2338. qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_CTRL,
  2339. QLCNIC_TA_WRITE_ENABLE);
  2340. qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_CTRL,
  2341. QLCNIC_TA_WRITE_START);
  2342. for (j = 0; j < MAX_CTL_CHECK; j++) {
  2343. temp = qlcnic_83xx_rd_reg_indirect(adapter,
  2344. QLCNIC_MS_CTRL);
  2345. if ((temp & TA_CTL_BUSY) == 0)
  2346. break;
  2347. }
  2348. /* Status check failure */
  2349. if (j >= MAX_CTL_CHECK) {
  2350. printk_ratelimited(KERN_WARNING
  2351. "MS memory write failed\n");
  2352. mutex_unlock(&adapter->ahw->mem_lock);
  2353. return -EIO;
  2354. }
  2355. }
  2356. mutex_unlock(&adapter->ahw->mem_lock);
  2357. return ret;
  2358. }
  2359. int qlcnic_83xx_flash_read32(struct qlcnic_adapter *adapter, u32 flash_addr,
  2360. u8 *p_data, int count)
  2361. {
  2362. int i, ret;
  2363. u32 word, addr = flash_addr;
  2364. ulong indirect_addr;
  2365. if (qlcnic_83xx_lock_flash(adapter) != 0)
  2366. return -EIO;
  2367. if (addr & 0x3) {
  2368. dev_err(&adapter->pdev->dev, "Illegal addr = 0x%x\n", addr);
  2369. qlcnic_83xx_unlock_flash(adapter);
  2370. return -EIO;
  2371. }
  2372. for (i = 0; i < count; i++) {
  2373. if (qlcnic_83xx_wrt_reg_indirect(adapter,
  2374. QLC_83XX_FLASH_DIRECT_WINDOW,
  2375. (addr))) {
  2376. qlcnic_83xx_unlock_flash(adapter);
  2377. return -EIO;
  2378. }
  2379. indirect_addr = QLC_83XX_FLASH_DIRECT_DATA(addr);
  2380. ret = qlcnic_83xx_rd_reg_indirect(adapter,
  2381. indirect_addr);
  2382. if (ret == -EIO)
  2383. return -EIO;
  2384. word = ret;
  2385. *(u32 *)p_data = word;
  2386. p_data = p_data + 4;
  2387. addr = addr + 4;
  2388. }
  2389. qlcnic_83xx_unlock_flash(adapter);
  2390. return 0;
  2391. }
  2392. int qlcnic_83xx_test_link(struct qlcnic_adapter *adapter)
  2393. {
  2394. u8 pci_func;
  2395. int err;
  2396. u32 config = 0, state;
  2397. struct qlcnic_cmd_args cmd;
  2398. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2399. if (qlcnic_sriov_vf_check(adapter))
  2400. pci_func = adapter->portnum;
  2401. else
  2402. pci_func = ahw->pci_func;
  2403. state = readl(ahw->pci_base0 + QLC_83XX_LINK_STATE(pci_func));
  2404. if (!QLC_83xx_FUNC_VAL(state, pci_func)) {
  2405. dev_info(&adapter->pdev->dev, "link state down\n");
  2406. return config;
  2407. }
  2408. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_LINK_STATUS);
  2409. err = qlcnic_issue_cmd(adapter, &cmd);
  2410. if (err) {
  2411. dev_info(&adapter->pdev->dev,
  2412. "Get Link Status Command failed: 0x%x\n", err);
  2413. goto out;
  2414. } else {
  2415. config = cmd.rsp.arg[1];
  2416. switch (QLC_83XX_CURRENT_LINK_SPEED(config)) {
  2417. case QLC_83XX_10M_LINK:
  2418. ahw->link_speed = SPEED_10;
  2419. break;
  2420. case QLC_83XX_100M_LINK:
  2421. ahw->link_speed = SPEED_100;
  2422. break;
  2423. case QLC_83XX_1G_LINK:
  2424. ahw->link_speed = SPEED_1000;
  2425. break;
  2426. case QLC_83XX_10G_LINK:
  2427. ahw->link_speed = SPEED_10000;
  2428. break;
  2429. default:
  2430. ahw->link_speed = 0;
  2431. break;
  2432. }
  2433. config = cmd.rsp.arg[3];
  2434. if (config & 1)
  2435. err = 1;
  2436. }
  2437. out:
  2438. qlcnic_free_mbx_args(&cmd);
  2439. return config;
  2440. }
  2441. int qlcnic_83xx_get_settings(struct qlcnic_adapter *adapter)
  2442. {
  2443. u32 config = 0;
  2444. int status = 0;
  2445. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2446. /* Get port configuration info */
  2447. status = qlcnic_83xx_get_port_info(adapter);
  2448. /* Get Link Status related info */
  2449. config = qlcnic_83xx_test_link(adapter);
  2450. ahw->module_type = QLC_83XX_SFP_MODULE_TYPE(config);
  2451. /* hard code until there is a way to get it from flash */
  2452. ahw->board_type = QLCNIC_BRDTYPE_83XX_10G;
  2453. return status;
  2454. }
  2455. int qlcnic_83xx_set_settings(struct qlcnic_adapter *adapter,
  2456. struct ethtool_cmd *ecmd)
  2457. {
  2458. int status = 0;
  2459. u32 config = adapter->ahw->port_config;
  2460. if (ecmd->autoneg)
  2461. adapter->ahw->port_config |= BIT_15;
  2462. switch (ethtool_cmd_speed(ecmd)) {
  2463. case SPEED_10:
  2464. adapter->ahw->port_config |= BIT_8;
  2465. break;
  2466. case SPEED_100:
  2467. adapter->ahw->port_config |= BIT_9;
  2468. break;
  2469. case SPEED_1000:
  2470. adapter->ahw->port_config |= BIT_10;
  2471. break;
  2472. case SPEED_10000:
  2473. adapter->ahw->port_config |= BIT_11;
  2474. break;
  2475. default:
  2476. return -EINVAL;
  2477. }
  2478. status = qlcnic_83xx_set_port_config(adapter);
  2479. if (status) {
  2480. dev_info(&adapter->pdev->dev,
  2481. "Faild to Set Link Speed and autoneg.\n");
  2482. adapter->ahw->port_config = config;
  2483. }
  2484. return status;
  2485. }
  2486. static inline u64 *qlcnic_83xx_copy_stats(struct qlcnic_cmd_args *cmd,
  2487. u64 *data, int index)
  2488. {
  2489. u32 low, hi;
  2490. u64 val;
  2491. low = cmd->rsp.arg[index];
  2492. hi = cmd->rsp.arg[index + 1];
  2493. val = (((u64) low) | (((u64) hi) << 32));
  2494. *data++ = val;
  2495. return data;
  2496. }
  2497. static u64 *qlcnic_83xx_fill_stats(struct qlcnic_adapter *adapter,
  2498. struct qlcnic_cmd_args *cmd, u64 *data,
  2499. int type, int *ret)
  2500. {
  2501. int err, k, total_regs;
  2502. *ret = 0;
  2503. err = qlcnic_issue_cmd(adapter, cmd);
  2504. if (err != QLCNIC_RCODE_SUCCESS) {
  2505. dev_info(&adapter->pdev->dev,
  2506. "Error in get statistics mailbox command\n");
  2507. *ret = -EIO;
  2508. return data;
  2509. }
  2510. total_regs = cmd->rsp.num;
  2511. switch (type) {
  2512. case QLC_83XX_STAT_MAC:
  2513. /* fill in MAC tx counters */
  2514. for (k = 2; k < 28; k += 2)
  2515. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2516. /* skip 24 bytes of reserved area */
  2517. /* fill in MAC rx counters */
  2518. for (k += 6; k < 60; k += 2)
  2519. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2520. /* skip 24 bytes of reserved area */
  2521. /* fill in MAC rx frame stats */
  2522. for (k += 6; k < 80; k += 2)
  2523. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2524. /* fill in eSwitch stats */
  2525. for (; k < total_regs; k += 2)
  2526. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2527. break;
  2528. case QLC_83XX_STAT_RX:
  2529. for (k = 2; k < 8; k += 2)
  2530. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2531. /* skip 8 bytes of reserved data */
  2532. for (k += 2; k < 24; k += 2)
  2533. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2534. /* skip 8 bytes containing RE1FBQ error data */
  2535. for (k += 2; k < total_regs; k += 2)
  2536. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2537. break;
  2538. case QLC_83XX_STAT_TX:
  2539. for (k = 2; k < 10; k += 2)
  2540. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2541. /* skip 8 bytes of reserved data */
  2542. for (k += 2; k < total_regs; k += 2)
  2543. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2544. break;
  2545. default:
  2546. dev_warn(&adapter->pdev->dev, "Unknown get statistics mode\n");
  2547. *ret = -EIO;
  2548. }
  2549. return data;
  2550. }
  2551. void qlcnic_83xx_get_stats(struct qlcnic_adapter *adapter, u64 *data)
  2552. {
  2553. struct qlcnic_cmd_args cmd;
  2554. struct net_device *netdev = adapter->netdev;
  2555. int ret = 0;
  2556. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_STATISTICS);
  2557. /* Get Tx stats */
  2558. cmd.req.arg[1] = BIT_1 | (adapter->tx_ring->ctx_id << 16);
  2559. cmd.rsp.num = QLC_83XX_TX_STAT_REGS;
  2560. data = qlcnic_83xx_fill_stats(adapter, &cmd, data,
  2561. QLC_83XX_STAT_TX, &ret);
  2562. if (ret) {
  2563. netdev_err(netdev, "Error getting Tx stats\n");
  2564. goto out;
  2565. }
  2566. /* Get MAC stats */
  2567. cmd.req.arg[1] = BIT_2 | (adapter->portnum << 16);
  2568. cmd.rsp.num = QLC_83XX_MAC_STAT_REGS;
  2569. memset(cmd.rsp.arg, 0, sizeof(u32) * cmd.rsp.num);
  2570. data = qlcnic_83xx_fill_stats(adapter, &cmd, data,
  2571. QLC_83XX_STAT_MAC, &ret);
  2572. if (ret) {
  2573. netdev_err(netdev, "Error getting MAC stats\n");
  2574. goto out;
  2575. }
  2576. /* Get Rx stats */
  2577. cmd.req.arg[1] = adapter->recv_ctx->context_id << 16;
  2578. cmd.rsp.num = QLC_83XX_RX_STAT_REGS;
  2579. memset(cmd.rsp.arg, 0, sizeof(u32) * cmd.rsp.num);
  2580. data = qlcnic_83xx_fill_stats(adapter, &cmd, data,
  2581. QLC_83XX_STAT_RX, &ret);
  2582. if (ret)
  2583. netdev_err(netdev, "Error getting Rx stats\n");
  2584. out:
  2585. qlcnic_free_mbx_args(&cmd);
  2586. }
  2587. int qlcnic_83xx_reg_test(struct qlcnic_adapter *adapter)
  2588. {
  2589. u32 major, minor, sub;
  2590. major = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MAJOR);
  2591. minor = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MINOR);
  2592. sub = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_SUB);
  2593. if (adapter->fw_version != QLCNIC_VERSION_CODE(major, minor, sub)) {
  2594. dev_info(&adapter->pdev->dev, "%s: Reg test failed\n",
  2595. __func__);
  2596. return 1;
  2597. }
  2598. return 0;
  2599. }
  2600. int qlcnic_83xx_get_regs_len(struct qlcnic_adapter *adapter)
  2601. {
  2602. return (ARRAY_SIZE(qlcnic_83xx_ext_reg_tbl) *
  2603. sizeof(adapter->ahw->ext_reg_tbl)) +
  2604. (ARRAY_SIZE(qlcnic_83xx_reg_tbl) +
  2605. sizeof(adapter->ahw->reg_tbl));
  2606. }
  2607. int qlcnic_83xx_get_registers(struct qlcnic_adapter *adapter, u32 *regs_buff)
  2608. {
  2609. int i, j = 0;
  2610. for (i = QLCNIC_DEV_INFO_SIZE + 1;
  2611. j < ARRAY_SIZE(qlcnic_83xx_reg_tbl); i++, j++)
  2612. regs_buff[i] = QLC_SHARED_REG_RD32(adapter, j);
  2613. for (j = 0; j < ARRAY_SIZE(qlcnic_83xx_ext_reg_tbl); j++)
  2614. regs_buff[i++] = QLCRDX(adapter->ahw, j);
  2615. return i;
  2616. }
  2617. int qlcnic_83xx_interrupt_test(struct net_device *netdev)
  2618. {
  2619. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  2620. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2621. struct qlcnic_cmd_args cmd;
  2622. u32 data;
  2623. u16 intrpt_id, id;
  2624. u8 val;
  2625. int ret, max_sds_rings = adapter->max_sds_rings;
  2626. if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
  2627. return -EIO;
  2628. ret = qlcnic_83xx_diag_alloc_res(netdev, QLCNIC_INTERRUPT_TEST);
  2629. if (ret)
  2630. goto fail_diag_irq;
  2631. ahw->diag_cnt = 0;
  2632. qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_INTRPT_TEST);
  2633. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  2634. intrpt_id = ahw->intr_tbl[0].id;
  2635. else
  2636. intrpt_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
  2637. cmd.req.arg[1] = 1;
  2638. cmd.req.arg[2] = intrpt_id;
  2639. cmd.req.arg[3] = BIT_0;
  2640. ret = qlcnic_issue_cmd(adapter, &cmd);
  2641. data = cmd.rsp.arg[2];
  2642. id = LSW(data);
  2643. val = LSB(MSW(data));
  2644. if (id != intrpt_id)
  2645. dev_info(&adapter->pdev->dev,
  2646. "Interrupt generated: 0x%x, requested:0x%x\n",
  2647. id, intrpt_id);
  2648. if (val)
  2649. dev_err(&adapter->pdev->dev,
  2650. "Interrupt test error: 0x%x\n", val);
  2651. if (ret)
  2652. goto done;
  2653. msleep(20);
  2654. ret = !ahw->diag_cnt;
  2655. done:
  2656. qlcnic_free_mbx_args(&cmd);
  2657. qlcnic_83xx_diag_free_res(netdev, max_sds_rings);
  2658. fail_diag_irq:
  2659. adapter->max_sds_rings = max_sds_rings;
  2660. clear_bit(__QLCNIC_RESETTING, &adapter->state);
  2661. return ret;
  2662. }
  2663. void qlcnic_83xx_get_pauseparam(struct qlcnic_adapter *adapter,
  2664. struct ethtool_pauseparam *pause)
  2665. {
  2666. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2667. int status = 0;
  2668. u32 config;
  2669. status = qlcnic_83xx_get_port_config(adapter);
  2670. if (status) {
  2671. dev_err(&adapter->pdev->dev,
  2672. "%s: Get Pause Config failed\n", __func__);
  2673. return;
  2674. }
  2675. config = ahw->port_config;
  2676. if (config & QLC_83XX_CFG_STD_PAUSE) {
  2677. if (config & QLC_83XX_CFG_STD_TX_PAUSE)
  2678. pause->tx_pause = 1;
  2679. if (config & QLC_83XX_CFG_STD_RX_PAUSE)
  2680. pause->rx_pause = 1;
  2681. }
  2682. if (QLC_83XX_AUTONEG(config))
  2683. pause->autoneg = 1;
  2684. }
  2685. int qlcnic_83xx_set_pauseparam(struct qlcnic_adapter *adapter,
  2686. struct ethtool_pauseparam *pause)
  2687. {
  2688. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2689. int status = 0;
  2690. u32 config;
  2691. status = qlcnic_83xx_get_port_config(adapter);
  2692. if (status) {
  2693. dev_err(&adapter->pdev->dev,
  2694. "%s: Get Pause Config failed.\n", __func__);
  2695. return status;
  2696. }
  2697. config = ahw->port_config;
  2698. if (ahw->port_type == QLCNIC_GBE) {
  2699. if (pause->autoneg)
  2700. ahw->port_config |= QLC_83XX_ENABLE_AUTONEG;
  2701. if (!pause->autoneg)
  2702. ahw->port_config &= ~QLC_83XX_ENABLE_AUTONEG;
  2703. } else if ((ahw->port_type == QLCNIC_XGBE) && (pause->autoneg)) {
  2704. return -EOPNOTSUPP;
  2705. }
  2706. if (!(config & QLC_83XX_CFG_STD_PAUSE))
  2707. ahw->port_config |= QLC_83XX_CFG_STD_PAUSE;
  2708. if (pause->rx_pause && pause->tx_pause) {
  2709. ahw->port_config |= QLC_83XX_CFG_STD_TX_RX_PAUSE;
  2710. } else if (pause->rx_pause && !pause->tx_pause) {
  2711. ahw->port_config &= ~QLC_83XX_CFG_STD_TX_PAUSE;
  2712. ahw->port_config |= QLC_83XX_CFG_STD_RX_PAUSE;
  2713. } else if (pause->tx_pause && !pause->rx_pause) {
  2714. ahw->port_config &= ~QLC_83XX_CFG_STD_RX_PAUSE;
  2715. ahw->port_config |= QLC_83XX_CFG_STD_TX_PAUSE;
  2716. } else if (!pause->rx_pause && !pause->tx_pause) {
  2717. ahw->port_config &= ~QLC_83XX_CFG_STD_TX_RX_PAUSE;
  2718. }
  2719. status = qlcnic_83xx_set_port_config(adapter);
  2720. if (status) {
  2721. dev_err(&adapter->pdev->dev,
  2722. "%s: Set Pause Config failed.\n", __func__);
  2723. ahw->port_config = config;
  2724. }
  2725. return status;
  2726. }
  2727. static int qlcnic_83xx_read_flash_status_reg(struct qlcnic_adapter *adapter)
  2728. {
  2729. int ret;
  2730. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2731. QLC_83XX_FLASH_OEM_READ_SIG);
  2732. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2733. QLC_83XX_FLASH_READ_CTRL);
  2734. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2735. if (ret)
  2736. return -EIO;
  2737. ret = qlcnic_83xx_rd_reg_indirect(adapter, QLC_83XX_FLASH_RDDATA);
  2738. return ret & 0xFF;
  2739. }
  2740. int qlcnic_83xx_flash_test(struct qlcnic_adapter *adapter)
  2741. {
  2742. int status;
  2743. status = qlcnic_83xx_read_flash_status_reg(adapter);
  2744. if (status == -EIO) {
  2745. dev_info(&adapter->pdev->dev, "%s: EEPROM test failed.\n",
  2746. __func__);
  2747. return 1;
  2748. }
  2749. return 0;
  2750. }