bfad_bsg.c 97 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431243224332434243524362437243824392440244124422443244424452446244724482449245024512452245324542455245624572458245924602461246224632464246524662467246824692470247124722473247424752476247724782479248024812482248324842485248624872488248924902491249224932494249524962497249824992500250125022503250425052506250725082509251025112512251325142515251625172518251925202521252225232524252525262527252825292530253125322533253425352536253725382539254025412542254325442545254625472548254925502551255225532554255525562557255825592560256125622563256425652566256725682569257025712572257325742575257625772578257925802581258225832584258525862587258825892590259125922593259425952596259725982599260026012602260326042605260626072608260926102611261226132614261526162617261826192620262126222623262426252626262726282629263026312632263326342635263626372638263926402641264226432644264526462647264826492650265126522653265426552656265726582659266026612662266326642665266626672668266926702671267226732674267526762677267826792680268126822683268426852686268726882689269026912692269326942695269626972698269927002701270227032704270527062707270827092710271127122713271427152716271727182719272027212722272327242725272627272728272927302731273227332734273527362737273827392740274127422743274427452746274727482749275027512752275327542755275627572758275927602761276227632764276527662767276827692770277127722773277427752776277727782779278027812782278327842785278627872788278927902791279227932794279527962797279827992800280128022803280428052806280728082809281028112812281328142815281628172818281928202821282228232824282528262827282828292830283128322833283428352836283728382839284028412842284328442845284628472848284928502851285228532854285528562857285828592860286128622863286428652866286728682869287028712872287328742875287628772878287928802881288228832884288528862887288828892890289128922893289428952896289728982899290029012902290329042905290629072908290929102911291229132914291529162917291829192920292129222923292429252926292729282929293029312932293329342935293629372938293929402941294229432944294529462947294829492950295129522953295429552956295729582959296029612962296329642965296629672968296929702971297229732974297529762977297829792980298129822983298429852986298729882989299029912992299329942995299629972998299930003001300230033004300530063007300830093010301130123013301430153016301730183019302030213022302330243025302630273028302930303031303230333034303530363037303830393040304130423043304430453046304730483049305030513052305330543055305630573058305930603061306230633064306530663067306830693070307130723073307430753076307730783079308030813082308330843085308630873088308930903091309230933094309530963097309830993100310131023103310431053106310731083109311031113112311331143115311631173118311931203121312231233124312531263127312831293130313131323133313431353136313731383139314031413142314331443145314631473148314931503151315231533154315531563157315831593160316131623163316431653166316731683169317031713172317331743175317631773178317931803181318231833184318531863187318831893190319131923193319431953196319731983199320032013202320332043205320632073208320932103211321232133214321532163217321832193220322132223223322432253226322732283229323032313232323332343235323632373238323932403241324232433244324532463247324832493250325132523253325432553256325732583259326032613262326332643265326632673268326932703271327232733274327532763277327832793280328132823283328432853286328732883289329032913292329332943295329632973298329933003301330233033304330533063307330833093310331133123313331433153316331733183319332033213322332333243325332633273328332933303331333233333334333533363337333833393340334133423343334433453346334733483349335033513352335333543355335633573358335933603361336233633364336533663367336833693370337133723373337433753376337733783379338033813382338333843385338633873388338933903391339233933394339533963397339833993400340134023403340434053406340734083409341034113412341334143415341634173418341934203421342234233424342534263427342834293430343134323433343434353436343734383439344034413442344334443445344634473448344934503451345234533454345534563457345834593460346134623463346434653466346734683469347034713472347334743475347634773478347934803481348234833484348534863487348834893490349134923493349434953496349734983499350035013502350335043505350635073508350935103511351235133514351535163517351835193520352135223523352435253526352735283529353035313532353335343535353635373538353935403541354235433544354535463547354835493550355135523553355435553556355735583559356035613562356335643565356635673568356935703571357235733574357535763577357835793580358135823583358435853586
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2005-2014 Brocade Communications Systems, Inc.
  4. * Copyright (c) 2014- QLogic Corporation.
  5. * All rights reserved
  6. * www.qlogic.com
  7. *
  8. * Linux driver for QLogic BR-series Fibre Channel Host Bus Adapter.
  9. */
  10. #include <linux/uaccess.h>
  11. #include "bfad_drv.h"
  12. #include "bfad_im.h"
  13. #include "bfad_bsg.h"
  14. BFA_TRC_FILE(LDRV, BSG);
  15. static int
  16. bfad_iocmd_ioc_enable(struct bfad_s *bfad, void *cmd)
  17. {
  18. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  19. unsigned long flags;
  20. spin_lock_irqsave(&bfad->bfad_lock, flags);
  21. /* If IOC is not in disabled state - return */
  22. if (!bfa_ioc_is_disabled(&bfad->bfa.ioc)) {
  23. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  24. iocmd->status = BFA_STATUS_OK;
  25. return 0;
  26. }
  27. init_completion(&bfad->enable_comp);
  28. bfa_iocfc_enable(&bfad->bfa);
  29. iocmd->status = BFA_STATUS_OK;
  30. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  31. wait_for_completion(&bfad->enable_comp);
  32. return 0;
  33. }
  34. static int
  35. bfad_iocmd_ioc_disable(struct bfad_s *bfad, void *cmd)
  36. {
  37. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  38. unsigned long flags;
  39. spin_lock_irqsave(&bfad->bfad_lock, flags);
  40. if (bfa_ioc_is_disabled(&bfad->bfa.ioc)) {
  41. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  42. iocmd->status = BFA_STATUS_OK;
  43. return 0;
  44. }
  45. if (bfad->disable_active) {
  46. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  47. return -EBUSY;
  48. }
  49. bfad->disable_active = BFA_TRUE;
  50. init_completion(&bfad->disable_comp);
  51. bfa_iocfc_disable(&bfad->bfa);
  52. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  53. wait_for_completion(&bfad->disable_comp);
  54. bfad->disable_active = BFA_FALSE;
  55. iocmd->status = BFA_STATUS_OK;
  56. return 0;
  57. }
  58. static int
  59. bfad_iocmd_ioc_get_info(struct bfad_s *bfad, void *cmd)
  60. {
  61. int i;
  62. struct bfa_bsg_ioc_info_s *iocmd = (struct bfa_bsg_ioc_info_s *)cmd;
  63. struct bfad_im_port_s *im_port;
  64. struct bfa_port_attr_s pattr;
  65. unsigned long flags;
  66. spin_lock_irqsave(&bfad->bfad_lock, flags);
  67. bfa_fcport_get_attr(&bfad->bfa, &pattr);
  68. iocmd->nwwn = pattr.nwwn;
  69. iocmd->pwwn = pattr.pwwn;
  70. iocmd->ioc_type = bfa_get_type(&bfad->bfa);
  71. iocmd->mac = bfa_get_mac(&bfad->bfa);
  72. iocmd->factory_mac = bfa_get_mfg_mac(&bfad->bfa);
  73. bfa_get_adapter_serial_num(&bfad->bfa, iocmd->serialnum);
  74. iocmd->factorynwwn = pattr.factorynwwn;
  75. iocmd->factorypwwn = pattr.factorypwwn;
  76. iocmd->bfad_num = bfad->inst_no;
  77. im_port = bfad->pport.im_port;
  78. iocmd->host = im_port->shost->host_no;
  79. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  80. strcpy(iocmd->name, bfad->adapter_name);
  81. strcpy(iocmd->port_name, bfad->port_name);
  82. strcpy(iocmd->hwpath, bfad->pci_name);
  83. /* set adapter hw path */
  84. strcpy(iocmd->adapter_hwpath, bfad->pci_name);
  85. for (i = 0; iocmd->adapter_hwpath[i] != ':' && i < BFA_STRING_32; i++)
  86. ;
  87. for (; iocmd->adapter_hwpath[++i] != ':' && i < BFA_STRING_32; )
  88. ;
  89. iocmd->adapter_hwpath[i] = '\0';
  90. iocmd->status = BFA_STATUS_OK;
  91. return 0;
  92. }
  93. static int
  94. bfad_iocmd_ioc_get_attr(struct bfad_s *bfad, void *cmd)
  95. {
  96. struct bfa_bsg_ioc_attr_s *iocmd = (struct bfa_bsg_ioc_attr_s *)cmd;
  97. unsigned long flags;
  98. spin_lock_irqsave(&bfad->bfad_lock, flags);
  99. bfa_ioc_get_attr(&bfad->bfa.ioc, &iocmd->ioc_attr);
  100. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  101. /* fill in driver attr info */
  102. strcpy(iocmd->ioc_attr.driver_attr.driver, BFAD_DRIVER_NAME);
  103. strlcpy(iocmd->ioc_attr.driver_attr.driver_ver,
  104. BFAD_DRIVER_VERSION, BFA_VERSION_LEN);
  105. strcpy(iocmd->ioc_attr.driver_attr.fw_ver,
  106. iocmd->ioc_attr.adapter_attr.fw_ver);
  107. strcpy(iocmd->ioc_attr.driver_attr.bios_ver,
  108. iocmd->ioc_attr.adapter_attr.optrom_ver);
  109. /* copy chip rev info first otherwise it will be overwritten */
  110. memcpy(bfad->pci_attr.chip_rev, iocmd->ioc_attr.pci_attr.chip_rev,
  111. sizeof(bfad->pci_attr.chip_rev));
  112. memcpy(&iocmd->ioc_attr.pci_attr, &bfad->pci_attr,
  113. sizeof(struct bfa_ioc_pci_attr_s));
  114. iocmd->status = BFA_STATUS_OK;
  115. return 0;
  116. }
  117. static int
  118. bfad_iocmd_ioc_get_stats(struct bfad_s *bfad, void *cmd)
  119. {
  120. struct bfa_bsg_ioc_stats_s *iocmd = (struct bfa_bsg_ioc_stats_s *)cmd;
  121. bfa_ioc_get_stats(&bfad->bfa, &iocmd->ioc_stats);
  122. iocmd->status = BFA_STATUS_OK;
  123. return 0;
  124. }
  125. static int
  126. bfad_iocmd_ioc_get_fwstats(struct bfad_s *bfad, void *cmd,
  127. unsigned int payload_len)
  128. {
  129. struct bfa_bsg_ioc_fwstats_s *iocmd =
  130. (struct bfa_bsg_ioc_fwstats_s *)cmd;
  131. void *iocmd_bufptr;
  132. unsigned long flags;
  133. if (bfad_chk_iocmd_sz(payload_len,
  134. sizeof(struct bfa_bsg_ioc_fwstats_s),
  135. sizeof(struct bfa_fw_stats_s)) != BFA_STATUS_OK) {
  136. iocmd->status = BFA_STATUS_VERSION_FAIL;
  137. goto out;
  138. }
  139. iocmd_bufptr = (char *)iocmd + sizeof(struct bfa_bsg_ioc_fwstats_s);
  140. spin_lock_irqsave(&bfad->bfad_lock, flags);
  141. iocmd->status = bfa_ioc_fw_stats_get(&bfad->bfa.ioc, iocmd_bufptr);
  142. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  143. if (iocmd->status != BFA_STATUS_OK) {
  144. bfa_trc(bfad, iocmd->status);
  145. goto out;
  146. }
  147. out:
  148. bfa_trc(bfad, 0x6666);
  149. return 0;
  150. }
  151. static int
  152. bfad_iocmd_ioc_reset_stats(struct bfad_s *bfad, void *cmd, unsigned int v_cmd)
  153. {
  154. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  155. unsigned long flags;
  156. if (v_cmd == IOCMD_IOC_RESET_STATS) {
  157. bfa_ioc_clear_stats(&bfad->bfa);
  158. iocmd->status = BFA_STATUS_OK;
  159. } else if (v_cmd == IOCMD_IOC_RESET_FWSTATS) {
  160. spin_lock_irqsave(&bfad->bfad_lock, flags);
  161. iocmd->status = bfa_ioc_fw_stats_clear(&bfad->bfa.ioc);
  162. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  163. }
  164. return 0;
  165. }
  166. static int
  167. bfad_iocmd_ioc_set_name(struct bfad_s *bfad, void *cmd, unsigned int v_cmd)
  168. {
  169. struct bfa_bsg_ioc_name_s *iocmd = (struct bfa_bsg_ioc_name_s *) cmd;
  170. if (v_cmd == IOCMD_IOC_SET_ADAPTER_NAME)
  171. strcpy(bfad->adapter_name, iocmd->name);
  172. else if (v_cmd == IOCMD_IOC_SET_PORT_NAME)
  173. strcpy(bfad->port_name, iocmd->name);
  174. iocmd->status = BFA_STATUS_OK;
  175. return 0;
  176. }
  177. static int
  178. bfad_iocmd_iocfc_get_attr(struct bfad_s *bfad, void *cmd)
  179. {
  180. struct bfa_bsg_iocfc_attr_s *iocmd = (struct bfa_bsg_iocfc_attr_s *)cmd;
  181. iocmd->status = BFA_STATUS_OK;
  182. bfa_iocfc_get_attr(&bfad->bfa, &iocmd->iocfc_attr);
  183. return 0;
  184. }
  185. static int
  186. bfad_iocmd_ioc_fw_sig_inv(struct bfad_s *bfad, void *cmd)
  187. {
  188. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  189. unsigned long flags;
  190. spin_lock_irqsave(&bfad->bfad_lock, flags);
  191. iocmd->status = bfa_ioc_fwsig_invalidate(&bfad->bfa.ioc);
  192. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  193. return 0;
  194. }
  195. static int
  196. bfad_iocmd_iocfc_set_intr(struct bfad_s *bfad, void *cmd)
  197. {
  198. struct bfa_bsg_iocfc_intr_s *iocmd = (struct bfa_bsg_iocfc_intr_s *)cmd;
  199. unsigned long flags;
  200. spin_lock_irqsave(&bfad->bfad_lock, flags);
  201. iocmd->status = bfa_iocfc_israttr_set(&bfad->bfa, &iocmd->attr);
  202. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  203. return 0;
  204. }
  205. static int
  206. bfad_iocmd_port_enable(struct bfad_s *bfad, void *cmd)
  207. {
  208. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  209. struct bfad_hal_comp fcomp;
  210. unsigned long flags;
  211. init_completion(&fcomp.comp);
  212. spin_lock_irqsave(&bfad->bfad_lock, flags);
  213. iocmd->status = bfa_port_enable(&bfad->bfa.modules.port,
  214. bfad_hcb_comp, &fcomp);
  215. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  216. if (iocmd->status != BFA_STATUS_OK) {
  217. bfa_trc(bfad, iocmd->status);
  218. return 0;
  219. }
  220. wait_for_completion(&fcomp.comp);
  221. iocmd->status = fcomp.status;
  222. return 0;
  223. }
  224. static int
  225. bfad_iocmd_port_disable(struct bfad_s *bfad, void *cmd)
  226. {
  227. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  228. struct bfad_hal_comp fcomp;
  229. unsigned long flags;
  230. init_completion(&fcomp.comp);
  231. spin_lock_irqsave(&bfad->bfad_lock, flags);
  232. iocmd->status = bfa_port_disable(&bfad->bfa.modules.port,
  233. bfad_hcb_comp, &fcomp);
  234. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  235. if (iocmd->status != BFA_STATUS_OK) {
  236. bfa_trc(bfad, iocmd->status);
  237. return 0;
  238. }
  239. wait_for_completion(&fcomp.comp);
  240. iocmd->status = fcomp.status;
  241. return 0;
  242. }
  243. static int
  244. bfad_iocmd_port_get_attr(struct bfad_s *bfad, void *cmd)
  245. {
  246. struct bfa_bsg_port_attr_s *iocmd = (struct bfa_bsg_port_attr_s *)cmd;
  247. struct bfa_lport_attr_s port_attr;
  248. unsigned long flags;
  249. spin_lock_irqsave(&bfad->bfad_lock, flags);
  250. bfa_fcport_get_attr(&bfad->bfa, &iocmd->attr);
  251. bfa_fcs_lport_get_attr(&bfad->bfa_fcs.fabric.bport, &port_attr);
  252. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  253. if (iocmd->attr.topology != BFA_PORT_TOPOLOGY_NONE)
  254. iocmd->attr.pid = port_attr.pid;
  255. else
  256. iocmd->attr.pid = 0;
  257. iocmd->attr.port_type = port_attr.port_type;
  258. iocmd->attr.loopback = port_attr.loopback;
  259. iocmd->attr.authfail = port_attr.authfail;
  260. strlcpy(iocmd->attr.port_symname.symname,
  261. port_attr.port_cfg.sym_name.symname,
  262. sizeof(iocmd->attr.port_symname.symname));
  263. iocmd->status = BFA_STATUS_OK;
  264. return 0;
  265. }
  266. static int
  267. bfad_iocmd_port_get_stats(struct bfad_s *bfad, void *cmd,
  268. unsigned int payload_len)
  269. {
  270. struct bfa_bsg_port_stats_s *iocmd = (struct bfa_bsg_port_stats_s *)cmd;
  271. struct bfad_hal_comp fcomp;
  272. void *iocmd_bufptr;
  273. unsigned long flags;
  274. if (bfad_chk_iocmd_sz(payload_len,
  275. sizeof(struct bfa_bsg_port_stats_s),
  276. sizeof(union bfa_port_stats_u)) != BFA_STATUS_OK) {
  277. iocmd->status = BFA_STATUS_VERSION_FAIL;
  278. return 0;
  279. }
  280. iocmd_bufptr = (char *)iocmd + sizeof(struct bfa_bsg_port_stats_s);
  281. init_completion(&fcomp.comp);
  282. spin_lock_irqsave(&bfad->bfad_lock, flags);
  283. iocmd->status = bfa_port_get_stats(&bfad->bfa.modules.port,
  284. iocmd_bufptr, bfad_hcb_comp, &fcomp);
  285. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  286. if (iocmd->status != BFA_STATUS_OK) {
  287. bfa_trc(bfad, iocmd->status);
  288. goto out;
  289. }
  290. wait_for_completion(&fcomp.comp);
  291. iocmd->status = fcomp.status;
  292. out:
  293. return 0;
  294. }
  295. static int
  296. bfad_iocmd_port_reset_stats(struct bfad_s *bfad, void *cmd)
  297. {
  298. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  299. struct bfad_hal_comp fcomp;
  300. unsigned long flags;
  301. init_completion(&fcomp.comp);
  302. spin_lock_irqsave(&bfad->bfad_lock, flags);
  303. iocmd->status = bfa_port_clear_stats(&bfad->bfa.modules.port,
  304. bfad_hcb_comp, &fcomp);
  305. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  306. if (iocmd->status != BFA_STATUS_OK) {
  307. bfa_trc(bfad, iocmd->status);
  308. return 0;
  309. }
  310. wait_for_completion(&fcomp.comp);
  311. iocmd->status = fcomp.status;
  312. return 0;
  313. }
  314. static int
  315. bfad_iocmd_set_port_cfg(struct bfad_s *bfad, void *iocmd, unsigned int v_cmd)
  316. {
  317. struct bfa_bsg_port_cfg_s *cmd = (struct bfa_bsg_port_cfg_s *)iocmd;
  318. unsigned long flags;
  319. spin_lock_irqsave(&bfad->bfad_lock, flags);
  320. if (v_cmd == IOCMD_PORT_CFG_TOPO)
  321. cmd->status = bfa_fcport_cfg_topology(&bfad->bfa, cmd->param);
  322. else if (v_cmd == IOCMD_PORT_CFG_SPEED)
  323. cmd->status = bfa_fcport_cfg_speed(&bfad->bfa, cmd->param);
  324. else if (v_cmd == IOCMD_PORT_CFG_ALPA)
  325. cmd->status = bfa_fcport_cfg_hardalpa(&bfad->bfa, cmd->param);
  326. else if (v_cmd == IOCMD_PORT_CLR_ALPA)
  327. cmd->status = bfa_fcport_clr_hardalpa(&bfad->bfa);
  328. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  329. return 0;
  330. }
  331. static int
  332. bfad_iocmd_port_cfg_maxfrsize(struct bfad_s *bfad, void *cmd)
  333. {
  334. struct bfa_bsg_port_cfg_maxfrsize_s *iocmd =
  335. (struct bfa_bsg_port_cfg_maxfrsize_s *)cmd;
  336. unsigned long flags;
  337. spin_lock_irqsave(&bfad->bfad_lock, flags);
  338. iocmd->status = bfa_fcport_cfg_maxfrsize(&bfad->bfa, iocmd->maxfrsize);
  339. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  340. return 0;
  341. }
  342. static int
  343. bfad_iocmd_port_cfg_bbcr(struct bfad_s *bfad, unsigned int cmd, void *pcmd)
  344. {
  345. struct bfa_bsg_bbcr_enable_s *iocmd =
  346. (struct bfa_bsg_bbcr_enable_s *)pcmd;
  347. unsigned long flags;
  348. int rc;
  349. spin_lock_irqsave(&bfad->bfad_lock, flags);
  350. if (cmd == IOCMD_PORT_BBCR_ENABLE)
  351. rc = bfa_fcport_cfg_bbcr(&bfad->bfa, BFA_TRUE, iocmd->bb_scn);
  352. else if (cmd == IOCMD_PORT_BBCR_DISABLE)
  353. rc = bfa_fcport_cfg_bbcr(&bfad->bfa, BFA_FALSE, 0);
  354. else {
  355. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  356. return -EINVAL;
  357. }
  358. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  359. iocmd->status = rc;
  360. return 0;
  361. }
  362. static int
  363. bfad_iocmd_port_get_bbcr_attr(struct bfad_s *bfad, void *pcmd)
  364. {
  365. struct bfa_bsg_bbcr_attr_s *iocmd = (struct bfa_bsg_bbcr_attr_s *) pcmd;
  366. unsigned long flags;
  367. spin_lock_irqsave(&bfad->bfad_lock, flags);
  368. iocmd->status =
  369. bfa_fcport_get_bbcr_attr(&bfad->bfa, &iocmd->attr);
  370. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  371. return 0;
  372. }
  373. static int
  374. bfad_iocmd_lport_get_attr(struct bfad_s *bfad, void *cmd)
  375. {
  376. struct bfa_fcs_lport_s *fcs_port;
  377. struct bfa_bsg_lport_attr_s *iocmd = (struct bfa_bsg_lport_attr_s *)cmd;
  378. unsigned long flags;
  379. spin_lock_irqsave(&bfad->bfad_lock, flags);
  380. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  381. iocmd->vf_id, iocmd->pwwn);
  382. if (fcs_port == NULL) {
  383. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  384. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  385. goto out;
  386. }
  387. bfa_fcs_lport_get_attr(fcs_port, &iocmd->port_attr);
  388. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  389. iocmd->status = BFA_STATUS_OK;
  390. out:
  391. return 0;
  392. }
  393. static int
  394. bfad_iocmd_lport_get_stats(struct bfad_s *bfad, void *cmd)
  395. {
  396. struct bfa_fcs_lport_s *fcs_port;
  397. struct bfa_bsg_lport_stats_s *iocmd =
  398. (struct bfa_bsg_lport_stats_s *)cmd;
  399. unsigned long flags;
  400. spin_lock_irqsave(&bfad->bfad_lock, flags);
  401. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  402. iocmd->vf_id, iocmd->pwwn);
  403. if (fcs_port == NULL) {
  404. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  405. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  406. goto out;
  407. }
  408. bfa_fcs_lport_get_stats(fcs_port, &iocmd->port_stats);
  409. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  410. iocmd->status = BFA_STATUS_OK;
  411. out:
  412. return 0;
  413. }
  414. static int
  415. bfad_iocmd_lport_reset_stats(struct bfad_s *bfad, void *cmd)
  416. {
  417. struct bfa_fcs_lport_s *fcs_port;
  418. struct bfa_bsg_reset_stats_s *iocmd =
  419. (struct bfa_bsg_reset_stats_s *)cmd;
  420. struct bfa_fcpim_s *fcpim = BFA_FCPIM(&bfad->bfa);
  421. struct list_head *qe, *qen;
  422. struct bfa_itnim_s *itnim;
  423. unsigned long flags;
  424. spin_lock_irqsave(&bfad->bfad_lock, flags);
  425. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  426. iocmd->vf_id, iocmd->vpwwn);
  427. if (fcs_port == NULL) {
  428. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  429. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  430. goto out;
  431. }
  432. bfa_fcs_lport_clear_stats(fcs_port);
  433. /* clear IO stats from all active itnims */
  434. list_for_each_safe(qe, qen, &fcpim->itnim_q) {
  435. itnim = (struct bfa_itnim_s *) qe;
  436. if (itnim->rport->rport_info.lp_tag != fcs_port->lp_tag)
  437. continue;
  438. bfa_itnim_clear_stats(itnim);
  439. }
  440. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  441. iocmd->status = BFA_STATUS_OK;
  442. out:
  443. return 0;
  444. }
  445. static int
  446. bfad_iocmd_lport_get_iostats(struct bfad_s *bfad, void *cmd)
  447. {
  448. struct bfa_fcs_lport_s *fcs_port;
  449. struct bfa_bsg_lport_iostats_s *iocmd =
  450. (struct bfa_bsg_lport_iostats_s *)cmd;
  451. unsigned long flags;
  452. spin_lock_irqsave(&bfad->bfad_lock, flags);
  453. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  454. iocmd->vf_id, iocmd->pwwn);
  455. if (fcs_port == NULL) {
  456. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  457. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  458. goto out;
  459. }
  460. bfa_fcpim_port_iostats(&bfad->bfa, &iocmd->iostats,
  461. fcs_port->lp_tag);
  462. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  463. iocmd->status = BFA_STATUS_OK;
  464. out:
  465. return 0;
  466. }
  467. static int
  468. bfad_iocmd_lport_get_rports(struct bfad_s *bfad, void *cmd,
  469. unsigned int payload_len)
  470. {
  471. struct bfa_bsg_lport_get_rports_s *iocmd =
  472. (struct bfa_bsg_lport_get_rports_s *)cmd;
  473. struct bfa_fcs_lport_s *fcs_port;
  474. unsigned long flags;
  475. void *iocmd_bufptr;
  476. if (iocmd->nrports == 0)
  477. return -EINVAL;
  478. if (bfad_chk_iocmd_sz(payload_len,
  479. sizeof(struct bfa_bsg_lport_get_rports_s),
  480. sizeof(struct bfa_rport_qualifier_s) * iocmd->nrports)
  481. != BFA_STATUS_OK) {
  482. iocmd->status = BFA_STATUS_VERSION_FAIL;
  483. return 0;
  484. }
  485. iocmd_bufptr = (char *)iocmd +
  486. sizeof(struct bfa_bsg_lport_get_rports_s);
  487. spin_lock_irqsave(&bfad->bfad_lock, flags);
  488. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  489. iocmd->vf_id, iocmd->pwwn);
  490. if (fcs_port == NULL) {
  491. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  492. bfa_trc(bfad, 0);
  493. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  494. goto out;
  495. }
  496. bfa_fcs_lport_get_rport_quals(fcs_port,
  497. (struct bfa_rport_qualifier_s *)iocmd_bufptr,
  498. &iocmd->nrports);
  499. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  500. iocmd->status = BFA_STATUS_OK;
  501. out:
  502. return 0;
  503. }
  504. static int
  505. bfad_iocmd_rport_get_attr(struct bfad_s *bfad, void *cmd)
  506. {
  507. struct bfa_bsg_rport_attr_s *iocmd = (struct bfa_bsg_rport_attr_s *)cmd;
  508. struct bfa_fcs_lport_s *fcs_port;
  509. struct bfa_fcs_rport_s *fcs_rport;
  510. unsigned long flags;
  511. spin_lock_irqsave(&bfad->bfad_lock, flags);
  512. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  513. iocmd->vf_id, iocmd->pwwn);
  514. if (fcs_port == NULL) {
  515. bfa_trc(bfad, 0);
  516. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  517. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  518. goto out;
  519. }
  520. if (iocmd->pid)
  521. fcs_rport = bfa_fcs_lport_get_rport_by_qualifier(fcs_port,
  522. iocmd->rpwwn, iocmd->pid);
  523. else
  524. fcs_rport = bfa_fcs_rport_lookup(fcs_port, iocmd->rpwwn);
  525. if (fcs_rport == NULL) {
  526. bfa_trc(bfad, 0);
  527. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  528. iocmd->status = BFA_STATUS_UNKNOWN_RWWN;
  529. goto out;
  530. }
  531. bfa_fcs_rport_get_attr(fcs_rport, &iocmd->attr);
  532. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  533. iocmd->status = BFA_STATUS_OK;
  534. out:
  535. return 0;
  536. }
  537. static int
  538. bfad_iocmd_rport_get_addr(struct bfad_s *bfad, void *cmd)
  539. {
  540. struct bfa_bsg_rport_scsi_addr_s *iocmd =
  541. (struct bfa_bsg_rport_scsi_addr_s *)cmd;
  542. struct bfa_fcs_lport_s *fcs_port;
  543. struct bfa_fcs_itnim_s *fcs_itnim;
  544. struct bfad_itnim_s *drv_itnim;
  545. unsigned long flags;
  546. spin_lock_irqsave(&bfad->bfad_lock, flags);
  547. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  548. iocmd->vf_id, iocmd->pwwn);
  549. if (fcs_port == NULL) {
  550. bfa_trc(bfad, 0);
  551. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  552. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  553. goto out;
  554. }
  555. fcs_itnim = bfa_fcs_itnim_lookup(fcs_port, iocmd->rpwwn);
  556. if (fcs_itnim == NULL) {
  557. bfa_trc(bfad, 0);
  558. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  559. iocmd->status = BFA_STATUS_UNKNOWN_RWWN;
  560. goto out;
  561. }
  562. drv_itnim = fcs_itnim->itnim_drv;
  563. if (drv_itnim && drv_itnim->im_port)
  564. iocmd->host = drv_itnim->im_port->shost->host_no;
  565. else {
  566. bfa_trc(bfad, 0);
  567. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  568. iocmd->status = BFA_STATUS_UNKNOWN_RWWN;
  569. goto out;
  570. }
  571. iocmd->target = drv_itnim->scsi_tgt_id;
  572. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  573. iocmd->bus = 0;
  574. iocmd->lun = 0;
  575. iocmd->status = BFA_STATUS_OK;
  576. out:
  577. return 0;
  578. }
  579. static int
  580. bfad_iocmd_rport_get_stats(struct bfad_s *bfad, void *cmd)
  581. {
  582. struct bfa_bsg_rport_stats_s *iocmd =
  583. (struct bfa_bsg_rport_stats_s *)cmd;
  584. struct bfa_fcs_lport_s *fcs_port;
  585. struct bfa_fcs_rport_s *fcs_rport;
  586. unsigned long flags;
  587. spin_lock_irqsave(&bfad->bfad_lock, flags);
  588. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  589. iocmd->vf_id, iocmd->pwwn);
  590. if (fcs_port == NULL) {
  591. bfa_trc(bfad, 0);
  592. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  593. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  594. goto out;
  595. }
  596. fcs_rport = bfa_fcs_rport_lookup(fcs_port, iocmd->rpwwn);
  597. if (fcs_rport == NULL) {
  598. bfa_trc(bfad, 0);
  599. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  600. iocmd->status = BFA_STATUS_UNKNOWN_RWWN;
  601. goto out;
  602. }
  603. memcpy((void *)&iocmd->stats, (void *)&fcs_rport->stats,
  604. sizeof(struct bfa_rport_stats_s));
  605. if (bfa_fcs_rport_get_halrport(fcs_rport)) {
  606. memcpy((void *)&iocmd->stats.hal_stats,
  607. (void *)&(bfa_fcs_rport_get_halrport(fcs_rport)->stats),
  608. sizeof(struct bfa_rport_hal_stats_s));
  609. }
  610. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  611. iocmd->status = BFA_STATUS_OK;
  612. out:
  613. return 0;
  614. }
  615. static int
  616. bfad_iocmd_rport_clr_stats(struct bfad_s *bfad, void *cmd)
  617. {
  618. struct bfa_bsg_rport_reset_stats_s *iocmd =
  619. (struct bfa_bsg_rport_reset_stats_s *)cmd;
  620. struct bfa_fcs_lport_s *fcs_port;
  621. struct bfa_fcs_rport_s *fcs_rport;
  622. struct bfa_rport_s *rport;
  623. unsigned long flags;
  624. spin_lock_irqsave(&bfad->bfad_lock, flags);
  625. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  626. iocmd->vf_id, iocmd->pwwn);
  627. if (fcs_port == NULL) {
  628. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  629. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  630. goto out;
  631. }
  632. fcs_rport = bfa_fcs_rport_lookup(fcs_port, iocmd->rpwwn);
  633. if (fcs_rport == NULL) {
  634. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  635. iocmd->status = BFA_STATUS_UNKNOWN_RWWN;
  636. goto out;
  637. }
  638. memset((char *)&fcs_rport->stats, 0, sizeof(struct bfa_rport_stats_s));
  639. rport = bfa_fcs_rport_get_halrport(fcs_rport);
  640. if (rport)
  641. memset(&rport->stats, 0, sizeof(rport->stats));
  642. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  643. iocmd->status = BFA_STATUS_OK;
  644. out:
  645. return 0;
  646. }
  647. static int
  648. bfad_iocmd_rport_set_speed(struct bfad_s *bfad, void *cmd)
  649. {
  650. struct bfa_bsg_rport_set_speed_s *iocmd =
  651. (struct bfa_bsg_rport_set_speed_s *)cmd;
  652. struct bfa_fcs_lport_s *fcs_port;
  653. struct bfa_fcs_rport_s *fcs_rport;
  654. unsigned long flags;
  655. spin_lock_irqsave(&bfad->bfad_lock, flags);
  656. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  657. iocmd->vf_id, iocmd->pwwn);
  658. if (fcs_port == NULL) {
  659. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  660. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  661. goto out;
  662. }
  663. fcs_rport = bfa_fcs_rport_lookup(fcs_port, iocmd->rpwwn);
  664. if (fcs_rport == NULL) {
  665. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  666. iocmd->status = BFA_STATUS_UNKNOWN_RWWN;
  667. goto out;
  668. }
  669. fcs_rport->rpf.assigned_speed = iocmd->speed;
  670. /* Set this speed in f/w only if the RPSC speed is not available */
  671. if (fcs_rport->rpf.rpsc_speed == BFA_PORT_SPEED_UNKNOWN)
  672. if (fcs_rport->bfa_rport)
  673. bfa_rport_speed(fcs_rport->bfa_rport, iocmd->speed);
  674. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  675. iocmd->status = BFA_STATUS_OK;
  676. out:
  677. return 0;
  678. }
  679. static int
  680. bfad_iocmd_vport_get_attr(struct bfad_s *bfad, void *cmd)
  681. {
  682. struct bfa_fcs_vport_s *fcs_vport;
  683. struct bfa_bsg_vport_attr_s *iocmd = (struct bfa_bsg_vport_attr_s *)cmd;
  684. unsigned long flags;
  685. spin_lock_irqsave(&bfad->bfad_lock, flags);
  686. fcs_vport = bfa_fcs_vport_lookup(&bfad->bfa_fcs,
  687. iocmd->vf_id, iocmd->vpwwn);
  688. if (fcs_vport == NULL) {
  689. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  690. iocmd->status = BFA_STATUS_UNKNOWN_VWWN;
  691. goto out;
  692. }
  693. bfa_fcs_vport_get_attr(fcs_vport, &iocmd->vport_attr);
  694. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  695. iocmd->status = BFA_STATUS_OK;
  696. out:
  697. return 0;
  698. }
  699. static int
  700. bfad_iocmd_vport_get_stats(struct bfad_s *bfad, void *cmd)
  701. {
  702. struct bfa_fcs_vport_s *fcs_vport;
  703. struct bfa_bsg_vport_stats_s *iocmd =
  704. (struct bfa_bsg_vport_stats_s *)cmd;
  705. unsigned long flags;
  706. spin_lock_irqsave(&bfad->bfad_lock, flags);
  707. fcs_vport = bfa_fcs_vport_lookup(&bfad->bfa_fcs,
  708. iocmd->vf_id, iocmd->vpwwn);
  709. if (fcs_vport == NULL) {
  710. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  711. iocmd->status = BFA_STATUS_UNKNOWN_VWWN;
  712. goto out;
  713. }
  714. memcpy((void *)&iocmd->vport_stats, (void *)&fcs_vport->vport_stats,
  715. sizeof(struct bfa_vport_stats_s));
  716. memcpy((void *)&iocmd->vport_stats.port_stats,
  717. (void *)&fcs_vport->lport.stats,
  718. sizeof(struct bfa_lport_stats_s));
  719. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  720. iocmd->status = BFA_STATUS_OK;
  721. out:
  722. return 0;
  723. }
  724. static int
  725. bfad_iocmd_vport_clr_stats(struct bfad_s *bfad, void *cmd)
  726. {
  727. struct bfa_fcs_vport_s *fcs_vport;
  728. struct bfa_bsg_reset_stats_s *iocmd =
  729. (struct bfa_bsg_reset_stats_s *)cmd;
  730. unsigned long flags;
  731. spin_lock_irqsave(&bfad->bfad_lock, flags);
  732. fcs_vport = bfa_fcs_vport_lookup(&bfad->bfa_fcs,
  733. iocmd->vf_id, iocmd->vpwwn);
  734. if (fcs_vport == NULL) {
  735. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  736. iocmd->status = BFA_STATUS_UNKNOWN_VWWN;
  737. goto out;
  738. }
  739. memset(&fcs_vport->vport_stats, 0, sizeof(struct bfa_vport_stats_s));
  740. memset(&fcs_vport->lport.stats, 0, sizeof(struct bfa_lport_stats_s));
  741. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  742. iocmd->status = BFA_STATUS_OK;
  743. out:
  744. return 0;
  745. }
  746. static int
  747. bfad_iocmd_fabric_get_lports(struct bfad_s *bfad, void *cmd,
  748. unsigned int payload_len)
  749. {
  750. struct bfa_bsg_fabric_get_lports_s *iocmd =
  751. (struct bfa_bsg_fabric_get_lports_s *)cmd;
  752. bfa_fcs_vf_t *fcs_vf;
  753. uint32_t nports = iocmd->nports;
  754. unsigned long flags;
  755. void *iocmd_bufptr;
  756. if (nports == 0) {
  757. iocmd->status = BFA_STATUS_EINVAL;
  758. goto out;
  759. }
  760. if (bfad_chk_iocmd_sz(payload_len,
  761. sizeof(struct bfa_bsg_fabric_get_lports_s),
  762. sizeof(wwn_t) * iocmd->nports) != BFA_STATUS_OK) {
  763. iocmd->status = BFA_STATUS_VERSION_FAIL;
  764. goto out;
  765. }
  766. iocmd_bufptr = (char *)iocmd +
  767. sizeof(struct bfa_bsg_fabric_get_lports_s);
  768. spin_lock_irqsave(&bfad->bfad_lock, flags);
  769. fcs_vf = bfa_fcs_vf_lookup(&bfad->bfa_fcs, iocmd->vf_id);
  770. if (fcs_vf == NULL) {
  771. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  772. iocmd->status = BFA_STATUS_UNKNOWN_VFID;
  773. goto out;
  774. }
  775. bfa_fcs_vf_get_ports(fcs_vf, (wwn_t *)iocmd_bufptr, &nports);
  776. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  777. iocmd->nports = nports;
  778. iocmd->status = BFA_STATUS_OK;
  779. out:
  780. return 0;
  781. }
  782. static int
  783. bfad_iocmd_qos_set_bw(struct bfad_s *bfad, void *pcmd)
  784. {
  785. struct bfa_bsg_qos_bw_s *iocmd = (struct bfa_bsg_qos_bw_s *)pcmd;
  786. unsigned long flags;
  787. spin_lock_irqsave(&bfad->bfad_lock, flags);
  788. iocmd->status = bfa_fcport_set_qos_bw(&bfad->bfa, &iocmd->qos_bw);
  789. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  790. return 0;
  791. }
  792. static int
  793. bfad_iocmd_ratelim(struct bfad_s *bfad, unsigned int cmd, void *pcmd)
  794. {
  795. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)pcmd;
  796. struct bfa_fcport_s *fcport = BFA_FCPORT_MOD(&bfad->bfa);
  797. unsigned long flags;
  798. spin_lock_irqsave(&bfad->bfad_lock, flags);
  799. if ((fcport->cfg.topology == BFA_PORT_TOPOLOGY_LOOP) &&
  800. (fcport->topology == BFA_PORT_TOPOLOGY_LOOP))
  801. iocmd->status = BFA_STATUS_TOPOLOGY_LOOP;
  802. else {
  803. if (cmd == IOCMD_RATELIM_ENABLE)
  804. fcport->cfg.ratelimit = BFA_TRUE;
  805. else if (cmd == IOCMD_RATELIM_DISABLE)
  806. fcport->cfg.ratelimit = BFA_FALSE;
  807. if (fcport->cfg.trl_def_speed == BFA_PORT_SPEED_UNKNOWN)
  808. fcport->cfg.trl_def_speed = BFA_PORT_SPEED_1GBPS;
  809. iocmd->status = BFA_STATUS_OK;
  810. }
  811. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  812. return 0;
  813. }
  814. static int
  815. bfad_iocmd_ratelim_speed(struct bfad_s *bfad, unsigned int cmd, void *pcmd)
  816. {
  817. struct bfa_bsg_trl_speed_s *iocmd = (struct bfa_bsg_trl_speed_s *)pcmd;
  818. struct bfa_fcport_s *fcport = BFA_FCPORT_MOD(&bfad->bfa);
  819. unsigned long flags;
  820. spin_lock_irqsave(&bfad->bfad_lock, flags);
  821. /* Auto and speeds greater than the supported speed, are invalid */
  822. if ((iocmd->speed == BFA_PORT_SPEED_AUTO) ||
  823. (iocmd->speed > fcport->speed_sup)) {
  824. iocmd->status = BFA_STATUS_UNSUPP_SPEED;
  825. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  826. return 0;
  827. }
  828. if ((fcport->cfg.topology == BFA_PORT_TOPOLOGY_LOOP) &&
  829. (fcport->topology == BFA_PORT_TOPOLOGY_LOOP))
  830. iocmd->status = BFA_STATUS_TOPOLOGY_LOOP;
  831. else {
  832. fcport->cfg.trl_def_speed = iocmd->speed;
  833. iocmd->status = BFA_STATUS_OK;
  834. }
  835. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  836. return 0;
  837. }
  838. static int
  839. bfad_iocmd_cfg_fcpim(struct bfad_s *bfad, void *cmd)
  840. {
  841. struct bfa_bsg_fcpim_s *iocmd = (struct bfa_bsg_fcpim_s *)cmd;
  842. unsigned long flags;
  843. spin_lock_irqsave(&bfad->bfad_lock, flags);
  844. bfa_fcpim_path_tov_set(&bfad->bfa, iocmd->param);
  845. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  846. iocmd->status = BFA_STATUS_OK;
  847. return 0;
  848. }
  849. static int
  850. bfad_iocmd_fcpim_get_modstats(struct bfad_s *bfad, void *cmd)
  851. {
  852. struct bfa_bsg_fcpim_modstats_s *iocmd =
  853. (struct bfa_bsg_fcpim_modstats_s *)cmd;
  854. struct bfa_fcpim_s *fcpim = BFA_FCPIM(&bfad->bfa);
  855. struct list_head *qe, *qen;
  856. struct bfa_itnim_s *itnim;
  857. unsigned long flags;
  858. spin_lock_irqsave(&bfad->bfad_lock, flags);
  859. /* accumulate IO stats from itnim */
  860. memset((void *)&iocmd->modstats, 0, sizeof(struct bfa_itnim_iostats_s));
  861. list_for_each_safe(qe, qen, &fcpim->itnim_q) {
  862. itnim = (struct bfa_itnim_s *) qe;
  863. bfa_fcpim_add_stats(&iocmd->modstats, &(itnim->stats));
  864. }
  865. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  866. iocmd->status = BFA_STATUS_OK;
  867. return 0;
  868. }
  869. static int
  870. bfad_iocmd_fcpim_clr_modstats(struct bfad_s *bfad, void *cmd)
  871. {
  872. struct bfa_bsg_fcpim_modstatsclr_s *iocmd =
  873. (struct bfa_bsg_fcpim_modstatsclr_s *)cmd;
  874. struct bfa_fcpim_s *fcpim = BFA_FCPIM(&bfad->bfa);
  875. struct list_head *qe, *qen;
  876. struct bfa_itnim_s *itnim;
  877. unsigned long flags;
  878. spin_lock_irqsave(&bfad->bfad_lock, flags);
  879. list_for_each_safe(qe, qen, &fcpim->itnim_q) {
  880. itnim = (struct bfa_itnim_s *) qe;
  881. bfa_itnim_clear_stats(itnim);
  882. }
  883. memset(&fcpim->del_itn_stats, 0,
  884. sizeof(struct bfa_fcpim_del_itn_stats_s));
  885. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  886. iocmd->status = BFA_STATUS_OK;
  887. return 0;
  888. }
  889. static int
  890. bfad_iocmd_fcpim_get_del_itn_stats(struct bfad_s *bfad, void *cmd)
  891. {
  892. struct bfa_bsg_fcpim_del_itn_stats_s *iocmd =
  893. (struct bfa_bsg_fcpim_del_itn_stats_s *)cmd;
  894. struct bfa_fcpim_s *fcpim = BFA_FCPIM(&bfad->bfa);
  895. unsigned long flags;
  896. spin_lock_irqsave(&bfad->bfad_lock, flags);
  897. memcpy((void *)&iocmd->modstats, (void *)&fcpim->del_itn_stats,
  898. sizeof(struct bfa_fcpim_del_itn_stats_s));
  899. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  900. iocmd->status = BFA_STATUS_OK;
  901. return 0;
  902. }
  903. static int
  904. bfad_iocmd_itnim_get_attr(struct bfad_s *bfad, void *cmd)
  905. {
  906. struct bfa_bsg_itnim_attr_s *iocmd = (struct bfa_bsg_itnim_attr_s *)cmd;
  907. struct bfa_fcs_lport_s *fcs_port;
  908. unsigned long flags;
  909. spin_lock_irqsave(&bfad->bfad_lock, flags);
  910. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  911. iocmd->vf_id, iocmd->lpwwn);
  912. if (!fcs_port)
  913. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  914. else
  915. iocmd->status = bfa_fcs_itnim_attr_get(fcs_port,
  916. iocmd->rpwwn, &iocmd->attr);
  917. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  918. return 0;
  919. }
  920. static int
  921. bfad_iocmd_itnim_get_iostats(struct bfad_s *bfad, void *cmd)
  922. {
  923. struct bfa_bsg_itnim_iostats_s *iocmd =
  924. (struct bfa_bsg_itnim_iostats_s *)cmd;
  925. struct bfa_fcs_lport_s *fcs_port;
  926. struct bfa_fcs_itnim_s *itnim;
  927. unsigned long flags;
  928. spin_lock_irqsave(&bfad->bfad_lock, flags);
  929. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  930. iocmd->vf_id, iocmd->lpwwn);
  931. if (!fcs_port) {
  932. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  933. bfa_trc(bfad, 0);
  934. } else {
  935. itnim = bfa_fcs_itnim_lookup(fcs_port, iocmd->rpwwn);
  936. if (itnim == NULL)
  937. iocmd->status = BFA_STATUS_UNKNOWN_RWWN;
  938. else {
  939. iocmd->status = BFA_STATUS_OK;
  940. if (bfa_fcs_itnim_get_halitn(itnim))
  941. memcpy((void *)&iocmd->iostats, (void *)
  942. &(bfa_fcs_itnim_get_halitn(itnim)->stats),
  943. sizeof(struct bfa_itnim_iostats_s));
  944. }
  945. }
  946. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  947. return 0;
  948. }
  949. static int
  950. bfad_iocmd_itnim_reset_stats(struct bfad_s *bfad, void *cmd)
  951. {
  952. struct bfa_bsg_rport_reset_stats_s *iocmd =
  953. (struct bfa_bsg_rport_reset_stats_s *)cmd;
  954. struct bfa_fcs_lport_s *fcs_port;
  955. struct bfa_fcs_itnim_s *itnim;
  956. unsigned long flags;
  957. spin_lock_irqsave(&bfad->bfad_lock, flags);
  958. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  959. iocmd->vf_id, iocmd->pwwn);
  960. if (!fcs_port)
  961. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  962. else {
  963. itnim = bfa_fcs_itnim_lookup(fcs_port, iocmd->rpwwn);
  964. if (itnim == NULL)
  965. iocmd->status = BFA_STATUS_UNKNOWN_RWWN;
  966. else {
  967. iocmd->status = BFA_STATUS_OK;
  968. bfa_fcs_itnim_stats_clear(fcs_port, iocmd->rpwwn);
  969. bfa_itnim_clear_stats(bfa_fcs_itnim_get_halitn(itnim));
  970. }
  971. }
  972. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  973. return 0;
  974. }
  975. static int
  976. bfad_iocmd_itnim_get_itnstats(struct bfad_s *bfad, void *cmd)
  977. {
  978. struct bfa_bsg_itnim_itnstats_s *iocmd =
  979. (struct bfa_bsg_itnim_itnstats_s *)cmd;
  980. struct bfa_fcs_lport_s *fcs_port;
  981. struct bfa_fcs_itnim_s *itnim;
  982. unsigned long flags;
  983. spin_lock_irqsave(&bfad->bfad_lock, flags);
  984. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  985. iocmd->vf_id, iocmd->lpwwn);
  986. if (!fcs_port) {
  987. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  988. bfa_trc(bfad, 0);
  989. } else {
  990. itnim = bfa_fcs_itnim_lookup(fcs_port, iocmd->rpwwn);
  991. if (itnim == NULL)
  992. iocmd->status = BFA_STATUS_UNKNOWN_RWWN;
  993. else {
  994. iocmd->status = BFA_STATUS_OK;
  995. bfa_fcs_itnim_stats_get(fcs_port, iocmd->rpwwn,
  996. &iocmd->itnstats);
  997. }
  998. }
  999. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1000. return 0;
  1001. }
  1002. static int
  1003. bfad_iocmd_fcport_enable(struct bfad_s *bfad, void *cmd)
  1004. {
  1005. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  1006. unsigned long flags;
  1007. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1008. iocmd->status = bfa_fcport_enable(&bfad->bfa);
  1009. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1010. return 0;
  1011. }
  1012. static int
  1013. bfad_iocmd_fcport_disable(struct bfad_s *bfad, void *cmd)
  1014. {
  1015. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  1016. unsigned long flags;
  1017. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1018. iocmd->status = bfa_fcport_disable(&bfad->bfa);
  1019. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1020. return 0;
  1021. }
  1022. static int
  1023. bfad_iocmd_ioc_get_pcifn_cfg(struct bfad_s *bfad, void *cmd)
  1024. {
  1025. struct bfa_bsg_pcifn_cfg_s *iocmd = (struct bfa_bsg_pcifn_cfg_s *)cmd;
  1026. struct bfad_hal_comp fcomp;
  1027. unsigned long flags;
  1028. init_completion(&fcomp.comp);
  1029. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1030. iocmd->status = bfa_ablk_query(&bfad->bfa.modules.ablk,
  1031. &iocmd->pcifn_cfg,
  1032. bfad_hcb_comp, &fcomp);
  1033. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1034. if (iocmd->status != BFA_STATUS_OK)
  1035. goto out;
  1036. wait_for_completion(&fcomp.comp);
  1037. iocmd->status = fcomp.status;
  1038. out:
  1039. return 0;
  1040. }
  1041. static int
  1042. bfad_iocmd_pcifn_create(struct bfad_s *bfad, void *cmd)
  1043. {
  1044. struct bfa_bsg_pcifn_s *iocmd = (struct bfa_bsg_pcifn_s *)cmd;
  1045. struct bfad_hal_comp fcomp;
  1046. unsigned long flags;
  1047. init_completion(&fcomp.comp);
  1048. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1049. iocmd->status = bfa_ablk_pf_create(&bfad->bfa.modules.ablk,
  1050. &iocmd->pcifn_id, iocmd->port,
  1051. iocmd->pcifn_class, iocmd->bw_min,
  1052. iocmd->bw_max, bfad_hcb_comp, &fcomp);
  1053. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1054. if (iocmd->status != BFA_STATUS_OK)
  1055. goto out;
  1056. wait_for_completion(&fcomp.comp);
  1057. iocmd->status = fcomp.status;
  1058. out:
  1059. return 0;
  1060. }
  1061. static int
  1062. bfad_iocmd_pcifn_delete(struct bfad_s *bfad, void *cmd)
  1063. {
  1064. struct bfa_bsg_pcifn_s *iocmd = (struct bfa_bsg_pcifn_s *)cmd;
  1065. struct bfad_hal_comp fcomp;
  1066. unsigned long flags;
  1067. init_completion(&fcomp.comp);
  1068. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1069. iocmd->status = bfa_ablk_pf_delete(&bfad->bfa.modules.ablk,
  1070. iocmd->pcifn_id,
  1071. bfad_hcb_comp, &fcomp);
  1072. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1073. if (iocmd->status != BFA_STATUS_OK)
  1074. goto out;
  1075. wait_for_completion(&fcomp.comp);
  1076. iocmd->status = fcomp.status;
  1077. out:
  1078. return 0;
  1079. }
  1080. static int
  1081. bfad_iocmd_pcifn_bw(struct bfad_s *bfad, void *cmd)
  1082. {
  1083. struct bfa_bsg_pcifn_s *iocmd = (struct bfa_bsg_pcifn_s *)cmd;
  1084. struct bfad_hal_comp fcomp;
  1085. unsigned long flags;
  1086. init_completion(&fcomp.comp);
  1087. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1088. iocmd->status = bfa_ablk_pf_update(&bfad->bfa.modules.ablk,
  1089. iocmd->pcifn_id, iocmd->bw_min,
  1090. iocmd->bw_max, bfad_hcb_comp, &fcomp);
  1091. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1092. bfa_trc(bfad, iocmd->status);
  1093. if (iocmd->status != BFA_STATUS_OK)
  1094. goto out;
  1095. wait_for_completion(&fcomp.comp);
  1096. iocmd->status = fcomp.status;
  1097. bfa_trc(bfad, iocmd->status);
  1098. out:
  1099. return 0;
  1100. }
  1101. static int
  1102. bfad_iocmd_adapter_cfg_mode(struct bfad_s *bfad, void *cmd)
  1103. {
  1104. struct bfa_bsg_adapter_cfg_mode_s *iocmd =
  1105. (struct bfa_bsg_adapter_cfg_mode_s *)cmd;
  1106. struct bfad_hal_comp fcomp;
  1107. unsigned long flags = 0;
  1108. init_completion(&fcomp.comp);
  1109. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1110. iocmd->status = bfa_ablk_adapter_config(&bfad->bfa.modules.ablk,
  1111. iocmd->cfg.mode, iocmd->cfg.max_pf,
  1112. iocmd->cfg.max_vf, bfad_hcb_comp, &fcomp);
  1113. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1114. if (iocmd->status != BFA_STATUS_OK)
  1115. goto out;
  1116. wait_for_completion(&fcomp.comp);
  1117. iocmd->status = fcomp.status;
  1118. out:
  1119. return 0;
  1120. }
  1121. static int
  1122. bfad_iocmd_port_cfg_mode(struct bfad_s *bfad, void *cmd)
  1123. {
  1124. struct bfa_bsg_port_cfg_mode_s *iocmd =
  1125. (struct bfa_bsg_port_cfg_mode_s *)cmd;
  1126. struct bfad_hal_comp fcomp;
  1127. unsigned long flags = 0;
  1128. init_completion(&fcomp.comp);
  1129. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1130. iocmd->status = bfa_ablk_port_config(&bfad->bfa.modules.ablk,
  1131. iocmd->instance, iocmd->cfg.mode,
  1132. iocmd->cfg.max_pf, iocmd->cfg.max_vf,
  1133. bfad_hcb_comp, &fcomp);
  1134. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1135. if (iocmd->status != BFA_STATUS_OK)
  1136. goto out;
  1137. wait_for_completion(&fcomp.comp);
  1138. iocmd->status = fcomp.status;
  1139. out:
  1140. return 0;
  1141. }
  1142. static int
  1143. bfad_iocmd_ablk_optrom(struct bfad_s *bfad, unsigned int cmd, void *pcmd)
  1144. {
  1145. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)pcmd;
  1146. struct bfad_hal_comp fcomp;
  1147. unsigned long flags;
  1148. init_completion(&fcomp.comp);
  1149. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1150. if (cmd == IOCMD_FLASH_ENABLE_OPTROM)
  1151. iocmd->status = bfa_ablk_optrom_en(&bfad->bfa.modules.ablk,
  1152. bfad_hcb_comp, &fcomp);
  1153. else
  1154. iocmd->status = bfa_ablk_optrom_dis(&bfad->bfa.modules.ablk,
  1155. bfad_hcb_comp, &fcomp);
  1156. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1157. if (iocmd->status != BFA_STATUS_OK)
  1158. goto out;
  1159. wait_for_completion(&fcomp.comp);
  1160. iocmd->status = fcomp.status;
  1161. out:
  1162. return 0;
  1163. }
  1164. static int
  1165. bfad_iocmd_faa_query(struct bfad_s *bfad, void *cmd)
  1166. {
  1167. struct bfa_bsg_faa_attr_s *iocmd = (struct bfa_bsg_faa_attr_s *)cmd;
  1168. struct bfad_hal_comp fcomp;
  1169. unsigned long flags;
  1170. init_completion(&fcomp.comp);
  1171. iocmd->status = BFA_STATUS_OK;
  1172. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1173. iocmd->status = bfa_faa_query(&bfad->bfa, &iocmd->faa_attr,
  1174. bfad_hcb_comp, &fcomp);
  1175. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1176. if (iocmd->status != BFA_STATUS_OK)
  1177. goto out;
  1178. wait_for_completion(&fcomp.comp);
  1179. iocmd->status = fcomp.status;
  1180. out:
  1181. return 0;
  1182. }
  1183. static int
  1184. bfad_iocmd_cee_attr(struct bfad_s *bfad, void *cmd, unsigned int payload_len)
  1185. {
  1186. struct bfa_bsg_cee_attr_s *iocmd =
  1187. (struct bfa_bsg_cee_attr_s *)cmd;
  1188. void *iocmd_bufptr;
  1189. struct bfad_hal_comp cee_comp;
  1190. unsigned long flags;
  1191. if (bfad_chk_iocmd_sz(payload_len,
  1192. sizeof(struct bfa_bsg_cee_attr_s),
  1193. sizeof(struct bfa_cee_attr_s)) != BFA_STATUS_OK) {
  1194. iocmd->status = BFA_STATUS_VERSION_FAIL;
  1195. return 0;
  1196. }
  1197. iocmd_bufptr = (char *)iocmd + sizeof(struct bfa_bsg_cee_attr_s);
  1198. cee_comp.status = 0;
  1199. init_completion(&cee_comp.comp);
  1200. mutex_lock(&bfad_mutex);
  1201. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1202. iocmd->status = bfa_cee_get_attr(&bfad->bfa.modules.cee, iocmd_bufptr,
  1203. bfad_hcb_comp, &cee_comp);
  1204. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1205. if (iocmd->status != BFA_STATUS_OK) {
  1206. mutex_unlock(&bfad_mutex);
  1207. bfa_trc(bfad, 0x5555);
  1208. goto out;
  1209. }
  1210. wait_for_completion(&cee_comp.comp);
  1211. mutex_unlock(&bfad_mutex);
  1212. out:
  1213. return 0;
  1214. }
  1215. static int
  1216. bfad_iocmd_cee_get_stats(struct bfad_s *bfad, void *cmd,
  1217. unsigned int payload_len)
  1218. {
  1219. struct bfa_bsg_cee_stats_s *iocmd =
  1220. (struct bfa_bsg_cee_stats_s *)cmd;
  1221. void *iocmd_bufptr;
  1222. struct bfad_hal_comp cee_comp;
  1223. unsigned long flags;
  1224. if (bfad_chk_iocmd_sz(payload_len,
  1225. sizeof(struct bfa_bsg_cee_stats_s),
  1226. sizeof(struct bfa_cee_stats_s)) != BFA_STATUS_OK) {
  1227. iocmd->status = BFA_STATUS_VERSION_FAIL;
  1228. return 0;
  1229. }
  1230. iocmd_bufptr = (char *)iocmd + sizeof(struct bfa_bsg_cee_stats_s);
  1231. cee_comp.status = 0;
  1232. init_completion(&cee_comp.comp);
  1233. mutex_lock(&bfad_mutex);
  1234. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1235. iocmd->status = bfa_cee_get_stats(&bfad->bfa.modules.cee, iocmd_bufptr,
  1236. bfad_hcb_comp, &cee_comp);
  1237. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1238. if (iocmd->status != BFA_STATUS_OK) {
  1239. mutex_unlock(&bfad_mutex);
  1240. bfa_trc(bfad, 0x5555);
  1241. goto out;
  1242. }
  1243. wait_for_completion(&cee_comp.comp);
  1244. mutex_unlock(&bfad_mutex);
  1245. out:
  1246. return 0;
  1247. }
  1248. static int
  1249. bfad_iocmd_cee_reset_stats(struct bfad_s *bfad, void *cmd)
  1250. {
  1251. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  1252. unsigned long flags;
  1253. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1254. iocmd->status = bfa_cee_reset_stats(&bfad->bfa.modules.cee, NULL, NULL);
  1255. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1256. if (iocmd->status != BFA_STATUS_OK)
  1257. bfa_trc(bfad, 0x5555);
  1258. return 0;
  1259. }
  1260. static int
  1261. bfad_iocmd_sfp_media(struct bfad_s *bfad, void *cmd)
  1262. {
  1263. struct bfa_bsg_sfp_media_s *iocmd = (struct bfa_bsg_sfp_media_s *)cmd;
  1264. struct bfad_hal_comp fcomp;
  1265. unsigned long flags;
  1266. init_completion(&fcomp.comp);
  1267. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1268. iocmd->status = bfa_sfp_media(BFA_SFP_MOD(&bfad->bfa), &iocmd->media,
  1269. bfad_hcb_comp, &fcomp);
  1270. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1271. bfa_trc(bfad, iocmd->status);
  1272. if (iocmd->status != BFA_STATUS_SFP_NOT_READY)
  1273. goto out;
  1274. wait_for_completion(&fcomp.comp);
  1275. iocmd->status = fcomp.status;
  1276. out:
  1277. return 0;
  1278. }
  1279. static int
  1280. bfad_iocmd_sfp_speed(struct bfad_s *bfad, void *cmd)
  1281. {
  1282. struct bfa_bsg_sfp_speed_s *iocmd = (struct bfa_bsg_sfp_speed_s *)cmd;
  1283. struct bfad_hal_comp fcomp;
  1284. unsigned long flags;
  1285. init_completion(&fcomp.comp);
  1286. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1287. iocmd->status = bfa_sfp_speed(BFA_SFP_MOD(&bfad->bfa), iocmd->speed,
  1288. bfad_hcb_comp, &fcomp);
  1289. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1290. bfa_trc(bfad, iocmd->status);
  1291. if (iocmd->status != BFA_STATUS_SFP_NOT_READY)
  1292. goto out;
  1293. wait_for_completion(&fcomp.comp);
  1294. iocmd->status = fcomp.status;
  1295. out:
  1296. return 0;
  1297. }
  1298. static int
  1299. bfad_iocmd_flash_get_attr(struct bfad_s *bfad, void *cmd)
  1300. {
  1301. struct bfa_bsg_flash_attr_s *iocmd =
  1302. (struct bfa_bsg_flash_attr_s *)cmd;
  1303. struct bfad_hal_comp fcomp;
  1304. unsigned long flags;
  1305. init_completion(&fcomp.comp);
  1306. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1307. iocmd->status = bfa_flash_get_attr(BFA_FLASH(&bfad->bfa), &iocmd->attr,
  1308. bfad_hcb_comp, &fcomp);
  1309. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1310. if (iocmd->status != BFA_STATUS_OK)
  1311. goto out;
  1312. wait_for_completion(&fcomp.comp);
  1313. iocmd->status = fcomp.status;
  1314. out:
  1315. return 0;
  1316. }
  1317. static int
  1318. bfad_iocmd_flash_erase_part(struct bfad_s *bfad, void *cmd)
  1319. {
  1320. struct bfa_bsg_flash_s *iocmd = (struct bfa_bsg_flash_s *)cmd;
  1321. struct bfad_hal_comp fcomp;
  1322. unsigned long flags;
  1323. init_completion(&fcomp.comp);
  1324. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1325. iocmd->status = bfa_flash_erase_part(BFA_FLASH(&bfad->bfa), iocmd->type,
  1326. iocmd->instance, bfad_hcb_comp, &fcomp);
  1327. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1328. if (iocmd->status != BFA_STATUS_OK)
  1329. goto out;
  1330. wait_for_completion(&fcomp.comp);
  1331. iocmd->status = fcomp.status;
  1332. out:
  1333. return 0;
  1334. }
  1335. static int
  1336. bfad_iocmd_flash_update_part(struct bfad_s *bfad, void *cmd,
  1337. unsigned int payload_len)
  1338. {
  1339. struct bfa_bsg_flash_s *iocmd = (struct bfa_bsg_flash_s *)cmd;
  1340. void *iocmd_bufptr;
  1341. struct bfad_hal_comp fcomp;
  1342. unsigned long flags;
  1343. if (bfad_chk_iocmd_sz(payload_len,
  1344. sizeof(struct bfa_bsg_flash_s),
  1345. iocmd->bufsz) != BFA_STATUS_OK) {
  1346. iocmd->status = BFA_STATUS_VERSION_FAIL;
  1347. return 0;
  1348. }
  1349. iocmd_bufptr = (char *)iocmd + sizeof(struct bfa_bsg_flash_s);
  1350. init_completion(&fcomp.comp);
  1351. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1352. iocmd->status = bfa_flash_update_part(BFA_FLASH(&bfad->bfa),
  1353. iocmd->type, iocmd->instance, iocmd_bufptr,
  1354. iocmd->bufsz, 0, bfad_hcb_comp, &fcomp);
  1355. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1356. if (iocmd->status != BFA_STATUS_OK)
  1357. goto out;
  1358. wait_for_completion(&fcomp.comp);
  1359. iocmd->status = fcomp.status;
  1360. out:
  1361. return 0;
  1362. }
  1363. static int
  1364. bfad_iocmd_flash_read_part(struct bfad_s *bfad, void *cmd,
  1365. unsigned int payload_len)
  1366. {
  1367. struct bfa_bsg_flash_s *iocmd = (struct bfa_bsg_flash_s *)cmd;
  1368. struct bfad_hal_comp fcomp;
  1369. void *iocmd_bufptr;
  1370. unsigned long flags;
  1371. if (bfad_chk_iocmd_sz(payload_len,
  1372. sizeof(struct bfa_bsg_flash_s),
  1373. iocmd->bufsz) != BFA_STATUS_OK) {
  1374. iocmd->status = BFA_STATUS_VERSION_FAIL;
  1375. return 0;
  1376. }
  1377. iocmd_bufptr = (char *)iocmd + sizeof(struct bfa_bsg_flash_s);
  1378. init_completion(&fcomp.comp);
  1379. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1380. iocmd->status = bfa_flash_read_part(BFA_FLASH(&bfad->bfa), iocmd->type,
  1381. iocmd->instance, iocmd_bufptr, iocmd->bufsz, 0,
  1382. bfad_hcb_comp, &fcomp);
  1383. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1384. if (iocmd->status != BFA_STATUS_OK)
  1385. goto out;
  1386. wait_for_completion(&fcomp.comp);
  1387. iocmd->status = fcomp.status;
  1388. out:
  1389. return 0;
  1390. }
  1391. static int
  1392. bfad_iocmd_diag_temp(struct bfad_s *bfad, void *cmd)
  1393. {
  1394. struct bfa_bsg_diag_get_temp_s *iocmd =
  1395. (struct bfa_bsg_diag_get_temp_s *)cmd;
  1396. struct bfad_hal_comp fcomp;
  1397. unsigned long flags;
  1398. init_completion(&fcomp.comp);
  1399. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1400. iocmd->status = bfa_diag_tsensor_query(BFA_DIAG_MOD(&bfad->bfa),
  1401. &iocmd->result, bfad_hcb_comp, &fcomp);
  1402. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1403. bfa_trc(bfad, iocmd->status);
  1404. if (iocmd->status != BFA_STATUS_OK)
  1405. goto out;
  1406. wait_for_completion(&fcomp.comp);
  1407. iocmd->status = fcomp.status;
  1408. out:
  1409. return 0;
  1410. }
  1411. static int
  1412. bfad_iocmd_diag_memtest(struct bfad_s *bfad, void *cmd)
  1413. {
  1414. struct bfa_bsg_diag_memtest_s *iocmd =
  1415. (struct bfa_bsg_diag_memtest_s *)cmd;
  1416. struct bfad_hal_comp fcomp;
  1417. unsigned long flags;
  1418. init_completion(&fcomp.comp);
  1419. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1420. iocmd->status = bfa_diag_memtest(BFA_DIAG_MOD(&bfad->bfa),
  1421. &iocmd->memtest, iocmd->pat,
  1422. &iocmd->result, bfad_hcb_comp, &fcomp);
  1423. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1424. bfa_trc(bfad, iocmd->status);
  1425. if (iocmd->status != BFA_STATUS_OK)
  1426. goto out;
  1427. wait_for_completion(&fcomp.comp);
  1428. iocmd->status = fcomp.status;
  1429. out:
  1430. return 0;
  1431. }
  1432. static int
  1433. bfad_iocmd_diag_loopback(struct bfad_s *bfad, void *cmd)
  1434. {
  1435. struct bfa_bsg_diag_loopback_s *iocmd =
  1436. (struct bfa_bsg_diag_loopback_s *)cmd;
  1437. struct bfad_hal_comp fcomp;
  1438. unsigned long flags;
  1439. init_completion(&fcomp.comp);
  1440. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1441. iocmd->status = bfa_fcdiag_loopback(&bfad->bfa, iocmd->opmode,
  1442. iocmd->speed, iocmd->lpcnt, iocmd->pat,
  1443. &iocmd->result, bfad_hcb_comp, &fcomp);
  1444. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1445. bfa_trc(bfad, iocmd->status);
  1446. if (iocmd->status != BFA_STATUS_OK)
  1447. goto out;
  1448. wait_for_completion(&fcomp.comp);
  1449. iocmd->status = fcomp.status;
  1450. out:
  1451. return 0;
  1452. }
  1453. static int
  1454. bfad_iocmd_diag_fwping(struct bfad_s *bfad, void *cmd)
  1455. {
  1456. struct bfa_bsg_diag_fwping_s *iocmd =
  1457. (struct bfa_bsg_diag_fwping_s *)cmd;
  1458. struct bfad_hal_comp fcomp;
  1459. unsigned long flags;
  1460. init_completion(&fcomp.comp);
  1461. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1462. iocmd->status = bfa_diag_fwping(BFA_DIAG_MOD(&bfad->bfa), iocmd->cnt,
  1463. iocmd->pattern, &iocmd->result,
  1464. bfad_hcb_comp, &fcomp);
  1465. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1466. bfa_trc(bfad, iocmd->status);
  1467. if (iocmd->status != BFA_STATUS_OK)
  1468. goto out;
  1469. bfa_trc(bfad, 0x77771);
  1470. wait_for_completion(&fcomp.comp);
  1471. iocmd->status = fcomp.status;
  1472. out:
  1473. return 0;
  1474. }
  1475. static int
  1476. bfad_iocmd_diag_queuetest(struct bfad_s *bfad, void *cmd)
  1477. {
  1478. struct bfa_bsg_diag_qtest_s *iocmd = (struct bfa_bsg_diag_qtest_s *)cmd;
  1479. struct bfad_hal_comp fcomp;
  1480. unsigned long flags;
  1481. init_completion(&fcomp.comp);
  1482. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1483. iocmd->status = bfa_fcdiag_queuetest(&bfad->bfa, iocmd->force,
  1484. iocmd->queue, &iocmd->result,
  1485. bfad_hcb_comp, &fcomp);
  1486. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1487. if (iocmd->status != BFA_STATUS_OK)
  1488. goto out;
  1489. wait_for_completion(&fcomp.comp);
  1490. iocmd->status = fcomp.status;
  1491. out:
  1492. return 0;
  1493. }
  1494. static int
  1495. bfad_iocmd_diag_sfp(struct bfad_s *bfad, void *cmd)
  1496. {
  1497. struct bfa_bsg_sfp_show_s *iocmd =
  1498. (struct bfa_bsg_sfp_show_s *)cmd;
  1499. struct bfad_hal_comp fcomp;
  1500. unsigned long flags;
  1501. init_completion(&fcomp.comp);
  1502. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1503. iocmd->status = bfa_sfp_show(BFA_SFP_MOD(&bfad->bfa), &iocmd->sfp,
  1504. bfad_hcb_comp, &fcomp);
  1505. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1506. bfa_trc(bfad, iocmd->status);
  1507. if (iocmd->status != BFA_STATUS_OK)
  1508. goto out;
  1509. wait_for_completion(&fcomp.comp);
  1510. iocmd->status = fcomp.status;
  1511. bfa_trc(bfad, iocmd->status);
  1512. out:
  1513. return 0;
  1514. }
  1515. static int
  1516. bfad_iocmd_diag_led(struct bfad_s *bfad, void *cmd)
  1517. {
  1518. struct bfa_bsg_diag_led_s *iocmd = (struct bfa_bsg_diag_led_s *)cmd;
  1519. unsigned long flags;
  1520. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1521. iocmd->status = bfa_diag_ledtest(BFA_DIAG_MOD(&bfad->bfa),
  1522. &iocmd->ledtest);
  1523. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1524. return 0;
  1525. }
  1526. static int
  1527. bfad_iocmd_diag_beacon_lport(struct bfad_s *bfad, void *cmd)
  1528. {
  1529. struct bfa_bsg_diag_beacon_s *iocmd =
  1530. (struct bfa_bsg_diag_beacon_s *)cmd;
  1531. unsigned long flags;
  1532. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1533. iocmd->status = bfa_diag_beacon_port(BFA_DIAG_MOD(&bfad->bfa),
  1534. iocmd->beacon, iocmd->link_e2e_beacon,
  1535. iocmd->second);
  1536. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1537. return 0;
  1538. }
  1539. static int
  1540. bfad_iocmd_diag_lb_stat(struct bfad_s *bfad, void *cmd)
  1541. {
  1542. struct bfa_bsg_diag_lb_stat_s *iocmd =
  1543. (struct bfa_bsg_diag_lb_stat_s *)cmd;
  1544. unsigned long flags;
  1545. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1546. iocmd->status = bfa_fcdiag_lb_is_running(&bfad->bfa);
  1547. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1548. bfa_trc(bfad, iocmd->status);
  1549. return 0;
  1550. }
  1551. static int
  1552. bfad_iocmd_diag_dport_enable(struct bfad_s *bfad, void *pcmd)
  1553. {
  1554. struct bfa_bsg_dport_enable_s *iocmd =
  1555. (struct bfa_bsg_dport_enable_s *)pcmd;
  1556. unsigned long flags;
  1557. struct bfad_hal_comp fcomp;
  1558. init_completion(&fcomp.comp);
  1559. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1560. iocmd->status = bfa_dport_enable(&bfad->bfa, iocmd->lpcnt,
  1561. iocmd->pat, bfad_hcb_comp, &fcomp);
  1562. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1563. if (iocmd->status != BFA_STATUS_OK)
  1564. bfa_trc(bfad, iocmd->status);
  1565. else {
  1566. wait_for_completion(&fcomp.comp);
  1567. iocmd->status = fcomp.status;
  1568. }
  1569. return 0;
  1570. }
  1571. static int
  1572. bfad_iocmd_diag_dport_disable(struct bfad_s *bfad, void *pcmd)
  1573. {
  1574. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)pcmd;
  1575. unsigned long flags;
  1576. struct bfad_hal_comp fcomp;
  1577. init_completion(&fcomp.comp);
  1578. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1579. iocmd->status = bfa_dport_disable(&bfad->bfa, bfad_hcb_comp, &fcomp);
  1580. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1581. if (iocmd->status != BFA_STATUS_OK)
  1582. bfa_trc(bfad, iocmd->status);
  1583. else {
  1584. wait_for_completion(&fcomp.comp);
  1585. iocmd->status = fcomp.status;
  1586. }
  1587. return 0;
  1588. }
  1589. static int
  1590. bfad_iocmd_diag_dport_start(struct bfad_s *bfad, void *pcmd)
  1591. {
  1592. struct bfa_bsg_dport_enable_s *iocmd =
  1593. (struct bfa_bsg_dport_enable_s *)pcmd;
  1594. unsigned long flags;
  1595. struct bfad_hal_comp fcomp;
  1596. init_completion(&fcomp.comp);
  1597. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1598. iocmd->status = bfa_dport_start(&bfad->bfa, iocmd->lpcnt,
  1599. iocmd->pat, bfad_hcb_comp,
  1600. &fcomp);
  1601. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1602. if (iocmd->status != BFA_STATUS_OK) {
  1603. bfa_trc(bfad, iocmd->status);
  1604. } else {
  1605. wait_for_completion(&fcomp.comp);
  1606. iocmd->status = fcomp.status;
  1607. }
  1608. return 0;
  1609. }
  1610. static int
  1611. bfad_iocmd_diag_dport_show(struct bfad_s *bfad, void *pcmd)
  1612. {
  1613. struct bfa_bsg_diag_dport_show_s *iocmd =
  1614. (struct bfa_bsg_diag_dport_show_s *)pcmd;
  1615. unsigned long flags;
  1616. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1617. iocmd->status = bfa_dport_show(&bfad->bfa, &iocmd->result);
  1618. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1619. return 0;
  1620. }
  1621. static int
  1622. bfad_iocmd_phy_get_attr(struct bfad_s *bfad, void *cmd)
  1623. {
  1624. struct bfa_bsg_phy_attr_s *iocmd =
  1625. (struct bfa_bsg_phy_attr_s *)cmd;
  1626. struct bfad_hal_comp fcomp;
  1627. unsigned long flags;
  1628. init_completion(&fcomp.comp);
  1629. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1630. iocmd->status = bfa_phy_get_attr(BFA_PHY(&bfad->bfa), iocmd->instance,
  1631. &iocmd->attr, bfad_hcb_comp, &fcomp);
  1632. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1633. if (iocmd->status != BFA_STATUS_OK)
  1634. goto out;
  1635. wait_for_completion(&fcomp.comp);
  1636. iocmd->status = fcomp.status;
  1637. out:
  1638. return 0;
  1639. }
  1640. static int
  1641. bfad_iocmd_phy_get_stats(struct bfad_s *bfad, void *cmd)
  1642. {
  1643. struct bfa_bsg_phy_stats_s *iocmd =
  1644. (struct bfa_bsg_phy_stats_s *)cmd;
  1645. struct bfad_hal_comp fcomp;
  1646. unsigned long flags;
  1647. init_completion(&fcomp.comp);
  1648. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1649. iocmd->status = bfa_phy_get_stats(BFA_PHY(&bfad->bfa), iocmd->instance,
  1650. &iocmd->stats, bfad_hcb_comp, &fcomp);
  1651. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1652. if (iocmd->status != BFA_STATUS_OK)
  1653. goto out;
  1654. wait_for_completion(&fcomp.comp);
  1655. iocmd->status = fcomp.status;
  1656. out:
  1657. return 0;
  1658. }
  1659. static int
  1660. bfad_iocmd_phy_read(struct bfad_s *bfad, void *cmd, unsigned int payload_len)
  1661. {
  1662. struct bfa_bsg_phy_s *iocmd = (struct bfa_bsg_phy_s *)cmd;
  1663. struct bfad_hal_comp fcomp;
  1664. void *iocmd_bufptr;
  1665. unsigned long flags;
  1666. if (bfad_chk_iocmd_sz(payload_len,
  1667. sizeof(struct bfa_bsg_phy_s),
  1668. iocmd->bufsz) != BFA_STATUS_OK) {
  1669. iocmd->status = BFA_STATUS_VERSION_FAIL;
  1670. return 0;
  1671. }
  1672. iocmd_bufptr = (char *)iocmd + sizeof(struct bfa_bsg_phy_s);
  1673. init_completion(&fcomp.comp);
  1674. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1675. iocmd->status = bfa_phy_read(BFA_PHY(&bfad->bfa),
  1676. iocmd->instance, iocmd_bufptr, iocmd->bufsz,
  1677. 0, bfad_hcb_comp, &fcomp);
  1678. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1679. if (iocmd->status != BFA_STATUS_OK)
  1680. goto out;
  1681. wait_for_completion(&fcomp.comp);
  1682. iocmd->status = fcomp.status;
  1683. if (iocmd->status != BFA_STATUS_OK)
  1684. goto out;
  1685. out:
  1686. return 0;
  1687. }
  1688. static int
  1689. bfad_iocmd_vhba_query(struct bfad_s *bfad, void *cmd)
  1690. {
  1691. struct bfa_bsg_vhba_attr_s *iocmd =
  1692. (struct bfa_bsg_vhba_attr_s *)cmd;
  1693. struct bfa_vhba_attr_s *attr = &iocmd->attr;
  1694. unsigned long flags;
  1695. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1696. attr->pwwn = bfad->bfa.ioc.attr->pwwn;
  1697. attr->nwwn = bfad->bfa.ioc.attr->nwwn;
  1698. attr->plog_enabled = (bfa_boolean_t)bfad->bfa.plog->plog_enabled;
  1699. attr->io_profile = bfa_fcpim_get_io_profile(&bfad->bfa);
  1700. attr->path_tov = bfa_fcpim_path_tov_get(&bfad->bfa);
  1701. iocmd->status = BFA_STATUS_OK;
  1702. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1703. return 0;
  1704. }
  1705. static int
  1706. bfad_iocmd_phy_update(struct bfad_s *bfad, void *cmd, unsigned int payload_len)
  1707. {
  1708. struct bfa_bsg_phy_s *iocmd = (struct bfa_bsg_phy_s *)cmd;
  1709. void *iocmd_bufptr;
  1710. struct bfad_hal_comp fcomp;
  1711. unsigned long flags;
  1712. if (bfad_chk_iocmd_sz(payload_len,
  1713. sizeof(struct bfa_bsg_phy_s),
  1714. iocmd->bufsz) != BFA_STATUS_OK) {
  1715. iocmd->status = BFA_STATUS_VERSION_FAIL;
  1716. return 0;
  1717. }
  1718. iocmd_bufptr = (char *)iocmd + sizeof(struct bfa_bsg_phy_s);
  1719. init_completion(&fcomp.comp);
  1720. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1721. iocmd->status = bfa_phy_update(BFA_PHY(&bfad->bfa),
  1722. iocmd->instance, iocmd_bufptr, iocmd->bufsz,
  1723. 0, bfad_hcb_comp, &fcomp);
  1724. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1725. if (iocmd->status != BFA_STATUS_OK)
  1726. goto out;
  1727. wait_for_completion(&fcomp.comp);
  1728. iocmd->status = fcomp.status;
  1729. out:
  1730. return 0;
  1731. }
  1732. static int
  1733. bfad_iocmd_porglog_get(struct bfad_s *bfad, void *cmd)
  1734. {
  1735. struct bfa_bsg_debug_s *iocmd = (struct bfa_bsg_debug_s *)cmd;
  1736. void *iocmd_bufptr;
  1737. if (iocmd->bufsz < sizeof(struct bfa_plog_s)) {
  1738. bfa_trc(bfad, sizeof(struct bfa_plog_s));
  1739. iocmd->status = BFA_STATUS_EINVAL;
  1740. goto out;
  1741. }
  1742. iocmd->status = BFA_STATUS_OK;
  1743. iocmd_bufptr = (char *)iocmd + sizeof(struct bfa_bsg_debug_s);
  1744. memcpy(iocmd_bufptr, (u8 *) &bfad->plog_buf, sizeof(struct bfa_plog_s));
  1745. out:
  1746. return 0;
  1747. }
  1748. #define BFA_DEBUG_FW_CORE_CHUNK_SZ 0x4000U /* 16K chunks for FW dump */
  1749. static int
  1750. bfad_iocmd_debug_fw_core(struct bfad_s *bfad, void *cmd,
  1751. unsigned int payload_len)
  1752. {
  1753. struct bfa_bsg_debug_s *iocmd = (struct bfa_bsg_debug_s *)cmd;
  1754. void *iocmd_bufptr;
  1755. unsigned long flags;
  1756. u32 offset;
  1757. if (bfad_chk_iocmd_sz(payload_len, sizeof(struct bfa_bsg_debug_s),
  1758. BFA_DEBUG_FW_CORE_CHUNK_SZ) != BFA_STATUS_OK) {
  1759. iocmd->status = BFA_STATUS_VERSION_FAIL;
  1760. return 0;
  1761. }
  1762. if (iocmd->bufsz < BFA_DEBUG_FW_CORE_CHUNK_SZ ||
  1763. !IS_ALIGNED(iocmd->bufsz, sizeof(u16)) ||
  1764. !IS_ALIGNED(iocmd->offset, sizeof(u32))) {
  1765. bfa_trc(bfad, BFA_DEBUG_FW_CORE_CHUNK_SZ);
  1766. iocmd->status = BFA_STATUS_EINVAL;
  1767. goto out;
  1768. }
  1769. iocmd_bufptr = (char *)iocmd + sizeof(struct bfa_bsg_debug_s);
  1770. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1771. offset = iocmd->offset;
  1772. iocmd->status = bfa_ioc_debug_fwcore(&bfad->bfa.ioc, iocmd_bufptr,
  1773. &offset, &iocmd->bufsz);
  1774. iocmd->offset = offset;
  1775. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1776. out:
  1777. return 0;
  1778. }
  1779. static int
  1780. bfad_iocmd_debug_ctl(struct bfad_s *bfad, void *cmd, unsigned int v_cmd)
  1781. {
  1782. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  1783. unsigned long flags;
  1784. if (v_cmd == IOCMD_DEBUG_FW_STATE_CLR) {
  1785. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1786. bfad->bfa.ioc.dbg_fwsave_once = BFA_TRUE;
  1787. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1788. } else if (v_cmd == IOCMD_DEBUG_PORTLOG_CLR)
  1789. bfad->plog_buf.head = bfad->plog_buf.tail = 0;
  1790. else if (v_cmd == IOCMD_DEBUG_START_DTRC)
  1791. bfa_trc_init(bfad->trcmod);
  1792. else if (v_cmd == IOCMD_DEBUG_STOP_DTRC)
  1793. bfa_trc_stop(bfad->trcmod);
  1794. iocmd->status = BFA_STATUS_OK;
  1795. return 0;
  1796. }
  1797. static int
  1798. bfad_iocmd_porglog_ctl(struct bfad_s *bfad, void *cmd)
  1799. {
  1800. struct bfa_bsg_portlogctl_s *iocmd = (struct bfa_bsg_portlogctl_s *)cmd;
  1801. if (iocmd->ctl == BFA_TRUE)
  1802. bfad->plog_buf.plog_enabled = 1;
  1803. else
  1804. bfad->plog_buf.plog_enabled = 0;
  1805. iocmd->status = BFA_STATUS_OK;
  1806. return 0;
  1807. }
  1808. static int
  1809. bfad_iocmd_fcpim_cfg_profile(struct bfad_s *bfad, void *cmd, unsigned int v_cmd)
  1810. {
  1811. struct bfa_bsg_fcpim_profile_s *iocmd =
  1812. (struct bfa_bsg_fcpim_profile_s *)cmd;
  1813. unsigned long flags;
  1814. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1815. if (v_cmd == IOCMD_FCPIM_PROFILE_ON)
  1816. iocmd->status = bfa_fcpim_profile_on(&bfad->bfa, ktime_get_real_seconds());
  1817. else if (v_cmd == IOCMD_FCPIM_PROFILE_OFF)
  1818. iocmd->status = bfa_fcpim_profile_off(&bfad->bfa);
  1819. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1820. return 0;
  1821. }
  1822. static int
  1823. bfad_iocmd_itnim_get_ioprofile(struct bfad_s *bfad, void *cmd)
  1824. {
  1825. struct bfa_bsg_itnim_ioprofile_s *iocmd =
  1826. (struct bfa_bsg_itnim_ioprofile_s *)cmd;
  1827. struct bfa_fcs_lport_s *fcs_port;
  1828. struct bfa_fcs_itnim_s *itnim;
  1829. unsigned long flags;
  1830. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1831. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs,
  1832. iocmd->vf_id, iocmd->lpwwn);
  1833. if (!fcs_port)
  1834. iocmd->status = BFA_STATUS_UNKNOWN_LWWN;
  1835. else {
  1836. itnim = bfa_fcs_itnim_lookup(fcs_port, iocmd->rpwwn);
  1837. if (itnim == NULL)
  1838. iocmd->status = BFA_STATUS_UNKNOWN_RWWN;
  1839. else
  1840. iocmd->status = bfa_itnim_get_ioprofile(
  1841. bfa_fcs_itnim_get_halitn(itnim),
  1842. &iocmd->ioprofile);
  1843. }
  1844. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1845. return 0;
  1846. }
  1847. static int
  1848. bfad_iocmd_fcport_get_stats(struct bfad_s *bfad, void *cmd)
  1849. {
  1850. struct bfa_bsg_fcport_stats_s *iocmd =
  1851. (struct bfa_bsg_fcport_stats_s *)cmd;
  1852. struct bfad_hal_comp fcomp;
  1853. unsigned long flags;
  1854. struct bfa_cb_pending_q_s cb_qe;
  1855. init_completion(&fcomp.comp);
  1856. bfa_pending_q_init(&cb_qe, (bfa_cb_cbfn_t)bfad_hcb_comp,
  1857. &fcomp, &iocmd->stats);
  1858. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1859. iocmd->status = bfa_fcport_get_stats(&bfad->bfa, &cb_qe);
  1860. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1861. if (iocmd->status != BFA_STATUS_OK) {
  1862. bfa_trc(bfad, iocmd->status);
  1863. goto out;
  1864. }
  1865. wait_for_completion(&fcomp.comp);
  1866. iocmd->status = fcomp.status;
  1867. out:
  1868. return 0;
  1869. }
  1870. static int
  1871. bfad_iocmd_fcport_reset_stats(struct bfad_s *bfad, void *cmd)
  1872. {
  1873. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  1874. struct bfad_hal_comp fcomp;
  1875. unsigned long flags;
  1876. struct bfa_cb_pending_q_s cb_qe;
  1877. init_completion(&fcomp.comp);
  1878. bfa_pending_q_init(&cb_qe, (bfa_cb_cbfn_t)bfad_hcb_comp, &fcomp, NULL);
  1879. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1880. iocmd->status = bfa_fcport_clear_stats(&bfad->bfa, &cb_qe);
  1881. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1882. if (iocmd->status != BFA_STATUS_OK) {
  1883. bfa_trc(bfad, iocmd->status);
  1884. goto out;
  1885. }
  1886. wait_for_completion(&fcomp.comp);
  1887. iocmd->status = fcomp.status;
  1888. out:
  1889. return 0;
  1890. }
  1891. static int
  1892. bfad_iocmd_boot_cfg(struct bfad_s *bfad, void *cmd)
  1893. {
  1894. struct bfa_bsg_boot_s *iocmd = (struct bfa_bsg_boot_s *)cmd;
  1895. struct bfad_hal_comp fcomp;
  1896. unsigned long flags;
  1897. init_completion(&fcomp.comp);
  1898. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1899. iocmd->status = bfa_flash_update_part(BFA_FLASH(&bfad->bfa),
  1900. BFA_FLASH_PART_BOOT, bfad->bfa.ioc.port_id,
  1901. &iocmd->cfg, sizeof(struct bfa_boot_cfg_s), 0,
  1902. bfad_hcb_comp, &fcomp);
  1903. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1904. if (iocmd->status != BFA_STATUS_OK)
  1905. goto out;
  1906. wait_for_completion(&fcomp.comp);
  1907. iocmd->status = fcomp.status;
  1908. out:
  1909. return 0;
  1910. }
  1911. static int
  1912. bfad_iocmd_boot_query(struct bfad_s *bfad, void *cmd)
  1913. {
  1914. struct bfa_bsg_boot_s *iocmd = (struct bfa_bsg_boot_s *)cmd;
  1915. struct bfad_hal_comp fcomp;
  1916. unsigned long flags;
  1917. init_completion(&fcomp.comp);
  1918. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1919. iocmd->status = bfa_flash_read_part(BFA_FLASH(&bfad->bfa),
  1920. BFA_FLASH_PART_BOOT, bfad->bfa.ioc.port_id,
  1921. &iocmd->cfg, sizeof(struct bfa_boot_cfg_s), 0,
  1922. bfad_hcb_comp, &fcomp);
  1923. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1924. if (iocmd->status != BFA_STATUS_OK)
  1925. goto out;
  1926. wait_for_completion(&fcomp.comp);
  1927. iocmd->status = fcomp.status;
  1928. out:
  1929. return 0;
  1930. }
  1931. static int
  1932. bfad_iocmd_preboot_query(struct bfad_s *bfad, void *cmd)
  1933. {
  1934. struct bfa_bsg_preboot_s *iocmd = (struct bfa_bsg_preboot_s *)cmd;
  1935. struct bfi_iocfc_cfgrsp_s *cfgrsp = bfad->bfa.iocfc.cfgrsp;
  1936. struct bfa_boot_pbc_s *pbcfg = &iocmd->cfg;
  1937. unsigned long flags;
  1938. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1939. pbcfg->enable = cfgrsp->pbc_cfg.boot_enabled;
  1940. pbcfg->nbluns = cfgrsp->pbc_cfg.nbluns;
  1941. pbcfg->speed = cfgrsp->pbc_cfg.port_speed;
  1942. memcpy(pbcfg->pblun, cfgrsp->pbc_cfg.blun, sizeof(pbcfg->pblun));
  1943. iocmd->status = BFA_STATUS_OK;
  1944. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1945. return 0;
  1946. }
  1947. static int
  1948. bfad_iocmd_ethboot_cfg(struct bfad_s *bfad, void *cmd)
  1949. {
  1950. struct bfa_bsg_ethboot_s *iocmd = (struct bfa_bsg_ethboot_s *)cmd;
  1951. struct bfad_hal_comp fcomp;
  1952. unsigned long flags;
  1953. init_completion(&fcomp.comp);
  1954. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1955. iocmd->status = bfa_flash_update_part(BFA_FLASH(&bfad->bfa),
  1956. BFA_FLASH_PART_PXECFG,
  1957. bfad->bfa.ioc.port_id, &iocmd->cfg,
  1958. sizeof(struct bfa_ethboot_cfg_s), 0,
  1959. bfad_hcb_comp, &fcomp);
  1960. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1961. if (iocmd->status != BFA_STATUS_OK)
  1962. goto out;
  1963. wait_for_completion(&fcomp.comp);
  1964. iocmd->status = fcomp.status;
  1965. out:
  1966. return 0;
  1967. }
  1968. static int
  1969. bfad_iocmd_ethboot_query(struct bfad_s *bfad, void *cmd)
  1970. {
  1971. struct bfa_bsg_ethboot_s *iocmd = (struct bfa_bsg_ethboot_s *)cmd;
  1972. struct bfad_hal_comp fcomp;
  1973. unsigned long flags;
  1974. init_completion(&fcomp.comp);
  1975. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1976. iocmd->status = bfa_flash_read_part(BFA_FLASH(&bfad->bfa),
  1977. BFA_FLASH_PART_PXECFG,
  1978. bfad->bfa.ioc.port_id, &iocmd->cfg,
  1979. sizeof(struct bfa_ethboot_cfg_s), 0,
  1980. bfad_hcb_comp, &fcomp);
  1981. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1982. if (iocmd->status != BFA_STATUS_OK)
  1983. goto out;
  1984. wait_for_completion(&fcomp.comp);
  1985. iocmd->status = fcomp.status;
  1986. out:
  1987. return 0;
  1988. }
  1989. static int
  1990. bfad_iocmd_cfg_trunk(struct bfad_s *bfad, void *cmd, unsigned int v_cmd)
  1991. {
  1992. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  1993. struct bfa_fcport_s *fcport = BFA_FCPORT_MOD(&bfad->bfa);
  1994. struct bfa_fcport_trunk_s *trunk = &fcport->trunk;
  1995. unsigned long flags;
  1996. spin_lock_irqsave(&bfad->bfad_lock, flags);
  1997. if (bfa_fcport_is_dport(&bfad->bfa)) {
  1998. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  1999. return BFA_STATUS_DPORT_ERR;
  2000. }
  2001. if ((fcport->cfg.topology == BFA_PORT_TOPOLOGY_LOOP) ||
  2002. (fcport->topology == BFA_PORT_TOPOLOGY_LOOP))
  2003. iocmd->status = BFA_STATUS_TOPOLOGY_LOOP;
  2004. else {
  2005. if (v_cmd == IOCMD_TRUNK_ENABLE) {
  2006. trunk->attr.state = BFA_TRUNK_OFFLINE;
  2007. bfa_fcport_disable(&bfad->bfa);
  2008. fcport->cfg.trunked = BFA_TRUE;
  2009. } else if (v_cmd == IOCMD_TRUNK_DISABLE) {
  2010. trunk->attr.state = BFA_TRUNK_DISABLED;
  2011. bfa_fcport_disable(&bfad->bfa);
  2012. fcport->cfg.trunked = BFA_FALSE;
  2013. }
  2014. if (!bfa_fcport_is_disabled(&bfad->bfa))
  2015. bfa_fcport_enable(&bfad->bfa);
  2016. iocmd->status = BFA_STATUS_OK;
  2017. }
  2018. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2019. return 0;
  2020. }
  2021. static int
  2022. bfad_iocmd_trunk_get_attr(struct bfad_s *bfad, void *cmd)
  2023. {
  2024. struct bfa_bsg_trunk_attr_s *iocmd = (struct bfa_bsg_trunk_attr_s *)cmd;
  2025. struct bfa_fcport_s *fcport = BFA_FCPORT_MOD(&bfad->bfa);
  2026. struct bfa_fcport_trunk_s *trunk = &fcport->trunk;
  2027. unsigned long flags;
  2028. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2029. if ((fcport->cfg.topology == BFA_PORT_TOPOLOGY_LOOP) ||
  2030. (fcport->topology == BFA_PORT_TOPOLOGY_LOOP))
  2031. iocmd->status = BFA_STATUS_TOPOLOGY_LOOP;
  2032. else {
  2033. memcpy((void *)&iocmd->attr, (void *)&trunk->attr,
  2034. sizeof(struct bfa_trunk_attr_s));
  2035. iocmd->attr.port_id = bfa_lps_get_base_pid(&bfad->bfa);
  2036. iocmd->status = BFA_STATUS_OK;
  2037. }
  2038. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2039. return 0;
  2040. }
  2041. static int
  2042. bfad_iocmd_qos(struct bfad_s *bfad, void *cmd, unsigned int v_cmd)
  2043. {
  2044. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  2045. struct bfa_fcport_s *fcport = BFA_FCPORT_MOD(&bfad->bfa);
  2046. unsigned long flags;
  2047. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2048. if (bfa_ioc_get_type(&bfad->bfa.ioc) == BFA_IOC_TYPE_FC) {
  2049. if ((fcport->cfg.topology == BFA_PORT_TOPOLOGY_LOOP) &&
  2050. (fcport->topology == BFA_PORT_TOPOLOGY_LOOP))
  2051. iocmd->status = BFA_STATUS_TOPOLOGY_LOOP;
  2052. else {
  2053. if (v_cmd == IOCMD_QOS_ENABLE)
  2054. fcport->cfg.qos_enabled = BFA_TRUE;
  2055. else if (v_cmd == IOCMD_QOS_DISABLE) {
  2056. fcport->cfg.qos_enabled = BFA_FALSE;
  2057. fcport->cfg.qos_bw.high = BFA_QOS_BW_HIGH;
  2058. fcport->cfg.qos_bw.med = BFA_QOS_BW_MED;
  2059. fcport->cfg.qos_bw.low = BFA_QOS_BW_LOW;
  2060. }
  2061. }
  2062. }
  2063. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2064. return 0;
  2065. }
  2066. static int
  2067. bfad_iocmd_qos_get_attr(struct bfad_s *bfad, void *cmd)
  2068. {
  2069. struct bfa_bsg_qos_attr_s *iocmd = (struct bfa_bsg_qos_attr_s *)cmd;
  2070. struct bfa_fcport_s *fcport = BFA_FCPORT_MOD(&bfad->bfa);
  2071. unsigned long flags;
  2072. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2073. if ((fcport->cfg.topology == BFA_PORT_TOPOLOGY_LOOP) &&
  2074. (fcport->topology == BFA_PORT_TOPOLOGY_LOOP))
  2075. iocmd->status = BFA_STATUS_TOPOLOGY_LOOP;
  2076. else {
  2077. iocmd->attr.state = fcport->qos_attr.state;
  2078. iocmd->attr.total_bb_cr =
  2079. be32_to_cpu(fcport->qos_attr.total_bb_cr);
  2080. iocmd->attr.qos_bw.high = fcport->cfg.qos_bw.high;
  2081. iocmd->attr.qos_bw.med = fcport->cfg.qos_bw.med;
  2082. iocmd->attr.qos_bw.low = fcport->cfg.qos_bw.low;
  2083. iocmd->attr.qos_bw_op = fcport->qos_attr.qos_bw_op;
  2084. iocmd->status = BFA_STATUS_OK;
  2085. }
  2086. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2087. return 0;
  2088. }
  2089. static int
  2090. bfad_iocmd_qos_get_vc_attr(struct bfad_s *bfad, void *cmd)
  2091. {
  2092. struct bfa_bsg_qos_vc_attr_s *iocmd =
  2093. (struct bfa_bsg_qos_vc_attr_s *)cmd;
  2094. struct bfa_fcport_s *fcport = BFA_FCPORT_MOD(&bfad->bfa);
  2095. struct bfa_qos_vc_attr_s *bfa_vc_attr = &fcport->qos_vc_attr;
  2096. unsigned long flags;
  2097. u32 i = 0;
  2098. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2099. iocmd->attr.total_vc_count = be16_to_cpu(bfa_vc_attr->total_vc_count);
  2100. iocmd->attr.shared_credit = be16_to_cpu(bfa_vc_attr->shared_credit);
  2101. iocmd->attr.elp_opmode_flags =
  2102. be32_to_cpu(bfa_vc_attr->elp_opmode_flags);
  2103. /* Individual VC info */
  2104. while (i < iocmd->attr.total_vc_count) {
  2105. iocmd->attr.vc_info[i].vc_credit =
  2106. bfa_vc_attr->vc_info[i].vc_credit;
  2107. iocmd->attr.vc_info[i].borrow_credit =
  2108. bfa_vc_attr->vc_info[i].borrow_credit;
  2109. iocmd->attr.vc_info[i].priority =
  2110. bfa_vc_attr->vc_info[i].priority;
  2111. i++;
  2112. }
  2113. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2114. iocmd->status = BFA_STATUS_OK;
  2115. return 0;
  2116. }
  2117. static int
  2118. bfad_iocmd_qos_get_stats(struct bfad_s *bfad, void *cmd)
  2119. {
  2120. struct bfa_bsg_fcport_stats_s *iocmd =
  2121. (struct bfa_bsg_fcport_stats_s *)cmd;
  2122. struct bfad_hal_comp fcomp;
  2123. unsigned long flags;
  2124. struct bfa_cb_pending_q_s cb_qe;
  2125. struct bfa_fcport_s *fcport = BFA_FCPORT_MOD(&bfad->bfa);
  2126. init_completion(&fcomp.comp);
  2127. bfa_pending_q_init(&cb_qe, (bfa_cb_cbfn_t)bfad_hcb_comp,
  2128. &fcomp, &iocmd->stats);
  2129. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2130. WARN_ON(!bfa_ioc_get_fcmode(&bfad->bfa.ioc));
  2131. if ((fcport->cfg.topology == BFA_PORT_TOPOLOGY_LOOP) &&
  2132. (fcport->topology == BFA_PORT_TOPOLOGY_LOOP))
  2133. iocmd->status = BFA_STATUS_TOPOLOGY_LOOP;
  2134. else
  2135. iocmd->status = bfa_fcport_get_stats(&bfad->bfa, &cb_qe);
  2136. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2137. if (iocmd->status != BFA_STATUS_OK) {
  2138. bfa_trc(bfad, iocmd->status);
  2139. goto out;
  2140. }
  2141. wait_for_completion(&fcomp.comp);
  2142. iocmd->status = fcomp.status;
  2143. out:
  2144. return 0;
  2145. }
  2146. static int
  2147. bfad_iocmd_qos_reset_stats(struct bfad_s *bfad, void *cmd)
  2148. {
  2149. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)cmd;
  2150. struct bfad_hal_comp fcomp;
  2151. unsigned long flags;
  2152. struct bfa_cb_pending_q_s cb_qe;
  2153. struct bfa_fcport_s *fcport = BFA_FCPORT_MOD(&bfad->bfa);
  2154. init_completion(&fcomp.comp);
  2155. bfa_pending_q_init(&cb_qe, (bfa_cb_cbfn_t)bfad_hcb_comp,
  2156. &fcomp, NULL);
  2157. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2158. WARN_ON(!bfa_ioc_get_fcmode(&bfad->bfa.ioc));
  2159. if ((fcport->cfg.topology == BFA_PORT_TOPOLOGY_LOOP) &&
  2160. (fcport->topology == BFA_PORT_TOPOLOGY_LOOP))
  2161. iocmd->status = BFA_STATUS_TOPOLOGY_LOOP;
  2162. else
  2163. iocmd->status = bfa_fcport_clear_stats(&bfad->bfa, &cb_qe);
  2164. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2165. if (iocmd->status != BFA_STATUS_OK) {
  2166. bfa_trc(bfad, iocmd->status);
  2167. goto out;
  2168. }
  2169. wait_for_completion(&fcomp.comp);
  2170. iocmd->status = fcomp.status;
  2171. out:
  2172. return 0;
  2173. }
  2174. static int
  2175. bfad_iocmd_vf_get_stats(struct bfad_s *bfad, void *cmd)
  2176. {
  2177. struct bfa_bsg_vf_stats_s *iocmd =
  2178. (struct bfa_bsg_vf_stats_s *)cmd;
  2179. struct bfa_fcs_fabric_s *fcs_vf;
  2180. unsigned long flags;
  2181. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2182. fcs_vf = bfa_fcs_vf_lookup(&bfad->bfa_fcs, iocmd->vf_id);
  2183. if (fcs_vf == NULL) {
  2184. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2185. iocmd->status = BFA_STATUS_UNKNOWN_VFID;
  2186. goto out;
  2187. }
  2188. memcpy((void *)&iocmd->stats, (void *)&fcs_vf->stats,
  2189. sizeof(struct bfa_vf_stats_s));
  2190. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2191. iocmd->status = BFA_STATUS_OK;
  2192. out:
  2193. return 0;
  2194. }
  2195. static int
  2196. bfad_iocmd_vf_clr_stats(struct bfad_s *bfad, void *cmd)
  2197. {
  2198. struct bfa_bsg_vf_reset_stats_s *iocmd =
  2199. (struct bfa_bsg_vf_reset_stats_s *)cmd;
  2200. struct bfa_fcs_fabric_s *fcs_vf;
  2201. unsigned long flags;
  2202. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2203. fcs_vf = bfa_fcs_vf_lookup(&bfad->bfa_fcs, iocmd->vf_id);
  2204. if (fcs_vf == NULL) {
  2205. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2206. iocmd->status = BFA_STATUS_UNKNOWN_VFID;
  2207. goto out;
  2208. }
  2209. memset((void *)&fcs_vf->stats, 0, sizeof(struct bfa_vf_stats_s));
  2210. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2211. iocmd->status = BFA_STATUS_OK;
  2212. out:
  2213. return 0;
  2214. }
  2215. /* Function to reset the LUN SCAN mode */
  2216. static void
  2217. bfad_iocmd_lunmask_reset_lunscan_mode(struct bfad_s *bfad, int lunmask_cfg)
  2218. {
  2219. struct bfad_im_port_s *pport_im = bfad->pport.im_port;
  2220. struct bfad_vport_s *vport = NULL;
  2221. /* Set the scsi device LUN SCAN flags for base port */
  2222. bfad_reset_sdev_bflags(pport_im, lunmask_cfg);
  2223. /* Set the scsi device LUN SCAN flags for the vports */
  2224. list_for_each_entry(vport, &bfad->vport_list, list_entry)
  2225. bfad_reset_sdev_bflags(vport->drv_port.im_port, lunmask_cfg);
  2226. }
  2227. static int
  2228. bfad_iocmd_lunmask(struct bfad_s *bfad, void *pcmd, unsigned int v_cmd)
  2229. {
  2230. struct bfa_bsg_gen_s *iocmd = (struct bfa_bsg_gen_s *)pcmd;
  2231. unsigned long flags;
  2232. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2233. if (v_cmd == IOCMD_FCPIM_LUNMASK_ENABLE) {
  2234. iocmd->status = bfa_fcpim_lunmask_update(&bfad->bfa, BFA_TRUE);
  2235. /* Set the LUN Scanning mode to be Sequential scan */
  2236. if (iocmd->status == BFA_STATUS_OK)
  2237. bfad_iocmd_lunmask_reset_lunscan_mode(bfad, BFA_TRUE);
  2238. } else if (v_cmd == IOCMD_FCPIM_LUNMASK_DISABLE) {
  2239. iocmd->status = bfa_fcpim_lunmask_update(&bfad->bfa, BFA_FALSE);
  2240. /* Set the LUN Scanning mode to default REPORT_LUNS scan */
  2241. if (iocmd->status == BFA_STATUS_OK)
  2242. bfad_iocmd_lunmask_reset_lunscan_mode(bfad, BFA_FALSE);
  2243. } else if (v_cmd == IOCMD_FCPIM_LUNMASK_CLEAR)
  2244. iocmd->status = bfa_fcpim_lunmask_clear(&bfad->bfa);
  2245. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2246. return 0;
  2247. }
  2248. static int
  2249. bfad_iocmd_fcpim_lunmask_query(struct bfad_s *bfad, void *cmd)
  2250. {
  2251. struct bfa_bsg_fcpim_lunmask_query_s *iocmd =
  2252. (struct bfa_bsg_fcpim_lunmask_query_s *)cmd;
  2253. struct bfa_lunmask_cfg_s *lun_mask = &iocmd->lun_mask;
  2254. unsigned long flags;
  2255. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2256. iocmd->status = bfa_fcpim_lunmask_query(&bfad->bfa, lun_mask);
  2257. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2258. return 0;
  2259. }
  2260. static int
  2261. bfad_iocmd_fcpim_cfg_lunmask(struct bfad_s *bfad, void *cmd, unsigned int v_cmd)
  2262. {
  2263. struct bfa_bsg_fcpim_lunmask_s *iocmd =
  2264. (struct bfa_bsg_fcpim_lunmask_s *)cmd;
  2265. unsigned long flags;
  2266. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2267. if (v_cmd == IOCMD_FCPIM_LUNMASK_ADD)
  2268. iocmd->status = bfa_fcpim_lunmask_add(&bfad->bfa, iocmd->vf_id,
  2269. &iocmd->pwwn, iocmd->rpwwn, iocmd->lun);
  2270. else if (v_cmd == IOCMD_FCPIM_LUNMASK_DELETE)
  2271. iocmd->status = bfa_fcpim_lunmask_delete(&bfad->bfa,
  2272. iocmd->vf_id, &iocmd->pwwn,
  2273. iocmd->rpwwn, iocmd->lun);
  2274. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2275. return 0;
  2276. }
  2277. static int
  2278. bfad_iocmd_fcpim_throttle_query(struct bfad_s *bfad, void *cmd)
  2279. {
  2280. struct bfa_bsg_fcpim_throttle_s *iocmd =
  2281. (struct bfa_bsg_fcpim_throttle_s *)cmd;
  2282. unsigned long flags;
  2283. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2284. iocmd->status = bfa_fcpim_throttle_get(&bfad->bfa,
  2285. (void *)&iocmd->throttle);
  2286. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2287. return 0;
  2288. }
  2289. static int
  2290. bfad_iocmd_fcpim_throttle_set(struct bfad_s *bfad, void *cmd)
  2291. {
  2292. struct bfa_bsg_fcpim_throttle_s *iocmd =
  2293. (struct bfa_bsg_fcpim_throttle_s *)cmd;
  2294. unsigned long flags;
  2295. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2296. iocmd->status = bfa_fcpim_throttle_set(&bfad->bfa,
  2297. iocmd->throttle.cfg_value);
  2298. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2299. return 0;
  2300. }
  2301. static int
  2302. bfad_iocmd_tfru_read(struct bfad_s *bfad, void *cmd)
  2303. {
  2304. struct bfa_bsg_tfru_s *iocmd =
  2305. (struct bfa_bsg_tfru_s *)cmd;
  2306. struct bfad_hal_comp fcomp;
  2307. unsigned long flags = 0;
  2308. init_completion(&fcomp.comp);
  2309. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2310. iocmd->status = bfa_tfru_read(BFA_FRU(&bfad->bfa),
  2311. &iocmd->data, iocmd->len, iocmd->offset,
  2312. bfad_hcb_comp, &fcomp);
  2313. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2314. if (iocmd->status == BFA_STATUS_OK) {
  2315. wait_for_completion(&fcomp.comp);
  2316. iocmd->status = fcomp.status;
  2317. }
  2318. return 0;
  2319. }
  2320. static int
  2321. bfad_iocmd_tfru_write(struct bfad_s *bfad, void *cmd)
  2322. {
  2323. struct bfa_bsg_tfru_s *iocmd =
  2324. (struct bfa_bsg_tfru_s *)cmd;
  2325. struct bfad_hal_comp fcomp;
  2326. unsigned long flags = 0;
  2327. init_completion(&fcomp.comp);
  2328. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2329. iocmd->status = bfa_tfru_write(BFA_FRU(&bfad->bfa),
  2330. &iocmd->data, iocmd->len, iocmd->offset,
  2331. bfad_hcb_comp, &fcomp);
  2332. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2333. if (iocmd->status == BFA_STATUS_OK) {
  2334. wait_for_completion(&fcomp.comp);
  2335. iocmd->status = fcomp.status;
  2336. }
  2337. return 0;
  2338. }
  2339. static int
  2340. bfad_iocmd_fruvpd_read(struct bfad_s *bfad, void *cmd)
  2341. {
  2342. struct bfa_bsg_fruvpd_s *iocmd =
  2343. (struct bfa_bsg_fruvpd_s *)cmd;
  2344. struct bfad_hal_comp fcomp;
  2345. unsigned long flags = 0;
  2346. init_completion(&fcomp.comp);
  2347. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2348. iocmd->status = bfa_fruvpd_read(BFA_FRU(&bfad->bfa),
  2349. &iocmd->data, iocmd->len, iocmd->offset,
  2350. bfad_hcb_comp, &fcomp);
  2351. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2352. if (iocmd->status == BFA_STATUS_OK) {
  2353. wait_for_completion(&fcomp.comp);
  2354. iocmd->status = fcomp.status;
  2355. }
  2356. return 0;
  2357. }
  2358. static int
  2359. bfad_iocmd_fruvpd_update(struct bfad_s *bfad, void *cmd)
  2360. {
  2361. struct bfa_bsg_fruvpd_s *iocmd =
  2362. (struct bfa_bsg_fruvpd_s *)cmd;
  2363. struct bfad_hal_comp fcomp;
  2364. unsigned long flags = 0;
  2365. init_completion(&fcomp.comp);
  2366. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2367. iocmd->status = bfa_fruvpd_update(BFA_FRU(&bfad->bfa),
  2368. &iocmd->data, iocmd->len, iocmd->offset,
  2369. bfad_hcb_comp, &fcomp, iocmd->trfr_cmpl);
  2370. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2371. if (iocmd->status == BFA_STATUS_OK) {
  2372. wait_for_completion(&fcomp.comp);
  2373. iocmd->status = fcomp.status;
  2374. }
  2375. return 0;
  2376. }
  2377. static int
  2378. bfad_iocmd_fruvpd_get_max_size(struct bfad_s *bfad, void *cmd)
  2379. {
  2380. struct bfa_bsg_fruvpd_max_size_s *iocmd =
  2381. (struct bfa_bsg_fruvpd_max_size_s *)cmd;
  2382. unsigned long flags = 0;
  2383. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2384. iocmd->status = bfa_fruvpd_get_max_size(BFA_FRU(&bfad->bfa),
  2385. &iocmd->max_size);
  2386. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2387. return 0;
  2388. }
  2389. static int
  2390. bfad_iocmd_handler(struct bfad_s *bfad, unsigned int cmd, void *iocmd,
  2391. unsigned int payload_len)
  2392. {
  2393. int rc = -EINVAL;
  2394. switch (cmd) {
  2395. case IOCMD_IOC_ENABLE:
  2396. rc = bfad_iocmd_ioc_enable(bfad, iocmd);
  2397. break;
  2398. case IOCMD_IOC_DISABLE:
  2399. rc = bfad_iocmd_ioc_disable(bfad, iocmd);
  2400. break;
  2401. case IOCMD_IOC_GET_INFO:
  2402. rc = bfad_iocmd_ioc_get_info(bfad, iocmd);
  2403. break;
  2404. case IOCMD_IOC_GET_ATTR:
  2405. rc = bfad_iocmd_ioc_get_attr(bfad, iocmd);
  2406. break;
  2407. case IOCMD_IOC_GET_STATS:
  2408. rc = bfad_iocmd_ioc_get_stats(bfad, iocmd);
  2409. break;
  2410. case IOCMD_IOC_GET_FWSTATS:
  2411. rc = bfad_iocmd_ioc_get_fwstats(bfad, iocmd, payload_len);
  2412. break;
  2413. case IOCMD_IOC_RESET_STATS:
  2414. case IOCMD_IOC_RESET_FWSTATS:
  2415. rc = bfad_iocmd_ioc_reset_stats(bfad, iocmd, cmd);
  2416. break;
  2417. case IOCMD_IOC_SET_ADAPTER_NAME:
  2418. case IOCMD_IOC_SET_PORT_NAME:
  2419. rc = bfad_iocmd_ioc_set_name(bfad, iocmd, cmd);
  2420. break;
  2421. case IOCMD_IOCFC_GET_ATTR:
  2422. rc = bfad_iocmd_iocfc_get_attr(bfad, iocmd);
  2423. break;
  2424. case IOCMD_IOCFC_SET_INTR:
  2425. rc = bfad_iocmd_iocfc_set_intr(bfad, iocmd);
  2426. break;
  2427. case IOCMD_PORT_ENABLE:
  2428. rc = bfad_iocmd_port_enable(bfad, iocmd);
  2429. break;
  2430. case IOCMD_PORT_DISABLE:
  2431. rc = bfad_iocmd_port_disable(bfad, iocmd);
  2432. break;
  2433. case IOCMD_PORT_GET_ATTR:
  2434. rc = bfad_iocmd_port_get_attr(bfad, iocmd);
  2435. break;
  2436. case IOCMD_PORT_GET_STATS:
  2437. rc = bfad_iocmd_port_get_stats(bfad, iocmd, payload_len);
  2438. break;
  2439. case IOCMD_PORT_RESET_STATS:
  2440. rc = bfad_iocmd_port_reset_stats(bfad, iocmd);
  2441. break;
  2442. case IOCMD_PORT_CFG_TOPO:
  2443. case IOCMD_PORT_CFG_SPEED:
  2444. case IOCMD_PORT_CFG_ALPA:
  2445. case IOCMD_PORT_CLR_ALPA:
  2446. rc = bfad_iocmd_set_port_cfg(bfad, iocmd, cmd);
  2447. break;
  2448. case IOCMD_PORT_CFG_MAXFRSZ:
  2449. rc = bfad_iocmd_port_cfg_maxfrsize(bfad, iocmd);
  2450. break;
  2451. case IOCMD_PORT_BBCR_ENABLE:
  2452. case IOCMD_PORT_BBCR_DISABLE:
  2453. rc = bfad_iocmd_port_cfg_bbcr(bfad, cmd, iocmd);
  2454. break;
  2455. case IOCMD_PORT_BBCR_GET_ATTR:
  2456. rc = bfad_iocmd_port_get_bbcr_attr(bfad, iocmd);
  2457. break;
  2458. case IOCMD_LPORT_GET_ATTR:
  2459. rc = bfad_iocmd_lport_get_attr(bfad, iocmd);
  2460. break;
  2461. case IOCMD_LPORT_GET_STATS:
  2462. rc = bfad_iocmd_lport_get_stats(bfad, iocmd);
  2463. break;
  2464. case IOCMD_LPORT_RESET_STATS:
  2465. rc = bfad_iocmd_lport_reset_stats(bfad, iocmd);
  2466. break;
  2467. case IOCMD_LPORT_GET_IOSTATS:
  2468. rc = bfad_iocmd_lport_get_iostats(bfad, iocmd);
  2469. break;
  2470. case IOCMD_LPORT_GET_RPORTS:
  2471. rc = bfad_iocmd_lport_get_rports(bfad, iocmd, payload_len);
  2472. break;
  2473. case IOCMD_RPORT_GET_ATTR:
  2474. rc = bfad_iocmd_rport_get_attr(bfad, iocmd);
  2475. break;
  2476. case IOCMD_RPORT_GET_ADDR:
  2477. rc = bfad_iocmd_rport_get_addr(bfad, iocmd);
  2478. break;
  2479. case IOCMD_RPORT_GET_STATS:
  2480. rc = bfad_iocmd_rport_get_stats(bfad, iocmd);
  2481. break;
  2482. case IOCMD_RPORT_RESET_STATS:
  2483. rc = bfad_iocmd_rport_clr_stats(bfad, iocmd);
  2484. break;
  2485. case IOCMD_RPORT_SET_SPEED:
  2486. rc = bfad_iocmd_rport_set_speed(bfad, iocmd);
  2487. break;
  2488. case IOCMD_VPORT_GET_ATTR:
  2489. rc = bfad_iocmd_vport_get_attr(bfad, iocmd);
  2490. break;
  2491. case IOCMD_VPORT_GET_STATS:
  2492. rc = bfad_iocmd_vport_get_stats(bfad, iocmd);
  2493. break;
  2494. case IOCMD_VPORT_RESET_STATS:
  2495. rc = bfad_iocmd_vport_clr_stats(bfad, iocmd);
  2496. break;
  2497. case IOCMD_FABRIC_GET_LPORTS:
  2498. rc = bfad_iocmd_fabric_get_lports(bfad, iocmd, payload_len);
  2499. break;
  2500. case IOCMD_RATELIM_ENABLE:
  2501. case IOCMD_RATELIM_DISABLE:
  2502. rc = bfad_iocmd_ratelim(bfad, cmd, iocmd);
  2503. break;
  2504. case IOCMD_RATELIM_DEF_SPEED:
  2505. rc = bfad_iocmd_ratelim_speed(bfad, cmd, iocmd);
  2506. break;
  2507. case IOCMD_FCPIM_FAILOVER:
  2508. rc = bfad_iocmd_cfg_fcpim(bfad, iocmd);
  2509. break;
  2510. case IOCMD_FCPIM_MODSTATS:
  2511. rc = bfad_iocmd_fcpim_get_modstats(bfad, iocmd);
  2512. break;
  2513. case IOCMD_FCPIM_MODSTATSCLR:
  2514. rc = bfad_iocmd_fcpim_clr_modstats(bfad, iocmd);
  2515. break;
  2516. case IOCMD_FCPIM_DEL_ITN_STATS:
  2517. rc = bfad_iocmd_fcpim_get_del_itn_stats(bfad, iocmd);
  2518. break;
  2519. case IOCMD_ITNIM_GET_ATTR:
  2520. rc = bfad_iocmd_itnim_get_attr(bfad, iocmd);
  2521. break;
  2522. case IOCMD_ITNIM_GET_IOSTATS:
  2523. rc = bfad_iocmd_itnim_get_iostats(bfad, iocmd);
  2524. break;
  2525. case IOCMD_ITNIM_RESET_STATS:
  2526. rc = bfad_iocmd_itnim_reset_stats(bfad, iocmd);
  2527. break;
  2528. case IOCMD_ITNIM_GET_ITNSTATS:
  2529. rc = bfad_iocmd_itnim_get_itnstats(bfad, iocmd);
  2530. break;
  2531. case IOCMD_FCPORT_ENABLE:
  2532. rc = bfad_iocmd_fcport_enable(bfad, iocmd);
  2533. break;
  2534. case IOCMD_FCPORT_DISABLE:
  2535. rc = bfad_iocmd_fcport_disable(bfad, iocmd);
  2536. break;
  2537. case IOCMD_IOC_PCIFN_CFG:
  2538. rc = bfad_iocmd_ioc_get_pcifn_cfg(bfad, iocmd);
  2539. break;
  2540. case IOCMD_IOC_FW_SIG_INV:
  2541. rc = bfad_iocmd_ioc_fw_sig_inv(bfad, iocmd);
  2542. break;
  2543. case IOCMD_PCIFN_CREATE:
  2544. rc = bfad_iocmd_pcifn_create(bfad, iocmd);
  2545. break;
  2546. case IOCMD_PCIFN_DELETE:
  2547. rc = bfad_iocmd_pcifn_delete(bfad, iocmd);
  2548. break;
  2549. case IOCMD_PCIFN_BW:
  2550. rc = bfad_iocmd_pcifn_bw(bfad, iocmd);
  2551. break;
  2552. case IOCMD_ADAPTER_CFG_MODE:
  2553. rc = bfad_iocmd_adapter_cfg_mode(bfad, iocmd);
  2554. break;
  2555. case IOCMD_PORT_CFG_MODE:
  2556. rc = bfad_iocmd_port_cfg_mode(bfad, iocmd);
  2557. break;
  2558. case IOCMD_FLASH_ENABLE_OPTROM:
  2559. case IOCMD_FLASH_DISABLE_OPTROM:
  2560. rc = bfad_iocmd_ablk_optrom(bfad, cmd, iocmd);
  2561. break;
  2562. case IOCMD_FAA_QUERY:
  2563. rc = bfad_iocmd_faa_query(bfad, iocmd);
  2564. break;
  2565. case IOCMD_CEE_GET_ATTR:
  2566. rc = bfad_iocmd_cee_attr(bfad, iocmd, payload_len);
  2567. break;
  2568. case IOCMD_CEE_GET_STATS:
  2569. rc = bfad_iocmd_cee_get_stats(bfad, iocmd, payload_len);
  2570. break;
  2571. case IOCMD_CEE_RESET_STATS:
  2572. rc = bfad_iocmd_cee_reset_stats(bfad, iocmd);
  2573. break;
  2574. case IOCMD_SFP_MEDIA:
  2575. rc = bfad_iocmd_sfp_media(bfad, iocmd);
  2576. break;
  2577. case IOCMD_SFP_SPEED:
  2578. rc = bfad_iocmd_sfp_speed(bfad, iocmd);
  2579. break;
  2580. case IOCMD_FLASH_GET_ATTR:
  2581. rc = bfad_iocmd_flash_get_attr(bfad, iocmd);
  2582. break;
  2583. case IOCMD_FLASH_ERASE_PART:
  2584. rc = bfad_iocmd_flash_erase_part(bfad, iocmd);
  2585. break;
  2586. case IOCMD_FLASH_UPDATE_PART:
  2587. rc = bfad_iocmd_flash_update_part(bfad, iocmd, payload_len);
  2588. break;
  2589. case IOCMD_FLASH_READ_PART:
  2590. rc = bfad_iocmd_flash_read_part(bfad, iocmd, payload_len);
  2591. break;
  2592. case IOCMD_DIAG_TEMP:
  2593. rc = bfad_iocmd_diag_temp(bfad, iocmd);
  2594. break;
  2595. case IOCMD_DIAG_MEMTEST:
  2596. rc = bfad_iocmd_diag_memtest(bfad, iocmd);
  2597. break;
  2598. case IOCMD_DIAG_LOOPBACK:
  2599. rc = bfad_iocmd_diag_loopback(bfad, iocmd);
  2600. break;
  2601. case IOCMD_DIAG_FWPING:
  2602. rc = bfad_iocmd_diag_fwping(bfad, iocmd);
  2603. break;
  2604. case IOCMD_DIAG_QUEUETEST:
  2605. rc = bfad_iocmd_diag_queuetest(bfad, iocmd);
  2606. break;
  2607. case IOCMD_DIAG_SFP:
  2608. rc = bfad_iocmd_diag_sfp(bfad, iocmd);
  2609. break;
  2610. case IOCMD_DIAG_LED:
  2611. rc = bfad_iocmd_diag_led(bfad, iocmd);
  2612. break;
  2613. case IOCMD_DIAG_BEACON_LPORT:
  2614. rc = bfad_iocmd_diag_beacon_lport(bfad, iocmd);
  2615. break;
  2616. case IOCMD_DIAG_LB_STAT:
  2617. rc = bfad_iocmd_diag_lb_stat(bfad, iocmd);
  2618. break;
  2619. case IOCMD_DIAG_DPORT_ENABLE:
  2620. rc = bfad_iocmd_diag_dport_enable(bfad, iocmd);
  2621. break;
  2622. case IOCMD_DIAG_DPORT_DISABLE:
  2623. rc = bfad_iocmd_diag_dport_disable(bfad, iocmd);
  2624. break;
  2625. case IOCMD_DIAG_DPORT_SHOW:
  2626. rc = bfad_iocmd_diag_dport_show(bfad, iocmd);
  2627. break;
  2628. case IOCMD_DIAG_DPORT_START:
  2629. rc = bfad_iocmd_diag_dport_start(bfad, iocmd);
  2630. break;
  2631. case IOCMD_PHY_GET_ATTR:
  2632. rc = bfad_iocmd_phy_get_attr(bfad, iocmd);
  2633. break;
  2634. case IOCMD_PHY_GET_STATS:
  2635. rc = bfad_iocmd_phy_get_stats(bfad, iocmd);
  2636. break;
  2637. case IOCMD_PHY_UPDATE_FW:
  2638. rc = bfad_iocmd_phy_update(bfad, iocmd, payload_len);
  2639. break;
  2640. case IOCMD_PHY_READ_FW:
  2641. rc = bfad_iocmd_phy_read(bfad, iocmd, payload_len);
  2642. break;
  2643. case IOCMD_VHBA_QUERY:
  2644. rc = bfad_iocmd_vhba_query(bfad, iocmd);
  2645. break;
  2646. case IOCMD_DEBUG_PORTLOG:
  2647. rc = bfad_iocmd_porglog_get(bfad, iocmd);
  2648. break;
  2649. case IOCMD_DEBUG_FW_CORE:
  2650. rc = bfad_iocmd_debug_fw_core(bfad, iocmd, payload_len);
  2651. break;
  2652. case IOCMD_DEBUG_FW_STATE_CLR:
  2653. case IOCMD_DEBUG_PORTLOG_CLR:
  2654. case IOCMD_DEBUG_START_DTRC:
  2655. case IOCMD_DEBUG_STOP_DTRC:
  2656. rc = bfad_iocmd_debug_ctl(bfad, iocmd, cmd);
  2657. break;
  2658. case IOCMD_DEBUG_PORTLOG_CTL:
  2659. rc = bfad_iocmd_porglog_ctl(bfad, iocmd);
  2660. break;
  2661. case IOCMD_FCPIM_PROFILE_ON:
  2662. case IOCMD_FCPIM_PROFILE_OFF:
  2663. rc = bfad_iocmd_fcpim_cfg_profile(bfad, iocmd, cmd);
  2664. break;
  2665. case IOCMD_ITNIM_GET_IOPROFILE:
  2666. rc = bfad_iocmd_itnim_get_ioprofile(bfad, iocmd);
  2667. break;
  2668. case IOCMD_FCPORT_GET_STATS:
  2669. rc = bfad_iocmd_fcport_get_stats(bfad, iocmd);
  2670. break;
  2671. case IOCMD_FCPORT_RESET_STATS:
  2672. rc = bfad_iocmd_fcport_reset_stats(bfad, iocmd);
  2673. break;
  2674. case IOCMD_BOOT_CFG:
  2675. rc = bfad_iocmd_boot_cfg(bfad, iocmd);
  2676. break;
  2677. case IOCMD_BOOT_QUERY:
  2678. rc = bfad_iocmd_boot_query(bfad, iocmd);
  2679. break;
  2680. case IOCMD_PREBOOT_QUERY:
  2681. rc = bfad_iocmd_preboot_query(bfad, iocmd);
  2682. break;
  2683. case IOCMD_ETHBOOT_CFG:
  2684. rc = bfad_iocmd_ethboot_cfg(bfad, iocmd);
  2685. break;
  2686. case IOCMD_ETHBOOT_QUERY:
  2687. rc = bfad_iocmd_ethboot_query(bfad, iocmd);
  2688. break;
  2689. case IOCMD_TRUNK_ENABLE:
  2690. case IOCMD_TRUNK_DISABLE:
  2691. rc = bfad_iocmd_cfg_trunk(bfad, iocmd, cmd);
  2692. break;
  2693. case IOCMD_TRUNK_GET_ATTR:
  2694. rc = bfad_iocmd_trunk_get_attr(bfad, iocmd);
  2695. break;
  2696. case IOCMD_QOS_ENABLE:
  2697. case IOCMD_QOS_DISABLE:
  2698. rc = bfad_iocmd_qos(bfad, iocmd, cmd);
  2699. break;
  2700. case IOCMD_QOS_GET_ATTR:
  2701. rc = bfad_iocmd_qos_get_attr(bfad, iocmd);
  2702. break;
  2703. case IOCMD_QOS_GET_VC_ATTR:
  2704. rc = bfad_iocmd_qos_get_vc_attr(bfad, iocmd);
  2705. break;
  2706. case IOCMD_QOS_GET_STATS:
  2707. rc = bfad_iocmd_qos_get_stats(bfad, iocmd);
  2708. break;
  2709. case IOCMD_QOS_RESET_STATS:
  2710. rc = bfad_iocmd_qos_reset_stats(bfad, iocmd);
  2711. break;
  2712. case IOCMD_QOS_SET_BW:
  2713. rc = bfad_iocmd_qos_set_bw(bfad, iocmd);
  2714. break;
  2715. case IOCMD_VF_GET_STATS:
  2716. rc = bfad_iocmd_vf_get_stats(bfad, iocmd);
  2717. break;
  2718. case IOCMD_VF_RESET_STATS:
  2719. rc = bfad_iocmd_vf_clr_stats(bfad, iocmd);
  2720. break;
  2721. case IOCMD_FCPIM_LUNMASK_ENABLE:
  2722. case IOCMD_FCPIM_LUNMASK_DISABLE:
  2723. case IOCMD_FCPIM_LUNMASK_CLEAR:
  2724. rc = bfad_iocmd_lunmask(bfad, iocmd, cmd);
  2725. break;
  2726. case IOCMD_FCPIM_LUNMASK_QUERY:
  2727. rc = bfad_iocmd_fcpim_lunmask_query(bfad, iocmd);
  2728. break;
  2729. case IOCMD_FCPIM_LUNMASK_ADD:
  2730. case IOCMD_FCPIM_LUNMASK_DELETE:
  2731. rc = bfad_iocmd_fcpim_cfg_lunmask(bfad, iocmd, cmd);
  2732. break;
  2733. case IOCMD_FCPIM_THROTTLE_QUERY:
  2734. rc = bfad_iocmd_fcpim_throttle_query(bfad, iocmd);
  2735. break;
  2736. case IOCMD_FCPIM_THROTTLE_SET:
  2737. rc = bfad_iocmd_fcpim_throttle_set(bfad, iocmd);
  2738. break;
  2739. /* TFRU */
  2740. case IOCMD_TFRU_READ:
  2741. rc = bfad_iocmd_tfru_read(bfad, iocmd);
  2742. break;
  2743. case IOCMD_TFRU_WRITE:
  2744. rc = bfad_iocmd_tfru_write(bfad, iocmd);
  2745. break;
  2746. /* FRU */
  2747. case IOCMD_FRUVPD_READ:
  2748. rc = bfad_iocmd_fruvpd_read(bfad, iocmd);
  2749. break;
  2750. case IOCMD_FRUVPD_UPDATE:
  2751. rc = bfad_iocmd_fruvpd_update(bfad, iocmd);
  2752. break;
  2753. case IOCMD_FRUVPD_GET_MAX_SIZE:
  2754. rc = bfad_iocmd_fruvpd_get_max_size(bfad, iocmd);
  2755. break;
  2756. default:
  2757. rc = -EINVAL;
  2758. break;
  2759. }
  2760. return rc;
  2761. }
  2762. static int
  2763. bfad_im_bsg_vendor_request(struct bsg_job *job)
  2764. {
  2765. struct fc_bsg_request *bsg_request = job->request;
  2766. struct fc_bsg_reply *bsg_reply = job->reply;
  2767. uint32_t vendor_cmd = bsg_request->rqst_data.h_vendor.vendor_cmd[0];
  2768. struct Scsi_Host *shost = fc_bsg_to_shost(job);
  2769. struct bfad_im_port_s *im_port = bfad_get_im_port(shost);
  2770. struct bfad_s *bfad = im_port->bfad;
  2771. void *payload_kbuf;
  2772. int rc = -EINVAL;
  2773. /* Allocate a temp buffer to hold the passed in user space command */
  2774. payload_kbuf = kzalloc(job->request_payload.payload_len, GFP_KERNEL);
  2775. if (!payload_kbuf) {
  2776. rc = -ENOMEM;
  2777. goto out;
  2778. }
  2779. /* Copy the sg_list passed in to a linear buffer: holds the cmnd data */
  2780. sg_copy_to_buffer(job->request_payload.sg_list,
  2781. job->request_payload.sg_cnt, payload_kbuf,
  2782. job->request_payload.payload_len);
  2783. /* Invoke IOCMD handler - to handle all the vendor command requests */
  2784. rc = bfad_iocmd_handler(bfad, vendor_cmd, payload_kbuf,
  2785. job->request_payload.payload_len);
  2786. if (rc != BFA_STATUS_OK)
  2787. goto error;
  2788. /* Copy the response data to the job->reply_payload sg_list */
  2789. sg_copy_from_buffer(job->reply_payload.sg_list,
  2790. job->reply_payload.sg_cnt,
  2791. payload_kbuf,
  2792. job->reply_payload.payload_len);
  2793. /* free the command buffer */
  2794. kfree(payload_kbuf);
  2795. /* Fill the BSG job reply data */
  2796. job->reply_len = job->reply_payload.payload_len;
  2797. bsg_reply->reply_payload_rcv_len = job->reply_payload.payload_len;
  2798. bsg_reply->result = rc;
  2799. bsg_job_done(job, bsg_reply->result,
  2800. bsg_reply->reply_payload_rcv_len);
  2801. return rc;
  2802. error:
  2803. /* free the command buffer */
  2804. kfree(payload_kbuf);
  2805. out:
  2806. bsg_reply->result = rc;
  2807. job->reply_len = sizeof(uint32_t);
  2808. bsg_reply->reply_payload_rcv_len = 0;
  2809. return rc;
  2810. }
  2811. /* FC passthru call backs */
  2812. static u64
  2813. bfad_fcxp_get_req_sgaddr_cb(void *bfad_fcxp, int sgeid)
  2814. {
  2815. struct bfad_fcxp *drv_fcxp = bfad_fcxp;
  2816. struct bfa_sge_s *sge;
  2817. u64 addr;
  2818. sge = drv_fcxp->req_sge + sgeid;
  2819. addr = (u64)(size_t) sge->sg_addr;
  2820. return addr;
  2821. }
  2822. static u32
  2823. bfad_fcxp_get_req_sglen_cb(void *bfad_fcxp, int sgeid)
  2824. {
  2825. struct bfad_fcxp *drv_fcxp = bfad_fcxp;
  2826. struct bfa_sge_s *sge;
  2827. sge = drv_fcxp->req_sge + sgeid;
  2828. return sge->sg_len;
  2829. }
  2830. static u64
  2831. bfad_fcxp_get_rsp_sgaddr_cb(void *bfad_fcxp, int sgeid)
  2832. {
  2833. struct bfad_fcxp *drv_fcxp = bfad_fcxp;
  2834. struct bfa_sge_s *sge;
  2835. u64 addr;
  2836. sge = drv_fcxp->rsp_sge + sgeid;
  2837. addr = (u64)(size_t) sge->sg_addr;
  2838. return addr;
  2839. }
  2840. static u32
  2841. bfad_fcxp_get_rsp_sglen_cb(void *bfad_fcxp, int sgeid)
  2842. {
  2843. struct bfad_fcxp *drv_fcxp = bfad_fcxp;
  2844. struct bfa_sge_s *sge;
  2845. sge = drv_fcxp->rsp_sge + sgeid;
  2846. return sge->sg_len;
  2847. }
  2848. static void
  2849. bfad_send_fcpt_cb(void *bfad_fcxp, struct bfa_fcxp_s *fcxp, void *cbarg,
  2850. bfa_status_t req_status, u32 rsp_len, u32 resid_len,
  2851. struct fchs_s *rsp_fchs)
  2852. {
  2853. struct bfad_fcxp *drv_fcxp = bfad_fcxp;
  2854. drv_fcxp->req_status = req_status;
  2855. drv_fcxp->rsp_len = rsp_len;
  2856. /* bfa_fcxp will be automatically freed by BFA */
  2857. drv_fcxp->bfa_fcxp = NULL;
  2858. complete(&drv_fcxp->comp);
  2859. }
  2860. static struct bfad_buf_info *
  2861. bfad_fcxp_map_sg(struct bfad_s *bfad, void *payload_kbuf,
  2862. uint32_t payload_len, uint32_t *num_sgles)
  2863. {
  2864. struct bfad_buf_info *buf_base, *buf_info;
  2865. struct bfa_sge_s *sg_table;
  2866. int sge_num = 1;
  2867. buf_base = kcalloc(sizeof(struct bfad_buf_info) +
  2868. sizeof(struct bfa_sge_s),
  2869. sge_num, GFP_KERNEL);
  2870. if (!buf_base)
  2871. return NULL;
  2872. sg_table = (struct bfa_sge_s *) (((uint8_t *)buf_base) +
  2873. (sizeof(struct bfad_buf_info) * sge_num));
  2874. /* Allocate dma coherent memory */
  2875. buf_info = buf_base;
  2876. buf_info->size = payload_len;
  2877. buf_info->virt = dma_alloc_coherent(&bfad->pcidev->dev,
  2878. buf_info->size, &buf_info->phys,
  2879. GFP_KERNEL);
  2880. if (!buf_info->virt)
  2881. goto out_free_mem;
  2882. /* copy the linear bsg buffer to buf_info */
  2883. memcpy(buf_info->virt, payload_kbuf, buf_info->size);
  2884. /*
  2885. * Setup SG table
  2886. */
  2887. sg_table->sg_len = buf_info->size;
  2888. sg_table->sg_addr = (void *)(size_t) buf_info->phys;
  2889. *num_sgles = sge_num;
  2890. return buf_base;
  2891. out_free_mem:
  2892. kfree(buf_base);
  2893. return NULL;
  2894. }
  2895. static void
  2896. bfad_fcxp_free_mem(struct bfad_s *bfad, struct bfad_buf_info *buf_base,
  2897. uint32_t num_sgles)
  2898. {
  2899. int i;
  2900. struct bfad_buf_info *buf_info = buf_base;
  2901. if (buf_base) {
  2902. for (i = 0; i < num_sgles; buf_info++, i++) {
  2903. if (buf_info->virt != NULL)
  2904. dma_free_coherent(&bfad->pcidev->dev,
  2905. buf_info->size, buf_info->virt,
  2906. buf_info->phys);
  2907. }
  2908. kfree(buf_base);
  2909. }
  2910. }
  2911. static int
  2912. bfad_fcxp_bsg_send(struct bsg_job *job, struct bfad_fcxp *drv_fcxp,
  2913. bfa_bsg_fcpt_t *bsg_fcpt)
  2914. {
  2915. struct bfa_fcxp_s *hal_fcxp;
  2916. struct bfad_s *bfad = drv_fcxp->port->bfad;
  2917. unsigned long flags;
  2918. uint8_t lp_tag;
  2919. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2920. /* Allocate bfa_fcxp structure */
  2921. hal_fcxp = bfa_fcxp_req_rsp_alloc(drv_fcxp, &bfad->bfa,
  2922. drv_fcxp->num_req_sgles,
  2923. drv_fcxp->num_rsp_sgles,
  2924. bfad_fcxp_get_req_sgaddr_cb,
  2925. bfad_fcxp_get_req_sglen_cb,
  2926. bfad_fcxp_get_rsp_sgaddr_cb,
  2927. bfad_fcxp_get_rsp_sglen_cb, BFA_TRUE);
  2928. if (!hal_fcxp) {
  2929. bfa_trc(bfad, 0);
  2930. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2931. return BFA_STATUS_ENOMEM;
  2932. }
  2933. drv_fcxp->bfa_fcxp = hal_fcxp;
  2934. lp_tag = bfa_lps_get_tag_from_pid(&bfad->bfa, bsg_fcpt->fchs.s_id);
  2935. bfa_fcxp_send(hal_fcxp, drv_fcxp->bfa_rport, bsg_fcpt->vf_id, lp_tag,
  2936. bsg_fcpt->cts, bsg_fcpt->cos,
  2937. job->request_payload.payload_len,
  2938. &bsg_fcpt->fchs, bfad_send_fcpt_cb, bfad,
  2939. job->reply_payload.payload_len, bsg_fcpt->tsecs);
  2940. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2941. return BFA_STATUS_OK;
  2942. }
  2943. static int
  2944. bfad_im_bsg_els_ct_request(struct bsg_job *job)
  2945. {
  2946. struct bfa_bsg_data *bsg_data;
  2947. struct Scsi_Host *shost = fc_bsg_to_shost(job);
  2948. struct bfad_im_port_s *im_port = bfad_get_im_port(shost);
  2949. struct bfad_s *bfad = im_port->bfad;
  2950. bfa_bsg_fcpt_t *bsg_fcpt;
  2951. struct bfad_fcxp *drv_fcxp;
  2952. struct bfa_fcs_lport_s *fcs_port;
  2953. struct bfa_fcs_rport_s *fcs_rport;
  2954. struct fc_bsg_request *bsg_request = job->request;
  2955. struct fc_bsg_reply *bsg_reply = job->reply;
  2956. uint32_t command_type = bsg_request->msgcode;
  2957. unsigned long flags;
  2958. struct bfad_buf_info *rsp_buf_info;
  2959. void *req_kbuf = NULL, *rsp_kbuf = NULL;
  2960. int rc = -EINVAL;
  2961. job->reply_len = sizeof(uint32_t); /* Atleast uint32_t reply_len */
  2962. bsg_reply->reply_payload_rcv_len = 0;
  2963. /* Get the payload passed in from userspace */
  2964. bsg_data = (struct bfa_bsg_data *) (((char *)bsg_request) +
  2965. sizeof(struct fc_bsg_request));
  2966. if (bsg_data == NULL)
  2967. goto out;
  2968. /*
  2969. * Allocate buffer for bsg_fcpt and do a copy_from_user op for payload
  2970. * buffer of size bsg_data->payload_len
  2971. */
  2972. bsg_fcpt = kzalloc(bsg_data->payload_len, GFP_KERNEL);
  2973. if (!bsg_fcpt) {
  2974. rc = -ENOMEM;
  2975. goto out;
  2976. }
  2977. if (copy_from_user((uint8_t *)bsg_fcpt,
  2978. (void *)(unsigned long)bsg_data->payload,
  2979. bsg_data->payload_len)) {
  2980. kfree(bsg_fcpt);
  2981. rc = -EIO;
  2982. goto out;
  2983. }
  2984. drv_fcxp = kzalloc(sizeof(struct bfad_fcxp), GFP_KERNEL);
  2985. if (drv_fcxp == NULL) {
  2986. kfree(bsg_fcpt);
  2987. rc = -ENOMEM;
  2988. goto out;
  2989. }
  2990. spin_lock_irqsave(&bfad->bfad_lock, flags);
  2991. fcs_port = bfa_fcs_lookup_port(&bfad->bfa_fcs, bsg_fcpt->vf_id,
  2992. bsg_fcpt->lpwwn);
  2993. if (fcs_port == NULL) {
  2994. bsg_fcpt->status = BFA_STATUS_UNKNOWN_LWWN;
  2995. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  2996. goto out_free_mem;
  2997. }
  2998. /* Check if the port is online before sending FC Passthru cmd */
  2999. if (!bfa_fcs_lport_is_online(fcs_port)) {
  3000. bsg_fcpt->status = BFA_STATUS_PORT_OFFLINE;
  3001. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  3002. goto out_free_mem;
  3003. }
  3004. drv_fcxp->port = fcs_port->bfad_port;
  3005. if (!drv_fcxp->port->bfad)
  3006. drv_fcxp->port->bfad = bfad;
  3007. /* Fetch the bfa_rport - if nexus needed */
  3008. if (command_type == FC_BSG_HST_ELS_NOLOGIN ||
  3009. command_type == FC_BSG_HST_CT) {
  3010. /* BSG HST commands: no nexus needed */
  3011. drv_fcxp->bfa_rport = NULL;
  3012. } else if (command_type == FC_BSG_RPT_ELS ||
  3013. command_type == FC_BSG_RPT_CT) {
  3014. /* BSG RPT commands: nexus needed */
  3015. fcs_rport = bfa_fcs_lport_get_rport_by_pwwn(fcs_port,
  3016. bsg_fcpt->dpwwn);
  3017. if (fcs_rport == NULL) {
  3018. bsg_fcpt->status = BFA_STATUS_UNKNOWN_RWWN;
  3019. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  3020. goto out_free_mem;
  3021. }
  3022. drv_fcxp->bfa_rport = fcs_rport->bfa_rport;
  3023. } else { /* Unknown BSG msgcode; return -EINVAL */
  3024. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  3025. goto out_free_mem;
  3026. }
  3027. spin_unlock_irqrestore(&bfad->bfad_lock, flags);
  3028. /* allocate memory for req / rsp buffers */
  3029. req_kbuf = kzalloc(job->request_payload.payload_len, GFP_KERNEL);
  3030. if (!req_kbuf) {
  3031. printk(KERN_INFO "bfa %s: fcpt request buffer alloc failed\n",
  3032. bfad->pci_name);
  3033. rc = -ENOMEM;
  3034. goto out_free_mem;
  3035. }
  3036. rsp_kbuf = kzalloc(job->reply_payload.payload_len, GFP_KERNEL);
  3037. if (!rsp_kbuf) {
  3038. printk(KERN_INFO "bfa %s: fcpt response buffer alloc failed\n",
  3039. bfad->pci_name);
  3040. rc = -ENOMEM;
  3041. goto out_free_mem;
  3042. }
  3043. /* map req sg - copy the sg_list passed in to the linear buffer */
  3044. sg_copy_to_buffer(job->request_payload.sg_list,
  3045. job->request_payload.sg_cnt, req_kbuf,
  3046. job->request_payload.payload_len);
  3047. drv_fcxp->reqbuf_info = bfad_fcxp_map_sg(bfad, req_kbuf,
  3048. job->request_payload.payload_len,
  3049. &drv_fcxp->num_req_sgles);
  3050. if (!drv_fcxp->reqbuf_info) {
  3051. printk(KERN_INFO "bfa %s: fcpt request fcxp_map_sg failed\n",
  3052. bfad->pci_name);
  3053. rc = -ENOMEM;
  3054. goto out_free_mem;
  3055. }
  3056. drv_fcxp->req_sge = (struct bfa_sge_s *)
  3057. (((uint8_t *)drv_fcxp->reqbuf_info) +
  3058. (sizeof(struct bfad_buf_info) *
  3059. drv_fcxp->num_req_sgles));
  3060. /* map rsp sg */
  3061. drv_fcxp->rspbuf_info = bfad_fcxp_map_sg(bfad, rsp_kbuf,
  3062. job->reply_payload.payload_len,
  3063. &drv_fcxp->num_rsp_sgles);
  3064. if (!drv_fcxp->rspbuf_info) {
  3065. printk(KERN_INFO "bfa %s: fcpt response fcxp_map_sg failed\n",
  3066. bfad->pci_name);
  3067. rc = -ENOMEM;
  3068. goto out_free_mem;
  3069. }
  3070. rsp_buf_info = (struct bfad_buf_info *)drv_fcxp->rspbuf_info;
  3071. drv_fcxp->rsp_sge = (struct bfa_sge_s *)
  3072. (((uint8_t *)drv_fcxp->rspbuf_info) +
  3073. (sizeof(struct bfad_buf_info) *
  3074. drv_fcxp->num_rsp_sgles));
  3075. /* fcxp send */
  3076. init_completion(&drv_fcxp->comp);
  3077. rc = bfad_fcxp_bsg_send(job, drv_fcxp, bsg_fcpt);
  3078. if (rc == BFA_STATUS_OK) {
  3079. wait_for_completion(&drv_fcxp->comp);
  3080. bsg_fcpt->status = drv_fcxp->req_status;
  3081. } else {
  3082. bsg_fcpt->status = rc;
  3083. goto out_free_mem;
  3084. }
  3085. /* fill the job->reply data */
  3086. if (drv_fcxp->req_status == BFA_STATUS_OK) {
  3087. job->reply_len = drv_fcxp->rsp_len;
  3088. bsg_reply->reply_payload_rcv_len = drv_fcxp->rsp_len;
  3089. bsg_reply->reply_data.ctels_reply.status = FC_CTELS_STATUS_OK;
  3090. } else {
  3091. bsg_reply->reply_payload_rcv_len =
  3092. sizeof(struct fc_bsg_ctels_reply);
  3093. job->reply_len = sizeof(uint32_t);
  3094. bsg_reply->reply_data.ctels_reply.status =
  3095. FC_CTELS_STATUS_REJECT;
  3096. }
  3097. /* Copy the response data to the reply_payload sg list */
  3098. sg_copy_from_buffer(job->reply_payload.sg_list,
  3099. job->reply_payload.sg_cnt,
  3100. (uint8_t *)rsp_buf_info->virt,
  3101. job->reply_payload.payload_len);
  3102. out_free_mem:
  3103. bfad_fcxp_free_mem(bfad, drv_fcxp->rspbuf_info,
  3104. drv_fcxp->num_rsp_sgles);
  3105. bfad_fcxp_free_mem(bfad, drv_fcxp->reqbuf_info,
  3106. drv_fcxp->num_req_sgles);
  3107. kfree(req_kbuf);
  3108. kfree(rsp_kbuf);
  3109. /* Need a copy to user op */
  3110. if (copy_to_user((void *)(unsigned long)bsg_data->payload,
  3111. (void *)bsg_fcpt, bsg_data->payload_len))
  3112. rc = -EIO;
  3113. kfree(bsg_fcpt);
  3114. kfree(drv_fcxp);
  3115. out:
  3116. bsg_reply->result = rc;
  3117. if (rc == BFA_STATUS_OK)
  3118. bsg_job_done(job, bsg_reply->result,
  3119. bsg_reply->reply_payload_rcv_len);
  3120. return rc;
  3121. }
  3122. int
  3123. bfad_im_bsg_request(struct bsg_job *job)
  3124. {
  3125. struct fc_bsg_request *bsg_request = job->request;
  3126. struct fc_bsg_reply *bsg_reply = job->reply;
  3127. uint32_t rc = BFA_STATUS_OK;
  3128. switch (bsg_request->msgcode) {
  3129. case FC_BSG_HST_VENDOR:
  3130. /* Process BSG HST Vendor requests */
  3131. rc = bfad_im_bsg_vendor_request(job);
  3132. break;
  3133. case FC_BSG_HST_ELS_NOLOGIN:
  3134. case FC_BSG_RPT_ELS:
  3135. case FC_BSG_HST_CT:
  3136. case FC_BSG_RPT_CT:
  3137. /* Process BSG ELS/CT commands */
  3138. rc = bfad_im_bsg_els_ct_request(job);
  3139. break;
  3140. default:
  3141. bsg_reply->result = rc = -EINVAL;
  3142. bsg_reply->reply_payload_rcv_len = 0;
  3143. break;
  3144. }
  3145. return rc;
  3146. }
  3147. int
  3148. bfad_im_bsg_timeout(struct bsg_job *job)
  3149. {
  3150. /* Don't complete the BSG job request - return -EAGAIN
  3151. * to reset bsg job timeout : for ELS/CT pass thru we
  3152. * already have timer to track the request.
  3153. */
  3154. return -EAGAIN;
  3155. }