qlcnic_83xx_hw.c 75 KB

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