qlcnic_83xx_hw.c 75 KB

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