qlcnic_83xx_hw.c 113 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586358735883589359035913592359335943595359635973598359936003601360236033604360536063607360836093610361136123613361436153616361736183619362036213622362336243625362636273628362936303631363236333634363536363637363836393640364136423643364436453646364736483649365036513652365336543655365636573658365936603661366236633664366536663667366836693670367136723673367436753676367736783679368036813682368336843685368636873688368936903691369236933694369536963697369836993700370137023703370437053706370737083709371037113712371337143715371637173718371937203721372237233724372537263727372837293730373137323733373437353736373737383739374037413742374337443745374637473748374937503751375237533754375537563757375837593760376137623763376437653766376737683769377037713772377337743775377637773778377937803781378237833784378537863787378837893790379137923793379437953796379737983799380038013802380338043805380638073808380938103811381238133814381538163817381838193820382138223823382438253826382738283829383038313832383338343835383638373838383938403841384238433844384538463847384838493850385138523853385438553856385738583859386038613862386338643865386638673868386938703871387238733874387538763877387838793880388138823883388438853886388738883889389038913892389338943895389638973898389939003901390239033904390539063907390839093910391139123913391439153916391739183919392039213922392339243925392639273928392939303931393239333934393539363937393839393940394139423943394439453946394739483949395039513952395339543955395639573958395939603961396239633964396539663967396839693970397139723973397439753976397739783979398039813982398339843985398639873988398939903991399239933994399539963997399839994000400140024003400440054006400740084009401040114012401340144015401640174018401940204021402240234024402540264027402840294030403140324033403440354036403740384039404040414042404340444045404640474048404940504051405240534054405540564057405840594060406140624063406440654066406740684069407040714072407340744075407640774078407940804081408240834084408540864087408840894090409140924093409440954096409740984099410041014102410341044105410641074108410941104111411241134114411541164117411841194120412141224123412441254126412741284129413041314132413341344135413641374138413941404141414241434144414541464147414841494150415141524153415441554156415741584159416041614162416341644165416641674168416941704171417241734174417541764177417841794180418141824183418441854186418741884189419041914192419341944195419641974198419942004201420242034204420542064207420842094210421142124213421442154216421742184219422042214222422342244225422642274228422942304231423242334234423542364237
  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 <linux/if_vlan.h>
  8. #include <linux/ipv6.h>
  9. #include <linux/ethtool.h>
  10. #include <linux/interrupt.h>
  11. #include <linux/aer.h>
  12. #include "qlcnic.h"
  13. #include "qlcnic_sriov.h"
  14. static void __qlcnic_83xx_process_aen(struct qlcnic_adapter *);
  15. static int qlcnic_83xx_clear_lb_mode(struct qlcnic_adapter *, u8);
  16. static void qlcnic_83xx_configure_mac(struct qlcnic_adapter *, u8 *, u8,
  17. struct qlcnic_cmd_args *);
  18. static int qlcnic_83xx_get_port_config(struct qlcnic_adapter *);
  19. static irqreturn_t qlcnic_83xx_handle_aen(int, void *);
  20. static pci_ers_result_t qlcnic_83xx_io_error_detected(struct pci_dev *,
  21. pci_channel_state_t);
  22. static int qlcnic_83xx_set_port_config(struct qlcnic_adapter *);
  23. static pci_ers_result_t qlcnic_83xx_io_slot_reset(struct pci_dev *);
  24. static void qlcnic_83xx_io_resume(struct pci_dev *);
  25. static int qlcnic_83xx_set_lb_mode(struct qlcnic_adapter *, u8);
  26. static void qlcnic_83xx_set_mac_filter_count(struct qlcnic_adapter *);
  27. static int qlcnic_83xx_resume(struct qlcnic_adapter *);
  28. static int qlcnic_83xx_shutdown(struct pci_dev *);
  29. static void qlcnic_83xx_get_beacon_state(struct qlcnic_adapter *);
  30. #define RSS_HASHTYPE_IP_TCP 0x3
  31. #define QLC_83XX_FW_MBX_CMD 0
  32. #define QLC_SKIP_INACTIVE_PCI_REGS 7
  33. #define QLC_MAX_LEGACY_FUNC_SUPP 8
  34. /* 83xx Module type */
  35. #define QLC_83XX_MODULE_FIBRE_10GBASE_LRM 0x1 /* 10GBase-LRM */
  36. #define QLC_83XX_MODULE_FIBRE_10GBASE_LR 0x2 /* 10GBase-LR */
  37. #define QLC_83XX_MODULE_FIBRE_10GBASE_SR 0x3 /* 10GBase-SR */
  38. #define QLC_83XX_MODULE_DA_10GE_PASSIVE_CP 0x4 /* 10GE passive
  39. * copper(compliant)
  40. */
  41. #define QLC_83XX_MODULE_DA_10GE_ACTIVE_CP 0x5 /* 10GE active limiting
  42. * copper(compliant)
  43. */
  44. #define QLC_83XX_MODULE_DA_10GE_LEGACY_CP 0x6 /* 10GE passive copper
  45. * (legacy, best effort)
  46. */
  47. #define QLC_83XX_MODULE_FIBRE_1000BASE_SX 0x7 /* 1000Base-SX */
  48. #define QLC_83XX_MODULE_FIBRE_1000BASE_LX 0x8 /* 1000Base-LX */
  49. #define QLC_83XX_MODULE_FIBRE_1000BASE_CX 0x9 /* 1000Base-CX */
  50. #define QLC_83XX_MODULE_TP_1000BASE_T 0xa /* 1000Base-T*/
  51. #define QLC_83XX_MODULE_DA_1GE_PASSIVE_CP 0xb /* 1GE passive copper
  52. * (legacy, best effort)
  53. */
  54. #define QLC_83XX_MODULE_UNKNOWN 0xf /* Unknown module type */
  55. /* Port types */
  56. #define QLC_83XX_10_CAPABLE BIT_8
  57. #define QLC_83XX_100_CAPABLE BIT_9
  58. #define QLC_83XX_1G_CAPABLE BIT_10
  59. #define QLC_83XX_10G_CAPABLE BIT_11
  60. #define QLC_83XX_AUTONEG_ENABLE BIT_15
  61. static const struct qlcnic_mailbox_metadata qlcnic_83xx_mbx_tbl[] = {
  62. {QLCNIC_CMD_CONFIGURE_IP_ADDR, 6, 1},
  63. {QLCNIC_CMD_CONFIG_INTRPT, 18, 34},
  64. {QLCNIC_CMD_CREATE_RX_CTX, 136, 27},
  65. {QLCNIC_CMD_DESTROY_RX_CTX, 2, 1},
  66. {QLCNIC_CMD_CREATE_TX_CTX, 54, 18},
  67. {QLCNIC_CMD_DESTROY_TX_CTX, 2, 1},
  68. {QLCNIC_CMD_CONFIGURE_MAC_LEARNING, 2, 1},
  69. {QLCNIC_CMD_INTRPT_TEST, 22, 12},
  70. {QLCNIC_CMD_SET_MTU, 3, 1},
  71. {QLCNIC_CMD_READ_PHY, 4, 2},
  72. {QLCNIC_CMD_WRITE_PHY, 5, 1},
  73. {QLCNIC_CMD_READ_HW_REG, 4, 1},
  74. {QLCNIC_CMD_GET_FLOW_CTL, 4, 2},
  75. {QLCNIC_CMD_SET_FLOW_CTL, 4, 1},
  76. {QLCNIC_CMD_READ_MAX_MTU, 4, 2},
  77. {QLCNIC_CMD_READ_MAX_LRO, 4, 2},
  78. {QLCNIC_CMD_MAC_ADDRESS, 4, 3},
  79. {QLCNIC_CMD_GET_PCI_INFO, 1, 129},
  80. {QLCNIC_CMD_GET_NIC_INFO, 2, 19},
  81. {QLCNIC_CMD_SET_NIC_INFO, 32, 1},
  82. {QLCNIC_CMD_GET_ESWITCH_CAPABILITY, 4, 3},
  83. {QLCNIC_CMD_TOGGLE_ESWITCH, 4, 1},
  84. {QLCNIC_CMD_GET_ESWITCH_STATUS, 4, 3},
  85. {QLCNIC_CMD_SET_PORTMIRRORING, 4, 1},
  86. {QLCNIC_CMD_CONFIGURE_ESWITCH, 4, 1},
  87. {QLCNIC_CMD_GET_ESWITCH_PORT_CONFIG, 4, 3},
  88. {QLCNIC_CMD_GET_ESWITCH_STATS, 5, 1},
  89. {QLCNIC_CMD_CONFIG_PORT, 4, 1},
  90. {QLCNIC_CMD_TEMP_SIZE, 1, 4},
  91. {QLCNIC_CMD_GET_TEMP_HDR, 5, 5},
  92. {QLCNIC_CMD_GET_LINK_EVENT, 2, 1},
  93. {QLCNIC_CMD_CONFIG_MAC_VLAN, 4, 3},
  94. {QLCNIC_CMD_CONFIG_INTR_COAL, 6, 1},
  95. {QLCNIC_CMD_CONFIGURE_RSS, 14, 1},
  96. {QLCNIC_CMD_CONFIGURE_LED, 2, 1},
  97. {QLCNIC_CMD_CONFIGURE_MAC_RX_MODE, 2, 1},
  98. {QLCNIC_CMD_CONFIGURE_HW_LRO, 2, 1},
  99. {QLCNIC_CMD_GET_STATISTICS, 2, 80},
  100. {QLCNIC_CMD_SET_PORT_CONFIG, 2, 1},
  101. {QLCNIC_CMD_GET_PORT_CONFIG, 2, 2},
  102. {QLCNIC_CMD_GET_LINK_STATUS, 2, 4},
  103. {QLCNIC_CMD_IDC_ACK, 5, 1},
  104. {QLCNIC_CMD_INIT_NIC_FUNC, 3, 1},
  105. {QLCNIC_CMD_STOP_NIC_FUNC, 2, 1},
  106. {QLCNIC_CMD_SET_LED_CONFIG, 5, 1},
  107. {QLCNIC_CMD_GET_LED_CONFIG, 1, 5},
  108. {QLCNIC_CMD_83XX_SET_DRV_VER, 4, 1},
  109. {QLCNIC_CMD_ADD_RCV_RINGS, 130, 26},
  110. {QLCNIC_CMD_CONFIG_VPORT, 4, 4},
  111. {QLCNIC_CMD_BC_EVENT_SETUP, 2, 1},
  112. {QLCNIC_CMD_DCB_QUERY_CAP, 1, 2},
  113. {QLCNIC_CMD_DCB_QUERY_PARAM, 1, 50},
  114. {QLCNIC_CMD_SET_INGRESS_ENCAP, 2, 1},
  115. {QLCNIC_CMD_83XX_EXTEND_ISCSI_DUMP_CAP, 4, 1},
  116. };
  117. const u32 qlcnic_83xx_ext_reg_tbl[] = {
  118. 0x38CC, /* Global Reset */
  119. 0x38F0, /* Wildcard */
  120. 0x38FC, /* Informant */
  121. 0x3038, /* Host MBX ctrl */
  122. 0x303C, /* FW MBX ctrl */
  123. 0x355C, /* BOOT LOADER ADDRESS REG */
  124. 0x3560, /* BOOT LOADER SIZE REG */
  125. 0x3564, /* FW IMAGE ADDR REG */
  126. 0x1000, /* MBX intr enable */
  127. 0x1200, /* Default Intr mask */
  128. 0x1204, /* Default Interrupt ID */
  129. 0x3780, /* QLC_83XX_IDC_MAJ_VERSION */
  130. 0x3784, /* QLC_83XX_IDC_DEV_STATE */
  131. 0x3788, /* QLC_83XX_IDC_DRV_PRESENCE */
  132. 0x378C, /* QLC_83XX_IDC_DRV_ACK */
  133. 0x3790, /* QLC_83XX_IDC_CTRL */
  134. 0x3794, /* QLC_83XX_IDC_DRV_AUDIT */
  135. 0x3798, /* QLC_83XX_IDC_MIN_VERSION */
  136. 0x379C, /* QLC_83XX_RECOVER_DRV_LOCK */
  137. 0x37A0, /* QLC_83XX_IDC_PF_0 */
  138. 0x37A4, /* QLC_83XX_IDC_PF_1 */
  139. 0x37A8, /* QLC_83XX_IDC_PF_2 */
  140. 0x37AC, /* QLC_83XX_IDC_PF_3 */
  141. 0x37B0, /* QLC_83XX_IDC_PF_4 */
  142. 0x37B4, /* QLC_83XX_IDC_PF_5 */
  143. 0x37B8, /* QLC_83XX_IDC_PF_6 */
  144. 0x37BC, /* QLC_83XX_IDC_PF_7 */
  145. 0x37C0, /* QLC_83XX_IDC_PF_8 */
  146. 0x37C4, /* QLC_83XX_IDC_PF_9 */
  147. 0x37C8, /* QLC_83XX_IDC_PF_10 */
  148. 0x37CC, /* QLC_83XX_IDC_PF_11 */
  149. 0x37D0, /* QLC_83XX_IDC_PF_12 */
  150. 0x37D4, /* QLC_83XX_IDC_PF_13 */
  151. 0x37D8, /* QLC_83XX_IDC_PF_14 */
  152. 0x37DC, /* QLC_83XX_IDC_PF_15 */
  153. 0x37E0, /* QLC_83XX_IDC_DEV_PARTITION_INFO_1 */
  154. 0x37E4, /* QLC_83XX_IDC_DEV_PARTITION_INFO_2 */
  155. 0x37F0, /* QLC_83XX_DRV_OP_MODE */
  156. 0x37F4, /* QLC_83XX_VNIC_STATE */
  157. 0x3868, /* QLC_83XX_DRV_LOCK */
  158. 0x386C, /* QLC_83XX_DRV_UNLOCK */
  159. 0x3504, /* QLC_83XX_DRV_LOCK_ID */
  160. 0x34A4, /* QLC_83XX_ASIC_TEMP */
  161. };
  162. const u32 qlcnic_83xx_reg_tbl[] = {
  163. 0x34A8, /* PEG_HALT_STAT1 */
  164. 0x34AC, /* PEG_HALT_STAT2 */
  165. 0x34B0, /* FW_HEARTBEAT */
  166. 0x3500, /* FLASH LOCK_ID */
  167. 0x3528, /* FW_CAPABILITIES */
  168. 0x3538, /* Driver active, DRV_REG0 */
  169. 0x3540, /* Device state, DRV_REG1 */
  170. 0x3544, /* Driver state, DRV_REG2 */
  171. 0x3548, /* Driver scratch, DRV_REG3 */
  172. 0x354C, /* Device partition info, DRV_REG4 */
  173. 0x3524, /* Driver IDC ver, DRV_REG5 */
  174. 0x3550, /* FW_VER_MAJOR */
  175. 0x3554, /* FW_VER_MINOR */
  176. 0x3558, /* FW_VER_SUB */
  177. 0x359C, /* NPAR STATE */
  178. 0x35FC, /* FW_IMG_VALID */
  179. 0x3650, /* CMD_PEG_STATE */
  180. 0x373C, /* RCV_PEG_STATE */
  181. 0x37B4, /* ASIC TEMP */
  182. 0x356C, /* FW API */
  183. 0x3570, /* DRV OP MODE */
  184. 0x3850, /* FLASH LOCK */
  185. 0x3854, /* FLASH UNLOCK */
  186. };
  187. static struct qlcnic_hardware_ops qlcnic_83xx_hw_ops = {
  188. .read_crb = qlcnic_83xx_read_crb,
  189. .write_crb = qlcnic_83xx_write_crb,
  190. .read_reg = qlcnic_83xx_rd_reg_indirect,
  191. .write_reg = qlcnic_83xx_wrt_reg_indirect,
  192. .get_mac_address = qlcnic_83xx_get_mac_address,
  193. .setup_intr = qlcnic_83xx_setup_intr,
  194. .alloc_mbx_args = qlcnic_83xx_alloc_mbx_args,
  195. .mbx_cmd = qlcnic_83xx_issue_cmd,
  196. .get_func_no = qlcnic_83xx_get_func_no,
  197. .api_lock = qlcnic_83xx_cam_lock,
  198. .api_unlock = qlcnic_83xx_cam_unlock,
  199. .add_sysfs = qlcnic_83xx_add_sysfs,
  200. .remove_sysfs = qlcnic_83xx_remove_sysfs,
  201. .process_lb_rcv_ring_diag = qlcnic_83xx_process_rcv_ring_diag,
  202. .create_rx_ctx = qlcnic_83xx_create_rx_ctx,
  203. .create_tx_ctx = qlcnic_83xx_create_tx_ctx,
  204. .del_rx_ctx = qlcnic_83xx_del_rx_ctx,
  205. .del_tx_ctx = qlcnic_83xx_del_tx_ctx,
  206. .setup_link_event = qlcnic_83xx_setup_link_event,
  207. .get_nic_info = qlcnic_83xx_get_nic_info,
  208. .get_pci_info = qlcnic_83xx_get_pci_info,
  209. .set_nic_info = qlcnic_83xx_set_nic_info,
  210. .change_macvlan = qlcnic_83xx_sre_macaddr_change,
  211. .napi_enable = qlcnic_83xx_napi_enable,
  212. .napi_disable = qlcnic_83xx_napi_disable,
  213. .config_intr_coal = qlcnic_83xx_config_intr_coal,
  214. .config_rss = qlcnic_83xx_config_rss,
  215. .config_hw_lro = qlcnic_83xx_config_hw_lro,
  216. .config_promisc_mode = qlcnic_83xx_nic_set_promisc,
  217. .change_l2_filter = qlcnic_83xx_change_l2_filter,
  218. .get_board_info = qlcnic_83xx_get_port_info,
  219. .set_mac_filter_count = qlcnic_83xx_set_mac_filter_count,
  220. .free_mac_list = qlcnic_82xx_free_mac_list,
  221. .io_error_detected = qlcnic_83xx_io_error_detected,
  222. .io_slot_reset = qlcnic_83xx_io_slot_reset,
  223. .io_resume = qlcnic_83xx_io_resume,
  224. .get_beacon_state = qlcnic_83xx_get_beacon_state,
  225. .enable_sds_intr = qlcnic_83xx_enable_sds_intr,
  226. .disable_sds_intr = qlcnic_83xx_disable_sds_intr,
  227. .enable_tx_intr = qlcnic_83xx_enable_tx_intr,
  228. .disable_tx_intr = qlcnic_83xx_disable_tx_intr,
  229. .get_saved_state = qlcnic_83xx_get_saved_state,
  230. .set_saved_state = qlcnic_83xx_set_saved_state,
  231. .cache_tmpl_hdr_values = qlcnic_83xx_cache_tmpl_hdr_values,
  232. .get_cap_size = qlcnic_83xx_get_cap_size,
  233. .set_sys_info = qlcnic_83xx_set_sys_info,
  234. .store_cap_mask = qlcnic_83xx_store_cap_mask,
  235. .encap_rx_offload = qlcnic_83xx_encap_rx_offload,
  236. .encap_tx_offload = qlcnic_83xx_encap_tx_offload,
  237. };
  238. static struct qlcnic_nic_template qlcnic_83xx_ops = {
  239. .config_bridged_mode = qlcnic_config_bridged_mode,
  240. .config_led = qlcnic_config_led,
  241. .request_reset = qlcnic_83xx_idc_request_reset,
  242. .cancel_idc_work = qlcnic_83xx_idc_exit,
  243. .napi_add = qlcnic_83xx_napi_add,
  244. .napi_del = qlcnic_83xx_napi_del,
  245. .config_ipaddr = qlcnic_83xx_config_ipaddr,
  246. .clear_legacy_intr = qlcnic_83xx_clear_legacy_intr,
  247. .shutdown = qlcnic_83xx_shutdown,
  248. .resume = qlcnic_83xx_resume,
  249. };
  250. void qlcnic_83xx_register_map(struct qlcnic_hardware_context *ahw)
  251. {
  252. ahw->hw_ops = &qlcnic_83xx_hw_ops;
  253. ahw->reg_tbl = (u32 *)qlcnic_83xx_reg_tbl;
  254. ahw->ext_reg_tbl = (u32 *)qlcnic_83xx_ext_reg_tbl;
  255. }
  256. int qlcnic_83xx_get_fw_version(struct qlcnic_adapter *adapter)
  257. {
  258. u32 fw_major, fw_minor, fw_build;
  259. struct pci_dev *pdev = adapter->pdev;
  260. fw_major = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MAJOR);
  261. fw_minor = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MINOR);
  262. fw_build = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_SUB);
  263. adapter->fw_version = QLCNIC_VERSION_CODE(fw_major, fw_minor, fw_build);
  264. dev_info(&pdev->dev, "Driver v%s, firmware version %d.%d.%d\n",
  265. QLCNIC_LINUX_VERSIONID, fw_major, fw_minor, fw_build);
  266. return adapter->fw_version;
  267. }
  268. static int __qlcnic_set_win_base(struct qlcnic_adapter *adapter, u32 addr)
  269. {
  270. void __iomem *base;
  271. u32 val;
  272. base = adapter->ahw->pci_base0 +
  273. QLC_83XX_CRB_WIN_FUNC(adapter->ahw->pci_func);
  274. writel(addr, base);
  275. val = readl(base);
  276. if (val != addr)
  277. return -EIO;
  278. return 0;
  279. }
  280. int qlcnic_83xx_rd_reg_indirect(struct qlcnic_adapter *adapter, ulong addr,
  281. int *err)
  282. {
  283. struct qlcnic_hardware_context *ahw = adapter->ahw;
  284. *err = __qlcnic_set_win_base(adapter, (u32) addr);
  285. if (!*err) {
  286. return QLCRDX(ahw, QLCNIC_WILDCARD);
  287. } else {
  288. dev_err(&adapter->pdev->dev,
  289. "%s failed, addr = 0x%lx\n", __func__, addr);
  290. return -EIO;
  291. }
  292. }
  293. int qlcnic_83xx_wrt_reg_indirect(struct qlcnic_adapter *adapter, ulong addr,
  294. u32 data)
  295. {
  296. int err;
  297. struct qlcnic_hardware_context *ahw = adapter->ahw;
  298. err = __qlcnic_set_win_base(adapter, (u32) addr);
  299. if (!err) {
  300. QLCWRX(ahw, QLCNIC_WILDCARD, data);
  301. return 0;
  302. } else {
  303. dev_err(&adapter->pdev->dev,
  304. "%s failed, addr = 0x%x data = 0x%x\n",
  305. __func__, (int)addr, data);
  306. return err;
  307. }
  308. }
  309. static void qlcnic_83xx_enable_legacy(struct qlcnic_adapter *adapter)
  310. {
  311. struct qlcnic_hardware_context *ahw = adapter->ahw;
  312. /* MSI-X enablement failed, use legacy interrupt */
  313. adapter->tgt_status_reg = ahw->pci_base0 + QLC_83XX_INTX_PTR;
  314. adapter->tgt_mask_reg = ahw->pci_base0 + QLC_83XX_INTX_MASK;
  315. adapter->isr_int_vec = ahw->pci_base0 + QLC_83XX_INTX_TRGR;
  316. adapter->msix_entries[0].vector = adapter->pdev->irq;
  317. dev_info(&adapter->pdev->dev, "using legacy interrupt\n");
  318. }
  319. static int qlcnic_83xx_calculate_msix_vector(struct qlcnic_adapter *adapter)
  320. {
  321. int num_msix;
  322. num_msix = adapter->drv_sds_rings;
  323. /* account for AEN interrupt MSI-X based interrupts */
  324. num_msix += 1;
  325. if (!(adapter->flags & QLCNIC_TX_INTR_SHARED))
  326. num_msix += adapter->drv_tx_rings;
  327. return num_msix;
  328. }
  329. int qlcnic_83xx_setup_intr(struct qlcnic_adapter *adapter)
  330. {
  331. struct qlcnic_hardware_context *ahw = adapter->ahw;
  332. int err, i, num_msix;
  333. if (adapter->flags & QLCNIC_TSS_RSS) {
  334. err = qlcnic_setup_tss_rss_intr(adapter);
  335. if (err < 0)
  336. return err;
  337. num_msix = ahw->num_msix;
  338. } else {
  339. num_msix = qlcnic_83xx_calculate_msix_vector(adapter);
  340. err = qlcnic_enable_msix(adapter, num_msix);
  341. if (err == -ENOMEM)
  342. return err;
  343. if (adapter->flags & QLCNIC_MSIX_ENABLED) {
  344. num_msix = ahw->num_msix;
  345. } else {
  346. if (qlcnic_sriov_vf_check(adapter))
  347. return -EINVAL;
  348. num_msix = 1;
  349. adapter->drv_sds_rings = QLCNIC_SINGLE_RING;
  350. adapter->drv_tx_rings = QLCNIC_SINGLE_RING;
  351. }
  352. }
  353. /* setup interrupt mapping table for fw */
  354. ahw->intr_tbl = vzalloc(num_msix *
  355. sizeof(struct qlcnic_intrpt_config));
  356. if (!ahw->intr_tbl)
  357. return -ENOMEM;
  358. if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) {
  359. if (adapter->ahw->pci_func >= QLC_MAX_LEGACY_FUNC_SUPP) {
  360. dev_err(&adapter->pdev->dev, "PCI function number 8 and higher are not supported with legacy interrupt, func 0x%x\n",
  361. ahw->pci_func);
  362. return -EOPNOTSUPP;
  363. }
  364. qlcnic_83xx_enable_legacy(adapter);
  365. }
  366. for (i = 0; i < num_msix; i++) {
  367. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  368. ahw->intr_tbl[i].type = QLCNIC_INTRPT_MSIX;
  369. else
  370. ahw->intr_tbl[i].type = QLCNIC_INTRPT_INTX;
  371. ahw->intr_tbl[i].id = i;
  372. ahw->intr_tbl[i].src = 0;
  373. }
  374. return 0;
  375. }
  376. static inline void qlcnic_83xx_clear_legacy_intr_mask(struct qlcnic_adapter *adapter)
  377. {
  378. writel(0, adapter->tgt_mask_reg);
  379. }
  380. static inline void qlcnic_83xx_set_legacy_intr_mask(struct qlcnic_adapter *adapter)
  381. {
  382. if (adapter->tgt_mask_reg)
  383. writel(1, adapter->tgt_mask_reg);
  384. }
  385. static inline void qlcnic_83xx_enable_legacy_msix_mbx_intr(struct qlcnic_adapter
  386. *adapter)
  387. {
  388. u32 mask;
  389. /* Mailbox in MSI-x mode and Legacy Interrupt share the same
  390. * source register. We could be here before contexts are created
  391. * and sds_ring->crb_intr_mask has not been initialized, calculate
  392. * BAR offset for Interrupt Source Register
  393. */
  394. mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);
  395. writel(0, adapter->ahw->pci_base0 + mask);
  396. }
  397. void qlcnic_83xx_disable_mbx_intr(struct qlcnic_adapter *adapter)
  398. {
  399. u32 mask;
  400. mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);
  401. writel(1, adapter->ahw->pci_base0 + mask);
  402. QLCWRX(adapter->ahw, QLCNIC_MBX_INTR_ENBL, 0);
  403. }
  404. static inline void qlcnic_83xx_get_mbx_data(struct qlcnic_adapter *adapter,
  405. struct qlcnic_cmd_args *cmd)
  406. {
  407. int i;
  408. if (cmd->op_type == QLC_83XX_MBX_POST_BC_OP)
  409. return;
  410. for (i = 0; i < cmd->rsp.num; i++)
  411. cmd->rsp.arg[i] = readl(QLCNIC_MBX_FW(adapter->ahw, i));
  412. }
  413. irqreturn_t qlcnic_83xx_clear_legacy_intr(struct qlcnic_adapter *adapter)
  414. {
  415. u32 intr_val;
  416. struct qlcnic_hardware_context *ahw = adapter->ahw;
  417. int retries = 0;
  418. intr_val = readl(adapter->tgt_status_reg);
  419. if (!QLC_83XX_VALID_INTX_BIT31(intr_val))
  420. return IRQ_NONE;
  421. if (QLC_83XX_INTX_FUNC(intr_val) != adapter->ahw->pci_func) {
  422. adapter->stats.spurious_intr++;
  423. return IRQ_NONE;
  424. }
  425. /* The barrier is required to ensure writes to the registers */
  426. wmb();
  427. /* clear the interrupt trigger control register */
  428. writel(0, adapter->isr_int_vec);
  429. intr_val = readl(adapter->isr_int_vec);
  430. do {
  431. intr_val = readl(adapter->tgt_status_reg);
  432. if (QLC_83XX_INTX_FUNC(intr_val) != ahw->pci_func)
  433. break;
  434. retries++;
  435. } while (QLC_83XX_VALID_INTX_BIT30(intr_val) &&
  436. (retries < QLC_83XX_LEGACY_INTX_MAX_RETRY));
  437. return IRQ_HANDLED;
  438. }
  439. static inline void qlcnic_83xx_notify_mbx_response(struct qlcnic_mailbox *mbx)
  440. {
  441. mbx->rsp_status = QLC_83XX_MBX_RESPONSE_ARRIVED;
  442. complete(&mbx->completion);
  443. }
  444. static void qlcnic_83xx_poll_process_aen(struct qlcnic_adapter *adapter)
  445. {
  446. u32 resp, event, rsp_status = QLC_83XX_MBX_RESPONSE_ARRIVED;
  447. struct qlcnic_mailbox *mbx = adapter->ahw->mailbox;
  448. unsigned long flags;
  449. spin_lock_irqsave(&mbx->aen_lock, flags);
  450. resp = QLCRDX(adapter->ahw, QLCNIC_FW_MBX_CTRL);
  451. if (!(resp & QLCNIC_SET_OWNER))
  452. goto out;
  453. event = readl(QLCNIC_MBX_FW(adapter->ahw, 0));
  454. if (event & QLCNIC_MBX_ASYNC_EVENT) {
  455. __qlcnic_83xx_process_aen(adapter);
  456. } else {
  457. if (mbx->rsp_status != rsp_status)
  458. qlcnic_83xx_notify_mbx_response(mbx);
  459. }
  460. out:
  461. qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
  462. spin_unlock_irqrestore(&mbx->aen_lock, flags);
  463. }
  464. irqreturn_t qlcnic_83xx_intr(int irq, void *data)
  465. {
  466. struct qlcnic_adapter *adapter = data;
  467. struct qlcnic_host_sds_ring *sds_ring;
  468. struct qlcnic_hardware_context *ahw = adapter->ahw;
  469. if (qlcnic_83xx_clear_legacy_intr(adapter) == IRQ_NONE)
  470. return IRQ_NONE;
  471. qlcnic_83xx_poll_process_aen(adapter);
  472. if (ahw->diag_test) {
  473. if (ahw->diag_test == QLCNIC_INTERRUPT_TEST)
  474. ahw->diag_cnt++;
  475. qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
  476. return IRQ_HANDLED;
  477. }
  478. if (!test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
  479. qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
  480. } else {
  481. sds_ring = &adapter->recv_ctx->sds_rings[0];
  482. napi_schedule(&sds_ring->napi);
  483. }
  484. return IRQ_HANDLED;
  485. }
  486. irqreturn_t qlcnic_83xx_tmp_intr(int irq, void *data)
  487. {
  488. struct qlcnic_host_sds_ring *sds_ring = data;
  489. struct qlcnic_adapter *adapter = sds_ring->adapter;
  490. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  491. goto done;
  492. if (adapter->nic_ops->clear_legacy_intr(adapter) == IRQ_NONE)
  493. return IRQ_NONE;
  494. done:
  495. adapter->ahw->diag_cnt++;
  496. qlcnic_enable_sds_intr(adapter, sds_ring);
  497. return IRQ_HANDLED;
  498. }
  499. void qlcnic_83xx_free_mbx_intr(struct qlcnic_adapter *adapter)
  500. {
  501. u32 num_msix;
  502. if (!(adapter->flags & QLCNIC_MSIX_ENABLED))
  503. qlcnic_83xx_set_legacy_intr_mask(adapter);
  504. qlcnic_83xx_disable_mbx_intr(adapter);
  505. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  506. num_msix = adapter->ahw->num_msix - 1;
  507. else
  508. num_msix = 0;
  509. msleep(20);
  510. if (adapter->msix_entries) {
  511. synchronize_irq(adapter->msix_entries[num_msix].vector);
  512. free_irq(adapter->msix_entries[num_msix].vector, adapter);
  513. }
  514. }
  515. int qlcnic_83xx_setup_mbx_intr(struct qlcnic_adapter *adapter)
  516. {
  517. irq_handler_t handler;
  518. u32 val;
  519. int err = 0;
  520. unsigned long flags = 0;
  521. if (!(adapter->flags & QLCNIC_MSI_ENABLED) &&
  522. !(adapter->flags & QLCNIC_MSIX_ENABLED))
  523. flags |= IRQF_SHARED;
  524. if (adapter->flags & QLCNIC_MSIX_ENABLED) {
  525. handler = qlcnic_83xx_handle_aen;
  526. val = adapter->msix_entries[adapter->ahw->num_msix - 1].vector;
  527. err = request_irq(val, handler, flags, "qlcnic-MB", adapter);
  528. if (err) {
  529. dev_err(&adapter->pdev->dev,
  530. "failed to register MBX interrupt\n");
  531. return err;
  532. }
  533. } else {
  534. handler = qlcnic_83xx_intr;
  535. val = adapter->msix_entries[0].vector;
  536. err = request_irq(val, handler, flags, "qlcnic", adapter);
  537. if (err) {
  538. dev_err(&adapter->pdev->dev,
  539. "failed to register INTx interrupt\n");
  540. return err;
  541. }
  542. qlcnic_83xx_clear_legacy_intr_mask(adapter);
  543. }
  544. /* Enable mailbox interrupt */
  545. qlcnic_83xx_enable_mbx_interrupt(adapter);
  546. return err;
  547. }
  548. void qlcnic_83xx_get_func_no(struct qlcnic_adapter *adapter)
  549. {
  550. u32 val = QLCRDX(adapter->ahw, QLCNIC_INFORMANT);
  551. adapter->ahw->pci_func = (val >> 24) & 0xff;
  552. }
  553. int qlcnic_83xx_cam_lock(struct qlcnic_adapter *adapter)
  554. {
  555. void __iomem *addr;
  556. u32 val, limit = 0;
  557. struct qlcnic_hardware_context *ahw = adapter->ahw;
  558. addr = ahw->pci_base0 + QLC_83XX_SEM_LOCK_FUNC(ahw->pci_func);
  559. do {
  560. val = readl(addr);
  561. if (val) {
  562. /* write the function number to register */
  563. QLC_SHARED_REG_WR32(adapter, QLCNIC_FLASH_LOCK_OWNER,
  564. ahw->pci_func);
  565. return 0;
  566. }
  567. usleep_range(1000, 2000);
  568. } while (++limit <= QLCNIC_PCIE_SEM_TIMEOUT);
  569. return -EIO;
  570. }
  571. void qlcnic_83xx_cam_unlock(struct qlcnic_adapter *adapter)
  572. {
  573. void __iomem *addr;
  574. u32 val;
  575. struct qlcnic_hardware_context *ahw = adapter->ahw;
  576. addr = ahw->pci_base0 + QLC_83XX_SEM_UNLOCK_FUNC(ahw->pci_func);
  577. val = readl(addr);
  578. }
  579. void qlcnic_83xx_read_crb(struct qlcnic_adapter *adapter, char *buf,
  580. loff_t offset, size_t size)
  581. {
  582. int ret = 0;
  583. u32 data;
  584. if (qlcnic_api_lock(adapter)) {
  585. dev_err(&adapter->pdev->dev,
  586. "%s: failed to acquire lock. addr offset 0x%x\n",
  587. __func__, (u32)offset);
  588. return;
  589. }
  590. data = QLCRD32(adapter, (u32) offset, &ret);
  591. qlcnic_api_unlock(adapter);
  592. if (ret == -EIO) {
  593. dev_err(&adapter->pdev->dev,
  594. "%s: failed. addr offset 0x%x\n",
  595. __func__, (u32)offset);
  596. return;
  597. }
  598. memcpy(buf, &data, size);
  599. }
  600. void qlcnic_83xx_write_crb(struct qlcnic_adapter *adapter, char *buf,
  601. loff_t offset, size_t size)
  602. {
  603. u32 data;
  604. memcpy(&data, buf, size);
  605. qlcnic_83xx_wrt_reg_indirect(adapter, (u32) offset, data);
  606. }
  607. int qlcnic_83xx_get_port_info(struct qlcnic_adapter *adapter)
  608. {
  609. struct qlcnic_hardware_context *ahw = adapter->ahw;
  610. int status;
  611. status = qlcnic_83xx_get_port_config(adapter);
  612. if (status) {
  613. dev_err(&adapter->pdev->dev,
  614. "Get Port Info failed\n");
  615. } else {
  616. if (ahw->port_config & QLC_83XX_10G_CAPABLE) {
  617. ahw->port_type = QLCNIC_XGBE;
  618. } else if (ahw->port_config & QLC_83XX_10_CAPABLE ||
  619. ahw->port_config & QLC_83XX_100_CAPABLE ||
  620. ahw->port_config & QLC_83XX_1G_CAPABLE) {
  621. ahw->port_type = QLCNIC_GBE;
  622. } else {
  623. ahw->port_type = QLCNIC_XGBE;
  624. }
  625. if (QLC_83XX_AUTONEG(ahw->port_config))
  626. ahw->link_autoneg = AUTONEG_ENABLE;
  627. }
  628. return status;
  629. }
  630. static void qlcnic_83xx_set_mac_filter_count(struct qlcnic_adapter *adapter)
  631. {
  632. struct qlcnic_hardware_context *ahw = adapter->ahw;
  633. u16 act_pci_fn = ahw->total_nic_func;
  634. u16 count;
  635. ahw->max_mc_count = QLC_83XX_MAX_MC_COUNT;
  636. if (act_pci_fn <= 2)
  637. count = (QLC_83XX_MAX_UC_COUNT - QLC_83XX_MAX_MC_COUNT) /
  638. act_pci_fn;
  639. else
  640. count = (QLC_83XX_LB_MAX_FILTERS - QLC_83XX_MAX_MC_COUNT) /
  641. act_pci_fn;
  642. ahw->max_uc_count = count;
  643. }
  644. void qlcnic_83xx_enable_mbx_interrupt(struct qlcnic_adapter *adapter)
  645. {
  646. u32 val;
  647. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  648. val = BIT_2 | ((adapter->ahw->num_msix - 1) << 8);
  649. else
  650. val = BIT_2;
  651. QLCWRX(adapter->ahw, QLCNIC_MBX_INTR_ENBL, val);
  652. qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
  653. }
  654. void qlcnic_83xx_check_vf(struct qlcnic_adapter *adapter,
  655. const struct pci_device_id *ent)
  656. {
  657. u32 op_mode, priv_level;
  658. struct qlcnic_hardware_context *ahw = adapter->ahw;
  659. ahw->fw_hal_version = 2;
  660. qlcnic_get_func_no(adapter);
  661. if (qlcnic_sriov_vf_check(adapter)) {
  662. qlcnic_sriov_vf_set_ops(adapter);
  663. return;
  664. }
  665. /* Determine function privilege level */
  666. op_mode = QLCRDX(adapter->ahw, QLC_83XX_DRV_OP_MODE);
  667. if (op_mode == QLC_83XX_DEFAULT_OPMODE)
  668. priv_level = QLCNIC_MGMT_FUNC;
  669. else
  670. priv_level = QLC_83XX_GET_FUNC_PRIVILEGE(op_mode,
  671. ahw->pci_func);
  672. if (priv_level == QLCNIC_NON_PRIV_FUNC) {
  673. ahw->op_mode = QLCNIC_NON_PRIV_FUNC;
  674. dev_info(&adapter->pdev->dev,
  675. "HAL Version: %d Non Privileged function\n",
  676. ahw->fw_hal_version);
  677. adapter->nic_ops = &qlcnic_vf_ops;
  678. } else {
  679. if (pci_find_ext_capability(adapter->pdev,
  680. PCI_EXT_CAP_ID_SRIOV))
  681. set_bit(__QLCNIC_SRIOV_CAPABLE, &adapter->state);
  682. adapter->nic_ops = &qlcnic_83xx_ops;
  683. }
  684. }
  685. static void qlcnic_83xx_handle_link_aen(struct qlcnic_adapter *adapter,
  686. u32 data[]);
  687. static void qlcnic_83xx_handle_idc_comp_aen(struct qlcnic_adapter *adapter,
  688. u32 data[]);
  689. void qlcnic_dump_mbx(struct qlcnic_adapter *adapter,
  690. struct qlcnic_cmd_args *cmd)
  691. {
  692. int i;
  693. if (cmd->op_type == QLC_83XX_MBX_POST_BC_OP)
  694. return;
  695. dev_info(&adapter->pdev->dev,
  696. "Host MBX regs(%d)\n", cmd->req.num);
  697. for (i = 0; i < cmd->req.num; i++) {
  698. if (i && !(i % 8))
  699. pr_info("\n");
  700. pr_info("%08x ", cmd->req.arg[i]);
  701. }
  702. pr_info("\n");
  703. dev_info(&adapter->pdev->dev,
  704. "FW MBX regs(%d)\n", cmd->rsp.num);
  705. for (i = 0; i < cmd->rsp.num; i++) {
  706. if (i && !(i % 8))
  707. pr_info("\n");
  708. pr_info("%08x ", cmd->rsp.arg[i]);
  709. }
  710. pr_info("\n");
  711. }
  712. static void qlcnic_83xx_poll_for_mbx_completion(struct qlcnic_adapter *adapter,
  713. struct qlcnic_cmd_args *cmd)
  714. {
  715. struct qlcnic_hardware_context *ahw = adapter->ahw;
  716. int opcode = LSW(cmd->req.arg[0]);
  717. unsigned long max_loops;
  718. max_loops = cmd->total_cmds * QLC_83XX_MBX_CMD_LOOP;
  719. for (; max_loops; max_loops--) {
  720. if (atomic_read(&cmd->rsp_status) ==
  721. QLC_83XX_MBX_RESPONSE_ARRIVED)
  722. return;
  723. udelay(1);
  724. }
  725. dev_err(&adapter->pdev->dev,
  726. "%s: Mailbox command timed out, cmd_op=0x%x, cmd_type=0x%x, pci_func=0x%x, op_mode=0x%x\n",
  727. __func__, opcode, cmd->type, ahw->pci_func, ahw->op_mode);
  728. flush_workqueue(ahw->mailbox->work_q);
  729. return;
  730. }
  731. int qlcnic_83xx_issue_cmd(struct qlcnic_adapter *adapter,
  732. struct qlcnic_cmd_args *cmd)
  733. {
  734. struct qlcnic_mailbox *mbx = adapter->ahw->mailbox;
  735. struct qlcnic_hardware_context *ahw = adapter->ahw;
  736. int cmd_type, err, opcode;
  737. unsigned long timeout;
  738. if (!mbx)
  739. return -EIO;
  740. opcode = LSW(cmd->req.arg[0]);
  741. cmd_type = cmd->type;
  742. err = mbx->ops->enqueue_cmd(adapter, cmd, &timeout);
  743. if (err) {
  744. dev_err(&adapter->pdev->dev,
  745. "%s: Mailbox not available, cmd_op=0x%x, cmd_context=0x%x, pci_func=0x%x, op_mode=0x%x\n",
  746. __func__, opcode, cmd->type, ahw->pci_func,
  747. ahw->op_mode);
  748. return err;
  749. }
  750. switch (cmd_type) {
  751. case QLC_83XX_MBX_CMD_WAIT:
  752. if (!wait_for_completion_timeout(&cmd->completion, timeout)) {
  753. dev_err(&adapter->pdev->dev,
  754. "%s: Mailbox command timed out, cmd_op=0x%x, cmd_type=0x%x, pci_func=0x%x, op_mode=0x%x\n",
  755. __func__, opcode, cmd_type, ahw->pci_func,
  756. ahw->op_mode);
  757. flush_workqueue(mbx->work_q);
  758. }
  759. break;
  760. case QLC_83XX_MBX_CMD_NO_WAIT:
  761. return 0;
  762. case QLC_83XX_MBX_CMD_BUSY_WAIT:
  763. qlcnic_83xx_poll_for_mbx_completion(adapter, cmd);
  764. break;
  765. default:
  766. dev_err(&adapter->pdev->dev,
  767. "%s: Invalid mailbox command, cmd_op=0x%x, cmd_type=0x%x, pci_func=0x%x, op_mode=0x%x\n",
  768. __func__, opcode, cmd_type, ahw->pci_func,
  769. ahw->op_mode);
  770. qlcnic_83xx_detach_mailbox_work(adapter);
  771. }
  772. return cmd->rsp_opcode;
  773. }
  774. int qlcnic_83xx_alloc_mbx_args(struct qlcnic_cmd_args *mbx,
  775. struct qlcnic_adapter *adapter, u32 type)
  776. {
  777. int i, size;
  778. u32 temp;
  779. const struct qlcnic_mailbox_metadata *mbx_tbl;
  780. memset(mbx, 0, sizeof(struct qlcnic_cmd_args));
  781. mbx_tbl = qlcnic_83xx_mbx_tbl;
  782. size = ARRAY_SIZE(qlcnic_83xx_mbx_tbl);
  783. for (i = 0; i < size; i++) {
  784. if (type == mbx_tbl[i].cmd) {
  785. mbx->op_type = QLC_83XX_FW_MBX_CMD;
  786. mbx->req.num = mbx_tbl[i].in_args;
  787. mbx->rsp.num = mbx_tbl[i].out_args;
  788. mbx->req.arg = kcalloc(mbx->req.num, sizeof(u32),
  789. GFP_ATOMIC);
  790. if (!mbx->req.arg)
  791. return -ENOMEM;
  792. mbx->rsp.arg = kcalloc(mbx->rsp.num, sizeof(u32),
  793. GFP_ATOMIC);
  794. if (!mbx->rsp.arg) {
  795. kfree(mbx->req.arg);
  796. mbx->req.arg = NULL;
  797. return -ENOMEM;
  798. }
  799. temp = adapter->ahw->fw_hal_version << 29;
  800. mbx->req.arg[0] = (type | (mbx->req.num << 16) | temp);
  801. mbx->cmd_op = type;
  802. return 0;
  803. }
  804. }
  805. dev_err(&adapter->pdev->dev, "%s: Invalid mailbox command opcode 0x%x\n",
  806. __func__, type);
  807. return -EINVAL;
  808. }
  809. void qlcnic_83xx_idc_aen_work(struct work_struct *work)
  810. {
  811. struct qlcnic_adapter *adapter;
  812. struct qlcnic_cmd_args cmd;
  813. int i, err = 0;
  814. adapter = container_of(work, struct qlcnic_adapter, idc_aen_work.work);
  815. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_IDC_ACK);
  816. if (err)
  817. return;
  818. for (i = 1; i < QLC_83XX_MBX_AEN_CNT; i++)
  819. cmd.req.arg[i] = adapter->ahw->mbox_aen[i];
  820. err = qlcnic_issue_cmd(adapter, &cmd);
  821. if (err)
  822. dev_info(&adapter->pdev->dev,
  823. "%s: Mailbox IDC ACK failed.\n", __func__);
  824. qlcnic_free_mbx_args(&cmd);
  825. }
  826. static void qlcnic_83xx_handle_idc_comp_aen(struct qlcnic_adapter *adapter,
  827. u32 data[])
  828. {
  829. dev_dbg(&adapter->pdev->dev, "Completion AEN:0x%x.\n",
  830. QLCNIC_MBX_RSP(data[0]));
  831. clear_bit(QLC_83XX_IDC_COMP_AEN, &adapter->ahw->idc.status);
  832. return;
  833. }
  834. static void __qlcnic_83xx_process_aen(struct qlcnic_adapter *adapter)
  835. {
  836. struct qlcnic_hardware_context *ahw = adapter->ahw;
  837. u32 event[QLC_83XX_MBX_AEN_CNT];
  838. int i;
  839. for (i = 0; i < QLC_83XX_MBX_AEN_CNT; i++)
  840. event[i] = readl(QLCNIC_MBX_FW(ahw, i));
  841. switch (QLCNIC_MBX_RSP(event[0])) {
  842. case QLCNIC_MBX_LINK_EVENT:
  843. qlcnic_83xx_handle_link_aen(adapter, event);
  844. break;
  845. case QLCNIC_MBX_COMP_EVENT:
  846. qlcnic_83xx_handle_idc_comp_aen(adapter, event);
  847. break;
  848. case QLCNIC_MBX_REQUEST_EVENT:
  849. for (i = 0; i < QLC_83XX_MBX_AEN_CNT; i++)
  850. adapter->ahw->mbox_aen[i] = QLCNIC_MBX_RSP(event[i]);
  851. queue_delayed_work(adapter->qlcnic_wq,
  852. &adapter->idc_aen_work, 0);
  853. break;
  854. case QLCNIC_MBX_TIME_EXTEND_EVENT:
  855. ahw->extend_lb_time = event[1] >> 8 & 0xf;
  856. break;
  857. case QLCNIC_MBX_BC_EVENT:
  858. qlcnic_sriov_handle_bc_event(adapter, event[1]);
  859. break;
  860. case QLCNIC_MBX_SFP_INSERT_EVENT:
  861. dev_info(&adapter->pdev->dev, "SFP+ Insert AEN:0x%x.\n",
  862. QLCNIC_MBX_RSP(event[0]));
  863. break;
  864. case QLCNIC_MBX_SFP_REMOVE_EVENT:
  865. dev_info(&adapter->pdev->dev, "SFP Removed AEN:0x%x.\n",
  866. QLCNIC_MBX_RSP(event[0]));
  867. break;
  868. case QLCNIC_MBX_DCBX_CONFIG_CHANGE_EVENT:
  869. qlcnic_dcb_aen_handler(adapter->dcb, (void *)&event[1]);
  870. break;
  871. default:
  872. dev_dbg(&adapter->pdev->dev, "Unsupported AEN:0x%x.\n",
  873. QLCNIC_MBX_RSP(event[0]));
  874. break;
  875. }
  876. QLCWRX(ahw, QLCNIC_FW_MBX_CTRL, QLCNIC_CLR_OWNER);
  877. }
  878. static void qlcnic_83xx_process_aen(struct qlcnic_adapter *adapter)
  879. {
  880. u32 resp, event, rsp_status = QLC_83XX_MBX_RESPONSE_ARRIVED;
  881. struct qlcnic_hardware_context *ahw = adapter->ahw;
  882. struct qlcnic_mailbox *mbx = ahw->mailbox;
  883. unsigned long flags;
  884. spin_lock_irqsave(&mbx->aen_lock, flags);
  885. resp = QLCRDX(ahw, QLCNIC_FW_MBX_CTRL);
  886. if (resp & QLCNIC_SET_OWNER) {
  887. event = readl(QLCNIC_MBX_FW(ahw, 0));
  888. if (event & QLCNIC_MBX_ASYNC_EVENT) {
  889. __qlcnic_83xx_process_aen(adapter);
  890. } else {
  891. if (mbx->rsp_status != rsp_status)
  892. qlcnic_83xx_notify_mbx_response(mbx);
  893. }
  894. }
  895. spin_unlock_irqrestore(&mbx->aen_lock, flags);
  896. }
  897. static void qlcnic_83xx_mbx_poll_work(struct work_struct *work)
  898. {
  899. struct qlcnic_adapter *adapter;
  900. adapter = container_of(work, struct qlcnic_adapter, mbx_poll_work.work);
  901. if (!test_bit(__QLCNIC_MBX_POLL_ENABLE, &adapter->state))
  902. return;
  903. qlcnic_83xx_process_aen(adapter);
  904. queue_delayed_work(adapter->qlcnic_wq, &adapter->mbx_poll_work,
  905. (HZ / 10));
  906. }
  907. void qlcnic_83xx_enable_mbx_poll(struct qlcnic_adapter *adapter)
  908. {
  909. if (test_and_set_bit(__QLCNIC_MBX_POLL_ENABLE, &adapter->state))
  910. return;
  911. INIT_DELAYED_WORK(&adapter->mbx_poll_work, qlcnic_83xx_mbx_poll_work);
  912. queue_delayed_work(adapter->qlcnic_wq, &adapter->mbx_poll_work, 0);
  913. }
  914. void qlcnic_83xx_disable_mbx_poll(struct qlcnic_adapter *adapter)
  915. {
  916. if (!test_and_clear_bit(__QLCNIC_MBX_POLL_ENABLE, &adapter->state))
  917. return;
  918. cancel_delayed_work_sync(&adapter->mbx_poll_work);
  919. }
  920. static int qlcnic_83xx_add_rings(struct qlcnic_adapter *adapter)
  921. {
  922. int index, i, err, sds_mbx_size;
  923. u32 *buf, intrpt_id, intr_mask;
  924. u16 context_id;
  925. u8 num_sds;
  926. struct qlcnic_cmd_args cmd;
  927. struct qlcnic_host_sds_ring *sds;
  928. struct qlcnic_sds_mbx sds_mbx;
  929. struct qlcnic_add_rings_mbx_out *mbx_out;
  930. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  931. struct qlcnic_hardware_context *ahw = adapter->ahw;
  932. sds_mbx_size = sizeof(struct qlcnic_sds_mbx);
  933. context_id = recv_ctx->context_id;
  934. num_sds = adapter->drv_sds_rings - QLCNIC_MAX_SDS_RINGS;
  935. ahw->hw_ops->alloc_mbx_args(&cmd, adapter,
  936. QLCNIC_CMD_ADD_RCV_RINGS);
  937. cmd.req.arg[1] = 0 | (num_sds << 8) | (context_id << 16);
  938. /* set up status rings, mbx 2-81 */
  939. index = 2;
  940. for (i = 8; i < adapter->drv_sds_rings; i++) {
  941. memset(&sds_mbx, 0, sds_mbx_size);
  942. sds = &recv_ctx->sds_rings[i];
  943. sds->consumer = 0;
  944. memset(sds->desc_head, 0, STATUS_DESC_RINGSIZE(sds));
  945. sds_mbx.phy_addr_low = LSD(sds->phys_addr);
  946. sds_mbx.phy_addr_high = MSD(sds->phys_addr);
  947. sds_mbx.sds_ring_size = sds->num_desc;
  948. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  949. intrpt_id = ahw->intr_tbl[i].id;
  950. else
  951. intrpt_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
  952. if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST)
  953. sds_mbx.intrpt_id = intrpt_id;
  954. else
  955. sds_mbx.intrpt_id = 0xffff;
  956. sds_mbx.intrpt_val = 0;
  957. buf = &cmd.req.arg[index];
  958. memcpy(buf, &sds_mbx, sds_mbx_size);
  959. index += sds_mbx_size / sizeof(u32);
  960. }
  961. /* send the mailbox command */
  962. err = ahw->hw_ops->mbx_cmd(adapter, &cmd);
  963. if (err) {
  964. dev_err(&adapter->pdev->dev,
  965. "Failed to add rings %d\n", err);
  966. goto out;
  967. }
  968. mbx_out = (struct qlcnic_add_rings_mbx_out *)&cmd.rsp.arg[1];
  969. index = 0;
  970. /* status descriptor ring */
  971. for (i = 8; i < adapter->drv_sds_rings; i++) {
  972. sds = &recv_ctx->sds_rings[i];
  973. sds->crb_sts_consumer = ahw->pci_base0 +
  974. mbx_out->host_csmr[index];
  975. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  976. intr_mask = ahw->intr_tbl[i].src;
  977. else
  978. intr_mask = QLCRDX(ahw, QLCNIC_DEF_INT_MASK);
  979. sds->crb_intr_mask = ahw->pci_base0 + intr_mask;
  980. index++;
  981. }
  982. out:
  983. qlcnic_free_mbx_args(&cmd);
  984. return err;
  985. }
  986. void qlcnic_83xx_del_rx_ctx(struct qlcnic_adapter *adapter)
  987. {
  988. int err;
  989. u32 temp = 0;
  990. struct qlcnic_cmd_args cmd;
  991. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  992. if (qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_DESTROY_RX_CTX))
  993. return;
  994. if (qlcnic_sriov_pf_check(adapter) || qlcnic_sriov_vf_check(adapter))
  995. cmd.req.arg[0] |= (0x3 << 29);
  996. if (qlcnic_sriov_pf_check(adapter))
  997. qlcnic_pf_set_interface_id_del_rx_ctx(adapter, &temp);
  998. cmd.req.arg[1] = recv_ctx->context_id | temp;
  999. err = qlcnic_issue_cmd(adapter, &cmd);
  1000. if (err)
  1001. dev_err(&adapter->pdev->dev,
  1002. "Failed to destroy rx ctx in firmware\n");
  1003. recv_ctx->state = QLCNIC_HOST_CTX_STATE_FREED;
  1004. qlcnic_free_mbx_args(&cmd);
  1005. }
  1006. int qlcnic_83xx_create_rx_ctx(struct qlcnic_adapter *adapter)
  1007. {
  1008. int i, err, index, sds_mbx_size, rds_mbx_size;
  1009. u8 num_sds, num_rds;
  1010. u32 *buf, intrpt_id, intr_mask, cap = 0;
  1011. struct qlcnic_host_sds_ring *sds;
  1012. struct qlcnic_host_rds_ring *rds;
  1013. struct qlcnic_sds_mbx sds_mbx;
  1014. struct qlcnic_rds_mbx rds_mbx;
  1015. struct qlcnic_cmd_args cmd;
  1016. struct qlcnic_rcv_mbx_out *mbx_out;
  1017. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1018. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1019. num_rds = adapter->max_rds_rings;
  1020. if (adapter->drv_sds_rings <= QLCNIC_MAX_SDS_RINGS)
  1021. num_sds = adapter->drv_sds_rings;
  1022. else
  1023. num_sds = QLCNIC_MAX_SDS_RINGS;
  1024. sds_mbx_size = sizeof(struct qlcnic_sds_mbx);
  1025. rds_mbx_size = sizeof(struct qlcnic_rds_mbx);
  1026. cap = QLCNIC_CAP0_LEGACY_CONTEXT;
  1027. if (adapter->flags & QLCNIC_FW_LRO_MSS_CAP)
  1028. cap |= QLC_83XX_FW_CAP_LRO_MSS;
  1029. /* set mailbox hdr and capabilities */
  1030. err = qlcnic_alloc_mbx_args(&cmd, adapter,
  1031. QLCNIC_CMD_CREATE_RX_CTX);
  1032. if (err)
  1033. return err;
  1034. if (qlcnic_sriov_pf_check(adapter) || qlcnic_sriov_vf_check(adapter))
  1035. cmd.req.arg[0] |= (0x3 << 29);
  1036. cmd.req.arg[1] = cap;
  1037. cmd.req.arg[5] = 1 | (num_rds << 5) | (num_sds << 8) |
  1038. (QLC_83XX_HOST_RDS_MODE_UNIQUE << 16);
  1039. if (qlcnic_sriov_pf_check(adapter))
  1040. qlcnic_pf_set_interface_id_create_rx_ctx(adapter,
  1041. &cmd.req.arg[6]);
  1042. /* set up status rings, mbx 8-57/87 */
  1043. index = QLC_83XX_HOST_SDS_MBX_IDX;
  1044. for (i = 0; i < num_sds; i++) {
  1045. memset(&sds_mbx, 0, sds_mbx_size);
  1046. sds = &recv_ctx->sds_rings[i];
  1047. sds->consumer = 0;
  1048. memset(sds->desc_head, 0, STATUS_DESC_RINGSIZE(sds));
  1049. sds_mbx.phy_addr_low = LSD(sds->phys_addr);
  1050. sds_mbx.phy_addr_high = MSD(sds->phys_addr);
  1051. sds_mbx.sds_ring_size = sds->num_desc;
  1052. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  1053. intrpt_id = ahw->intr_tbl[i].id;
  1054. else
  1055. intrpt_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
  1056. if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST)
  1057. sds_mbx.intrpt_id = intrpt_id;
  1058. else
  1059. sds_mbx.intrpt_id = 0xffff;
  1060. sds_mbx.intrpt_val = 0;
  1061. buf = &cmd.req.arg[index];
  1062. memcpy(buf, &sds_mbx, sds_mbx_size);
  1063. index += sds_mbx_size / sizeof(u32);
  1064. }
  1065. /* set up receive rings, mbx 88-111/135 */
  1066. index = QLCNIC_HOST_RDS_MBX_IDX;
  1067. rds = &recv_ctx->rds_rings[0];
  1068. rds->producer = 0;
  1069. memset(&rds_mbx, 0, rds_mbx_size);
  1070. rds_mbx.phy_addr_reg_low = LSD(rds->phys_addr);
  1071. rds_mbx.phy_addr_reg_high = MSD(rds->phys_addr);
  1072. rds_mbx.reg_ring_sz = rds->dma_size;
  1073. rds_mbx.reg_ring_len = rds->num_desc;
  1074. /* Jumbo ring */
  1075. rds = &recv_ctx->rds_rings[1];
  1076. rds->producer = 0;
  1077. rds_mbx.phy_addr_jmb_low = LSD(rds->phys_addr);
  1078. rds_mbx.phy_addr_jmb_high = MSD(rds->phys_addr);
  1079. rds_mbx.jmb_ring_sz = rds->dma_size;
  1080. rds_mbx.jmb_ring_len = rds->num_desc;
  1081. buf = &cmd.req.arg[index];
  1082. memcpy(buf, &rds_mbx, rds_mbx_size);
  1083. /* send the mailbox command */
  1084. err = ahw->hw_ops->mbx_cmd(adapter, &cmd);
  1085. if (err) {
  1086. dev_err(&adapter->pdev->dev,
  1087. "Failed to create Rx ctx in firmware%d\n", err);
  1088. goto out;
  1089. }
  1090. mbx_out = (struct qlcnic_rcv_mbx_out *)&cmd.rsp.arg[1];
  1091. recv_ctx->context_id = mbx_out->ctx_id;
  1092. recv_ctx->state = mbx_out->state;
  1093. recv_ctx->virt_port = mbx_out->vport_id;
  1094. dev_info(&adapter->pdev->dev, "Rx Context[%d] Created, state:0x%x\n",
  1095. recv_ctx->context_id, recv_ctx->state);
  1096. /* Receive descriptor ring */
  1097. /* Standard ring */
  1098. rds = &recv_ctx->rds_rings[0];
  1099. rds->crb_rcv_producer = ahw->pci_base0 +
  1100. mbx_out->host_prod[0].reg_buf;
  1101. /* Jumbo ring */
  1102. rds = &recv_ctx->rds_rings[1];
  1103. rds->crb_rcv_producer = ahw->pci_base0 +
  1104. mbx_out->host_prod[0].jmb_buf;
  1105. /* status descriptor ring */
  1106. for (i = 0; i < num_sds; i++) {
  1107. sds = &recv_ctx->sds_rings[i];
  1108. sds->crb_sts_consumer = ahw->pci_base0 +
  1109. mbx_out->host_csmr[i];
  1110. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  1111. intr_mask = ahw->intr_tbl[i].src;
  1112. else
  1113. intr_mask = QLCRDX(ahw, QLCNIC_DEF_INT_MASK);
  1114. sds->crb_intr_mask = ahw->pci_base0 + intr_mask;
  1115. }
  1116. if (adapter->drv_sds_rings > QLCNIC_MAX_SDS_RINGS)
  1117. err = qlcnic_83xx_add_rings(adapter);
  1118. out:
  1119. qlcnic_free_mbx_args(&cmd);
  1120. return err;
  1121. }
  1122. void qlcnic_83xx_del_tx_ctx(struct qlcnic_adapter *adapter,
  1123. struct qlcnic_host_tx_ring *tx_ring)
  1124. {
  1125. struct qlcnic_cmd_args cmd;
  1126. u32 temp = 0;
  1127. if (qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_DESTROY_TX_CTX))
  1128. return;
  1129. if (qlcnic_sriov_pf_check(adapter) || qlcnic_sriov_vf_check(adapter))
  1130. cmd.req.arg[0] |= (0x3 << 29);
  1131. if (qlcnic_sriov_pf_check(adapter))
  1132. qlcnic_pf_set_interface_id_del_tx_ctx(adapter, &temp);
  1133. cmd.req.arg[1] = tx_ring->ctx_id | temp;
  1134. if (qlcnic_issue_cmd(adapter, &cmd))
  1135. dev_err(&adapter->pdev->dev,
  1136. "Failed to destroy tx ctx in firmware\n");
  1137. qlcnic_free_mbx_args(&cmd);
  1138. }
  1139. int qlcnic_83xx_create_tx_ctx(struct qlcnic_adapter *adapter,
  1140. struct qlcnic_host_tx_ring *tx, int ring)
  1141. {
  1142. int err;
  1143. u16 msix_id;
  1144. u32 *buf, intr_mask, temp = 0;
  1145. struct qlcnic_cmd_args cmd;
  1146. struct qlcnic_tx_mbx mbx;
  1147. struct qlcnic_tx_mbx_out *mbx_out;
  1148. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1149. u32 msix_vector;
  1150. /* Reset host resources */
  1151. tx->producer = 0;
  1152. tx->sw_consumer = 0;
  1153. *(tx->hw_consumer) = 0;
  1154. memset(&mbx, 0, sizeof(struct qlcnic_tx_mbx));
  1155. /* setup mailbox inbox registerss */
  1156. mbx.phys_addr_low = LSD(tx->phys_addr);
  1157. mbx.phys_addr_high = MSD(tx->phys_addr);
  1158. mbx.cnsmr_index_low = LSD(tx->hw_cons_phys_addr);
  1159. mbx.cnsmr_index_high = MSD(tx->hw_cons_phys_addr);
  1160. mbx.size = tx->num_desc;
  1161. if (adapter->flags & QLCNIC_MSIX_ENABLED) {
  1162. if (!(adapter->flags & QLCNIC_TX_INTR_SHARED))
  1163. msix_vector = adapter->drv_sds_rings + ring;
  1164. else
  1165. msix_vector = adapter->drv_sds_rings - 1;
  1166. msix_id = ahw->intr_tbl[msix_vector].id;
  1167. } else {
  1168. msix_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
  1169. }
  1170. if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST)
  1171. mbx.intr_id = msix_id;
  1172. else
  1173. mbx.intr_id = 0xffff;
  1174. mbx.src = 0;
  1175. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CREATE_TX_CTX);
  1176. if (err)
  1177. return err;
  1178. if (qlcnic_sriov_pf_check(adapter) || qlcnic_sriov_vf_check(adapter))
  1179. cmd.req.arg[0] |= (0x3 << 29);
  1180. if (qlcnic_sriov_pf_check(adapter))
  1181. qlcnic_pf_set_interface_id_create_tx_ctx(adapter, &temp);
  1182. cmd.req.arg[1] = QLCNIC_CAP0_LEGACY_CONTEXT;
  1183. cmd.req.arg[5] = QLCNIC_SINGLE_RING | temp;
  1184. buf = &cmd.req.arg[6];
  1185. memcpy(buf, &mbx, sizeof(struct qlcnic_tx_mbx));
  1186. /* send the mailbox command*/
  1187. err = qlcnic_issue_cmd(adapter, &cmd);
  1188. if (err) {
  1189. netdev_err(adapter->netdev,
  1190. "Failed to create Tx ctx in firmware 0x%x\n", err);
  1191. goto out;
  1192. }
  1193. mbx_out = (struct qlcnic_tx_mbx_out *)&cmd.rsp.arg[2];
  1194. tx->crb_cmd_producer = ahw->pci_base0 + mbx_out->host_prod;
  1195. tx->ctx_id = mbx_out->ctx_id;
  1196. if ((adapter->flags & QLCNIC_MSIX_ENABLED) &&
  1197. !(adapter->flags & QLCNIC_TX_INTR_SHARED)) {
  1198. intr_mask = ahw->intr_tbl[adapter->drv_sds_rings + ring].src;
  1199. tx->crb_intr_mask = ahw->pci_base0 + intr_mask;
  1200. }
  1201. netdev_info(adapter->netdev,
  1202. "Tx Context[0x%x] Created, state:0x%x\n",
  1203. tx->ctx_id, mbx_out->state);
  1204. out:
  1205. qlcnic_free_mbx_args(&cmd);
  1206. return err;
  1207. }
  1208. static int qlcnic_83xx_diag_alloc_res(struct net_device *netdev, int test,
  1209. u8 num_sds_ring)
  1210. {
  1211. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  1212. struct qlcnic_host_sds_ring *sds_ring;
  1213. struct qlcnic_host_rds_ring *rds_ring;
  1214. u16 adapter_state = adapter->is_up;
  1215. u8 ring;
  1216. int ret;
  1217. netif_device_detach(netdev);
  1218. if (netif_running(netdev))
  1219. __qlcnic_down(adapter, netdev);
  1220. qlcnic_detach(adapter);
  1221. adapter->drv_sds_rings = QLCNIC_SINGLE_RING;
  1222. adapter->ahw->diag_test = test;
  1223. adapter->ahw->linkup = 0;
  1224. ret = qlcnic_attach(adapter);
  1225. if (ret) {
  1226. netif_device_attach(netdev);
  1227. return ret;
  1228. }
  1229. ret = qlcnic_fw_create_ctx(adapter);
  1230. if (ret) {
  1231. qlcnic_detach(adapter);
  1232. if (adapter_state == QLCNIC_ADAPTER_UP_MAGIC) {
  1233. adapter->drv_sds_rings = num_sds_ring;
  1234. qlcnic_attach(adapter);
  1235. }
  1236. netif_device_attach(netdev);
  1237. return ret;
  1238. }
  1239. for (ring = 0; ring < adapter->max_rds_rings; ring++) {
  1240. rds_ring = &adapter->recv_ctx->rds_rings[ring];
  1241. qlcnic_post_rx_buffers(adapter, rds_ring, ring);
  1242. }
  1243. if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
  1244. for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
  1245. sds_ring = &adapter->recv_ctx->sds_rings[ring];
  1246. qlcnic_enable_sds_intr(adapter, sds_ring);
  1247. }
  1248. }
  1249. if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
  1250. adapter->ahw->loopback_state = 0;
  1251. adapter->ahw->hw_ops->setup_link_event(adapter, 1);
  1252. }
  1253. set_bit(__QLCNIC_DEV_UP, &adapter->state);
  1254. return 0;
  1255. }
  1256. static void qlcnic_83xx_diag_free_res(struct net_device *netdev,
  1257. u8 drv_sds_rings)
  1258. {
  1259. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  1260. struct qlcnic_host_sds_ring *sds_ring;
  1261. int ring;
  1262. clear_bit(__QLCNIC_DEV_UP, &adapter->state);
  1263. if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
  1264. for (ring = 0; ring < adapter->drv_sds_rings; ring++) {
  1265. sds_ring = &adapter->recv_ctx->sds_rings[ring];
  1266. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  1267. qlcnic_disable_sds_intr(adapter, sds_ring);
  1268. }
  1269. }
  1270. qlcnic_fw_destroy_ctx(adapter);
  1271. qlcnic_detach(adapter);
  1272. adapter->ahw->diag_test = 0;
  1273. adapter->drv_sds_rings = drv_sds_rings;
  1274. if (qlcnic_attach(adapter))
  1275. goto out;
  1276. if (netif_running(netdev))
  1277. __qlcnic_up(adapter, netdev);
  1278. out:
  1279. netif_device_attach(netdev);
  1280. }
  1281. static void qlcnic_83xx_get_beacon_state(struct qlcnic_adapter *adapter)
  1282. {
  1283. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1284. struct qlcnic_cmd_args cmd;
  1285. u8 beacon_state;
  1286. int err = 0;
  1287. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_LED_CONFIG);
  1288. if (!err) {
  1289. err = qlcnic_issue_cmd(adapter, &cmd);
  1290. if (!err) {
  1291. beacon_state = cmd.rsp.arg[4];
  1292. if (beacon_state == QLCNIC_BEACON_DISABLE)
  1293. ahw->beacon_state = QLC_83XX_BEACON_OFF;
  1294. else if (beacon_state == QLC_83XX_ENABLE_BEACON)
  1295. ahw->beacon_state = QLC_83XX_BEACON_ON;
  1296. }
  1297. } else {
  1298. netdev_err(adapter->netdev, "Get beacon state failed, err=%d\n",
  1299. err);
  1300. }
  1301. qlcnic_free_mbx_args(&cmd);
  1302. return;
  1303. }
  1304. int qlcnic_83xx_config_led(struct qlcnic_adapter *adapter, u32 state,
  1305. u32 beacon)
  1306. {
  1307. struct qlcnic_cmd_args cmd;
  1308. u32 mbx_in;
  1309. int i, status = 0;
  1310. if (state) {
  1311. /* Get LED configuration */
  1312. status = qlcnic_alloc_mbx_args(&cmd, adapter,
  1313. QLCNIC_CMD_GET_LED_CONFIG);
  1314. if (status)
  1315. return status;
  1316. status = qlcnic_issue_cmd(adapter, &cmd);
  1317. if (status) {
  1318. dev_err(&adapter->pdev->dev,
  1319. "Get led config failed.\n");
  1320. goto mbx_err;
  1321. } else {
  1322. for (i = 0; i < 4; i++)
  1323. adapter->ahw->mbox_reg[i] = cmd.rsp.arg[i+1];
  1324. }
  1325. qlcnic_free_mbx_args(&cmd);
  1326. /* Set LED Configuration */
  1327. mbx_in = (LSW(QLC_83XX_LED_CONFIG) << 16) |
  1328. LSW(QLC_83XX_LED_CONFIG);
  1329. status = qlcnic_alloc_mbx_args(&cmd, adapter,
  1330. QLCNIC_CMD_SET_LED_CONFIG);
  1331. if (status)
  1332. return status;
  1333. cmd.req.arg[1] = mbx_in;
  1334. cmd.req.arg[2] = mbx_in;
  1335. cmd.req.arg[3] = mbx_in;
  1336. if (beacon)
  1337. cmd.req.arg[4] = QLC_83XX_ENABLE_BEACON;
  1338. status = qlcnic_issue_cmd(adapter, &cmd);
  1339. if (status) {
  1340. dev_err(&adapter->pdev->dev,
  1341. "Set led config failed.\n");
  1342. }
  1343. mbx_err:
  1344. qlcnic_free_mbx_args(&cmd);
  1345. return status;
  1346. } else {
  1347. /* Restoring default LED configuration */
  1348. status = qlcnic_alloc_mbx_args(&cmd, adapter,
  1349. QLCNIC_CMD_SET_LED_CONFIG);
  1350. if (status)
  1351. return status;
  1352. cmd.req.arg[1] = adapter->ahw->mbox_reg[0];
  1353. cmd.req.arg[2] = adapter->ahw->mbox_reg[1];
  1354. cmd.req.arg[3] = adapter->ahw->mbox_reg[2];
  1355. if (beacon)
  1356. cmd.req.arg[4] = adapter->ahw->mbox_reg[3];
  1357. status = qlcnic_issue_cmd(adapter, &cmd);
  1358. if (status)
  1359. dev_err(&adapter->pdev->dev,
  1360. "Restoring led config failed.\n");
  1361. qlcnic_free_mbx_args(&cmd);
  1362. return status;
  1363. }
  1364. }
  1365. int qlcnic_83xx_set_led(struct net_device *netdev,
  1366. enum ethtool_phys_id_state state)
  1367. {
  1368. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  1369. int err = -EIO, active = 1;
  1370. if (adapter->ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
  1371. netdev_warn(netdev,
  1372. "LED test is not supported in non-privileged mode\n");
  1373. return -EOPNOTSUPP;
  1374. }
  1375. switch (state) {
  1376. case ETHTOOL_ID_ACTIVE:
  1377. if (test_and_set_bit(__QLCNIC_LED_ENABLE, &adapter->state))
  1378. return -EBUSY;
  1379. if (test_bit(__QLCNIC_RESETTING, &adapter->state))
  1380. break;
  1381. err = qlcnic_83xx_config_led(adapter, active, 0);
  1382. if (err)
  1383. netdev_err(netdev, "Failed to set LED blink state\n");
  1384. break;
  1385. case ETHTOOL_ID_INACTIVE:
  1386. active = 0;
  1387. if (test_bit(__QLCNIC_RESETTING, &adapter->state))
  1388. break;
  1389. err = qlcnic_83xx_config_led(adapter, active, 0);
  1390. if (err)
  1391. netdev_err(netdev, "Failed to reset LED blink state\n");
  1392. break;
  1393. default:
  1394. return -EINVAL;
  1395. }
  1396. if (!active || err)
  1397. clear_bit(__QLCNIC_LED_ENABLE, &adapter->state);
  1398. return err;
  1399. }
  1400. void qlcnic_83xx_initialize_nic(struct qlcnic_adapter *adapter, int enable)
  1401. {
  1402. struct qlcnic_cmd_args cmd;
  1403. int status;
  1404. if (qlcnic_sriov_vf_check(adapter))
  1405. return;
  1406. if (enable)
  1407. status = qlcnic_alloc_mbx_args(&cmd, adapter,
  1408. QLCNIC_CMD_INIT_NIC_FUNC);
  1409. else
  1410. status = qlcnic_alloc_mbx_args(&cmd, adapter,
  1411. QLCNIC_CMD_STOP_NIC_FUNC);
  1412. if (status)
  1413. return;
  1414. cmd.req.arg[1] = QLC_REGISTER_LB_IDC | QLC_INIT_FW_RESOURCES;
  1415. if (adapter->dcb)
  1416. cmd.req.arg[1] |= QLC_REGISTER_DCB_AEN;
  1417. status = qlcnic_issue_cmd(adapter, &cmd);
  1418. if (status)
  1419. dev_err(&adapter->pdev->dev,
  1420. "Failed to %s in NIC IDC function event.\n",
  1421. (enable ? "register" : "unregister"));
  1422. qlcnic_free_mbx_args(&cmd);
  1423. }
  1424. static int qlcnic_83xx_set_port_config(struct qlcnic_adapter *adapter)
  1425. {
  1426. struct qlcnic_cmd_args cmd;
  1427. int err;
  1428. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_SET_PORT_CONFIG);
  1429. if (err)
  1430. return err;
  1431. cmd.req.arg[1] = adapter->ahw->port_config;
  1432. err = qlcnic_issue_cmd(adapter, &cmd);
  1433. if (err)
  1434. dev_info(&adapter->pdev->dev, "Set Port Config failed.\n");
  1435. qlcnic_free_mbx_args(&cmd);
  1436. return err;
  1437. }
  1438. static int qlcnic_83xx_get_port_config(struct qlcnic_adapter *adapter)
  1439. {
  1440. struct qlcnic_cmd_args cmd;
  1441. int err;
  1442. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_PORT_CONFIG);
  1443. if (err)
  1444. return err;
  1445. err = qlcnic_issue_cmd(adapter, &cmd);
  1446. if (err)
  1447. dev_info(&adapter->pdev->dev, "Get Port config failed\n");
  1448. else
  1449. adapter->ahw->port_config = cmd.rsp.arg[1];
  1450. qlcnic_free_mbx_args(&cmd);
  1451. return err;
  1452. }
  1453. int qlcnic_83xx_setup_link_event(struct qlcnic_adapter *adapter, int enable)
  1454. {
  1455. int err;
  1456. u32 temp;
  1457. struct qlcnic_cmd_args cmd;
  1458. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_LINK_EVENT);
  1459. if (err)
  1460. return err;
  1461. temp = adapter->recv_ctx->context_id << 16;
  1462. cmd.req.arg[1] = (enable ? 1 : 0) | BIT_8 | temp;
  1463. err = qlcnic_issue_cmd(adapter, &cmd);
  1464. if (err)
  1465. dev_info(&adapter->pdev->dev,
  1466. "Setup linkevent mailbox failed\n");
  1467. qlcnic_free_mbx_args(&cmd);
  1468. return err;
  1469. }
  1470. static void qlcnic_83xx_set_interface_id_promisc(struct qlcnic_adapter *adapter,
  1471. u32 *interface_id)
  1472. {
  1473. if (qlcnic_sriov_pf_check(adapter)) {
  1474. qlcnic_alloc_lb_filters_mem(adapter);
  1475. qlcnic_pf_set_interface_id_promisc(adapter, interface_id);
  1476. adapter->rx_mac_learn = true;
  1477. } else {
  1478. if (!qlcnic_sriov_vf_check(adapter))
  1479. *interface_id = adapter->recv_ctx->context_id << 16;
  1480. }
  1481. }
  1482. int qlcnic_83xx_nic_set_promisc(struct qlcnic_adapter *adapter, u32 mode)
  1483. {
  1484. struct qlcnic_cmd_args *cmd = NULL;
  1485. u32 temp = 0;
  1486. int err;
  1487. if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
  1488. return -EIO;
  1489. cmd = kzalloc(sizeof(*cmd), GFP_ATOMIC);
  1490. if (!cmd)
  1491. return -ENOMEM;
  1492. err = qlcnic_alloc_mbx_args(cmd, adapter,
  1493. QLCNIC_CMD_CONFIGURE_MAC_RX_MODE);
  1494. if (err)
  1495. goto out;
  1496. cmd->type = QLC_83XX_MBX_CMD_NO_WAIT;
  1497. qlcnic_83xx_set_interface_id_promisc(adapter, &temp);
  1498. if (qlcnic_84xx_check(adapter) && qlcnic_sriov_pf_check(adapter))
  1499. mode = VPORT_MISS_MODE_ACCEPT_ALL;
  1500. cmd->req.arg[1] = mode | temp;
  1501. err = qlcnic_issue_cmd(adapter, cmd);
  1502. if (!err)
  1503. return err;
  1504. qlcnic_free_mbx_args(cmd);
  1505. out:
  1506. kfree(cmd);
  1507. return err;
  1508. }
  1509. int qlcnic_83xx_loopback_test(struct net_device *netdev, u8 mode)
  1510. {
  1511. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  1512. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1513. u8 drv_sds_rings = adapter->drv_sds_rings;
  1514. u8 drv_tx_rings = adapter->drv_tx_rings;
  1515. int ret = 0, loop = 0;
  1516. if (ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
  1517. netdev_warn(netdev,
  1518. "Loopback test not supported in non privileged mode\n");
  1519. return -ENOTSUPP;
  1520. }
  1521. if (test_bit(__QLCNIC_RESETTING, &adapter->state)) {
  1522. netdev_info(netdev, "Device is resetting\n");
  1523. return -EBUSY;
  1524. }
  1525. if (qlcnic_get_diag_lock(adapter)) {
  1526. netdev_info(netdev, "Device is in diagnostics mode\n");
  1527. return -EBUSY;
  1528. }
  1529. netdev_info(netdev, "%s loopback test in progress\n",
  1530. mode == QLCNIC_ILB_MODE ? "internal" : "external");
  1531. ret = qlcnic_83xx_diag_alloc_res(netdev, QLCNIC_LOOPBACK_TEST,
  1532. drv_sds_rings);
  1533. if (ret)
  1534. goto fail_diag_alloc;
  1535. ret = qlcnic_83xx_set_lb_mode(adapter, mode);
  1536. if (ret)
  1537. goto free_diag_res;
  1538. /* Poll for link up event before running traffic */
  1539. do {
  1540. msleep(QLC_83XX_LB_MSLEEP_COUNT);
  1541. if (test_bit(__QLCNIC_RESETTING, &adapter->state)) {
  1542. netdev_info(netdev,
  1543. "Device is resetting, free LB test resources\n");
  1544. ret = -EBUSY;
  1545. goto free_diag_res;
  1546. }
  1547. if (loop++ > QLC_83XX_LB_WAIT_COUNT) {
  1548. netdev_info(netdev,
  1549. "Firmware didn't sent link up event to loopback request\n");
  1550. ret = -ETIMEDOUT;
  1551. qlcnic_83xx_clear_lb_mode(adapter, mode);
  1552. goto free_diag_res;
  1553. }
  1554. } while ((adapter->ahw->linkup && ahw->has_link_events) != 1);
  1555. ret = qlcnic_do_lb_test(adapter, mode);
  1556. qlcnic_83xx_clear_lb_mode(adapter, mode);
  1557. free_diag_res:
  1558. qlcnic_83xx_diag_free_res(netdev, drv_sds_rings);
  1559. fail_diag_alloc:
  1560. adapter->drv_sds_rings = drv_sds_rings;
  1561. adapter->drv_tx_rings = drv_tx_rings;
  1562. qlcnic_release_diag_lock(adapter);
  1563. return ret;
  1564. }
  1565. static void qlcnic_extend_lb_idc_cmpltn_wait(struct qlcnic_adapter *adapter,
  1566. u32 *max_wait_count)
  1567. {
  1568. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1569. int temp;
  1570. netdev_info(adapter->netdev, "Received loopback IDC time extend event for 0x%x seconds\n",
  1571. ahw->extend_lb_time);
  1572. temp = ahw->extend_lb_time * 1000;
  1573. *max_wait_count += temp / QLC_83XX_LB_MSLEEP_COUNT;
  1574. ahw->extend_lb_time = 0;
  1575. }
  1576. static int qlcnic_83xx_set_lb_mode(struct qlcnic_adapter *adapter, u8 mode)
  1577. {
  1578. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1579. struct net_device *netdev = adapter->netdev;
  1580. u32 config, max_wait_count;
  1581. int status = 0, loop = 0;
  1582. ahw->extend_lb_time = 0;
  1583. max_wait_count = QLC_83XX_LB_WAIT_COUNT;
  1584. status = qlcnic_83xx_get_port_config(adapter);
  1585. if (status)
  1586. return status;
  1587. config = ahw->port_config;
  1588. /* Check if port is already in loopback mode */
  1589. if ((config & QLC_83XX_CFG_LOOPBACK_HSS) ||
  1590. (config & QLC_83XX_CFG_LOOPBACK_EXT)) {
  1591. netdev_err(netdev,
  1592. "Port already in Loopback mode.\n");
  1593. return -EINPROGRESS;
  1594. }
  1595. set_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1596. if (mode == QLCNIC_ILB_MODE)
  1597. ahw->port_config |= QLC_83XX_CFG_LOOPBACK_HSS;
  1598. if (mode == QLCNIC_ELB_MODE)
  1599. ahw->port_config |= QLC_83XX_CFG_LOOPBACK_EXT;
  1600. status = qlcnic_83xx_set_port_config(adapter);
  1601. if (status) {
  1602. netdev_err(netdev,
  1603. "Failed to Set Loopback Mode = 0x%x.\n",
  1604. ahw->port_config);
  1605. ahw->port_config = config;
  1606. clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1607. return status;
  1608. }
  1609. /* Wait for Link and IDC Completion AEN */
  1610. do {
  1611. msleep(QLC_83XX_LB_MSLEEP_COUNT);
  1612. if (test_bit(__QLCNIC_RESETTING, &adapter->state)) {
  1613. netdev_info(netdev,
  1614. "Device is resetting, free LB test resources\n");
  1615. clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1616. return -EBUSY;
  1617. }
  1618. if (ahw->extend_lb_time)
  1619. qlcnic_extend_lb_idc_cmpltn_wait(adapter,
  1620. &max_wait_count);
  1621. if (loop++ > max_wait_count) {
  1622. netdev_err(netdev, "%s: Did not receive loopback IDC completion AEN\n",
  1623. __func__);
  1624. clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1625. qlcnic_83xx_clear_lb_mode(adapter, mode);
  1626. return -ETIMEDOUT;
  1627. }
  1628. } while (test_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status));
  1629. qlcnic_sre_macaddr_change(adapter, adapter->mac_addr, 0,
  1630. QLCNIC_MAC_ADD);
  1631. return status;
  1632. }
  1633. static int qlcnic_83xx_clear_lb_mode(struct qlcnic_adapter *adapter, u8 mode)
  1634. {
  1635. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1636. u32 config = ahw->port_config, max_wait_count;
  1637. struct net_device *netdev = adapter->netdev;
  1638. int status = 0, loop = 0;
  1639. ahw->extend_lb_time = 0;
  1640. max_wait_count = QLC_83XX_LB_WAIT_COUNT;
  1641. set_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1642. if (mode == QLCNIC_ILB_MODE)
  1643. ahw->port_config &= ~QLC_83XX_CFG_LOOPBACK_HSS;
  1644. if (mode == QLCNIC_ELB_MODE)
  1645. ahw->port_config &= ~QLC_83XX_CFG_LOOPBACK_EXT;
  1646. status = qlcnic_83xx_set_port_config(adapter);
  1647. if (status) {
  1648. netdev_err(netdev,
  1649. "Failed to Clear Loopback Mode = 0x%x.\n",
  1650. ahw->port_config);
  1651. ahw->port_config = config;
  1652. clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1653. return status;
  1654. }
  1655. /* Wait for Link and IDC Completion AEN */
  1656. do {
  1657. msleep(QLC_83XX_LB_MSLEEP_COUNT);
  1658. if (test_bit(__QLCNIC_RESETTING, &adapter->state)) {
  1659. netdev_info(netdev,
  1660. "Device is resetting, free LB test resources\n");
  1661. clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1662. return -EBUSY;
  1663. }
  1664. if (ahw->extend_lb_time)
  1665. qlcnic_extend_lb_idc_cmpltn_wait(adapter,
  1666. &max_wait_count);
  1667. if (loop++ > max_wait_count) {
  1668. netdev_err(netdev, "%s: Did not receive loopback IDC completion AEN\n",
  1669. __func__);
  1670. clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
  1671. return -ETIMEDOUT;
  1672. }
  1673. } while (test_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status));
  1674. qlcnic_sre_macaddr_change(adapter, adapter->mac_addr, 0,
  1675. QLCNIC_MAC_DEL);
  1676. return status;
  1677. }
  1678. static void qlcnic_83xx_set_interface_id_ipaddr(struct qlcnic_adapter *adapter,
  1679. u32 *interface_id)
  1680. {
  1681. if (qlcnic_sriov_pf_check(adapter)) {
  1682. qlcnic_pf_set_interface_id_ipaddr(adapter, interface_id);
  1683. } else {
  1684. if (!qlcnic_sriov_vf_check(adapter))
  1685. *interface_id = adapter->recv_ctx->context_id << 16;
  1686. }
  1687. }
  1688. void qlcnic_83xx_config_ipaddr(struct qlcnic_adapter *adapter, __be32 ip,
  1689. int mode)
  1690. {
  1691. int err;
  1692. u32 temp = 0, temp_ip;
  1693. struct qlcnic_cmd_args cmd;
  1694. err = qlcnic_alloc_mbx_args(&cmd, adapter,
  1695. QLCNIC_CMD_CONFIGURE_IP_ADDR);
  1696. if (err)
  1697. return;
  1698. qlcnic_83xx_set_interface_id_ipaddr(adapter, &temp);
  1699. if (mode == QLCNIC_IP_UP)
  1700. cmd.req.arg[1] = 1 | temp;
  1701. else
  1702. cmd.req.arg[1] = 2 | temp;
  1703. /*
  1704. * Adapter needs IP address in network byte order.
  1705. * But hardware mailbox registers go through writel(), hence IP address
  1706. * gets swapped on big endian architecture.
  1707. * To negate swapping of writel() on big endian architecture
  1708. * use swab32(value).
  1709. */
  1710. temp_ip = swab32(ntohl(ip));
  1711. memcpy(&cmd.req.arg[2], &temp_ip, sizeof(u32));
  1712. err = qlcnic_issue_cmd(adapter, &cmd);
  1713. if (err != QLCNIC_RCODE_SUCCESS)
  1714. dev_err(&adapter->netdev->dev,
  1715. "could not notify %s IP 0x%x request\n",
  1716. (mode == QLCNIC_IP_UP) ? "Add" : "Remove", ip);
  1717. qlcnic_free_mbx_args(&cmd);
  1718. }
  1719. int qlcnic_83xx_config_hw_lro(struct qlcnic_adapter *adapter, int mode)
  1720. {
  1721. int err;
  1722. u32 temp, arg1;
  1723. struct qlcnic_cmd_args cmd;
  1724. int lro_bit_mask;
  1725. lro_bit_mask = (mode ? (BIT_0 | BIT_1 | BIT_2 | BIT_3) : 0);
  1726. if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
  1727. return 0;
  1728. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIGURE_HW_LRO);
  1729. if (err)
  1730. return err;
  1731. temp = adapter->recv_ctx->context_id << 16;
  1732. arg1 = lro_bit_mask | temp;
  1733. cmd.req.arg[1] = arg1;
  1734. err = qlcnic_issue_cmd(adapter, &cmd);
  1735. if (err)
  1736. dev_info(&adapter->pdev->dev, "LRO config failed\n");
  1737. qlcnic_free_mbx_args(&cmd);
  1738. return err;
  1739. }
  1740. int qlcnic_83xx_config_rss(struct qlcnic_adapter *adapter, int enable)
  1741. {
  1742. int err;
  1743. u32 word;
  1744. struct qlcnic_cmd_args cmd;
  1745. const u64 key[] = { 0xbeac01fa6a42b73bULL, 0x8030f20c77cb2da3ULL,
  1746. 0xae7b30b4d0ca2bcbULL, 0x43a38fb04167253dULL,
  1747. 0x255b0ec26d5a56daULL };
  1748. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIGURE_RSS);
  1749. if (err)
  1750. return err;
  1751. /*
  1752. * RSS request:
  1753. * bits 3-0: Rsvd
  1754. * 5-4: hash_type_ipv4
  1755. * 7-6: hash_type_ipv6
  1756. * 8: enable
  1757. * 9: use indirection table
  1758. * 16-31: indirection table mask
  1759. */
  1760. word = ((u32)(RSS_HASHTYPE_IP_TCP & 0x3) << 4) |
  1761. ((u32)(RSS_HASHTYPE_IP_TCP & 0x3) << 6) |
  1762. ((u32)(enable & 0x1) << 8) |
  1763. ((0x7ULL) << 16);
  1764. cmd.req.arg[1] = (adapter->recv_ctx->context_id);
  1765. cmd.req.arg[2] = word;
  1766. memcpy(&cmd.req.arg[4], key, sizeof(key));
  1767. err = qlcnic_issue_cmd(adapter, &cmd);
  1768. if (err)
  1769. dev_info(&adapter->pdev->dev, "RSS config failed\n");
  1770. qlcnic_free_mbx_args(&cmd);
  1771. return err;
  1772. }
  1773. static void qlcnic_83xx_set_interface_id_macaddr(struct qlcnic_adapter *adapter,
  1774. u32 *interface_id)
  1775. {
  1776. if (qlcnic_sriov_pf_check(adapter)) {
  1777. qlcnic_pf_set_interface_id_macaddr(adapter, interface_id);
  1778. } else {
  1779. if (!qlcnic_sriov_vf_check(adapter))
  1780. *interface_id = adapter->recv_ctx->context_id << 16;
  1781. }
  1782. }
  1783. int qlcnic_83xx_sre_macaddr_change(struct qlcnic_adapter *adapter, u8 *addr,
  1784. u16 vlan_id, u8 op)
  1785. {
  1786. struct qlcnic_cmd_args *cmd = NULL;
  1787. struct qlcnic_macvlan_mbx mv;
  1788. u32 *buf, temp = 0;
  1789. int err;
  1790. if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
  1791. return -EIO;
  1792. cmd = kzalloc(sizeof(*cmd), GFP_ATOMIC);
  1793. if (!cmd)
  1794. return -ENOMEM;
  1795. err = qlcnic_alloc_mbx_args(cmd, adapter, QLCNIC_CMD_CONFIG_MAC_VLAN);
  1796. if (err)
  1797. goto out;
  1798. cmd->type = QLC_83XX_MBX_CMD_NO_WAIT;
  1799. if (vlan_id)
  1800. op = (op == QLCNIC_MAC_ADD || op == QLCNIC_MAC_VLAN_ADD) ?
  1801. QLCNIC_MAC_VLAN_ADD : QLCNIC_MAC_VLAN_DEL;
  1802. cmd->req.arg[1] = op | (1 << 8);
  1803. qlcnic_83xx_set_interface_id_macaddr(adapter, &temp);
  1804. cmd->req.arg[1] |= temp;
  1805. mv.vlan = vlan_id;
  1806. mv.mac_addr0 = addr[0];
  1807. mv.mac_addr1 = addr[1];
  1808. mv.mac_addr2 = addr[2];
  1809. mv.mac_addr3 = addr[3];
  1810. mv.mac_addr4 = addr[4];
  1811. mv.mac_addr5 = addr[5];
  1812. buf = &cmd->req.arg[2];
  1813. memcpy(buf, &mv, sizeof(struct qlcnic_macvlan_mbx));
  1814. err = qlcnic_issue_cmd(adapter, cmd);
  1815. if (!err)
  1816. return err;
  1817. qlcnic_free_mbx_args(cmd);
  1818. out:
  1819. kfree(cmd);
  1820. return err;
  1821. }
  1822. void qlcnic_83xx_change_l2_filter(struct qlcnic_adapter *adapter, u64 *addr,
  1823. u16 vlan_id)
  1824. {
  1825. u8 mac[ETH_ALEN];
  1826. memcpy(&mac, addr, ETH_ALEN);
  1827. qlcnic_83xx_sre_macaddr_change(adapter, mac, vlan_id, QLCNIC_MAC_ADD);
  1828. }
  1829. static void qlcnic_83xx_configure_mac(struct qlcnic_adapter *adapter, u8 *mac,
  1830. u8 type, struct qlcnic_cmd_args *cmd)
  1831. {
  1832. switch (type) {
  1833. case QLCNIC_SET_STATION_MAC:
  1834. case QLCNIC_SET_FAC_DEF_MAC:
  1835. memcpy(&cmd->req.arg[2], mac, sizeof(u32));
  1836. memcpy(&cmd->req.arg[3], &mac[4], sizeof(u16));
  1837. break;
  1838. }
  1839. cmd->req.arg[1] = type;
  1840. }
  1841. int qlcnic_83xx_get_mac_address(struct qlcnic_adapter *adapter, u8 *mac,
  1842. u8 function)
  1843. {
  1844. int err, i;
  1845. struct qlcnic_cmd_args cmd;
  1846. u32 mac_low, mac_high;
  1847. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_MAC_ADDRESS);
  1848. if (err)
  1849. return err;
  1850. qlcnic_83xx_configure_mac(adapter, mac, QLCNIC_GET_CURRENT_MAC, &cmd);
  1851. err = qlcnic_issue_cmd(adapter, &cmd);
  1852. if (err == QLCNIC_RCODE_SUCCESS) {
  1853. mac_low = cmd.rsp.arg[1];
  1854. mac_high = cmd.rsp.arg[2];
  1855. for (i = 0; i < 2; i++)
  1856. mac[i] = (u8) (mac_high >> ((1 - i) * 8));
  1857. for (i = 2; i < 6; i++)
  1858. mac[i] = (u8) (mac_low >> ((5 - i) * 8));
  1859. } else {
  1860. dev_err(&adapter->pdev->dev, "Failed to get mac address%d\n",
  1861. err);
  1862. err = -EIO;
  1863. }
  1864. qlcnic_free_mbx_args(&cmd);
  1865. return err;
  1866. }
  1867. static int qlcnic_83xx_set_rx_intr_coal(struct qlcnic_adapter *adapter)
  1868. {
  1869. struct qlcnic_nic_intr_coalesce *coal = &adapter->ahw->coal;
  1870. struct qlcnic_cmd_args cmd;
  1871. u16 temp;
  1872. int err;
  1873. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIG_INTR_COAL);
  1874. if (err)
  1875. return err;
  1876. temp = adapter->recv_ctx->context_id;
  1877. cmd.req.arg[1] = QLCNIC_INTR_COAL_TYPE_RX | temp << 16;
  1878. temp = coal->rx_time_us;
  1879. cmd.req.arg[2] = coal->rx_packets | temp << 16;
  1880. cmd.req.arg[3] = coal->flag;
  1881. err = qlcnic_issue_cmd(adapter, &cmd);
  1882. if (err != QLCNIC_RCODE_SUCCESS)
  1883. netdev_err(adapter->netdev,
  1884. "failed to set interrupt coalescing parameters\n");
  1885. qlcnic_free_mbx_args(&cmd);
  1886. return err;
  1887. }
  1888. static int qlcnic_83xx_set_tx_intr_coal(struct qlcnic_adapter *adapter)
  1889. {
  1890. struct qlcnic_nic_intr_coalesce *coal = &adapter->ahw->coal;
  1891. struct qlcnic_cmd_args cmd;
  1892. u16 temp;
  1893. int err;
  1894. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIG_INTR_COAL);
  1895. if (err)
  1896. return err;
  1897. temp = adapter->tx_ring->ctx_id;
  1898. cmd.req.arg[1] = QLCNIC_INTR_COAL_TYPE_TX | temp << 16;
  1899. temp = coal->tx_time_us;
  1900. cmd.req.arg[2] = coal->tx_packets | temp << 16;
  1901. cmd.req.arg[3] = coal->flag;
  1902. err = qlcnic_issue_cmd(adapter, &cmd);
  1903. if (err != QLCNIC_RCODE_SUCCESS)
  1904. netdev_err(adapter->netdev,
  1905. "failed to set interrupt coalescing parameters\n");
  1906. qlcnic_free_mbx_args(&cmd);
  1907. return err;
  1908. }
  1909. int qlcnic_83xx_set_rx_tx_intr_coal(struct qlcnic_adapter *adapter)
  1910. {
  1911. int err = 0;
  1912. err = qlcnic_83xx_set_rx_intr_coal(adapter);
  1913. if (err)
  1914. netdev_err(adapter->netdev,
  1915. "failed to set Rx coalescing parameters\n");
  1916. err = qlcnic_83xx_set_tx_intr_coal(adapter);
  1917. if (err)
  1918. netdev_err(adapter->netdev,
  1919. "failed to set Tx coalescing parameters\n");
  1920. return err;
  1921. }
  1922. int qlcnic_83xx_config_intr_coal(struct qlcnic_adapter *adapter,
  1923. struct ethtool_coalesce *ethcoal)
  1924. {
  1925. struct qlcnic_nic_intr_coalesce *coal = &adapter->ahw->coal;
  1926. u32 rx_coalesce_usecs, rx_max_frames;
  1927. u32 tx_coalesce_usecs, tx_max_frames;
  1928. int err;
  1929. if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
  1930. return -EIO;
  1931. tx_coalesce_usecs = ethcoal->tx_coalesce_usecs;
  1932. tx_max_frames = ethcoal->tx_max_coalesced_frames;
  1933. rx_coalesce_usecs = ethcoal->rx_coalesce_usecs;
  1934. rx_max_frames = ethcoal->rx_max_coalesced_frames;
  1935. coal->flag = QLCNIC_INTR_DEFAULT;
  1936. if ((coal->rx_time_us == rx_coalesce_usecs) &&
  1937. (coal->rx_packets == rx_max_frames)) {
  1938. coal->type = QLCNIC_INTR_COAL_TYPE_TX;
  1939. coal->tx_time_us = tx_coalesce_usecs;
  1940. coal->tx_packets = tx_max_frames;
  1941. } else if ((coal->tx_time_us == tx_coalesce_usecs) &&
  1942. (coal->tx_packets == tx_max_frames)) {
  1943. coal->type = QLCNIC_INTR_COAL_TYPE_RX;
  1944. coal->rx_time_us = rx_coalesce_usecs;
  1945. coal->rx_packets = rx_max_frames;
  1946. } else {
  1947. coal->type = QLCNIC_INTR_COAL_TYPE_RX_TX;
  1948. coal->rx_time_us = rx_coalesce_usecs;
  1949. coal->rx_packets = rx_max_frames;
  1950. coal->tx_time_us = tx_coalesce_usecs;
  1951. coal->tx_packets = tx_max_frames;
  1952. }
  1953. switch (coal->type) {
  1954. case QLCNIC_INTR_COAL_TYPE_RX:
  1955. err = qlcnic_83xx_set_rx_intr_coal(adapter);
  1956. break;
  1957. case QLCNIC_INTR_COAL_TYPE_TX:
  1958. err = qlcnic_83xx_set_tx_intr_coal(adapter);
  1959. break;
  1960. case QLCNIC_INTR_COAL_TYPE_RX_TX:
  1961. err = qlcnic_83xx_set_rx_tx_intr_coal(adapter);
  1962. break;
  1963. default:
  1964. err = -EINVAL;
  1965. netdev_err(adapter->netdev,
  1966. "Invalid Interrupt coalescing type\n");
  1967. break;
  1968. }
  1969. return err;
  1970. }
  1971. static void qlcnic_83xx_handle_link_aen(struct qlcnic_adapter *adapter,
  1972. u32 data[])
  1973. {
  1974. struct qlcnic_hardware_context *ahw = adapter->ahw;
  1975. u8 link_status, duplex;
  1976. /* link speed */
  1977. link_status = LSB(data[3]) & 1;
  1978. if (link_status) {
  1979. ahw->link_speed = MSW(data[2]);
  1980. duplex = LSB(MSW(data[3]));
  1981. if (duplex)
  1982. ahw->link_duplex = DUPLEX_FULL;
  1983. else
  1984. ahw->link_duplex = DUPLEX_HALF;
  1985. } else {
  1986. ahw->link_speed = SPEED_UNKNOWN;
  1987. ahw->link_duplex = DUPLEX_UNKNOWN;
  1988. }
  1989. ahw->link_autoneg = MSB(MSW(data[3]));
  1990. ahw->module_type = MSB(LSW(data[3]));
  1991. ahw->has_link_events = 1;
  1992. ahw->lb_mode = data[4] & QLCNIC_LB_MODE_MASK;
  1993. qlcnic_advert_link_change(adapter, link_status);
  1994. }
  1995. static irqreturn_t qlcnic_83xx_handle_aen(int irq, void *data)
  1996. {
  1997. u32 mask, resp, event, rsp_status = QLC_83XX_MBX_RESPONSE_ARRIVED;
  1998. struct qlcnic_adapter *adapter = data;
  1999. struct qlcnic_mailbox *mbx;
  2000. unsigned long flags;
  2001. mbx = adapter->ahw->mailbox;
  2002. spin_lock_irqsave(&mbx->aen_lock, flags);
  2003. resp = QLCRDX(adapter->ahw, QLCNIC_FW_MBX_CTRL);
  2004. if (!(resp & QLCNIC_SET_OWNER))
  2005. goto out;
  2006. event = readl(QLCNIC_MBX_FW(adapter->ahw, 0));
  2007. if (event & QLCNIC_MBX_ASYNC_EVENT) {
  2008. __qlcnic_83xx_process_aen(adapter);
  2009. } else {
  2010. if (mbx->rsp_status != rsp_status)
  2011. qlcnic_83xx_notify_mbx_response(mbx);
  2012. else
  2013. adapter->stats.mbx_spurious_intr++;
  2014. }
  2015. out:
  2016. mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);
  2017. writel(0, adapter->ahw->pci_base0 + mask);
  2018. spin_unlock_irqrestore(&mbx->aen_lock, flags);
  2019. return IRQ_HANDLED;
  2020. }
  2021. int qlcnic_83xx_set_nic_info(struct qlcnic_adapter *adapter,
  2022. struct qlcnic_info *nic)
  2023. {
  2024. int i, err = -EIO;
  2025. struct qlcnic_cmd_args cmd;
  2026. if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
  2027. dev_err(&adapter->pdev->dev,
  2028. "%s: Error, invoked by non management func\n",
  2029. __func__);
  2030. return err;
  2031. }
  2032. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_SET_NIC_INFO);
  2033. if (err)
  2034. return err;
  2035. cmd.req.arg[1] = (nic->pci_func << 16);
  2036. cmd.req.arg[2] = 0x1 << 16;
  2037. cmd.req.arg[3] = nic->phys_port | (nic->switch_mode << 16);
  2038. cmd.req.arg[4] = nic->capabilities;
  2039. cmd.req.arg[5] = (nic->max_mac_filters & 0xFF) | ((nic->max_mtu) << 16);
  2040. cmd.req.arg[6] = (nic->max_tx_ques) | ((nic->max_rx_ques) << 16);
  2041. cmd.req.arg[7] = (nic->min_tx_bw) | ((nic->max_tx_bw) << 16);
  2042. for (i = 8; i < 32; i++)
  2043. cmd.req.arg[i] = 0;
  2044. err = qlcnic_issue_cmd(adapter, &cmd);
  2045. if (err != QLCNIC_RCODE_SUCCESS) {
  2046. dev_err(&adapter->pdev->dev, "Failed to set nic info%d\n",
  2047. err);
  2048. err = -EIO;
  2049. }
  2050. qlcnic_free_mbx_args(&cmd);
  2051. return err;
  2052. }
  2053. int qlcnic_83xx_get_nic_info(struct qlcnic_adapter *adapter,
  2054. struct qlcnic_info *npar_info, u8 func_id)
  2055. {
  2056. int err;
  2057. u32 temp;
  2058. u8 op = 0;
  2059. struct qlcnic_cmd_args cmd;
  2060. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2061. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_NIC_INFO);
  2062. if (err)
  2063. return err;
  2064. if (func_id != ahw->pci_func) {
  2065. temp = func_id << 16;
  2066. cmd.req.arg[1] = op | BIT_31 | temp;
  2067. } else {
  2068. cmd.req.arg[1] = ahw->pci_func << 16;
  2069. }
  2070. err = qlcnic_issue_cmd(adapter, &cmd);
  2071. if (err) {
  2072. dev_info(&adapter->pdev->dev,
  2073. "Failed to get nic info %d\n", err);
  2074. goto out;
  2075. }
  2076. npar_info->op_type = cmd.rsp.arg[1];
  2077. npar_info->pci_func = cmd.rsp.arg[2] & 0xFFFF;
  2078. npar_info->op_mode = (cmd.rsp.arg[2] & 0xFFFF0000) >> 16;
  2079. npar_info->phys_port = cmd.rsp.arg[3] & 0xFFFF;
  2080. npar_info->switch_mode = (cmd.rsp.arg[3] & 0xFFFF0000) >> 16;
  2081. npar_info->capabilities = cmd.rsp.arg[4];
  2082. npar_info->max_mac_filters = cmd.rsp.arg[5] & 0xFF;
  2083. npar_info->max_mtu = (cmd.rsp.arg[5] & 0xFFFF0000) >> 16;
  2084. npar_info->max_tx_ques = cmd.rsp.arg[6] & 0xFFFF;
  2085. npar_info->max_rx_ques = (cmd.rsp.arg[6] & 0xFFFF0000) >> 16;
  2086. npar_info->min_tx_bw = cmd.rsp.arg[7] & 0xFFFF;
  2087. npar_info->max_tx_bw = (cmd.rsp.arg[7] & 0xFFFF0000) >> 16;
  2088. if (cmd.rsp.arg[8] & 0x1)
  2089. npar_info->max_bw_reg_offset = (cmd.rsp.arg[8] & 0x7FFE) >> 1;
  2090. if (cmd.rsp.arg[8] & 0x10000) {
  2091. temp = (cmd.rsp.arg[8] & 0x7FFE0000) >> 17;
  2092. npar_info->max_linkspeed_reg_offset = temp;
  2093. }
  2094. memcpy(ahw->extra_capability, &cmd.rsp.arg[16],
  2095. sizeof(ahw->extra_capability));
  2096. out:
  2097. qlcnic_free_mbx_args(&cmd);
  2098. return err;
  2099. }
  2100. int qlcnic_get_pci_func_type(struct qlcnic_adapter *adapter, u16 type,
  2101. u16 *nic, u16 *fcoe, u16 *iscsi)
  2102. {
  2103. struct device *dev = &adapter->pdev->dev;
  2104. int err = 0;
  2105. switch (type) {
  2106. case QLCNIC_TYPE_NIC:
  2107. (*nic)++;
  2108. break;
  2109. case QLCNIC_TYPE_FCOE:
  2110. (*fcoe)++;
  2111. break;
  2112. case QLCNIC_TYPE_ISCSI:
  2113. (*iscsi)++;
  2114. break;
  2115. default:
  2116. dev_err(dev, "%s: Unknown PCI type[%x]\n",
  2117. __func__, type);
  2118. err = -EIO;
  2119. }
  2120. return err;
  2121. }
  2122. int qlcnic_83xx_get_pci_info(struct qlcnic_adapter *adapter,
  2123. struct qlcnic_pci_info *pci_info)
  2124. {
  2125. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2126. struct device *dev = &adapter->pdev->dev;
  2127. u16 nic = 0, fcoe = 0, iscsi = 0;
  2128. struct qlcnic_cmd_args cmd;
  2129. int i, err = 0, j = 0;
  2130. u32 temp;
  2131. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_PCI_INFO);
  2132. if (err)
  2133. return err;
  2134. err = qlcnic_issue_cmd(adapter, &cmd);
  2135. ahw->total_nic_func = 0;
  2136. if (err == QLCNIC_RCODE_SUCCESS) {
  2137. ahw->max_pci_func = cmd.rsp.arg[1] & 0xFF;
  2138. for (i = 2, j = 0; j < ahw->max_vnic_func; j++, pci_info++) {
  2139. pci_info->id = cmd.rsp.arg[i] & 0xFFFF;
  2140. pci_info->active = (cmd.rsp.arg[i] & 0xFFFF0000) >> 16;
  2141. i++;
  2142. if (!pci_info->active) {
  2143. i += QLC_SKIP_INACTIVE_PCI_REGS;
  2144. continue;
  2145. }
  2146. pci_info->type = cmd.rsp.arg[i] & 0xFFFF;
  2147. err = qlcnic_get_pci_func_type(adapter, pci_info->type,
  2148. &nic, &fcoe, &iscsi);
  2149. temp = (cmd.rsp.arg[i] & 0xFFFF0000) >> 16;
  2150. pci_info->default_port = temp;
  2151. i++;
  2152. pci_info->tx_min_bw = cmd.rsp.arg[i] & 0xFFFF;
  2153. temp = (cmd.rsp.arg[i] & 0xFFFF0000) >> 16;
  2154. pci_info->tx_max_bw = temp;
  2155. i = i + 2;
  2156. memcpy(pci_info->mac, &cmd.rsp.arg[i], ETH_ALEN - 2);
  2157. i++;
  2158. memcpy(pci_info->mac + sizeof(u32), &cmd.rsp.arg[i], 2);
  2159. i = i + 3;
  2160. }
  2161. } else {
  2162. dev_err(dev, "Failed to get PCI Info, error = %d\n", err);
  2163. err = -EIO;
  2164. }
  2165. ahw->total_nic_func = nic;
  2166. ahw->total_pci_func = nic + fcoe + iscsi;
  2167. if (ahw->total_nic_func == 0 || ahw->total_pci_func == 0) {
  2168. dev_err(dev, "%s: Invalid function count: total nic func[%x], total pci func[%x]\n",
  2169. __func__, ahw->total_nic_func, ahw->total_pci_func);
  2170. err = -EIO;
  2171. }
  2172. qlcnic_free_mbx_args(&cmd);
  2173. return err;
  2174. }
  2175. int qlcnic_83xx_config_intrpt(struct qlcnic_adapter *adapter, bool op_type)
  2176. {
  2177. int i, index, err;
  2178. u8 max_ints;
  2179. u32 val, temp, type;
  2180. struct qlcnic_cmd_args cmd;
  2181. max_ints = adapter->ahw->num_msix - 1;
  2182. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIG_INTRPT);
  2183. if (err)
  2184. return err;
  2185. cmd.req.arg[1] = max_ints;
  2186. if (qlcnic_sriov_vf_check(adapter))
  2187. cmd.req.arg[1] |= (adapter->ahw->pci_func << 8) | BIT_16;
  2188. for (i = 0, index = 2; i < max_ints; i++) {
  2189. type = op_type ? QLCNIC_INTRPT_ADD : QLCNIC_INTRPT_DEL;
  2190. val = type | (adapter->ahw->intr_tbl[i].type << 4);
  2191. if (adapter->ahw->intr_tbl[i].type == QLCNIC_INTRPT_MSIX)
  2192. val |= (adapter->ahw->intr_tbl[i].id << 16);
  2193. cmd.req.arg[index++] = val;
  2194. }
  2195. err = qlcnic_issue_cmd(adapter, &cmd);
  2196. if (err) {
  2197. dev_err(&adapter->pdev->dev,
  2198. "Failed to configure interrupts 0x%x\n", err);
  2199. goto out;
  2200. }
  2201. max_ints = cmd.rsp.arg[1];
  2202. for (i = 0, index = 2; i < max_ints; i++, index += 2) {
  2203. val = cmd.rsp.arg[index];
  2204. if (LSB(val)) {
  2205. dev_info(&adapter->pdev->dev,
  2206. "Can't configure interrupt %d\n",
  2207. adapter->ahw->intr_tbl[i].id);
  2208. continue;
  2209. }
  2210. if (op_type) {
  2211. adapter->ahw->intr_tbl[i].id = MSW(val);
  2212. adapter->ahw->intr_tbl[i].enabled = 1;
  2213. temp = cmd.rsp.arg[index + 1];
  2214. adapter->ahw->intr_tbl[i].src = temp;
  2215. } else {
  2216. adapter->ahw->intr_tbl[i].id = i;
  2217. adapter->ahw->intr_tbl[i].enabled = 0;
  2218. adapter->ahw->intr_tbl[i].src = 0;
  2219. }
  2220. }
  2221. out:
  2222. qlcnic_free_mbx_args(&cmd);
  2223. return err;
  2224. }
  2225. int qlcnic_83xx_lock_flash(struct qlcnic_adapter *adapter)
  2226. {
  2227. int id, timeout = 0;
  2228. u32 status = 0;
  2229. while (status == 0) {
  2230. status = QLC_SHARED_REG_RD32(adapter, QLCNIC_FLASH_LOCK);
  2231. if (status)
  2232. break;
  2233. if (++timeout >= QLC_83XX_FLASH_LOCK_TIMEOUT) {
  2234. id = QLC_SHARED_REG_RD32(adapter,
  2235. QLCNIC_FLASH_LOCK_OWNER);
  2236. dev_err(&adapter->pdev->dev,
  2237. "%s: failed, lock held by %d\n", __func__, id);
  2238. return -EIO;
  2239. }
  2240. usleep_range(1000, 2000);
  2241. }
  2242. QLC_SHARED_REG_WR32(adapter, QLCNIC_FLASH_LOCK_OWNER, adapter->portnum);
  2243. return 0;
  2244. }
  2245. void qlcnic_83xx_unlock_flash(struct qlcnic_adapter *adapter)
  2246. {
  2247. QLC_SHARED_REG_RD32(adapter, QLCNIC_FLASH_UNLOCK);
  2248. QLC_SHARED_REG_WR32(adapter, QLCNIC_FLASH_LOCK_OWNER, 0xFF);
  2249. }
  2250. int qlcnic_83xx_lockless_flash_read32(struct qlcnic_adapter *adapter,
  2251. u32 flash_addr, u8 *p_data,
  2252. int count)
  2253. {
  2254. u32 word, range, flash_offset, addr = flash_addr, ret;
  2255. ulong indirect_add, direct_window;
  2256. int i, err = 0;
  2257. flash_offset = addr & (QLCNIC_FLASH_SECTOR_SIZE - 1);
  2258. if (addr & 0x3) {
  2259. dev_err(&adapter->pdev->dev, "Illegal addr = 0x%x\n", addr);
  2260. return -EIO;
  2261. }
  2262. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_DIRECT_WINDOW,
  2263. (addr & 0xFFFF0000));
  2264. range = flash_offset + (count * sizeof(u32));
  2265. /* Check if data is spread across multiple sectors */
  2266. if (range > (QLCNIC_FLASH_SECTOR_SIZE - 1)) {
  2267. /* Multi sector read */
  2268. for (i = 0; i < count; i++) {
  2269. indirect_add = QLC_83XX_FLASH_DIRECT_DATA(addr);
  2270. ret = QLCRD32(adapter, indirect_add, &err);
  2271. if (err == -EIO)
  2272. return err;
  2273. word = ret;
  2274. *(u32 *)p_data = word;
  2275. p_data = p_data + 4;
  2276. addr = addr + 4;
  2277. flash_offset = flash_offset + 4;
  2278. if (flash_offset > (QLCNIC_FLASH_SECTOR_SIZE - 1)) {
  2279. direct_window = QLC_83XX_FLASH_DIRECT_WINDOW;
  2280. /* This write is needed once for each sector */
  2281. qlcnic_83xx_wrt_reg_indirect(adapter,
  2282. direct_window,
  2283. (addr));
  2284. flash_offset = 0;
  2285. }
  2286. }
  2287. } else {
  2288. /* Single sector read */
  2289. for (i = 0; i < count; i++) {
  2290. indirect_add = QLC_83XX_FLASH_DIRECT_DATA(addr);
  2291. ret = QLCRD32(adapter, indirect_add, &err);
  2292. if (err == -EIO)
  2293. return err;
  2294. word = ret;
  2295. *(u32 *)p_data = word;
  2296. p_data = p_data + 4;
  2297. addr = addr + 4;
  2298. }
  2299. }
  2300. return 0;
  2301. }
  2302. static int qlcnic_83xx_poll_flash_status_reg(struct qlcnic_adapter *adapter)
  2303. {
  2304. u32 status;
  2305. int retries = QLC_83XX_FLASH_READ_RETRY_COUNT;
  2306. int err = 0;
  2307. do {
  2308. status = QLCRD32(adapter, QLC_83XX_FLASH_STATUS, &err);
  2309. if (err == -EIO)
  2310. return err;
  2311. if ((status & QLC_83XX_FLASH_STATUS_READY) ==
  2312. QLC_83XX_FLASH_STATUS_READY)
  2313. break;
  2314. usleep_range(1000, 1100);
  2315. } while (--retries);
  2316. if (!retries)
  2317. return -EIO;
  2318. return 0;
  2319. }
  2320. int qlcnic_83xx_enable_flash_write(struct qlcnic_adapter *adapter)
  2321. {
  2322. int ret;
  2323. u32 cmd;
  2324. cmd = adapter->ahw->fdt.write_statusreg_cmd;
  2325. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2326. (QLC_83XX_FLASH_FDT_WRITE_DEF_SIG | cmd));
  2327. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
  2328. adapter->ahw->fdt.write_enable_bits);
  2329. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2330. QLC_83XX_FLASH_SECOND_ERASE_MS_VAL);
  2331. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2332. if (ret)
  2333. return -EIO;
  2334. return 0;
  2335. }
  2336. int qlcnic_83xx_disable_flash_write(struct qlcnic_adapter *adapter)
  2337. {
  2338. int ret;
  2339. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2340. (QLC_83XX_FLASH_FDT_WRITE_DEF_SIG |
  2341. adapter->ahw->fdt.write_statusreg_cmd));
  2342. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
  2343. adapter->ahw->fdt.write_disable_bits);
  2344. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2345. QLC_83XX_FLASH_SECOND_ERASE_MS_VAL);
  2346. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2347. if (ret)
  2348. return -EIO;
  2349. return 0;
  2350. }
  2351. int qlcnic_83xx_read_flash_mfg_id(struct qlcnic_adapter *adapter)
  2352. {
  2353. int ret, err = 0;
  2354. u32 mfg_id;
  2355. if (qlcnic_83xx_lock_flash(adapter))
  2356. return -EIO;
  2357. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2358. QLC_83XX_FLASH_FDT_READ_MFG_ID_VAL);
  2359. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2360. QLC_83XX_FLASH_READ_CTRL);
  2361. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2362. if (ret) {
  2363. qlcnic_83xx_unlock_flash(adapter);
  2364. return -EIO;
  2365. }
  2366. mfg_id = QLCRD32(adapter, QLC_83XX_FLASH_RDDATA, &err);
  2367. if (err == -EIO) {
  2368. qlcnic_83xx_unlock_flash(adapter);
  2369. return err;
  2370. }
  2371. adapter->flash_mfg_id = (mfg_id & 0xFF);
  2372. qlcnic_83xx_unlock_flash(adapter);
  2373. return 0;
  2374. }
  2375. int qlcnic_83xx_read_flash_descriptor_table(struct qlcnic_adapter *adapter)
  2376. {
  2377. int count, fdt_size, ret = 0;
  2378. fdt_size = sizeof(struct qlcnic_fdt);
  2379. count = fdt_size / sizeof(u32);
  2380. if (qlcnic_83xx_lock_flash(adapter))
  2381. return -EIO;
  2382. memset(&adapter->ahw->fdt, 0, fdt_size);
  2383. ret = qlcnic_83xx_lockless_flash_read32(adapter, QLCNIC_FDT_LOCATION,
  2384. (u8 *)&adapter->ahw->fdt,
  2385. count);
  2386. qlcnic_swap32_buffer((u32 *)&adapter->ahw->fdt, count);
  2387. qlcnic_83xx_unlock_flash(adapter);
  2388. return ret;
  2389. }
  2390. int qlcnic_83xx_erase_flash_sector(struct qlcnic_adapter *adapter,
  2391. u32 sector_start_addr)
  2392. {
  2393. u32 reversed_addr, addr1, addr2, cmd;
  2394. int ret = -EIO;
  2395. if (qlcnic_83xx_lock_flash(adapter) != 0)
  2396. return -EIO;
  2397. if (adapter->ahw->fdt.mfg_id == adapter->flash_mfg_id) {
  2398. ret = qlcnic_83xx_enable_flash_write(adapter);
  2399. if (ret) {
  2400. qlcnic_83xx_unlock_flash(adapter);
  2401. dev_err(&adapter->pdev->dev,
  2402. "%s failed at %d\n",
  2403. __func__, __LINE__);
  2404. return ret;
  2405. }
  2406. }
  2407. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2408. if (ret) {
  2409. qlcnic_83xx_unlock_flash(adapter);
  2410. dev_err(&adapter->pdev->dev,
  2411. "%s: failed at %d\n", __func__, __LINE__);
  2412. return -EIO;
  2413. }
  2414. addr1 = (sector_start_addr & 0xFF) << 16;
  2415. addr2 = (sector_start_addr & 0xFF0000) >> 16;
  2416. reversed_addr = addr1 | addr2 | (sector_start_addr & 0xFF00);
  2417. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
  2418. reversed_addr);
  2419. cmd = QLC_83XX_FLASH_FDT_ERASE_DEF_SIG | adapter->ahw->fdt.erase_cmd;
  2420. if (adapter->ahw->fdt.mfg_id == adapter->flash_mfg_id)
  2421. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR, cmd);
  2422. else
  2423. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2424. QLC_83XX_FLASH_OEM_ERASE_SIG);
  2425. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2426. QLC_83XX_FLASH_LAST_ERASE_MS_VAL);
  2427. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2428. if (ret) {
  2429. qlcnic_83xx_unlock_flash(adapter);
  2430. dev_err(&adapter->pdev->dev,
  2431. "%s: failed at %d\n", __func__, __LINE__);
  2432. return -EIO;
  2433. }
  2434. if (adapter->ahw->fdt.mfg_id == adapter->flash_mfg_id) {
  2435. ret = qlcnic_83xx_disable_flash_write(adapter);
  2436. if (ret) {
  2437. qlcnic_83xx_unlock_flash(adapter);
  2438. dev_err(&adapter->pdev->dev,
  2439. "%s: failed at %d\n", __func__, __LINE__);
  2440. return ret;
  2441. }
  2442. }
  2443. qlcnic_83xx_unlock_flash(adapter);
  2444. return 0;
  2445. }
  2446. int qlcnic_83xx_flash_write32(struct qlcnic_adapter *adapter, u32 addr,
  2447. u32 *p_data)
  2448. {
  2449. int ret = -EIO;
  2450. u32 addr1 = 0x00800000 | (addr >> 2);
  2451. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR, addr1);
  2452. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA, *p_data);
  2453. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2454. QLC_83XX_FLASH_LAST_ERASE_MS_VAL);
  2455. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2456. if (ret) {
  2457. dev_err(&adapter->pdev->dev,
  2458. "%s: failed at %d\n", __func__, __LINE__);
  2459. return -EIO;
  2460. }
  2461. return 0;
  2462. }
  2463. int qlcnic_83xx_flash_bulk_write(struct qlcnic_adapter *adapter, u32 addr,
  2464. u32 *p_data, int count)
  2465. {
  2466. u32 temp;
  2467. int ret = -EIO, err = 0;
  2468. if ((count < QLC_83XX_FLASH_WRITE_MIN) ||
  2469. (count > QLC_83XX_FLASH_WRITE_MAX)) {
  2470. dev_err(&adapter->pdev->dev,
  2471. "%s: Invalid word count\n", __func__);
  2472. return -EIO;
  2473. }
  2474. temp = QLCRD32(adapter, QLC_83XX_FLASH_SPI_CONTROL, &err);
  2475. if (err == -EIO)
  2476. return err;
  2477. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_SPI_CONTROL,
  2478. (temp | QLC_83XX_FLASH_SPI_CTRL));
  2479. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2480. QLC_83XX_FLASH_ADDR_TEMP_VAL);
  2481. /* First DWORD write */
  2482. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA, *p_data++);
  2483. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2484. QLC_83XX_FLASH_FIRST_MS_PATTERN);
  2485. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2486. if (ret) {
  2487. dev_err(&adapter->pdev->dev,
  2488. "%s: failed at %d\n", __func__, __LINE__);
  2489. return -EIO;
  2490. }
  2491. count--;
  2492. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2493. QLC_83XX_FLASH_ADDR_SECOND_TEMP_VAL);
  2494. /* Second to N-1 DWORD writes */
  2495. while (count != 1) {
  2496. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
  2497. *p_data++);
  2498. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2499. QLC_83XX_FLASH_SECOND_MS_PATTERN);
  2500. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2501. if (ret) {
  2502. dev_err(&adapter->pdev->dev,
  2503. "%s: failed at %d\n", __func__, __LINE__);
  2504. return -EIO;
  2505. }
  2506. count--;
  2507. }
  2508. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  2509. QLC_83XX_FLASH_ADDR_TEMP_VAL |
  2510. (addr >> 2));
  2511. /* Last DWORD write */
  2512. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA, *p_data++);
  2513. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  2514. QLC_83XX_FLASH_LAST_MS_PATTERN);
  2515. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  2516. if (ret) {
  2517. dev_err(&adapter->pdev->dev,
  2518. "%s: failed at %d\n", __func__, __LINE__);
  2519. return -EIO;
  2520. }
  2521. ret = QLCRD32(adapter, QLC_83XX_FLASH_SPI_STATUS, &err);
  2522. if (err == -EIO)
  2523. return err;
  2524. if ((ret & QLC_83XX_FLASH_SPI_CTRL) == QLC_83XX_FLASH_SPI_CTRL) {
  2525. dev_err(&adapter->pdev->dev, "%s: failed at %d\n",
  2526. __func__, __LINE__);
  2527. /* Operation failed, clear error bit */
  2528. temp = QLCRD32(adapter, QLC_83XX_FLASH_SPI_CONTROL, &err);
  2529. if (err == -EIO)
  2530. return err;
  2531. qlcnic_83xx_wrt_reg_indirect(adapter,
  2532. QLC_83XX_FLASH_SPI_CONTROL,
  2533. (temp | QLC_83XX_FLASH_SPI_CTRL));
  2534. }
  2535. return 0;
  2536. }
  2537. static void qlcnic_83xx_recover_driver_lock(struct qlcnic_adapter *adapter)
  2538. {
  2539. u32 val, id;
  2540. val = QLCRDX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK);
  2541. /* Check if recovery need to be performed by the calling function */
  2542. if ((val & QLC_83XX_DRV_LOCK_RECOVERY_STATUS_MASK) == 0) {
  2543. val = val & ~0x3F;
  2544. val = val | ((adapter->portnum << 2) |
  2545. QLC_83XX_NEED_DRV_LOCK_RECOVERY);
  2546. QLCWRX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK, val);
  2547. dev_info(&adapter->pdev->dev,
  2548. "%s: lock recovery initiated\n", __func__);
  2549. msleep(QLC_83XX_DRV_LOCK_RECOVERY_DELAY);
  2550. val = QLCRDX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK);
  2551. id = ((val >> 2) & 0xF);
  2552. if (id == adapter->portnum) {
  2553. val = val & ~QLC_83XX_DRV_LOCK_RECOVERY_STATUS_MASK;
  2554. val = val | QLC_83XX_DRV_LOCK_RECOVERY_IN_PROGRESS;
  2555. QLCWRX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK, val);
  2556. /* Force release the lock */
  2557. QLCRDX(adapter->ahw, QLC_83XX_DRV_UNLOCK);
  2558. /* Clear recovery bits */
  2559. val = val & ~0x3F;
  2560. QLCWRX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK, val);
  2561. dev_info(&adapter->pdev->dev,
  2562. "%s: lock recovery completed\n", __func__);
  2563. } else {
  2564. dev_info(&adapter->pdev->dev,
  2565. "%s: func %d to resume lock recovery process\n",
  2566. __func__, id);
  2567. }
  2568. } else {
  2569. dev_info(&adapter->pdev->dev,
  2570. "%s: lock recovery initiated by other functions\n",
  2571. __func__);
  2572. }
  2573. }
  2574. int qlcnic_83xx_lock_driver(struct qlcnic_adapter *adapter)
  2575. {
  2576. u32 lock_alive_counter, val, id, i = 0, status = 0, temp = 0;
  2577. int max_attempt = 0;
  2578. while (status == 0) {
  2579. status = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK);
  2580. if (status)
  2581. break;
  2582. msleep(QLC_83XX_DRV_LOCK_WAIT_DELAY);
  2583. i++;
  2584. if (i == 1)
  2585. temp = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
  2586. if (i == QLC_83XX_DRV_LOCK_WAIT_COUNTER) {
  2587. val = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
  2588. if (val == temp) {
  2589. id = val & 0xFF;
  2590. dev_info(&adapter->pdev->dev,
  2591. "%s: lock to be recovered from %d\n",
  2592. __func__, id);
  2593. qlcnic_83xx_recover_driver_lock(adapter);
  2594. i = 0;
  2595. max_attempt++;
  2596. } else {
  2597. dev_err(&adapter->pdev->dev,
  2598. "%s: failed to get lock\n", __func__);
  2599. return -EIO;
  2600. }
  2601. }
  2602. /* Force exit from while loop after few attempts */
  2603. if (max_attempt == QLC_83XX_MAX_DRV_LOCK_RECOVERY_ATTEMPT) {
  2604. dev_err(&adapter->pdev->dev,
  2605. "%s: failed to get lock\n", __func__);
  2606. return -EIO;
  2607. }
  2608. }
  2609. val = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
  2610. lock_alive_counter = val >> 8;
  2611. lock_alive_counter++;
  2612. val = lock_alive_counter << 8 | adapter->portnum;
  2613. QLCWRX(adapter->ahw, QLC_83XX_DRV_LOCK_ID, val);
  2614. return 0;
  2615. }
  2616. void qlcnic_83xx_unlock_driver(struct qlcnic_adapter *adapter)
  2617. {
  2618. u32 val, lock_alive_counter, id;
  2619. val = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
  2620. id = val & 0xFF;
  2621. lock_alive_counter = val >> 8;
  2622. if (id != adapter->portnum)
  2623. dev_err(&adapter->pdev->dev,
  2624. "%s:Warning func %d is unlocking lock owned by %d\n",
  2625. __func__, adapter->portnum, id);
  2626. val = (lock_alive_counter << 8) | 0xFF;
  2627. QLCWRX(adapter->ahw, QLC_83XX_DRV_LOCK_ID, val);
  2628. QLCRDX(adapter->ahw, QLC_83XX_DRV_UNLOCK);
  2629. }
  2630. int qlcnic_ms_mem_write128(struct qlcnic_adapter *adapter, u64 addr,
  2631. u32 *data, u32 count)
  2632. {
  2633. int i, j, ret = 0;
  2634. u32 temp;
  2635. /* Check alignment */
  2636. if (addr & 0xF)
  2637. return -EIO;
  2638. mutex_lock(&adapter->ahw->mem_lock);
  2639. qlcnic_ind_wr(adapter, QLCNIC_MS_ADDR_HI, 0);
  2640. for (i = 0; i < count; i++, addr += 16) {
  2641. if (!((ADDR_IN_RANGE(addr, QLCNIC_ADDR_QDR_NET,
  2642. QLCNIC_ADDR_QDR_NET_MAX)) ||
  2643. (ADDR_IN_RANGE(addr, QLCNIC_ADDR_DDR_NET,
  2644. QLCNIC_ADDR_DDR_NET_MAX)))) {
  2645. mutex_unlock(&adapter->ahw->mem_lock);
  2646. return -EIO;
  2647. }
  2648. qlcnic_ind_wr(adapter, QLCNIC_MS_ADDR_LO, addr);
  2649. qlcnic_ind_wr(adapter, QLCNIC_MS_WRTDATA_LO, *data++);
  2650. qlcnic_ind_wr(adapter, QLCNIC_MS_WRTDATA_HI, *data++);
  2651. qlcnic_ind_wr(adapter, QLCNIC_MS_WRTDATA_ULO, *data++);
  2652. qlcnic_ind_wr(adapter, QLCNIC_MS_WRTDATA_UHI, *data++);
  2653. qlcnic_ind_wr(adapter, QLCNIC_MS_CTRL, QLCNIC_TA_WRITE_ENABLE);
  2654. qlcnic_ind_wr(adapter, QLCNIC_MS_CTRL, QLCNIC_TA_WRITE_START);
  2655. for (j = 0; j < MAX_CTL_CHECK; j++) {
  2656. temp = qlcnic_ind_rd(adapter, QLCNIC_MS_CTRL);
  2657. if ((temp & TA_CTL_BUSY) == 0)
  2658. break;
  2659. }
  2660. /* Status check failure */
  2661. if (j >= MAX_CTL_CHECK) {
  2662. printk_ratelimited(KERN_WARNING
  2663. "MS memory write failed\n");
  2664. mutex_unlock(&adapter->ahw->mem_lock);
  2665. return -EIO;
  2666. }
  2667. }
  2668. mutex_unlock(&adapter->ahw->mem_lock);
  2669. return ret;
  2670. }
  2671. int qlcnic_83xx_flash_read32(struct qlcnic_adapter *adapter, u32 flash_addr,
  2672. u8 *p_data, int count)
  2673. {
  2674. u32 word, addr = flash_addr, ret;
  2675. ulong indirect_addr;
  2676. int i, err = 0;
  2677. if (qlcnic_83xx_lock_flash(adapter) != 0)
  2678. return -EIO;
  2679. if (addr & 0x3) {
  2680. dev_err(&adapter->pdev->dev, "Illegal addr = 0x%x\n", addr);
  2681. qlcnic_83xx_unlock_flash(adapter);
  2682. return -EIO;
  2683. }
  2684. for (i = 0; i < count; i++) {
  2685. if (qlcnic_83xx_wrt_reg_indirect(adapter,
  2686. QLC_83XX_FLASH_DIRECT_WINDOW,
  2687. (addr))) {
  2688. qlcnic_83xx_unlock_flash(adapter);
  2689. return -EIO;
  2690. }
  2691. indirect_addr = QLC_83XX_FLASH_DIRECT_DATA(addr);
  2692. ret = QLCRD32(adapter, indirect_addr, &err);
  2693. if (err == -EIO)
  2694. return err;
  2695. word = ret;
  2696. *(u32 *)p_data = word;
  2697. p_data = p_data + 4;
  2698. addr = addr + 4;
  2699. }
  2700. qlcnic_83xx_unlock_flash(adapter);
  2701. return 0;
  2702. }
  2703. void qlcnic_83xx_get_port_type(struct qlcnic_adapter *adapter)
  2704. {
  2705. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2706. struct qlcnic_cmd_args cmd;
  2707. u32 config;
  2708. int err;
  2709. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_LINK_STATUS);
  2710. if (err)
  2711. return;
  2712. err = qlcnic_issue_cmd(adapter, &cmd);
  2713. if (err) {
  2714. dev_info(&adapter->pdev->dev,
  2715. "Get Link Status Command failed: 0x%x\n", err);
  2716. goto out;
  2717. } else {
  2718. config = cmd.rsp.arg[3];
  2719. switch (QLC_83XX_SFP_MODULE_TYPE(config)) {
  2720. case QLC_83XX_MODULE_FIBRE_1000BASE_SX:
  2721. case QLC_83XX_MODULE_FIBRE_1000BASE_LX:
  2722. case QLC_83XX_MODULE_FIBRE_1000BASE_CX:
  2723. case QLC_83XX_MODULE_TP_1000BASE_T:
  2724. ahw->port_type = QLCNIC_GBE;
  2725. break;
  2726. default:
  2727. ahw->port_type = QLCNIC_XGBE;
  2728. }
  2729. }
  2730. out:
  2731. qlcnic_free_mbx_args(&cmd);
  2732. }
  2733. int qlcnic_83xx_test_link(struct qlcnic_adapter *adapter)
  2734. {
  2735. u8 pci_func;
  2736. int err;
  2737. u32 config = 0, state;
  2738. struct qlcnic_cmd_args cmd;
  2739. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2740. if (qlcnic_sriov_vf_check(adapter))
  2741. pci_func = adapter->portnum;
  2742. else
  2743. pci_func = ahw->pci_func;
  2744. state = readl(ahw->pci_base0 + QLC_83XX_LINK_STATE(pci_func));
  2745. if (!QLC_83xx_FUNC_VAL(state, pci_func)) {
  2746. dev_info(&adapter->pdev->dev, "link state down\n");
  2747. return config;
  2748. }
  2749. err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_LINK_STATUS);
  2750. if (err)
  2751. return err;
  2752. err = qlcnic_issue_cmd(adapter, &cmd);
  2753. if (err) {
  2754. dev_info(&adapter->pdev->dev,
  2755. "Get Link Status Command failed: 0x%x\n", err);
  2756. goto out;
  2757. } else {
  2758. config = cmd.rsp.arg[1];
  2759. switch (QLC_83XX_CURRENT_LINK_SPEED(config)) {
  2760. case QLC_83XX_10M_LINK:
  2761. ahw->link_speed = SPEED_10;
  2762. break;
  2763. case QLC_83XX_100M_LINK:
  2764. ahw->link_speed = SPEED_100;
  2765. break;
  2766. case QLC_83XX_1G_LINK:
  2767. ahw->link_speed = SPEED_1000;
  2768. break;
  2769. case QLC_83XX_10G_LINK:
  2770. ahw->link_speed = SPEED_10000;
  2771. break;
  2772. default:
  2773. ahw->link_speed = 0;
  2774. break;
  2775. }
  2776. config = cmd.rsp.arg[3];
  2777. switch (QLC_83XX_SFP_MODULE_TYPE(config)) {
  2778. case QLC_83XX_MODULE_FIBRE_10GBASE_LRM:
  2779. case QLC_83XX_MODULE_FIBRE_10GBASE_LR:
  2780. case QLC_83XX_MODULE_FIBRE_10GBASE_SR:
  2781. ahw->supported_type = PORT_FIBRE;
  2782. ahw->port_type = QLCNIC_XGBE;
  2783. break;
  2784. case QLC_83XX_MODULE_FIBRE_1000BASE_SX:
  2785. case QLC_83XX_MODULE_FIBRE_1000BASE_LX:
  2786. case QLC_83XX_MODULE_FIBRE_1000BASE_CX:
  2787. ahw->supported_type = PORT_FIBRE;
  2788. ahw->port_type = QLCNIC_GBE;
  2789. break;
  2790. case QLC_83XX_MODULE_TP_1000BASE_T:
  2791. ahw->supported_type = PORT_TP;
  2792. ahw->port_type = QLCNIC_GBE;
  2793. break;
  2794. case QLC_83XX_MODULE_DA_10GE_PASSIVE_CP:
  2795. case QLC_83XX_MODULE_DA_10GE_ACTIVE_CP:
  2796. case QLC_83XX_MODULE_DA_10GE_LEGACY_CP:
  2797. case QLC_83XX_MODULE_DA_1GE_PASSIVE_CP:
  2798. ahw->supported_type = PORT_DA;
  2799. ahw->port_type = QLCNIC_XGBE;
  2800. break;
  2801. default:
  2802. ahw->supported_type = PORT_OTHER;
  2803. ahw->port_type = QLCNIC_XGBE;
  2804. }
  2805. if (config & 1)
  2806. err = 1;
  2807. }
  2808. out:
  2809. qlcnic_free_mbx_args(&cmd);
  2810. return config;
  2811. }
  2812. int qlcnic_83xx_get_link_ksettings(struct qlcnic_adapter *adapter,
  2813. struct ethtool_link_ksettings *ecmd)
  2814. {
  2815. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2816. u32 config = 0;
  2817. int status = 0;
  2818. u32 supported, advertising;
  2819. if (!test_bit(__QLCNIC_MAINTENANCE_MODE, &adapter->state)) {
  2820. /* Get port configuration info */
  2821. status = qlcnic_83xx_get_port_info(adapter);
  2822. /* Get Link Status related info */
  2823. config = qlcnic_83xx_test_link(adapter);
  2824. ahw->module_type = QLC_83XX_SFP_MODULE_TYPE(config);
  2825. }
  2826. /* hard code until there is a way to get it from flash */
  2827. ahw->board_type = QLCNIC_BRDTYPE_83XX_10G;
  2828. if (netif_running(adapter->netdev) && ahw->has_link_events) {
  2829. ecmd->base.speed = ahw->link_speed;
  2830. ecmd->base.duplex = ahw->link_duplex;
  2831. ecmd->base.autoneg = ahw->link_autoneg;
  2832. } else {
  2833. ecmd->base.speed = SPEED_UNKNOWN;
  2834. ecmd->base.duplex = DUPLEX_UNKNOWN;
  2835. ecmd->base.autoneg = AUTONEG_DISABLE;
  2836. }
  2837. supported = (SUPPORTED_10baseT_Full |
  2838. SUPPORTED_100baseT_Full |
  2839. SUPPORTED_1000baseT_Full |
  2840. SUPPORTED_10000baseT_Full |
  2841. SUPPORTED_Autoneg);
  2842. ethtool_convert_link_mode_to_legacy_u32(&advertising,
  2843. ecmd->link_modes.advertising);
  2844. if (ecmd->base.autoneg == AUTONEG_ENABLE) {
  2845. if (ahw->port_config & QLC_83XX_10_CAPABLE)
  2846. advertising |= SUPPORTED_10baseT_Full;
  2847. if (ahw->port_config & QLC_83XX_100_CAPABLE)
  2848. advertising |= SUPPORTED_100baseT_Full;
  2849. if (ahw->port_config & QLC_83XX_1G_CAPABLE)
  2850. advertising |= SUPPORTED_1000baseT_Full;
  2851. if (ahw->port_config & QLC_83XX_10G_CAPABLE)
  2852. advertising |= SUPPORTED_10000baseT_Full;
  2853. if (ahw->port_config & QLC_83XX_AUTONEG_ENABLE)
  2854. advertising |= ADVERTISED_Autoneg;
  2855. } else {
  2856. switch (ahw->link_speed) {
  2857. case SPEED_10:
  2858. advertising = SUPPORTED_10baseT_Full;
  2859. break;
  2860. case SPEED_100:
  2861. advertising = SUPPORTED_100baseT_Full;
  2862. break;
  2863. case SPEED_1000:
  2864. advertising = SUPPORTED_1000baseT_Full;
  2865. break;
  2866. case SPEED_10000:
  2867. advertising = SUPPORTED_10000baseT_Full;
  2868. break;
  2869. default:
  2870. break;
  2871. }
  2872. }
  2873. switch (ahw->supported_type) {
  2874. case PORT_FIBRE:
  2875. supported |= SUPPORTED_FIBRE;
  2876. advertising |= ADVERTISED_FIBRE;
  2877. ecmd->base.port = PORT_FIBRE;
  2878. break;
  2879. case PORT_TP:
  2880. supported |= SUPPORTED_TP;
  2881. advertising |= ADVERTISED_TP;
  2882. ecmd->base.port = PORT_TP;
  2883. break;
  2884. case PORT_DA:
  2885. supported |= SUPPORTED_FIBRE;
  2886. advertising |= ADVERTISED_FIBRE;
  2887. ecmd->base.port = PORT_DA;
  2888. break;
  2889. default:
  2890. supported |= SUPPORTED_FIBRE;
  2891. advertising |= ADVERTISED_FIBRE;
  2892. ecmd->base.port = PORT_OTHER;
  2893. break;
  2894. }
  2895. ecmd->base.phy_address = ahw->physical_port;
  2896. ethtool_convert_legacy_u32_to_link_mode(ecmd->link_modes.supported,
  2897. supported);
  2898. ethtool_convert_legacy_u32_to_link_mode(ecmd->link_modes.advertising,
  2899. advertising);
  2900. return status;
  2901. }
  2902. int qlcnic_83xx_set_link_ksettings(struct qlcnic_adapter *adapter,
  2903. const struct ethtool_link_ksettings *ecmd)
  2904. {
  2905. struct qlcnic_hardware_context *ahw = adapter->ahw;
  2906. u32 config = adapter->ahw->port_config;
  2907. int status = 0;
  2908. /* 83xx devices do not support Half duplex */
  2909. if (ecmd->base.duplex == DUPLEX_HALF) {
  2910. netdev_info(adapter->netdev,
  2911. "Half duplex mode not supported\n");
  2912. return -EINVAL;
  2913. }
  2914. if (ecmd->base.autoneg) {
  2915. ahw->port_config |= QLC_83XX_AUTONEG_ENABLE;
  2916. ahw->port_config |= (QLC_83XX_100_CAPABLE |
  2917. QLC_83XX_1G_CAPABLE |
  2918. QLC_83XX_10G_CAPABLE);
  2919. } else { /* force speed */
  2920. ahw->port_config &= ~QLC_83XX_AUTONEG_ENABLE;
  2921. switch (ecmd->base.speed) {
  2922. case SPEED_10:
  2923. ahw->port_config &= ~(QLC_83XX_100_CAPABLE |
  2924. QLC_83XX_1G_CAPABLE |
  2925. QLC_83XX_10G_CAPABLE);
  2926. ahw->port_config |= QLC_83XX_10_CAPABLE;
  2927. break;
  2928. case SPEED_100:
  2929. ahw->port_config &= ~(QLC_83XX_10_CAPABLE |
  2930. QLC_83XX_1G_CAPABLE |
  2931. QLC_83XX_10G_CAPABLE);
  2932. ahw->port_config |= QLC_83XX_100_CAPABLE;
  2933. break;
  2934. case SPEED_1000:
  2935. ahw->port_config &= ~(QLC_83XX_10_CAPABLE |
  2936. QLC_83XX_100_CAPABLE |
  2937. QLC_83XX_10G_CAPABLE);
  2938. ahw->port_config |= QLC_83XX_1G_CAPABLE;
  2939. break;
  2940. case SPEED_10000:
  2941. ahw->port_config &= ~(QLC_83XX_10_CAPABLE |
  2942. QLC_83XX_100_CAPABLE |
  2943. QLC_83XX_1G_CAPABLE);
  2944. ahw->port_config |= QLC_83XX_10G_CAPABLE;
  2945. break;
  2946. default:
  2947. return -EINVAL;
  2948. }
  2949. }
  2950. status = qlcnic_83xx_set_port_config(adapter);
  2951. if (status) {
  2952. netdev_info(adapter->netdev,
  2953. "Failed to Set Link Speed and autoneg.\n");
  2954. ahw->port_config = config;
  2955. }
  2956. return status;
  2957. }
  2958. static inline u64 *qlcnic_83xx_copy_stats(struct qlcnic_cmd_args *cmd,
  2959. u64 *data, int index)
  2960. {
  2961. u32 low, hi;
  2962. u64 val;
  2963. low = cmd->rsp.arg[index];
  2964. hi = cmd->rsp.arg[index + 1];
  2965. val = (((u64) low) | (((u64) hi) << 32));
  2966. *data++ = val;
  2967. return data;
  2968. }
  2969. static u64 *qlcnic_83xx_fill_stats(struct qlcnic_adapter *adapter,
  2970. struct qlcnic_cmd_args *cmd, u64 *data,
  2971. int type, int *ret)
  2972. {
  2973. int err, k, total_regs;
  2974. *ret = 0;
  2975. err = qlcnic_issue_cmd(adapter, cmd);
  2976. if (err != QLCNIC_RCODE_SUCCESS) {
  2977. dev_info(&adapter->pdev->dev,
  2978. "Error in get statistics mailbox command\n");
  2979. *ret = -EIO;
  2980. return data;
  2981. }
  2982. total_regs = cmd->rsp.num;
  2983. switch (type) {
  2984. case QLC_83XX_STAT_MAC:
  2985. /* fill in MAC tx counters */
  2986. for (k = 2; k < 28; k += 2)
  2987. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2988. /* skip 24 bytes of reserved area */
  2989. /* fill in MAC rx counters */
  2990. for (k += 6; k < 60; k += 2)
  2991. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2992. /* skip 24 bytes of reserved area */
  2993. /* fill in MAC rx frame stats */
  2994. for (k += 6; k < 80; k += 2)
  2995. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2996. /* fill in eSwitch stats */
  2997. for (; k < total_regs; k += 2)
  2998. data = qlcnic_83xx_copy_stats(cmd, data, k);
  2999. break;
  3000. case QLC_83XX_STAT_RX:
  3001. for (k = 2; k < 8; k += 2)
  3002. data = qlcnic_83xx_copy_stats(cmd, data, k);
  3003. /* skip 8 bytes of reserved data */
  3004. for (k += 2; k < 24; k += 2)
  3005. data = qlcnic_83xx_copy_stats(cmd, data, k);
  3006. /* skip 8 bytes containing RE1FBQ error data */
  3007. for (k += 2; k < total_regs; k += 2)
  3008. data = qlcnic_83xx_copy_stats(cmd, data, k);
  3009. break;
  3010. case QLC_83XX_STAT_TX:
  3011. for (k = 2; k < 10; k += 2)
  3012. data = qlcnic_83xx_copy_stats(cmd, data, k);
  3013. /* skip 8 bytes of reserved data */
  3014. for (k += 2; k < total_regs; k += 2)
  3015. data = qlcnic_83xx_copy_stats(cmd, data, k);
  3016. break;
  3017. default:
  3018. dev_warn(&adapter->pdev->dev, "Unknown get statistics mode\n");
  3019. *ret = -EIO;
  3020. }
  3021. return data;
  3022. }
  3023. void qlcnic_83xx_get_stats(struct qlcnic_adapter *adapter, u64 *data)
  3024. {
  3025. struct qlcnic_cmd_args cmd;
  3026. struct net_device *netdev = adapter->netdev;
  3027. int ret = 0;
  3028. ret = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_STATISTICS);
  3029. if (ret)
  3030. return;
  3031. /* Get Tx stats */
  3032. cmd.req.arg[1] = BIT_1 | (adapter->tx_ring->ctx_id << 16);
  3033. cmd.rsp.num = QLC_83XX_TX_STAT_REGS;
  3034. data = qlcnic_83xx_fill_stats(adapter, &cmd, data,
  3035. QLC_83XX_STAT_TX, &ret);
  3036. if (ret) {
  3037. netdev_err(netdev, "Error getting Tx stats\n");
  3038. goto out;
  3039. }
  3040. /* Get MAC stats */
  3041. cmd.req.arg[1] = BIT_2 | (adapter->portnum << 16);
  3042. cmd.rsp.num = QLC_83XX_MAC_STAT_REGS;
  3043. memset(cmd.rsp.arg, 0, sizeof(u32) * cmd.rsp.num);
  3044. data = qlcnic_83xx_fill_stats(adapter, &cmd, data,
  3045. QLC_83XX_STAT_MAC, &ret);
  3046. if (ret) {
  3047. netdev_err(netdev, "Error getting MAC stats\n");
  3048. goto out;
  3049. }
  3050. /* Get Rx stats */
  3051. cmd.req.arg[1] = adapter->recv_ctx->context_id << 16;
  3052. cmd.rsp.num = QLC_83XX_RX_STAT_REGS;
  3053. memset(cmd.rsp.arg, 0, sizeof(u32) * cmd.rsp.num);
  3054. data = qlcnic_83xx_fill_stats(adapter, &cmd, data,
  3055. QLC_83XX_STAT_RX, &ret);
  3056. if (ret)
  3057. netdev_err(netdev, "Error getting Rx stats\n");
  3058. out:
  3059. qlcnic_free_mbx_args(&cmd);
  3060. }
  3061. #define QLCNIC_83XX_ADD_PORT0 BIT_0
  3062. #define QLCNIC_83XX_ADD_PORT1 BIT_1
  3063. #define QLCNIC_83XX_EXTENDED_MEM_SIZE 13 /* In MB */
  3064. int qlcnic_83xx_extend_md_capab(struct qlcnic_adapter *adapter)
  3065. {
  3066. struct qlcnic_cmd_args cmd;
  3067. int err;
  3068. err = qlcnic_alloc_mbx_args(&cmd, adapter,
  3069. QLCNIC_CMD_83XX_EXTEND_ISCSI_DUMP_CAP);
  3070. if (err)
  3071. return err;
  3072. cmd.req.arg[1] = (QLCNIC_83XX_ADD_PORT0 | QLCNIC_83XX_ADD_PORT1);
  3073. cmd.req.arg[2] = QLCNIC_83XX_EXTENDED_MEM_SIZE;
  3074. cmd.req.arg[3] = QLCNIC_83XX_EXTENDED_MEM_SIZE;
  3075. err = qlcnic_issue_cmd(adapter, &cmd);
  3076. if (err)
  3077. dev_err(&adapter->pdev->dev,
  3078. "failed to issue extend iSCSI minidump capability\n");
  3079. return err;
  3080. }
  3081. int qlcnic_83xx_reg_test(struct qlcnic_adapter *adapter)
  3082. {
  3083. u32 major, minor, sub;
  3084. major = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MAJOR);
  3085. minor = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MINOR);
  3086. sub = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_SUB);
  3087. if (adapter->fw_version != QLCNIC_VERSION_CODE(major, minor, sub)) {
  3088. dev_info(&adapter->pdev->dev, "%s: Reg test failed\n",
  3089. __func__);
  3090. return 1;
  3091. }
  3092. return 0;
  3093. }
  3094. inline int qlcnic_83xx_get_regs_len(struct qlcnic_adapter *adapter)
  3095. {
  3096. return (ARRAY_SIZE(qlcnic_83xx_ext_reg_tbl) *
  3097. sizeof(*adapter->ahw->ext_reg_tbl)) +
  3098. (ARRAY_SIZE(qlcnic_83xx_reg_tbl) *
  3099. sizeof(*adapter->ahw->reg_tbl));
  3100. }
  3101. int qlcnic_83xx_get_registers(struct qlcnic_adapter *adapter, u32 *regs_buff)
  3102. {
  3103. int i, j = 0;
  3104. for (i = QLCNIC_DEV_INFO_SIZE + 1;
  3105. j < ARRAY_SIZE(qlcnic_83xx_reg_tbl); i++, j++)
  3106. regs_buff[i] = QLC_SHARED_REG_RD32(adapter, j);
  3107. for (j = 0; j < ARRAY_SIZE(qlcnic_83xx_ext_reg_tbl); j++)
  3108. regs_buff[i++] = QLCRDX(adapter->ahw, j);
  3109. return i;
  3110. }
  3111. int qlcnic_83xx_interrupt_test(struct net_device *netdev)
  3112. {
  3113. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  3114. struct qlcnic_hardware_context *ahw = adapter->ahw;
  3115. struct qlcnic_cmd_args cmd;
  3116. u8 val, drv_sds_rings = adapter->drv_sds_rings;
  3117. u8 drv_tx_rings = adapter->drv_tx_rings;
  3118. u32 data;
  3119. u16 intrpt_id, id;
  3120. int ret;
  3121. if (test_bit(__QLCNIC_RESETTING, &adapter->state)) {
  3122. netdev_info(netdev, "Device is resetting\n");
  3123. return -EBUSY;
  3124. }
  3125. if (qlcnic_get_diag_lock(adapter)) {
  3126. netdev_info(netdev, "Device in diagnostics mode\n");
  3127. return -EBUSY;
  3128. }
  3129. ret = qlcnic_83xx_diag_alloc_res(netdev, QLCNIC_INTERRUPT_TEST,
  3130. drv_sds_rings);
  3131. if (ret)
  3132. goto fail_diag_irq;
  3133. ahw->diag_cnt = 0;
  3134. ret = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_INTRPT_TEST);
  3135. if (ret)
  3136. goto fail_diag_irq;
  3137. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  3138. intrpt_id = ahw->intr_tbl[0].id;
  3139. else
  3140. intrpt_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
  3141. cmd.req.arg[1] = 1;
  3142. cmd.req.arg[2] = intrpt_id;
  3143. cmd.req.arg[3] = BIT_0;
  3144. ret = qlcnic_issue_cmd(adapter, &cmd);
  3145. data = cmd.rsp.arg[2];
  3146. id = LSW(data);
  3147. val = LSB(MSW(data));
  3148. if (id != intrpt_id)
  3149. dev_info(&adapter->pdev->dev,
  3150. "Interrupt generated: 0x%x, requested:0x%x\n",
  3151. id, intrpt_id);
  3152. if (val)
  3153. dev_err(&adapter->pdev->dev,
  3154. "Interrupt test error: 0x%x\n", val);
  3155. if (ret)
  3156. goto done;
  3157. msleep(20);
  3158. ret = !ahw->diag_cnt;
  3159. done:
  3160. qlcnic_free_mbx_args(&cmd);
  3161. qlcnic_83xx_diag_free_res(netdev, drv_sds_rings);
  3162. fail_diag_irq:
  3163. adapter->drv_sds_rings = drv_sds_rings;
  3164. adapter->drv_tx_rings = drv_tx_rings;
  3165. qlcnic_release_diag_lock(adapter);
  3166. return ret;
  3167. }
  3168. void qlcnic_83xx_get_pauseparam(struct qlcnic_adapter *adapter,
  3169. struct ethtool_pauseparam *pause)
  3170. {
  3171. struct qlcnic_hardware_context *ahw = adapter->ahw;
  3172. int status = 0;
  3173. u32 config;
  3174. status = qlcnic_83xx_get_port_config(adapter);
  3175. if (status) {
  3176. dev_err(&adapter->pdev->dev,
  3177. "%s: Get Pause Config failed\n", __func__);
  3178. return;
  3179. }
  3180. config = ahw->port_config;
  3181. if (config & QLC_83XX_CFG_STD_PAUSE) {
  3182. switch (MSW(config)) {
  3183. case QLC_83XX_TX_PAUSE:
  3184. pause->tx_pause = 1;
  3185. break;
  3186. case QLC_83XX_RX_PAUSE:
  3187. pause->rx_pause = 1;
  3188. break;
  3189. case QLC_83XX_TX_RX_PAUSE:
  3190. default:
  3191. /* Backward compatibility for existing
  3192. * flash definitions
  3193. */
  3194. pause->tx_pause = 1;
  3195. pause->rx_pause = 1;
  3196. }
  3197. }
  3198. if (QLC_83XX_AUTONEG(config))
  3199. pause->autoneg = 1;
  3200. }
  3201. int qlcnic_83xx_set_pauseparam(struct qlcnic_adapter *adapter,
  3202. struct ethtool_pauseparam *pause)
  3203. {
  3204. struct qlcnic_hardware_context *ahw = adapter->ahw;
  3205. int status = 0;
  3206. u32 config;
  3207. status = qlcnic_83xx_get_port_config(adapter);
  3208. if (status) {
  3209. dev_err(&adapter->pdev->dev,
  3210. "%s: Get Pause Config failed.\n", __func__);
  3211. return status;
  3212. }
  3213. config = ahw->port_config;
  3214. if (ahw->port_type == QLCNIC_GBE) {
  3215. if (pause->autoneg)
  3216. ahw->port_config |= QLC_83XX_ENABLE_AUTONEG;
  3217. if (!pause->autoneg)
  3218. ahw->port_config &= ~QLC_83XX_ENABLE_AUTONEG;
  3219. } else if ((ahw->port_type == QLCNIC_XGBE) && (pause->autoneg)) {
  3220. return -EOPNOTSUPP;
  3221. }
  3222. if (!(config & QLC_83XX_CFG_STD_PAUSE))
  3223. ahw->port_config |= QLC_83XX_CFG_STD_PAUSE;
  3224. if (pause->rx_pause && pause->tx_pause) {
  3225. ahw->port_config |= QLC_83XX_CFG_STD_TX_RX_PAUSE;
  3226. } else if (pause->rx_pause && !pause->tx_pause) {
  3227. ahw->port_config &= ~QLC_83XX_CFG_STD_TX_PAUSE;
  3228. ahw->port_config |= QLC_83XX_CFG_STD_RX_PAUSE;
  3229. } else if (pause->tx_pause && !pause->rx_pause) {
  3230. ahw->port_config &= ~QLC_83XX_CFG_STD_RX_PAUSE;
  3231. ahw->port_config |= QLC_83XX_CFG_STD_TX_PAUSE;
  3232. } else if (!pause->rx_pause && !pause->tx_pause) {
  3233. ahw->port_config &= ~(QLC_83XX_CFG_STD_TX_RX_PAUSE |
  3234. QLC_83XX_CFG_STD_PAUSE);
  3235. }
  3236. status = qlcnic_83xx_set_port_config(adapter);
  3237. if (status) {
  3238. dev_err(&adapter->pdev->dev,
  3239. "%s: Set Pause Config failed.\n", __func__);
  3240. ahw->port_config = config;
  3241. }
  3242. return status;
  3243. }
  3244. static int qlcnic_83xx_read_flash_status_reg(struct qlcnic_adapter *adapter)
  3245. {
  3246. int ret, err = 0;
  3247. u32 temp;
  3248. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
  3249. QLC_83XX_FLASH_OEM_READ_SIG);
  3250. qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
  3251. QLC_83XX_FLASH_READ_CTRL);
  3252. ret = qlcnic_83xx_poll_flash_status_reg(adapter);
  3253. if (ret)
  3254. return -EIO;
  3255. temp = QLCRD32(adapter, QLC_83XX_FLASH_RDDATA, &err);
  3256. if (err == -EIO)
  3257. return err;
  3258. return temp & 0xFF;
  3259. }
  3260. int qlcnic_83xx_flash_test(struct qlcnic_adapter *adapter)
  3261. {
  3262. int status;
  3263. status = qlcnic_83xx_read_flash_status_reg(adapter);
  3264. if (status == -EIO) {
  3265. dev_info(&adapter->pdev->dev, "%s: EEPROM test failed.\n",
  3266. __func__);
  3267. return 1;
  3268. }
  3269. return 0;
  3270. }
  3271. static int qlcnic_83xx_shutdown(struct pci_dev *pdev)
  3272. {
  3273. struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
  3274. struct net_device *netdev = adapter->netdev;
  3275. int retval;
  3276. netif_device_detach(netdev);
  3277. qlcnic_cancel_idc_work(adapter);
  3278. if (netif_running(netdev))
  3279. qlcnic_down(adapter, netdev);
  3280. qlcnic_83xx_disable_mbx_intr(adapter);
  3281. cancel_delayed_work_sync(&adapter->idc_aen_work);
  3282. retval = pci_save_state(pdev);
  3283. if (retval)
  3284. return retval;
  3285. return 0;
  3286. }
  3287. static int qlcnic_83xx_resume(struct qlcnic_adapter *adapter)
  3288. {
  3289. struct qlcnic_hardware_context *ahw = adapter->ahw;
  3290. struct qlc_83xx_idc *idc = &ahw->idc;
  3291. int err = 0;
  3292. err = qlcnic_83xx_idc_init(adapter);
  3293. if (err)
  3294. return err;
  3295. if (ahw->nic_mode == QLCNIC_VNIC_MODE) {
  3296. if (ahw->op_mode == QLCNIC_MGMT_FUNC) {
  3297. qlcnic_83xx_set_vnic_opmode(adapter);
  3298. } else {
  3299. err = qlcnic_83xx_check_vnic_state(adapter);
  3300. if (err)
  3301. return err;
  3302. }
  3303. }
  3304. err = qlcnic_83xx_idc_reattach_driver(adapter);
  3305. if (err)
  3306. return err;
  3307. qlcnic_schedule_work(adapter, qlcnic_83xx_idc_poll_dev_state,
  3308. idc->delay);
  3309. return err;
  3310. }
  3311. void qlcnic_83xx_reinit_mbx_work(struct qlcnic_mailbox *mbx)
  3312. {
  3313. reinit_completion(&mbx->completion);
  3314. set_bit(QLC_83XX_MBX_READY, &mbx->status);
  3315. }
  3316. void qlcnic_83xx_free_mailbox(struct qlcnic_mailbox *mbx)
  3317. {
  3318. if (!mbx)
  3319. return;
  3320. destroy_workqueue(mbx->work_q);
  3321. kfree(mbx);
  3322. }
  3323. static inline void
  3324. qlcnic_83xx_notify_cmd_completion(struct qlcnic_adapter *adapter,
  3325. struct qlcnic_cmd_args *cmd)
  3326. {
  3327. atomic_set(&cmd->rsp_status, QLC_83XX_MBX_RESPONSE_ARRIVED);
  3328. if (cmd->type == QLC_83XX_MBX_CMD_NO_WAIT) {
  3329. qlcnic_free_mbx_args(cmd);
  3330. kfree(cmd);
  3331. return;
  3332. }
  3333. complete(&cmd->completion);
  3334. }
  3335. static void qlcnic_83xx_flush_mbx_queue(struct qlcnic_adapter *adapter)
  3336. {
  3337. struct qlcnic_mailbox *mbx = adapter->ahw->mailbox;
  3338. struct list_head *head = &mbx->cmd_q;
  3339. struct qlcnic_cmd_args *cmd = NULL;
  3340. spin_lock(&mbx->queue_lock);
  3341. while (!list_empty(head)) {
  3342. cmd = list_entry(head->next, struct qlcnic_cmd_args, list);
  3343. dev_info(&adapter->pdev->dev, "%s: Mailbox command 0x%x\n",
  3344. __func__, cmd->cmd_op);
  3345. list_del(&cmd->list);
  3346. mbx->num_cmds--;
  3347. qlcnic_83xx_notify_cmd_completion(adapter, cmd);
  3348. }
  3349. spin_unlock(&mbx->queue_lock);
  3350. }
  3351. static int qlcnic_83xx_check_mbx_status(struct qlcnic_adapter *adapter)
  3352. {
  3353. struct qlcnic_hardware_context *ahw = adapter->ahw;
  3354. struct qlcnic_mailbox *mbx = ahw->mailbox;
  3355. u32 host_mbx_ctrl;
  3356. if (!test_bit(QLC_83XX_MBX_READY, &mbx->status))
  3357. return -EBUSY;
  3358. host_mbx_ctrl = QLCRDX(ahw, QLCNIC_HOST_MBX_CTRL);
  3359. if (host_mbx_ctrl) {
  3360. clear_bit(QLC_83XX_MBX_READY, &mbx->status);
  3361. ahw->idc.collect_dump = 1;
  3362. return -EIO;
  3363. }
  3364. return 0;
  3365. }
  3366. static inline void qlcnic_83xx_signal_mbx_cmd(struct qlcnic_adapter *adapter,
  3367. u8 issue_cmd)
  3368. {
  3369. if (issue_cmd)
  3370. QLCWRX(adapter->ahw, QLCNIC_HOST_MBX_CTRL, QLCNIC_SET_OWNER);
  3371. else
  3372. QLCWRX(adapter->ahw, QLCNIC_FW_MBX_CTRL, QLCNIC_CLR_OWNER);
  3373. }
  3374. static void qlcnic_83xx_dequeue_mbx_cmd(struct qlcnic_adapter *adapter,
  3375. struct qlcnic_cmd_args *cmd)
  3376. {
  3377. struct qlcnic_mailbox *mbx = adapter->ahw->mailbox;
  3378. spin_lock(&mbx->queue_lock);
  3379. list_del(&cmd->list);
  3380. mbx->num_cmds--;
  3381. spin_unlock(&mbx->queue_lock);
  3382. qlcnic_83xx_notify_cmd_completion(adapter, cmd);
  3383. }
  3384. static void qlcnic_83xx_encode_mbx_cmd(struct qlcnic_adapter *adapter,
  3385. struct qlcnic_cmd_args *cmd)
  3386. {
  3387. u32 mbx_cmd, fw_hal_version, hdr_size, total_size, tmp;
  3388. struct qlcnic_hardware_context *ahw = adapter->ahw;
  3389. int i, j;
  3390. if (cmd->op_type != QLC_83XX_MBX_POST_BC_OP) {
  3391. mbx_cmd = cmd->req.arg[0];
  3392. writel(mbx_cmd, QLCNIC_MBX_HOST(ahw, 0));
  3393. for (i = 1; i < cmd->req.num; i++)
  3394. writel(cmd->req.arg[i], QLCNIC_MBX_HOST(ahw, i));
  3395. } else {
  3396. fw_hal_version = ahw->fw_hal_version;
  3397. hdr_size = sizeof(struct qlcnic_bc_hdr) / sizeof(u32);
  3398. total_size = cmd->pay_size + hdr_size;
  3399. tmp = QLCNIC_CMD_BC_EVENT_SETUP | total_size << 16;
  3400. mbx_cmd = tmp | fw_hal_version << 29;
  3401. writel(mbx_cmd, QLCNIC_MBX_HOST(ahw, 0));
  3402. /* Back channel specific operations bits */
  3403. mbx_cmd = 0x1 | 1 << 4;
  3404. if (qlcnic_sriov_pf_check(adapter))
  3405. mbx_cmd |= cmd->func_num << 5;
  3406. writel(mbx_cmd, QLCNIC_MBX_HOST(ahw, 1));
  3407. for (i = 2, j = 0; j < hdr_size; i++, j++)
  3408. writel(*(cmd->hdr++), QLCNIC_MBX_HOST(ahw, i));
  3409. for (j = 0; j < cmd->pay_size; j++, i++)
  3410. writel(*(cmd->pay++), QLCNIC_MBX_HOST(ahw, i));
  3411. }
  3412. }
  3413. void qlcnic_83xx_detach_mailbox_work(struct qlcnic_adapter *adapter)
  3414. {
  3415. struct qlcnic_mailbox *mbx = adapter->ahw->mailbox;
  3416. if (!mbx)
  3417. return;
  3418. clear_bit(QLC_83XX_MBX_READY, &mbx->status);
  3419. complete(&mbx->completion);
  3420. cancel_work_sync(&mbx->work);
  3421. flush_workqueue(mbx->work_q);
  3422. qlcnic_83xx_flush_mbx_queue(adapter);
  3423. }
  3424. static int qlcnic_83xx_enqueue_mbx_cmd(struct qlcnic_adapter *adapter,
  3425. struct qlcnic_cmd_args *cmd,
  3426. unsigned long *timeout)
  3427. {
  3428. struct qlcnic_mailbox *mbx = adapter->ahw->mailbox;
  3429. if (test_bit(QLC_83XX_MBX_READY, &mbx->status)) {
  3430. atomic_set(&cmd->rsp_status, QLC_83XX_MBX_RESPONSE_WAIT);
  3431. init_completion(&cmd->completion);
  3432. cmd->rsp_opcode = QLC_83XX_MBX_RESPONSE_UNKNOWN;
  3433. spin_lock(&mbx->queue_lock);
  3434. list_add_tail(&cmd->list, &mbx->cmd_q);
  3435. mbx->num_cmds++;
  3436. cmd->total_cmds = mbx->num_cmds;
  3437. *timeout = cmd->total_cmds * QLC_83XX_MBX_TIMEOUT;
  3438. queue_work(mbx->work_q, &mbx->work);
  3439. spin_unlock(&mbx->queue_lock);
  3440. return 0;
  3441. }
  3442. return -EBUSY;
  3443. }
  3444. static int qlcnic_83xx_check_mac_rcode(struct qlcnic_adapter *adapter,
  3445. struct qlcnic_cmd_args *cmd)
  3446. {
  3447. u8 mac_cmd_rcode;
  3448. u32 fw_data;
  3449. if (cmd->cmd_op == QLCNIC_CMD_CONFIG_MAC_VLAN) {
  3450. fw_data = readl(QLCNIC_MBX_FW(adapter->ahw, 2));
  3451. mac_cmd_rcode = (u8)fw_data;
  3452. if (mac_cmd_rcode == QLC_83XX_NO_NIC_RESOURCE ||
  3453. mac_cmd_rcode == QLC_83XX_MAC_PRESENT ||
  3454. mac_cmd_rcode == QLC_83XX_MAC_ABSENT) {
  3455. cmd->rsp_opcode = QLCNIC_RCODE_SUCCESS;
  3456. return QLCNIC_RCODE_SUCCESS;
  3457. }
  3458. }
  3459. return -EINVAL;
  3460. }
  3461. static void qlcnic_83xx_decode_mbx_rsp(struct qlcnic_adapter *adapter,
  3462. struct qlcnic_cmd_args *cmd)
  3463. {
  3464. struct qlcnic_hardware_context *ahw = adapter->ahw;
  3465. struct device *dev = &adapter->pdev->dev;
  3466. u8 mbx_err_code;
  3467. u32 fw_data;
  3468. fw_data = readl(QLCNIC_MBX_FW(ahw, 0));
  3469. mbx_err_code = QLCNIC_MBX_STATUS(fw_data);
  3470. qlcnic_83xx_get_mbx_data(adapter, cmd);
  3471. switch (mbx_err_code) {
  3472. case QLCNIC_MBX_RSP_OK:
  3473. case QLCNIC_MBX_PORT_RSP_OK:
  3474. cmd->rsp_opcode = QLCNIC_RCODE_SUCCESS;
  3475. break;
  3476. default:
  3477. if (!qlcnic_83xx_check_mac_rcode(adapter, cmd))
  3478. break;
  3479. dev_err(dev, "%s: Mailbox command failed, opcode=0x%x, cmd_type=0x%x, func=0x%x, op_mode=0x%x, error=0x%x\n",
  3480. __func__, cmd->cmd_op, cmd->type, ahw->pci_func,
  3481. ahw->op_mode, mbx_err_code);
  3482. cmd->rsp_opcode = QLC_83XX_MBX_RESPONSE_FAILED;
  3483. qlcnic_dump_mbx(adapter, cmd);
  3484. }
  3485. return;
  3486. }
  3487. static inline void qlcnic_dump_mailbox_registers(struct qlcnic_adapter *adapter)
  3488. {
  3489. struct qlcnic_hardware_context *ahw = adapter->ahw;
  3490. u32 offset;
  3491. offset = QLCRDX(ahw, QLCNIC_DEF_INT_MASK);
  3492. dev_info(&adapter->pdev->dev, "Mbx interrupt mask=0x%x, Mbx interrupt enable=0x%x, Host mbx control=0x%x, Fw mbx control=0x%x",
  3493. readl(ahw->pci_base0 + offset),
  3494. QLCRDX(ahw, QLCNIC_MBX_INTR_ENBL),
  3495. QLCRDX(ahw, QLCNIC_HOST_MBX_CTRL),
  3496. QLCRDX(ahw, QLCNIC_FW_MBX_CTRL));
  3497. }
  3498. static void qlcnic_83xx_mailbox_worker(struct work_struct *work)
  3499. {
  3500. struct qlcnic_mailbox *mbx = container_of(work, struct qlcnic_mailbox,
  3501. work);
  3502. struct qlcnic_adapter *adapter = mbx->adapter;
  3503. const struct qlcnic_mbx_ops *mbx_ops = mbx->ops;
  3504. struct device *dev = &adapter->pdev->dev;
  3505. struct list_head *head = &mbx->cmd_q;
  3506. struct qlcnic_hardware_context *ahw;
  3507. struct qlcnic_cmd_args *cmd = NULL;
  3508. unsigned long flags;
  3509. ahw = adapter->ahw;
  3510. while (true) {
  3511. if (qlcnic_83xx_check_mbx_status(adapter)) {
  3512. qlcnic_83xx_flush_mbx_queue(adapter);
  3513. return;
  3514. }
  3515. spin_lock_irqsave(&mbx->aen_lock, flags);
  3516. mbx->rsp_status = QLC_83XX_MBX_RESPONSE_WAIT;
  3517. spin_unlock_irqrestore(&mbx->aen_lock, flags);
  3518. spin_lock(&mbx->queue_lock);
  3519. if (list_empty(head)) {
  3520. spin_unlock(&mbx->queue_lock);
  3521. return;
  3522. }
  3523. cmd = list_entry(head->next, struct qlcnic_cmd_args, list);
  3524. spin_unlock(&mbx->queue_lock);
  3525. mbx_ops->encode_cmd(adapter, cmd);
  3526. mbx_ops->nofity_fw(adapter, QLC_83XX_MBX_REQUEST);
  3527. if (wait_for_completion_timeout(&mbx->completion,
  3528. QLC_83XX_MBX_TIMEOUT)) {
  3529. mbx_ops->decode_resp(adapter, cmd);
  3530. mbx_ops->nofity_fw(adapter, QLC_83XX_MBX_COMPLETION);
  3531. } else {
  3532. dev_err(dev, "%s: Mailbox command timeout, opcode=0x%x, cmd_type=0x%x, func=0x%x, op_mode=0x%x\n",
  3533. __func__, cmd->cmd_op, cmd->type, ahw->pci_func,
  3534. ahw->op_mode);
  3535. clear_bit(QLC_83XX_MBX_READY, &mbx->status);
  3536. qlcnic_dump_mailbox_registers(adapter);
  3537. qlcnic_83xx_get_mbx_data(adapter, cmd);
  3538. qlcnic_dump_mbx(adapter, cmd);
  3539. qlcnic_83xx_idc_request_reset(adapter,
  3540. QLCNIC_FORCE_FW_DUMP_KEY);
  3541. cmd->rsp_opcode = QLCNIC_RCODE_TIMEOUT;
  3542. }
  3543. mbx_ops->dequeue_cmd(adapter, cmd);
  3544. }
  3545. }
  3546. static const struct qlcnic_mbx_ops qlcnic_83xx_mbx_ops = {
  3547. .enqueue_cmd = qlcnic_83xx_enqueue_mbx_cmd,
  3548. .dequeue_cmd = qlcnic_83xx_dequeue_mbx_cmd,
  3549. .decode_resp = qlcnic_83xx_decode_mbx_rsp,
  3550. .encode_cmd = qlcnic_83xx_encode_mbx_cmd,
  3551. .nofity_fw = qlcnic_83xx_signal_mbx_cmd,
  3552. };
  3553. int qlcnic_83xx_init_mailbox_work(struct qlcnic_adapter *adapter)
  3554. {
  3555. struct qlcnic_hardware_context *ahw = adapter->ahw;
  3556. struct qlcnic_mailbox *mbx;
  3557. ahw->mailbox = kzalloc(sizeof(*mbx), GFP_KERNEL);
  3558. if (!ahw->mailbox)
  3559. return -ENOMEM;
  3560. mbx = ahw->mailbox;
  3561. mbx->ops = &qlcnic_83xx_mbx_ops;
  3562. mbx->adapter = adapter;
  3563. spin_lock_init(&mbx->queue_lock);
  3564. spin_lock_init(&mbx->aen_lock);
  3565. INIT_LIST_HEAD(&mbx->cmd_q);
  3566. init_completion(&mbx->completion);
  3567. mbx->work_q = create_singlethread_workqueue("qlcnic_mailbox");
  3568. if (mbx->work_q == NULL) {
  3569. kfree(mbx);
  3570. return -ENOMEM;
  3571. }
  3572. INIT_WORK(&mbx->work, qlcnic_83xx_mailbox_worker);
  3573. set_bit(QLC_83XX_MBX_READY, &mbx->status);
  3574. return 0;
  3575. }
  3576. static pci_ers_result_t qlcnic_83xx_io_error_detected(struct pci_dev *pdev,
  3577. pci_channel_state_t state)
  3578. {
  3579. struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
  3580. if (state == pci_channel_io_perm_failure)
  3581. return PCI_ERS_RESULT_DISCONNECT;
  3582. if (state == pci_channel_io_normal)
  3583. return PCI_ERS_RESULT_RECOVERED;
  3584. set_bit(__QLCNIC_AER, &adapter->state);
  3585. set_bit(__QLCNIC_RESETTING, &adapter->state);
  3586. qlcnic_83xx_aer_stop_poll_work(adapter);
  3587. pci_save_state(pdev);
  3588. pci_disable_device(pdev);
  3589. return PCI_ERS_RESULT_NEED_RESET;
  3590. }
  3591. static pci_ers_result_t qlcnic_83xx_io_slot_reset(struct pci_dev *pdev)
  3592. {
  3593. struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
  3594. int err = 0;
  3595. pdev->error_state = pci_channel_io_normal;
  3596. err = pci_enable_device(pdev);
  3597. if (err)
  3598. goto disconnect;
  3599. pci_set_power_state(pdev, PCI_D0);
  3600. pci_set_master(pdev);
  3601. pci_restore_state(pdev);
  3602. err = qlcnic_83xx_aer_reset(adapter);
  3603. if (err == 0)
  3604. return PCI_ERS_RESULT_RECOVERED;
  3605. disconnect:
  3606. clear_bit(__QLCNIC_AER, &adapter->state);
  3607. clear_bit(__QLCNIC_RESETTING, &adapter->state);
  3608. return PCI_ERS_RESULT_DISCONNECT;
  3609. }
  3610. static void qlcnic_83xx_io_resume(struct pci_dev *pdev)
  3611. {
  3612. struct qlcnic_adapter *adapter = pci_get_drvdata(pdev);
  3613. pci_cleanup_aer_uncorrect_error_status(pdev);
  3614. if (test_and_clear_bit(__QLCNIC_AER, &adapter->state))
  3615. qlcnic_83xx_aer_start_poll_work(adapter);
  3616. }