12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537253825392540254125422543254425452546254725482549255025512552255325542555255625572558255925602561256225632564256525662567256825692570257125722573257425752576257725782579258025812582258325842585258625872588258925902591259225932594259525962597259825992600260126022603260426052606260726082609261026112612261326142615261626172618261926202621262226232624262526262627262826292630263126322633263426352636263726382639264026412642264326442645264626472648264926502651265226532654265526562657265826592660266126622663266426652666266726682669267026712672267326742675267626772678267926802681268226832684268526862687268826892690269126922693269426952696269726982699270027012702270327042705270627072708270927102711271227132714271527162717271827192720272127222723272427252726272727282729273027312732273327342735273627372738273927402741274227432744274527462747274827492750275127522753275427552756275727582759276027612762276327642765276627672768276927702771277227732774277527762777277827792780278127822783278427852786278727882789279027912792279327942795279627972798279928002801280228032804280528062807280828092810281128122813281428152816281728182819282028212822282328242825282628272828282928302831283228332834283528362837283828392840284128422843284428452846284728482849285028512852285328542855285628572858285928602861286228632864286528662867286828692870287128722873287428752876287728782879288028812882288328842885288628872888288928902891289228932894289528962897289828992900290129022903290429052906290729082909291029112912291329142915291629172918291929202921292229232924292529262927292829292930293129322933293429352936293729382939294029412942294329442945294629472948294929502951295229532954295529562957295829592960296129622963296429652966296729682969297029712972297329742975297629772978297929802981298229832984298529862987298829892990299129922993299429952996299729982999300030013002300330043005300630073008300930103011 |
- /*
- * QLogic qlcnic NIC Driver
- * Copyright (c) 2009-2013 QLogic Corporation
- *
- * See LICENSE.qlcnic for copyright and licensing details.
- */
- #include "qlcnic.h"
- #include <linux/if_vlan.h>
- #include <linux/ipv6.h>
- #include <linux/ethtool.h>
- #include <linux/interrupt.h>
- #define QLCNIC_MAX_TX_QUEUES 1
- #define RSS_HASHTYPE_IP_TCP 0x3
- /* status descriptor mailbox data
- * @phy_addr: physical address of buffer
- * @sds_ring_size: buffer size
- * @intrpt_id: interrupt id
- * @intrpt_val: source of interrupt
- */
- struct qlcnic_sds_mbx {
- u64 phy_addr;
- u8 rsvd1[16];
- u16 sds_ring_size;
- u16 rsvd2[3];
- u16 intrpt_id;
- u8 intrpt_val;
- u8 rsvd3[5];
- } __packed;
- /* receive descriptor buffer data
- * phy_addr_reg: physical address of regular buffer
- * phy_addr_jmb: physical address of jumbo buffer
- * reg_ring_sz: size of regular buffer
- * reg_ring_len: no. of entries in regular buffer
- * jmb_ring_len: no. of entries in jumbo buffer
- * jmb_ring_sz: size of jumbo buffer
- */
- struct qlcnic_rds_mbx {
- u64 phy_addr_reg;
- u64 phy_addr_jmb;
- u16 reg_ring_sz;
- u16 reg_ring_len;
- u16 jmb_ring_sz;
- u16 jmb_ring_len;
- } __packed;
- /* host producers for regular and jumbo rings */
- struct __host_producer_mbx {
- u32 reg_buf;
- u32 jmb_buf;
- } __packed;
- /* Receive context mailbox data outbox registers
- * @state: state of the context
- * @vport_id: virtual port id
- * @context_id: receive context id
- * @num_pci_func: number of pci functions of the port
- * @phy_port: physical port id
- */
- struct qlcnic_rcv_mbx_out {
- u8 rcv_num;
- u8 sts_num;
- u16 ctx_id;
- u8 state;
- u8 num_pci_func;
- u8 phy_port;
- u8 vport_id;
- u32 host_csmr[QLCNIC_MAX_RING_SETS];
- struct __host_producer_mbx host_prod[QLCNIC_MAX_RING_SETS];
- } __packed;
- struct qlcnic_add_rings_mbx_out {
- u8 rcv_num;
- u8 sts_num;
- u16 ctx_id;
- u32 host_csmr[QLCNIC_MAX_RING_SETS];
- struct __host_producer_mbx host_prod[QLCNIC_MAX_RING_SETS];
- } __packed;
- /* Transmit context mailbox inbox registers
- * @phys_addr: DMA address of the transmit buffer
- * @cnsmr_index: host consumer index
- * @size: legth of transmit buffer ring
- * @intr_id: interrput id
- * @src: src of interrupt
- */
- struct qlcnic_tx_mbx {
- u64 phys_addr;
- u64 cnsmr_index;
- u16 size;
- u16 intr_id;
- u8 src;
- u8 rsvd[3];
- } __packed;
- /* Transmit context mailbox outbox registers
- * @host_prod: host producer index
- * @ctx_id: transmit context id
- * @state: state of the transmit context
- */
- struct qlcnic_tx_mbx_out {
- u32 host_prod;
- u16 ctx_id;
- u8 state;
- u8 rsvd;
- } __packed;
- static const struct qlcnic_mailbox_metadata qlcnic_83xx_mbx_tbl[] = {
- {QLCNIC_CMD_CONFIGURE_IP_ADDR, 6, 1},
- {QLCNIC_CMD_CONFIG_INTRPT, 18, 34},
- {QLCNIC_CMD_CREATE_RX_CTX, 136, 27},
- {QLCNIC_CMD_DESTROY_RX_CTX, 2, 1},
- {QLCNIC_CMD_CREATE_TX_CTX, 54, 18},
- {QLCNIC_CMD_DESTROY_TX_CTX, 2, 1},
- {QLCNIC_CMD_CONFIGURE_MAC_LEARNING, 2, 1},
- {QLCNIC_CMD_INTRPT_TEST, 22, 12},
- {QLCNIC_CMD_SET_MTU, 3, 1},
- {QLCNIC_CMD_READ_PHY, 4, 2},
- {QLCNIC_CMD_WRITE_PHY, 5, 1},
- {QLCNIC_CMD_READ_HW_REG, 4, 1},
- {QLCNIC_CMD_GET_FLOW_CTL, 4, 2},
- {QLCNIC_CMD_SET_FLOW_CTL, 4, 1},
- {QLCNIC_CMD_READ_MAX_MTU, 4, 2},
- {QLCNIC_CMD_READ_MAX_LRO, 4, 2},
- {QLCNIC_CMD_MAC_ADDRESS, 4, 3},
- {QLCNIC_CMD_GET_PCI_INFO, 1, 66},
- {QLCNIC_CMD_GET_NIC_INFO, 2, 19},
- {QLCNIC_CMD_SET_NIC_INFO, 32, 1},
- {QLCNIC_CMD_GET_ESWITCH_CAPABILITY, 4, 3},
- {QLCNIC_CMD_TOGGLE_ESWITCH, 4, 1},
- {QLCNIC_CMD_GET_ESWITCH_STATUS, 4, 3},
- {QLCNIC_CMD_SET_PORTMIRRORING, 4, 1},
- {QLCNIC_CMD_CONFIGURE_ESWITCH, 4, 1},
- {QLCNIC_CMD_GET_ESWITCH_PORT_CONFIG, 4, 3},
- {QLCNIC_CMD_GET_ESWITCH_STATS, 5, 1},
- {QLCNIC_CMD_CONFIG_PORT, 4, 1},
- {QLCNIC_CMD_TEMP_SIZE, 1, 4},
- {QLCNIC_CMD_GET_TEMP_HDR, 5, 5},
- {QLCNIC_CMD_GET_LINK_EVENT, 2, 1},
- {QLCNIC_CMD_CONFIG_MAC_VLAN, 4, 3},
- {QLCNIC_CMD_CONFIG_INTR_COAL, 6, 1},
- {QLCNIC_CMD_CONFIGURE_RSS, 14, 1},
- {QLCNIC_CMD_CONFIGURE_LED, 2, 1},
- {QLCNIC_CMD_CONFIGURE_MAC_RX_MODE, 2, 1},
- {QLCNIC_CMD_CONFIGURE_HW_LRO, 2, 1},
- {QLCNIC_CMD_GET_STATISTICS, 2, 80},
- {QLCNIC_CMD_SET_PORT_CONFIG, 2, 1},
- {QLCNIC_CMD_GET_PORT_CONFIG, 2, 2},
- {QLCNIC_CMD_GET_LINK_STATUS, 2, 4},
- {QLCNIC_CMD_IDC_ACK, 5, 1},
- {QLCNIC_CMD_INIT_NIC_FUNC, 2, 1},
- {QLCNIC_CMD_STOP_NIC_FUNC, 2, 1},
- {QLCNIC_CMD_SET_LED_CONFIG, 5, 1},
- {QLCNIC_CMD_GET_LED_CONFIG, 1, 5},
- {QLCNIC_CMD_ADD_RCV_RINGS, 130, 26},
- };
- static const u32 qlcnic_83xx_ext_reg_tbl[] = {
- 0x38CC, /* Global Reset */
- 0x38F0, /* Wildcard */
- 0x38FC, /* Informant */
- 0x3038, /* Host MBX ctrl */
- 0x303C, /* FW MBX ctrl */
- 0x355C, /* BOOT LOADER ADDRESS REG */
- 0x3560, /* BOOT LOADER SIZE REG */
- 0x3564, /* FW IMAGE ADDR REG */
- 0x1000, /* MBX intr enable */
- 0x1200, /* Default Intr mask */
- 0x1204, /* Default Interrupt ID */
- 0x3780, /* QLC_83XX_IDC_MAJ_VERSION */
- 0x3784, /* QLC_83XX_IDC_DEV_STATE */
- 0x3788, /* QLC_83XX_IDC_DRV_PRESENCE */
- 0x378C, /* QLC_83XX_IDC_DRV_ACK */
- 0x3790, /* QLC_83XX_IDC_CTRL */
- 0x3794, /* QLC_83XX_IDC_DRV_AUDIT */
- 0x3798, /* QLC_83XX_IDC_MIN_VERSION */
- 0x379C, /* QLC_83XX_RECOVER_DRV_LOCK */
- 0x37A0, /* QLC_83XX_IDC_PF_0 */
- 0x37A4, /* QLC_83XX_IDC_PF_1 */
- 0x37A8, /* QLC_83XX_IDC_PF_2 */
- 0x37AC, /* QLC_83XX_IDC_PF_3 */
- 0x37B0, /* QLC_83XX_IDC_PF_4 */
- 0x37B4, /* QLC_83XX_IDC_PF_5 */
- 0x37B8, /* QLC_83XX_IDC_PF_6 */
- 0x37BC, /* QLC_83XX_IDC_PF_7 */
- 0x37C0, /* QLC_83XX_IDC_PF_8 */
- 0x37C4, /* QLC_83XX_IDC_PF_9 */
- 0x37C8, /* QLC_83XX_IDC_PF_10 */
- 0x37CC, /* QLC_83XX_IDC_PF_11 */
- 0x37D0, /* QLC_83XX_IDC_PF_12 */
- 0x37D4, /* QLC_83XX_IDC_PF_13 */
- 0x37D8, /* QLC_83XX_IDC_PF_14 */
- 0x37DC, /* QLC_83XX_IDC_PF_15 */
- 0x37E0, /* QLC_83XX_IDC_DEV_PARTITION_INFO_1 */
- 0x37E4, /* QLC_83XX_IDC_DEV_PARTITION_INFO_2 */
- 0x37F0, /* QLC_83XX_DRV_OP_MODE */
- 0x37F4, /* QLC_83XX_VNIC_STATE */
- 0x3868, /* QLC_83XX_DRV_LOCK */
- 0x386C, /* QLC_83XX_DRV_UNLOCK */
- 0x3504, /* QLC_83XX_DRV_LOCK_ID */
- 0x34A4, /* QLC_83XX_ASIC_TEMP */
- };
- static const u32 qlcnic_83xx_reg_tbl[] = {
- 0x34A8, /* PEG_HALT_STAT1 */
- 0x34AC, /* PEG_HALT_STAT2 */
- 0x34B0, /* FW_HEARTBEAT */
- 0x3500, /* FLASH LOCK_ID */
- 0x3528, /* FW_CAPABILITIES */
- 0x3538, /* Driver active, DRV_REG0 */
- 0x3540, /* Device state, DRV_REG1 */
- 0x3544, /* Driver state, DRV_REG2 */
- 0x3548, /* Driver scratch, DRV_REG3 */
- 0x354C, /* Device partiton info, DRV_REG4 */
- 0x3524, /* Driver IDC ver, DRV_REG5 */
- 0x3550, /* FW_VER_MAJOR */
- 0x3554, /* FW_VER_MINOR */
- 0x3558, /* FW_VER_SUB */
- 0x359C, /* NPAR STATE */
- 0x35FC, /* FW_IMG_VALID */
- 0x3650, /* CMD_PEG_STATE */
- 0x373C, /* RCV_PEG_STATE */
- 0x37B4, /* ASIC TEMP */
- 0x356C, /* FW API */
- 0x3570, /* DRV OP MODE */
- 0x3850, /* FLASH LOCK */
- 0x3854, /* FLASH UNLOCK */
- };
- static struct qlcnic_hardware_ops qlcnic_83xx_hw_ops = {
- .read_crb = qlcnic_83xx_read_crb,
- .write_crb = qlcnic_83xx_write_crb,
- .read_reg = qlcnic_83xx_rd_reg_indirect,
- .write_reg = qlcnic_83xx_wrt_reg_indirect,
- .get_mac_address = qlcnic_83xx_get_mac_address,
- .setup_intr = qlcnic_83xx_setup_intr,
- .alloc_mbx_args = qlcnic_83xx_alloc_mbx_args,
- .mbx_cmd = qlcnic_83xx_mbx_op,
- .get_func_no = qlcnic_83xx_get_func_no,
- .api_lock = qlcnic_83xx_cam_lock,
- .api_unlock = qlcnic_83xx_cam_unlock,
- .add_sysfs = qlcnic_83xx_add_sysfs,
- .remove_sysfs = qlcnic_83xx_remove_sysfs,
- .process_lb_rcv_ring_diag = qlcnic_83xx_process_rcv_ring_diag,
- .create_rx_ctx = qlcnic_83xx_create_rx_ctx,
- .create_tx_ctx = qlcnic_83xx_create_tx_ctx,
- .setup_link_event = qlcnic_83xx_setup_link_event,
- .get_nic_info = qlcnic_83xx_get_nic_info,
- .get_pci_info = qlcnic_83xx_get_pci_info,
- .set_nic_info = qlcnic_83xx_set_nic_info,
- .change_macvlan = qlcnic_83xx_sre_macaddr_change,
- .napi_enable = qlcnic_83xx_napi_enable,
- .napi_disable = qlcnic_83xx_napi_disable,
- .config_intr_coal = qlcnic_83xx_config_intr_coal,
- .config_rss = qlcnic_83xx_config_rss,
- .config_hw_lro = qlcnic_83xx_config_hw_lro,
- .config_promisc_mode = qlcnic_83xx_nic_set_promisc,
- .change_l2_filter = qlcnic_83xx_change_l2_filter,
- .get_board_info = qlcnic_83xx_get_port_info,
- };
- static struct qlcnic_nic_template qlcnic_83xx_ops = {
- .config_bridged_mode = qlcnic_config_bridged_mode,
- .config_led = qlcnic_config_led,
- .request_reset = qlcnic_83xx_idc_request_reset,
- .cancel_idc_work = qlcnic_83xx_idc_exit,
- .napi_add = qlcnic_83xx_napi_add,
- .napi_del = qlcnic_83xx_napi_del,
- .config_ipaddr = qlcnic_83xx_config_ipaddr,
- .clear_legacy_intr = qlcnic_83xx_clear_legacy_intr,
- };
- void qlcnic_83xx_register_map(struct qlcnic_hardware_context *ahw)
- {
- ahw->hw_ops = &qlcnic_83xx_hw_ops;
- ahw->reg_tbl = (u32 *)qlcnic_83xx_reg_tbl;
- ahw->ext_reg_tbl = (u32 *)qlcnic_83xx_ext_reg_tbl;
- }
- int qlcnic_83xx_get_fw_version(struct qlcnic_adapter *adapter)
- {
- u32 fw_major, fw_minor, fw_build;
- struct pci_dev *pdev = adapter->pdev;
- fw_major = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MAJOR);
- fw_minor = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MINOR);
- fw_build = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_SUB);
- adapter->fw_version = QLCNIC_VERSION_CODE(fw_major, fw_minor, fw_build);
- dev_info(&pdev->dev, "Driver v%s, firmware version %d.%d.%d\n",
- QLCNIC_LINUX_VERSIONID, fw_major, fw_minor, fw_build);
- return adapter->fw_version;
- }
- static int __qlcnic_set_win_base(struct qlcnic_adapter *adapter, u32 addr)
- {
- void __iomem *base;
- u32 val;
- base = adapter->ahw->pci_base0 +
- QLC_83XX_CRB_WIN_FUNC(adapter->ahw->pci_func);
- writel(addr, base);
- val = readl(base);
- if (val != addr)
- return -EIO;
- return 0;
- }
- int qlcnic_83xx_rd_reg_indirect(struct qlcnic_adapter *adapter, ulong addr)
- {
- int ret;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- ret = __qlcnic_set_win_base(adapter, (u32) addr);
- if (!ret) {
- return QLCRDX(ahw, QLCNIC_WILDCARD);
- } else {
- dev_err(&adapter->pdev->dev,
- "%s failed, addr = 0x%x\n", __func__, (int)addr);
- return -EIO;
- }
- }
- int qlcnic_83xx_wrt_reg_indirect(struct qlcnic_adapter *adapter, ulong addr,
- u32 data)
- {
- int err;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- err = __qlcnic_set_win_base(adapter, (u32) addr);
- if (!err) {
- QLCWRX(ahw, QLCNIC_WILDCARD, data);
- return 0;
- } else {
- dev_err(&adapter->pdev->dev,
- "%s failed, addr = 0x%x data = 0x%x\n",
- __func__, (int)addr, data);
- return err;
- }
- }
- int qlcnic_83xx_setup_intr(struct qlcnic_adapter *adapter, u8 num_intr)
- {
- int err, i, num_msix;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- if (!num_intr)
- num_intr = QLCNIC_DEF_NUM_STS_DESC_RINGS;
- num_msix = rounddown_pow_of_two(min_t(int, num_online_cpus(),
- num_intr));
- /* account for AEN interrupt MSI-X based interrupts */
- num_msix += 1;
- num_msix += adapter->max_drv_tx_rings;
- err = qlcnic_enable_msix(adapter, num_msix);
- if (err == -ENOMEM)
- return err;
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- num_msix = adapter->ahw->num_msix;
- else
- num_msix = 1;
- /* setup interrupt mapping table for fw */
- ahw->intr_tbl = vzalloc(num_msix *
- sizeof(struct qlcnic_intrpt_config));
- if (!ahw->intr_tbl)
- return -ENOMEM;
- if (!(adapter->flags & QLCNIC_MSIX_ENABLED)) {
- /* MSI-X enablement failed, use legacy interrupt */
- adapter->tgt_status_reg = ahw->pci_base0 + QLC_83XX_INTX_PTR;
- adapter->tgt_mask_reg = ahw->pci_base0 + QLC_83XX_INTX_MASK;
- adapter->isr_int_vec = ahw->pci_base0 + QLC_83XX_INTX_TRGR;
- adapter->msix_entries[0].vector = adapter->pdev->irq;
- dev_info(&adapter->pdev->dev, "using legacy interrupt\n");
- }
- for (i = 0; i < num_msix; i++) {
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- ahw->intr_tbl[i].type = QLCNIC_INTRPT_MSIX;
- else
- ahw->intr_tbl[i].type = QLCNIC_INTRPT_INTX;
- ahw->intr_tbl[i].id = i;
- ahw->intr_tbl[i].src = 0;
- }
- return 0;
- }
- inline void qlcnic_83xx_clear_legacy_intr_mask(struct qlcnic_adapter *adapter)
- {
- writel(0, adapter->tgt_mask_reg);
- }
- /* Enable MSI-x and INT-x interrupts */
- void qlcnic_83xx_enable_intr(struct qlcnic_adapter *adapter,
- struct qlcnic_host_sds_ring *sds_ring)
- {
- writel(0, sds_ring->crb_intr_mask);
- }
- /* Disable MSI-x and INT-x interrupts */
- void qlcnic_83xx_disable_intr(struct qlcnic_adapter *adapter,
- struct qlcnic_host_sds_ring *sds_ring)
- {
- writel(1, sds_ring->crb_intr_mask);
- }
- inline void qlcnic_83xx_enable_legacy_msix_mbx_intr(struct qlcnic_adapter
- *adapter)
- {
- u32 mask;
- /* Mailbox in MSI-x mode and Legacy Interrupt share the same
- * source register. We could be here before contexts are created
- * and sds_ring->crb_intr_mask has not been initialized, calculate
- * BAR offset for Interrupt Source Register
- */
- mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);
- writel(0, adapter->ahw->pci_base0 + mask);
- }
- inline void qlcnic_83xx_disable_mbx_intr(struct qlcnic_adapter *adapter)
- {
- u32 mask;
- mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);
- writel(1, adapter->ahw->pci_base0 + mask);
- }
- static inline void qlcnic_83xx_get_mbx_data(struct qlcnic_adapter *adapter,
- struct qlcnic_cmd_args *cmd)
- {
- int i;
- for (i = 0; i < cmd->rsp.num; i++)
- cmd->rsp.arg[i] = readl(QLCNIC_MBX_FW(adapter->ahw, i));
- }
- irqreturn_t qlcnic_83xx_clear_legacy_intr(struct qlcnic_adapter *adapter)
- {
- u32 intr_val;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- int retries = 0;
- intr_val = readl(adapter->tgt_status_reg);
- if (!QLC_83XX_VALID_INTX_BIT31(intr_val))
- return IRQ_NONE;
- if (QLC_83XX_INTX_FUNC(intr_val) != adapter->ahw->pci_func) {
- adapter->stats.spurious_intr++;
- return IRQ_NONE;
- }
- /* The barrier is required to ensure writes to the registers */
- wmb();
- /* clear the interrupt trigger control register */
- writel(0, adapter->isr_int_vec);
- intr_val = readl(adapter->isr_int_vec);
- do {
- intr_val = readl(adapter->tgt_status_reg);
- if (QLC_83XX_INTX_FUNC(intr_val) != ahw->pci_func)
- break;
- retries++;
- } while (QLC_83XX_VALID_INTX_BIT30(intr_val) &&
- (retries < QLC_83XX_LEGACY_INTX_MAX_RETRY));
- return IRQ_HANDLED;
- }
- static void qlcnic_83xx_poll_process_aen(struct qlcnic_adapter *adapter)
- {
- u32 resp, event;
- unsigned long flags;
- spin_lock_irqsave(&adapter->ahw->mbx_lock, flags);
- resp = QLCRDX(adapter->ahw, QLCNIC_FW_MBX_CTRL);
- if (!(resp & QLCNIC_SET_OWNER))
- goto out;
- event = readl(QLCNIC_MBX_FW(adapter->ahw, 0));
- if (event & QLCNIC_MBX_ASYNC_EVENT)
- qlcnic_83xx_process_aen(adapter);
- out:
- qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
- spin_unlock_irqrestore(&adapter->ahw->mbx_lock, flags);
- }
- irqreturn_t qlcnic_83xx_intr(int irq, void *data)
- {
- struct qlcnic_adapter *adapter = data;
- struct qlcnic_host_sds_ring *sds_ring;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- if (qlcnic_83xx_clear_legacy_intr(adapter) == IRQ_NONE)
- return IRQ_NONE;
- qlcnic_83xx_poll_process_aen(adapter);
- if (ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
- ahw->diag_cnt++;
- qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
- return IRQ_HANDLED;
- }
- if (!test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
- qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
- } else {
- sds_ring = &adapter->recv_ctx->sds_rings[0];
- napi_schedule(&sds_ring->napi);
- }
- return IRQ_HANDLED;
- }
- irqreturn_t qlcnic_83xx_tmp_intr(int irq, void *data)
- {
- struct qlcnic_host_sds_ring *sds_ring = data;
- struct qlcnic_adapter *adapter = sds_ring->adapter;
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- goto done;
- if (adapter->nic_ops->clear_legacy_intr(adapter) == IRQ_NONE)
- return IRQ_NONE;
- done:
- adapter->ahw->diag_cnt++;
- qlcnic_83xx_enable_intr(adapter, sds_ring);
- return IRQ_HANDLED;
- }
- void qlcnic_83xx_free_mbx_intr(struct qlcnic_adapter *adapter)
- {
- u32 val = 0, num_msix = adapter->ahw->num_msix - 1;
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- num_msix = adapter->ahw->num_msix - 1;
- else
- num_msix = 0;
- QLCWRX(adapter->ahw, QLCNIC_MBX_INTR_ENBL, val);
- qlcnic_83xx_disable_mbx_intr(adapter);
- msleep(20);
- synchronize_irq(adapter->msix_entries[num_msix].vector);
- free_irq(adapter->msix_entries[num_msix].vector, adapter);
- }
- int qlcnic_83xx_setup_mbx_intr(struct qlcnic_adapter *adapter)
- {
- irq_handler_t handler;
- u32 val;
- char name[32];
- int err = 0;
- unsigned long flags = 0;
- if (!(adapter->flags & QLCNIC_MSI_ENABLED) &&
- !(adapter->flags & QLCNIC_MSIX_ENABLED))
- flags |= IRQF_SHARED;
- if (adapter->flags & QLCNIC_MSIX_ENABLED) {
- handler = qlcnic_83xx_handle_aen;
- val = adapter->msix_entries[adapter->ahw->num_msix - 1].vector;
- snprintf(name, (IFNAMSIZ + 4),
- "%s[%s]", "qlcnic", "aen");
- err = request_irq(val, handler, flags, name, adapter);
- if (err) {
- dev_err(&adapter->pdev->dev,
- "failed to register MBX interrupt\n");
- return err;
- }
- } else {
- handler = qlcnic_83xx_intr;
- val = adapter->msix_entries[0].vector;
- err = request_irq(val, handler, flags, "qlcnic", adapter);
- if (err) {
- dev_err(&adapter->pdev->dev,
- "failed to register INTx interrupt\n");
- return err;
- }
- qlcnic_83xx_clear_legacy_intr_mask(adapter);
- }
- /* Enable mailbox interrupt */
- qlcnic_83xx_enable_mbx_intrpt(adapter);
- return err;
- }
- void qlcnic_83xx_get_func_no(struct qlcnic_adapter *adapter)
- {
- u32 val = QLCRDX(adapter->ahw, QLCNIC_INFORMANT);
- adapter->ahw->pci_func = val & 0xf;
- }
- int qlcnic_83xx_cam_lock(struct qlcnic_adapter *adapter)
- {
- void __iomem *addr;
- u32 val, limit = 0;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- addr = ahw->pci_base0 + QLC_83XX_SEM_LOCK_FUNC(ahw->pci_func);
- do {
- val = readl(addr);
- if (val) {
- /* write the function number to register */
- QLC_SHARED_REG_WR32(adapter, QLCNIC_FLASH_LOCK_OWNER,
- ahw->pci_func);
- return 0;
- }
- usleep_range(1000, 2000);
- } while (++limit <= QLCNIC_PCIE_SEM_TIMEOUT);
- return -EIO;
- }
- void qlcnic_83xx_cam_unlock(struct qlcnic_adapter *adapter)
- {
- void __iomem *addr;
- u32 val;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- addr = ahw->pci_base0 + QLC_83XX_SEM_UNLOCK_FUNC(ahw->pci_func);
- val = readl(addr);
- }
- void qlcnic_83xx_read_crb(struct qlcnic_adapter *adapter, char *buf,
- loff_t offset, size_t size)
- {
- int ret;
- u32 data;
- if (qlcnic_api_lock(adapter)) {
- dev_err(&adapter->pdev->dev,
- "%s: failed to acquire lock. addr offset 0x%x\n",
- __func__, (u32)offset);
- return;
- }
- ret = qlcnic_83xx_rd_reg_indirect(adapter, (u32) offset);
- qlcnic_api_unlock(adapter);
- if (ret == -EIO) {
- dev_err(&adapter->pdev->dev,
- "%s: failed. addr offset 0x%x\n",
- __func__, (u32)offset);
- return;
- }
- data = ret;
- memcpy(buf, &data, size);
- }
- void qlcnic_83xx_write_crb(struct qlcnic_adapter *adapter, char *buf,
- loff_t offset, size_t size)
- {
- u32 data;
- memcpy(&data, buf, size);
- qlcnic_83xx_wrt_reg_indirect(adapter, (u32) offset, data);
- }
- int qlcnic_83xx_get_port_info(struct qlcnic_adapter *adapter)
- {
- int status;
- status = qlcnic_83xx_get_port_config(adapter);
- if (status) {
- dev_err(&adapter->pdev->dev,
- "Get Port Info failed\n");
- } else {
- if (QLC_83XX_SFP_10G_CAPABLE(adapter->ahw->port_config))
- adapter->ahw->port_type = QLCNIC_XGBE;
- else
- adapter->ahw->port_type = QLCNIC_GBE;
- if (QLC_83XX_AUTONEG(adapter->ahw->port_config))
- adapter->ahw->link_autoneg = AUTONEG_ENABLE;
- }
- return status;
- }
- void qlcnic_83xx_enable_mbx_intrpt(struct qlcnic_adapter *adapter)
- {
- u32 val;
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- val = BIT_2 | ((adapter->ahw->num_msix - 1) << 8);
- else
- val = BIT_2;
- QLCWRX(adapter->ahw, QLCNIC_MBX_INTR_ENBL, val);
- qlcnic_83xx_enable_legacy_msix_mbx_intr(adapter);
- }
- void qlcnic_83xx_check_vf(struct qlcnic_adapter *adapter,
- const struct pci_device_id *ent)
- {
- u32 op_mode, priv_level;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- ahw->fw_hal_version = 2;
- qlcnic_get_func_no(adapter);
- /* Determine function privilege level */
- op_mode = QLCRDX(adapter->ahw, QLC_83XX_DRV_OP_MODE);
- if (op_mode == QLC_83XX_DEFAULT_OPMODE)
- priv_level = QLCNIC_MGMT_FUNC;
- else
- priv_level = QLC_83XX_GET_FUNC_PRIVILEGE(op_mode,
- ahw->pci_func);
- if (priv_level == QLCNIC_NON_PRIV_FUNC) {
- ahw->op_mode = QLCNIC_NON_PRIV_FUNC;
- dev_info(&adapter->pdev->dev,
- "HAL Version: %d Non Privileged function\n",
- ahw->fw_hal_version);
- adapter->nic_ops = &qlcnic_vf_ops;
- } else {
- adapter->nic_ops = &qlcnic_83xx_ops;
- }
- }
- static void qlcnic_83xx_handle_link_aen(struct qlcnic_adapter *adapter,
- u32 data[]);
- static void qlcnic_83xx_handle_idc_comp_aen(struct qlcnic_adapter *adapter,
- u32 data[]);
- static void qlcnic_dump_mbx(struct qlcnic_adapter *adapter,
- struct qlcnic_cmd_args *cmd)
- {
- int i;
- dev_info(&adapter->pdev->dev,
- "Host MBX regs(%d)\n", cmd->req.num);
- for (i = 0; i < cmd->req.num; i++) {
- if (i && !(i % 8))
- pr_info("\n");
- pr_info("%08x ", cmd->req.arg[i]);
- }
- pr_info("\n");
- dev_info(&adapter->pdev->dev,
- "FW MBX regs(%d)\n", cmd->rsp.num);
- for (i = 0; i < cmd->rsp.num; i++) {
- if (i && !(i % 8))
- pr_info("\n");
- pr_info("%08x ", cmd->rsp.arg[i]);
- }
- pr_info("\n");
- }
- /* Mailbox response for mac rcode */
- static u32 qlcnic_83xx_mac_rcode(struct qlcnic_adapter *adapter)
- {
- u32 fw_data;
- u8 mac_cmd_rcode;
- fw_data = readl(QLCNIC_MBX_FW(adapter->ahw, 2));
- mac_cmd_rcode = (u8)fw_data;
- if (mac_cmd_rcode == QLC_83XX_NO_NIC_RESOURCE ||
- mac_cmd_rcode == QLC_83XX_MAC_PRESENT ||
- mac_cmd_rcode == QLC_83XX_MAC_ABSENT)
- return QLCNIC_RCODE_SUCCESS;
- return 1;
- }
- static u32 qlcnic_83xx_mbx_poll(struct qlcnic_adapter *adapter)
- {
- u32 data;
- unsigned long wait_time = 0;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- /* wait for mailbox completion */
- do {
- data = QLCRDX(ahw, QLCNIC_FW_MBX_CTRL);
- if (++wait_time > QLCNIC_MBX_TIMEOUT) {
- data = QLCNIC_RCODE_TIMEOUT;
- break;
- }
- mdelay(1);
- } while (!data);
- return data;
- }
- int qlcnic_83xx_mbx_op(struct qlcnic_adapter *adapter,
- struct qlcnic_cmd_args *cmd)
- {
- int i;
- u16 opcode;
- u8 mbx_err_code;
- unsigned long flags;
- u32 rsp, mbx_val, fw_data, rsp_num, mbx_cmd;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- opcode = LSW(cmd->req.arg[0]);
- if (!test_bit(QLC_83XX_MBX_READY, &adapter->ahw->idc.status)) {
- dev_info(&adapter->pdev->dev,
- "Mailbox cmd attempted, 0x%x\n", opcode);
- dev_info(&adapter->pdev->dev, "Mailbox detached\n");
- return 0;
- }
- spin_lock_irqsave(&adapter->ahw->mbx_lock, flags);
- mbx_val = QLCRDX(ahw, QLCNIC_HOST_MBX_CTRL);
- if (mbx_val) {
- QLCDB(adapter, DRV,
- "Mailbox cmd attempted, 0x%x\n", opcode);
- QLCDB(adapter, DRV,
- "Mailbox not available, 0x%x, collect FW dump\n",
- mbx_val);
- cmd->rsp.arg[0] = QLCNIC_RCODE_TIMEOUT;
- spin_unlock_irqrestore(&adapter->ahw->mbx_lock, flags);
- return cmd->rsp.arg[0];
- }
- /* Fill in mailbox registers */
- mbx_cmd = cmd->req.arg[0];
- writel(mbx_cmd, QLCNIC_MBX_HOST(ahw, 0));
- for (i = 1; i < cmd->req.num; i++)
- writel(cmd->req.arg[i], QLCNIC_MBX_HOST(ahw, i));
- /* Signal FW about the impending command */
- QLCWRX(ahw, QLCNIC_HOST_MBX_CTRL, QLCNIC_SET_OWNER);
- poll:
- rsp = qlcnic_83xx_mbx_poll(adapter);
- if (rsp != QLCNIC_RCODE_TIMEOUT) {
- /* Get the FW response data */
- fw_data = readl(QLCNIC_MBX_FW(ahw, 0));
- if (fw_data & QLCNIC_MBX_ASYNC_EVENT) {
- qlcnic_83xx_process_aen(adapter);
- mbx_val = QLCRDX(ahw, QLCNIC_HOST_MBX_CTRL);
- if (mbx_val)
- goto poll;
- }
- mbx_err_code = QLCNIC_MBX_STATUS(fw_data);
- rsp_num = QLCNIC_MBX_NUM_REGS(fw_data);
- opcode = QLCNIC_MBX_RSP(fw_data);
- qlcnic_83xx_get_mbx_data(adapter, cmd);
- switch (mbx_err_code) {
- case QLCNIC_MBX_RSP_OK:
- case QLCNIC_MBX_PORT_RSP_OK:
- rsp = QLCNIC_RCODE_SUCCESS;
- break;
- default:
- if (opcode == QLCNIC_CMD_CONFIG_MAC_VLAN) {
- rsp = qlcnic_83xx_mac_rcode(adapter);
- if (!rsp)
- goto out;
- }
- dev_err(&adapter->pdev->dev,
- "MBX command 0x%x failed with err:0x%x\n",
- opcode, mbx_err_code);
- rsp = mbx_err_code;
- qlcnic_dump_mbx(adapter, cmd);
- break;
- }
- goto out;
- }
- dev_err(&adapter->pdev->dev, "MBX command 0x%x timed out\n",
- QLCNIC_MBX_RSP(mbx_cmd));
- rsp = QLCNIC_RCODE_TIMEOUT;
- out:
- /* clear fw mbx control register */
- QLCWRX(ahw, QLCNIC_FW_MBX_CTRL, QLCNIC_CLR_OWNER);
- spin_unlock_irqrestore(&adapter->ahw->mbx_lock, flags);
- return rsp;
- }
- int qlcnic_83xx_alloc_mbx_args(struct qlcnic_cmd_args *mbx,
- struct qlcnic_adapter *adapter, u32 type)
- {
- int i, size;
- u32 temp;
- const struct qlcnic_mailbox_metadata *mbx_tbl;
- mbx_tbl = qlcnic_83xx_mbx_tbl;
- size = ARRAY_SIZE(qlcnic_83xx_mbx_tbl);
- for (i = 0; i < size; i++) {
- if (type == mbx_tbl[i].cmd) {
- mbx->req.num = mbx_tbl[i].in_args;
- mbx->rsp.num = mbx_tbl[i].out_args;
- mbx->req.arg = kcalloc(mbx->req.num, sizeof(u32),
- GFP_ATOMIC);
- if (!mbx->req.arg)
- return -ENOMEM;
- mbx->rsp.arg = kcalloc(mbx->rsp.num, sizeof(u32),
- GFP_ATOMIC);
- if (!mbx->rsp.arg) {
- kfree(mbx->req.arg);
- mbx->req.arg = NULL;
- return -ENOMEM;
- }
- memset(mbx->req.arg, 0, sizeof(u32) * mbx->req.num);
- memset(mbx->rsp.arg, 0, sizeof(u32) * mbx->rsp.num);
- temp = adapter->ahw->fw_hal_version << 29;
- mbx->req.arg[0] = (type | (mbx->req.num << 16) | temp);
- break;
- }
- }
- return 0;
- }
- void qlcnic_83xx_idc_aen_work(struct work_struct *work)
- {
- struct qlcnic_adapter *adapter;
- struct qlcnic_cmd_args cmd;
- int i, err = 0;
- adapter = container_of(work, struct qlcnic_adapter, idc_aen_work.work);
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_IDC_ACK);
- for (i = 1; i < QLC_83XX_MBX_AEN_CNT; i++)
- cmd.req.arg[i] = adapter->ahw->mbox_aen[i];
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err)
- dev_info(&adapter->pdev->dev,
- "%s: Mailbox IDC ACK failed.\n", __func__);
- qlcnic_free_mbx_args(&cmd);
- }
- static void qlcnic_83xx_handle_idc_comp_aen(struct qlcnic_adapter *adapter,
- u32 data[])
- {
- dev_dbg(&adapter->pdev->dev, "Completion AEN:0x%x.\n",
- QLCNIC_MBX_RSP(data[0]));
- clear_bit(QLC_83XX_IDC_COMP_AEN, &adapter->ahw->idc.status);
- return;
- }
- void qlcnic_83xx_process_aen(struct qlcnic_adapter *adapter)
- {
- u32 event[QLC_83XX_MBX_AEN_CNT];
- int i;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- for (i = 0; i < QLC_83XX_MBX_AEN_CNT; i++)
- event[i] = readl(QLCNIC_MBX_FW(ahw, i));
- switch (QLCNIC_MBX_RSP(event[0])) {
- case QLCNIC_MBX_LINK_EVENT:
- qlcnic_83xx_handle_link_aen(adapter, event);
- break;
- case QLCNIC_MBX_COMP_EVENT:
- qlcnic_83xx_handle_idc_comp_aen(adapter, event);
- break;
- case QLCNIC_MBX_REQUEST_EVENT:
- for (i = 0; i < QLC_83XX_MBX_AEN_CNT; i++)
- adapter->ahw->mbox_aen[i] = QLCNIC_MBX_RSP(event[i]);
- queue_delayed_work(adapter->qlcnic_wq,
- &adapter->idc_aen_work, 0);
- break;
- case QLCNIC_MBX_TIME_EXTEND_EVENT:
- break;
- case QLCNIC_MBX_SFP_INSERT_EVENT:
- dev_info(&adapter->pdev->dev, "SFP+ Insert AEN:0x%x.\n",
- QLCNIC_MBX_RSP(event[0]));
- break;
- case QLCNIC_MBX_SFP_REMOVE_EVENT:
- dev_info(&adapter->pdev->dev, "SFP Removed AEN:0x%x.\n",
- QLCNIC_MBX_RSP(event[0]));
- break;
- default:
- dev_dbg(&adapter->pdev->dev, "Unsupported AEN:0x%x.\n",
- QLCNIC_MBX_RSP(event[0]));
- break;
- }
- QLCWRX(ahw, QLCNIC_FW_MBX_CTRL, QLCNIC_CLR_OWNER);
- }
- static int qlcnic_83xx_add_rings(struct qlcnic_adapter *adapter)
- {
- int index, i, err, sds_mbx_size;
- u32 *buf, intrpt_id, intr_mask;
- u16 context_id;
- u8 num_sds;
- struct qlcnic_cmd_args cmd;
- struct qlcnic_host_sds_ring *sds;
- struct qlcnic_sds_mbx sds_mbx;
- struct qlcnic_add_rings_mbx_out *mbx_out;
- struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- sds_mbx_size = sizeof(struct qlcnic_sds_mbx);
- context_id = recv_ctx->context_id;
- num_sds = (adapter->max_sds_rings - QLCNIC_MAX_RING_SETS);
- ahw->hw_ops->alloc_mbx_args(&cmd, adapter,
- QLCNIC_CMD_ADD_RCV_RINGS);
- cmd.req.arg[1] = 0 | (num_sds << 8) | (context_id << 16);
- /* set up status rings, mbx 2-81 */
- index = 2;
- for (i = 8; i < adapter->max_sds_rings; i++) {
- memset(&sds_mbx, 0, sds_mbx_size);
- sds = &recv_ctx->sds_rings[i];
- sds->consumer = 0;
- memset(sds->desc_head, 0, STATUS_DESC_RINGSIZE(sds));
- sds_mbx.phy_addr = sds->phys_addr;
- sds_mbx.sds_ring_size = sds->num_desc;
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- intrpt_id = ahw->intr_tbl[i].id;
- else
- intrpt_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
- if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST)
- sds_mbx.intrpt_id = intrpt_id;
- else
- sds_mbx.intrpt_id = 0xffff;
- sds_mbx.intrpt_val = 0;
- buf = &cmd.req.arg[index];
- memcpy(buf, &sds_mbx, sds_mbx_size);
- index += sds_mbx_size / sizeof(u32);
- }
- /* send the mailbox command */
- err = ahw->hw_ops->mbx_cmd(adapter, &cmd);
- if (err) {
- dev_err(&adapter->pdev->dev,
- "Failed to add rings %d\n", err);
- goto out;
- }
- mbx_out = (struct qlcnic_add_rings_mbx_out *)&cmd.rsp.arg[1];
- index = 0;
- /* status descriptor ring */
- for (i = 8; i < adapter->max_sds_rings; i++) {
- sds = &recv_ctx->sds_rings[i];
- sds->crb_sts_consumer = ahw->pci_base0 +
- mbx_out->host_csmr[index];
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- intr_mask = ahw->intr_tbl[i].src;
- else
- intr_mask = QLCRDX(ahw, QLCNIC_DEF_INT_MASK);
- sds->crb_intr_mask = ahw->pci_base0 + intr_mask;
- index++;
- }
- out:
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_create_rx_ctx(struct qlcnic_adapter *adapter)
- {
- int i, err, index, sds_mbx_size, rds_mbx_size;
- u8 num_sds, num_rds;
- u32 *buf, intrpt_id, intr_mask, cap = 0;
- struct qlcnic_host_sds_ring *sds;
- struct qlcnic_host_rds_ring *rds;
- struct qlcnic_sds_mbx sds_mbx;
- struct qlcnic_rds_mbx rds_mbx;
- struct qlcnic_cmd_args cmd;
- struct qlcnic_rcv_mbx_out *mbx_out;
- struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- num_rds = adapter->max_rds_rings;
- if (adapter->max_sds_rings <= QLCNIC_MAX_RING_SETS)
- num_sds = adapter->max_sds_rings;
- else
- num_sds = QLCNIC_MAX_RING_SETS;
- sds_mbx_size = sizeof(struct qlcnic_sds_mbx);
- rds_mbx_size = sizeof(struct qlcnic_rds_mbx);
- cap = QLCNIC_CAP0_LEGACY_CONTEXT;
- if (adapter->flags & QLCNIC_FW_LRO_MSS_CAP)
- cap |= QLC_83XX_FW_CAP_LRO_MSS;
- /* set mailbox hdr and capabilities */
- qlcnic_alloc_mbx_args(&cmd, adapter,
- QLCNIC_CMD_CREATE_RX_CTX);
- cmd.req.arg[1] = cap;
- cmd.req.arg[5] = 1 | (num_rds << 5) | (num_sds << 8) |
- (QLC_83XX_HOST_RDS_MODE_UNIQUE << 16);
- /* set up status rings, mbx 8-57/87 */
- index = QLC_83XX_HOST_SDS_MBX_IDX;
- for (i = 0; i < num_sds; i++) {
- memset(&sds_mbx, 0, sds_mbx_size);
- sds = &recv_ctx->sds_rings[i];
- sds->consumer = 0;
- memset(sds->desc_head, 0, STATUS_DESC_RINGSIZE(sds));
- sds_mbx.phy_addr = sds->phys_addr;
- sds_mbx.sds_ring_size = sds->num_desc;
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- intrpt_id = ahw->intr_tbl[i].id;
- else
- intrpt_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
- if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST)
- sds_mbx.intrpt_id = intrpt_id;
- else
- sds_mbx.intrpt_id = 0xffff;
- sds_mbx.intrpt_val = 0;
- buf = &cmd.req.arg[index];
- memcpy(buf, &sds_mbx, sds_mbx_size);
- index += sds_mbx_size / sizeof(u32);
- }
- /* set up receive rings, mbx 88-111/135 */
- index = QLCNIC_HOST_RDS_MBX_IDX;
- rds = &recv_ctx->rds_rings[0];
- rds->producer = 0;
- memset(&rds_mbx, 0, rds_mbx_size);
- rds_mbx.phy_addr_reg = rds->phys_addr;
- rds_mbx.reg_ring_sz = rds->dma_size;
- rds_mbx.reg_ring_len = rds->num_desc;
- /* Jumbo ring */
- rds = &recv_ctx->rds_rings[1];
- rds->producer = 0;
- rds_mbx.phy_addr_jmb = rds->phys_addr;
- rds_mbx.jmb_ring_sz = rds->dma_size;
- rds_mbx.jmb_ring_len = rds->num_desc;
- buf = &cmd.req.arg[index];
- memcpy(buf, &rds_mbx, rds_mbx_size);
- /* send the mailbox command */
- err = ahw->hw_ops->mbx_cmd(adapter, &cmd);
- if (err) {
- dev_err(&adapter->pdev->dev,
- "Failed to create Rx ctx in firmware%d\n", err);
- goto out;
- }
- mbx_out = (struct qlcnic_rcv_mbx_out *)&cmd.rsp.arg[1];
- recv_ctx->context_id = mbx_out->ctx_id;
- recv_ctx->state = mbx_out->state;
- recv_ctx->virt_port = mbx_out->vport_id;
- dev_info(&adapter->pdev->dev, "Rx Context[%d] Created, state:0x%x\n",
- recv_ctx->context_id, recv_ctx->state);
- /* Receive descriptor ring */
- /* Standard ring */
- rds = &recv_ctx->rds_rings[0];
- rds->crb_rcv_producer = ahw->pci_base0 +
- mbx_out->host_prod[0].reg_buf;
- /* Jumbo ring */
- rds = &recv_ctx->rds_rings[1];
- rds->crb_rcv_producer = ahw->pci_base0 +
- mbx_out->host_prod[0].jmb_buf;
- /* status descriptor ring */
- for (i = 0; i < num_sds; i++) {
- sds = &recv_ctx->sds_rings[i];
- sds->crb_sts_consumer = ahw->pci_base0 +
- mbx_out->host_csmr[i];
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- intr_mask = ahw->intr_tbl[i].src;
- else
- intr_mask = QLCRDX(ahw, QLCNIC_DEF_INT_MASK);
- sds->crb_intr_mask = ahw->pci_base0 + intr_mask;
- }
- if (adapter->max_sds_rings > QLCNIC_MAX_RING_SETS)
- err = qlcnic_83xx_add_rings(adapter);
- out:
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_create_tx_ctx(struct qlcnic_adapter *adapter,
- struct qlcnic_host_tx_ring *tx, int ring)
- {
- int err;
- u16 msix_id;
- u32 *buf, intr_mask;
- struct qlcnic_cmd_args cmd;
- struct qlcnic_tx_mbx mbx;
- struct qlcnic_tx_mbx_out *mbx_out;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- /* Reset host resources */
- tx->producer = 0;
- tx->sw_consumer = 0;
- *(tx->hw_consumer) = 0;
- memset(&mbx, 0, sizeof(struct qlcnic_tx_mbx));
- /* setup mailbox inbox registerss */
- mbx.phys_addr = tx->phys_addr;
- mbx.cnsmr_index = tx->hw_cons_phys_addr;
- mbx.size = tx->num_desc;
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- msix_id = ahw->intr_tbl[adapter->max_sds_rings + ring].id;
- else
- msix_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
- if (adapter->ahw->diag_test != QLCNIC_LOOPBACK_TEST)
- mbx.intr_id = msix_id;
- else
- mbx.intr_id = 0xffff;
- mbx.src = 0;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CREATE_TX_CTX);
- cmd.req.arg[1] = QLCNIC_CAP0_LEGACY_CONTEXT;
- cmd.req.arg[5] = QLCNIC_MAX_TX_QUEUES;
- buf = &cmd.req.arg[6];
- memcpy(buf, &mbx, sizeof(struct qlcnic_tx_mbx));
- /* send the mailbox command*/
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err) {
- dev_err(&adapter->pdev->dev,
- "Failed to create Tx ctx in firmware 0x%x\n", err);
- goto out;
- }
- mbx_out = (struct qlcnic_tx_mbx_out *)&cmd.rsp.arg[2];
- tx->crb_cmd_producer = ahw->pci_base0 + mbx_out->host_prod;
- tx->ctx_id = mbx_out->ctx_id;
- if (adapter->flags & QLCNIC_MSIX_ENABLED) {
- intr_mask = ahw->intr_tbl[adapter->max_sds_rings + ring].src;
- tx->crb_intr_mask = ahw->pci_base0 + intr_mask;
- }
- dev_info(&adapter->pdev->dev, "Tx Context[0x%x] Created, state:0x%x\n",
- tx->ctx_id, mbx_out->state);
- out:
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- static int qlcnic_83xx_diag_alloc_res(struct net_device *netdev, int test)
- {
- struct qlcnic_adapter *adapter = netdev_priv(netdev);
- struct qlcnic_host_sds_ring *sds_ring;
- struct qlcnic_host_rds_ring *rds_ring;
- u8 ring;
- int ret;
- netif_device_detach(netdev);
- if (netif_running(netdev))
- __qlcnic_down(adapter, netdev);
- qlcnic_detach(adapter);
- adapter->max_sds_rings = 1;
- adapter->ahw->diag_test = test;
- adapter->ahw->linkup = 0;
- ret = qlcnic_attach(adapter);
- if (ret) {
- netif_device_attach(netdev);
- return ret;
- }
- ret = qlcnic_fw_create_ctx(adapter);
- if (ret) {
- qlcnic_detach(adapter);
- netif_device_attach(netdev);
- return ret;
- }
- for (ring = 0; ring < adapter->max_rds_rings; ring++) {
- rds_ring = &adapter->recv_ctx->rds_rings[ring];
- qlcnic_post_rx_buffers(adapter, rds_ring, ring);
- }
- if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
- for (ring = 0; ring < adapter->max_sds_rings; ring++) {
- sds_ring = &adapter->recv_ctx->sds_rings[ring];
- qlcnic_83xx_enable_intr(adapter, sds_ring);
- }
- }
- if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
- /* disable and free mailbox interrupt */
- qlcnic_83xx_free_mbx_intr(adapter);
- adapter->ahw->loopback_state = 0;
- adapter->ahw->hw_ops->setup_link_event(adapter, 1);
- }
- set_bit(__QLCNIC_DEV_UP, &adapter->state);
- return 0;
- }
- static void qlcnic_83xx_diag_free_res(struct net_device *netdev,
- int max_sds_rings)
- {
- struct qlcnic_adapter *adapter = netdev_priv(netdev);
- struct qlcnic_host_sds_ring *sds_ring;
- int ring, err;
- clear_bit(__QLCNIC_DEV_UP, &adapter->state);
- if (adapter->ahw->diag_test == QLCNIC_INTERRUPT_TEST) {
- for (ring = 0; ring < adapter->max_sds_rings; ring++) {
- sds_ring = &adapter->recv_ctx->sds_rings[ring];
- qlcnic_83xx_disable_intr(adapter, sds_ring);
- }
- }
- qlcnic_fw_destroy_ctx(adapter);
- qlcnic_detach(adapter);
- if (adapter->ahw->diag_test == QLCNIC_LOOPBACK_TEST) {
- err = qlcnic_83xx_setup_mbx_intr(adapter);
- if (err) {
- dev_err(&adapter->pdev->dev,
- "%s: failed to setup mbx interrupt\n",
- __func__);
- goto out;
- }
- }
- adapter->ahw->diag_test = 0;
- adapter->max_sds_rings = max_sds_rings;
- if (qlcnic_attach(adapter))
- goto out;
- if (netif_running(netdev))
- __qlcnic_up(adapter, netdev);
- out:
- netif_device_attach(netdev);
- }
- int qlcnic_83xx_config_led(struct qlcnic_adapter *adapter, u32 state,
- u32 beacon)
- {
- struct qlcnic_cmd_args cmd;
- u32 mbx_in;
- int i, status = 0;
- if (state) {
- /* Get LED configuration */
- qlcnic_alloc_mbx_args(&cmd, adapter,
- QLCNIC_CMD_GET_LED_CONFIG);
- status = qlcnic_issue_cmd(adapter, &cmd);
- if (status) {
- dev_err(&adapter->pdev->dev,
- "Get led config failed.\n");
- goto mbx_err;
- } else {
- for (i = 0; i < 4; i++)
- adapter->ahw->mbox_reg[i] = cmd.rsp.arg[i+1];
- }
- qlcnic_free_mbx_args(&cmd);
- /* Set LED Configuration */
- mbx_in = (LSW(QLC_83XX_LED_CONFIG) << 16) |
- LSW(QLC_83XX_LED_CONFIG);
- qlcnic_alloc_mbx_args(&cmd, adapter,
- QLCNIC_CMD_SET_LED_CONFIG);
- cmd.req.arg[1] = mbx_in;
- cmd.req.arg[2] = mbx_in;
- cmd.req.arg[3] = mbx_in;
- if (beacon)
- cmd.req.arg[4] = QLC_83XX_ENABLE_BEACON;
- status = qlcnic_issue_cmd(adapter, &cmd);
- if (status) {
- dev_err(&adapter->pdev->dev,
- "Set led config failed.\n");
- }
- mbx_err:
- qlcnic_free_mbx_args(&cmd);
- return status;
- } else {
- /* Restoring default LED configuration */
- qlcnic_alloc_mbx_args(&cmd, adapter,
- QLCNIC_CMD_SET_LED_CONFIG);
- cmd.req.arg[1] = adapter->ahw->mbox_reg[0];
- cmd.req.arg[2] = adapter->ahw->mbox_reg[1];
- cmd.req.arg[3] = adapter->ahw->mbox_reg[2];
- if (beacon)
- cmd.req.arg[4] = adapter->ahw->mbox_reg[3];
- status = qlcnic_issue_cmd(adapter, &cmd);
- if (status)
- dev_err(&adapter->pdev->dev,
- "Restoring led config failed.\n");
- qlcnic_free_mbx_args(&cmd);
- return status;
- }
- }
- void qlcnic_83xx_register_nic_idc_func(struct qlcnic_adapter *adapter,
- int enable)
- {
- struct qlcnic_cmd_args cmd;
- int status;
- if (enable) {
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_INIT_NIC_FUNC);
- cmd.req.arg[1] = BIT_0 | BIT_31;
- } else {
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_STOP_NIC_FUNC);
- cmd.req.arg[1] = BIT_0 | BIT_31;
- }
- status = qlcnic_issue_cmd(adapter, &cmd);
- if (status)
- dev_err(&adapter->pdev->dev,
- "Failed to %s in NIC IDC function event.\n",
- (enable ? "register" : "unregister"));
- qlcnic_free_mbx_args(&cmd);
- }
- int qlcnic_83xx_set_port_config(struct qlcnic_adapter *adapter)
- {
- struct qlcnic_cmd_args cmd;
- int err;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_SET_PORT_CONFIG);
- cmd.req.arg[1] = adapter->ahw->port_config;
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err)
- dev_info(&adapter->pdev->dev, "Set Port Config failed.\n");
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_get_port_config(struct qlcnic_adapter *adapter)
- {
- struct qlcnic_cmd_args cmd;
- int err;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_PORT_CONFIG);
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err)
- dev_info(&adapter->pdev->dev, "Get Port config failed\n");
- else
- adapter->ahw->port_config = cmd.rsp.arg[1];
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_setup_link_event(struct qlcnic_adapter *adapter, int enable)
- {
- int err;
- u32 temp;
- struct qlcnic_cmd_args cmd;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_LINK_EVENT);
- temp = adapter->recv_ctx->context_id << 16;
- cmd.req.arg[1] = (enable ? 1 : 0) | BIT_8 | temp;
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err)
- dev_info(&adapter->pdev->dev,
- "Setup linkevent mailbox failed\n");
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_nic_set_promisc(struct qlcnic_adapter *adapter, u32 mode)
- {
- int err;
- u32 temp;
- struct qlcnic_cmd_args cmd;
- if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
- return -EIO;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIGURE_MAC_RX_MODE);
- temp = adapter->recv_ctx->context_id << 16;
- cmd.req.arg[1] = (mode ? 1 : 0) | temp;
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err)
- dev_info(&adapter->pdev->dev,
- "Promiscous mode config failed\n");
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_loopback_test(struct net_device *netdev, u8 mode)
- {
- struct qlcnic_adapter *adapter = netdev_priv(netdev);
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- int ret = 0, loop = 0, max_sds_rings = adapter->max_sds_rings;
- QLCDB(adapter, DRV, "%s loopback test in progress\n",
- mode == QLCNIC_ILB_MODE ? "internal" : "external");
- if (ahw->op_mode == QLCNIC_NON_PRIV_FUNC) {
- dev_warn(&adapter->pdev->dev,
- "Loopback test not supported for non privilege function\n");
- return ret;
- }
- if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
- return -EBUSY;
- ret = qlcnic_83xx_diag_alloc_res(netdev, QLCNIC_LOOPBACK_TEST);
- if (ret)
- goto fail_diag_alloc;
- ret = qlcnic_83xx_set_lb_mode(adapter, mode);
- if (ret)
- goto free_diag_res;
- /* Poll for link up event before running traffic */
- do {
- msleep(500);
- qlcnic_83xx_process_aen(adapter);
- if (loop++ > QLCNIC_ILB_MAX_RCV_LOOP) {
- dev_info(&adapter->pdev->dev,
- "Firmware didn't sent link up event to loopback request\n");
- ret = -QLCNIC_FW_NOT_RESPOND;
- qlcnic_83xx_clear_lb_mode(adapter, mode);
- goto free_diag_res;
- }
- } while ((adapter->ahw->linkup && ahw->has_link_events) != 1);
- ret = qlcnic_do_lb_test(adapter, mode);
- qlcnic_83xx_clear_lb_mode(adapter, mode);
- free_diag_res:
- qlcnic_83xx_diag_free_res(netdev, max_sds_rings);
- fail_diag_alloc:
- adapter->max_sds_rings = max_sds_rings;
- clear_bit(__QLCNIC_RESETTING, &adapter->state);
- return ret;
- }
- int qlcnic_83xx_set_lb_mode(struct qlcnic_adapter *adapter, u8 mode)
- {
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- int status = 0, loop = 0;
- u32 config;
- status = qlcnic_83xx_get_port_config(adapter);
- if (status)
- return status;
- config = ahw->port_config;
- set_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
- if (mode == QLCNIC_ILB_MODE)
- ahw->port_config |= QLC_83XX_CFG_LOOPBACK_HSS;
- if (mode == QLCNIC_ELB_MODE)
- ahw->port_config |= QLC_83XX_CFG_LOOPBACK_EXT;
- status = qlcnic_83xx_set_port_config(adapter);
- if (status) {
- dev_err(&adapter->pdev->dev,
- "Failed to Set Loopback Mode = 0x%x.\n",
- ahw->port_config);
- ahw->port_config = config;
- clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
- return status;
- }
- /* Wait for Link and IDC Completion AEN */
- do {
- msleep(300);
- qlcnic_83xx_process_aen(adapter);
- if (loop++ > QLCNIC_ILB_MAX_RCV_LOOP) {
- dev_err(&adapter->pdev->dev,
- "FW did not generate IDC completion AEN\n");
- clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
- qlcnic_83xx_clear_lb_mode(adapter, mode);
- return -EIO;
- }
- } while (test_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status));
- qlcnic_sre_macaddr_change(adapter, adapter->mac_addr, 0,
- QLCNIC_MAC_ADD);
- return status;
- }
- int qlcnic_83xx_clear_lb_mode(struct qlcnic_adapter *adapter, u8 mode)
- {
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- int status = 0, loop = 0;
- u32 config = ahw->port_config;
- set_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
- if (mode == QLCNIC_ILB_MODE)
- ahw->port_config &= ~QLC_83XX_CFG_LOOPBACK_HSS;
- if (mode == QLCNIC_ELB_MODE)
- ahw->port_config &= ~QLC_83XX_CFG_LOOPBACK_EXT;
- status = qlcnic_83xx_set_port_config(adapter);
- if (status) {
- dev_err(&adapter->pdev->dev,
- "Failed to Clear Loopback Mode = 0x%x.\n",
- ahw->port_config);
- ahw->port_config = config;
- clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
- return status;
- }
- /* Wait for Link and IDC Completion AEN */
- do {
- msleep(300);
- qlcnic_83xx_process_aen(adapter);
- if (loop++ > QLCNIC_ILB_MAX_RCV_LOOP) {
- dev_err(&adapter->pdev->dev,
- "Firmware didn't sent IDC completion AEN\n");
- clear_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status);
- return -EIO;
- }
- } while (test_bit(QLC_83XX_IDC_COMP_AEN, &ahw->idc.status));
- qlcnic_sre_macaddr_change(adapter, adapter->mac_addr, 0,
- QLCNIC_MAC_DEL);
- return status;
- }
- void qlcnic_83xx_config_ipaddr(struct qlcnic_adapter *adapter, __be32 ip,
- int mode)
- {
- int err;
- u32 temp, temp_ip;
- struct qlcnic_cmd_args cmd;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIGURE_IP_ADDR);
- if (mode == QLCNIC_IP_UP) {
- temp = adapter->recv_ctx->context_id << 16;
- cmd.req.arg[1] = 1 | temp;
- } else {
- temp = adapter->recv_ctx->context_id << 16;
- cmd.req.arg[1] = 2 | temp;
- }
- /*
- * Adapter needs IP address in network byte order.
- * But hardware mailbox registers go through writel(), hence IP address
- * gets swapped on big endian architecture.
- * To negate swapping of writel() on big endian architecture
- * use swab32(value).
- */
- temp_ip = swab32(ntohl(ip));
- memcpy(&cmd.req.arg[2], &temp_ip, sizeof(u32));
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err != QLCNIC_RCODE_SUCCESS)
- dev_err(&adapter->netdev->dev,
- "could not notify %s IP 0x%x request\n",
- (mode == QLCNIC_IP_UP) ? "Add" : "Remove", ip);
- qlcnic_free_mbx_args(&cmd);
- }
- int qlcnic_83xx_config_hw_lro(struct qlcnic_adapter *adapter, int mode)
- {
- int err;
- u32 temp, arg1;
- struct qlcnic_cmd_args cmd;
- int lro_bit_mask;
- lro_bit_mask = (mode ? (BIT_0 | BIT_1 | BIT_2 | BIT_3) : 0);
- if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
- return 0;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIGURE_HW_LRO);
- temp = adapter->recv_ctx->context_id << 16;
- arg1 = lro_bit_mask | temp;
- cmd.req.arg[1] = arg1;
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err)
- dev_info(&adapter->pdev->dev, "LRO config failed\n");
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_config_rss(struct qlcnic_adapter *adapter, int enable)
- {
- int err;
- u32 word;
- struct qlcnic_cmd_args cmd;
- const u64 key[] = { 0xbeac01fa6a42b73bULL, 0x8030f20c77cb2da3ULL,
- 0xae7b30b4d0ca2bcbULL, 0x43a38fb04167253dULL,
- 0x255b0ec26d5a56daULL };
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIGURE_RSS);
- /*
- * RSS request:
- * bits 3-0: Rsvd
- * 5-4: hash_type_ipv4
- * 7-6: hash_type_ipv6
- * 8: enable
- * 9: use indirection table
- * 16-31: indirection table mask
- */
- word = ((u32)(RSS_HASHTYPE_IP_TCP & 0x3) << 4) |
- ((u32)(RSS_HASHTYPE_IP_TCP & 0x3) << 6) |
- ((u32)(enable & 0x1) << 8) |
- ((0x7ULL) << 16);
- cmd.req.arg[1] = (adapter->recv_ctx->context_id);
- cmd.req.arg[2] = word;
- memcpy(&cmd.req.arg[4], key, sizeof(key));
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err)
- dev_info(&adapter->pdev->dev, "RSS config failed\n");
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_sre_macaddr_change(struct qlcnic_adapter *adapter, u8 *addr,
- __le16 vlan_id, u8 op)
- {
- int err;
- u32 *buf;
- struct qlcnic_cmd_args cmd;
- struct qlcnic_macvlan_mbx mv;
- if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
- return -EIO;
- err = qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIG_MAC_VLAN);
- if (err)
- return err;
- cmd.req.arg[1] = op | (1 << 8) |
- (adapter->recv_ctx->context_id << 16);
- mv.vlan = le16_to_cpu(vlan_id);
- memcpy(&mv.mac, addr, ETH_ALEN);
- buf = &cmd.req.arg[2];
- memcpy(buf, &mv, sizeof(struct qlcnic_macvlan_mbx));
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err)
- dev_err(&adapter->pdev->dev,
- "MAC-VLAN %s to CAM failed, err=%d.\n",
- ((op == 1) ? "add " : "delete "), err);
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- void qlcnic_83xx_change_l2_filter(struct qlcnic_adapter *adapter, u64 *addr,
- __le16 vlan_id)
- {
- u8 mac[ETH_ALEN];
- memcpy(&mac, addr, ETH_ALEN);
- qlcnic_83xx_sre_macaddr_change(adapter, mac, vlan_id, QLCNIC_MAC_ADD);
- }
- void qlcnic_83xx_configure_mac(struct qlcnic_adapter *adapter, u8 *mac,
- u8 type, struct qlcnic_cmd_args *cmd)
- {
- switch (type) {
- case QLCNIC_SET_STATION_MAC:
- case QLCNIC_SET_FAC_DEF_MAC:
- memcpy(&cmd->req.arg[2], mac, sizeof(u32));
- memcpy(&cmd->req.arg[3], &mac[4], sizeof(u16));
- break;
- }
- cmd->req.arg[1] = type;
- }
- int qlcnic_83xx_get_mac_address(struct qlcnic_adapter *adapter, u8 *mac)
- {
- int err, i;
- struct qlcnic_cmd_args cmd;
- u32 mac_low, mac_high;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_MAC_ADDRESS);
- qlcnic_83xx_configure_mac(adapter, mac, QLCNIC_GET_CURRENT_MAC, &cmd);
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err == QLCNIC_RCODE_SUCCESS) {
- mac_low = cmd.rsp.arg[1];
- mac_high = cmd.rsp.arg[2];
- for (i = 0; i < 2; i++)
- mac[i] = (u8) (mac_high >> ((1 - i) * 8));
- for (i = 2; i < 6; i++)
- mac[i] = (u8) (mac_low >> ((5 - i) * 8));
- } else {
- dev_err(&adapter->pdev->dev, "Failed to get mac address%d\n",
- err);
- err = -EIO;
- }
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- void qlcnic_83xx_config_intr_coal(struct qlcnic_adapter *adapter)
- {
- int err;
- u32 temp;
- struct qlcnic_cmd_args cmd;
- struct qlcnic_nic_intr_coalesce *coal = &adapter->ahw->coal;
- if (adapter->recv_ctx->state == QLCNIC_HOST_CTX_STATE_FREED)
- return;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIG_INTR_COAL);
- cmd.req.arg[1] = 1 | (adapter->recv_ctx->context_id << 16);
- cmd.req.arg[3] = coal->flag;
- temp = coal->rx_time_us << 16;
- cmd.req.arg[2] = coal->rx_packets | temp;
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err != QLCNIC_RCODE_SUCCESS)
- dev_info(&adapter->pdev->dev,
- "Failed to send interrupt coalescence parameters\n");
- qlcnic_free_mbx_args(&cmd);
- }
- static void qlcnic_83xx_handle_link_aen(struct qlcnic_adapter *adapter,
- u32 data[])
- {
- u8 link_status, duplex;
- /* link speed */
- link_status = LSB(data[3]) & 1;
- adapter->ahw->link_speed = MSW(data[2]);
- adapter->ahw->link_autoneg = MSB(MSW(data[3]));
- adapter->ahw->module_type = MSB(LSW(data[3]));
- duplex = LSB(MSW(data[3]));
- if (duplex)
- adapter->ahw->link_duplex = DUPLEX_FULL;
- else
- adapter->ahw->link_duplex = DUPLEX_HALF;
- adapter->ahw->has_link_events = 1;
- qlcnic_advert_link_change(adapter, link_status);
- }
- irqreturn_t qlcnic_83xx_handle_aen(int irq, void *data)
- {
- struct qlcnic_adapter *adapter = data;
- unsigned long flags;
- u32 mask, resp, event;
- spin_lock_irqsave(&adapter->ahw->mbx_lock, flags);
- resp = QLCRDX(adapter->ahw, QLCNIC_FW_MBX_CTRL);
- if (!(resp & QLCNIC_SET_OWNER))
- goto out;
- event = readl(QLCNIC_MBX_FW(adapter->ahw, 0));
- if (event & QLCNIC_MBX_ASYNC_EVENT)
- qlcnic_83xx_process_aen(adapter);
- out:
- mask = QLCRDX(adapter->ahw, QLCNIC_DEF_INT_MASK);
- writel(0, adapter->ahw->pci_base0 + mask);
- spin_unlock_irqrestore(&adapter->ahw->mbx_lock, flags);
- return IRQ_HANDLED;
- }
- int qlcnic_enable_eswitch(struct qlcnic_adapter *adapter, u8 port, u8 enable)
- {
- int err = -EIO;
- struct qlcnic_cmd_args cmd;
- if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
- dev_err(&adapter->pdev->dev,
- "%s: Error, invoked by non management func\n",
- __func__);
- return err;
- }
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_TOGGLE_ESWITCH);
- cmd.req.arg[1] = (port & 0xf) | BIT_4;
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err != QLCNIC_RCODE_SUCCESS) {
- dev_err(&adapter->pdev->dev, "Failed to enable eswitch%d\n",
- err);
- err = -EIO;
- }
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_set_nic_info(struct qlcnic_adapter *adapter,
- struct qlcnic_info *nic)
- {
- int i, err = -EIO;
- struct qlcnic_cmd_args cmd;
- if (adapter->ahw->op_mode != QLCNIC_MGMT_FUNC) {
- dev_err(&adapter->pdev->dev,
- "%s: Error, invoked by non management func\n",
- __func__);
- return err;
- }
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_SET_NIC_INFO);
- cmd.req.arg[1] = (nic->pci_func << 16);
- cmd.req.arg[2] = 0x1 << 16;
- cmd.req.arg[3] = nic->phys_port | (nic->switch_mode << 16);
- cmd.req.arg[4] = nic->capabilities;
- cmd.req.arg[5] = (nic->max_mac_filters & 0xFF) | ((nic->max_mtu) << 16);
- cmd.req.arg[6] = (nic->max_tx_ques) | ((nic->max_rx_ques) << 16);
- cmd.req.arg[7] = (nic->min_tx_bw) | ((nic->max_tx_bw) << 16);
- for (i = 8; i < 32; i++)
- cmd.req.arg[i] = 0;
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err != QLCNIC_RCODE_SUCCESS) {
- dev_err(&adapter->pdev->dev, "Failed to set nic info%d\n",
- err);
- err = -EIO;
- }
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_get_nic_info(struct qlcnic_adapter *adapter,
- struct qlcnic_info *npar_info, u8 func_id)
- {
- int err;
- u32 temp;
- u8 op = 0;
- struct qlcnic_cmd_args cmd;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_NIC_INFO);
- if (func_id != adapter->ahw->pci_func) {
- temp = func_id << 16;
- cmd.req.arg[1] = op | BIT_31 | temp;
- } else {
- cmd.req.arg[1] = adapter->ahw->pci_func << 16;
- }
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err) {
- dev_info(&adapter->pdev->dev,
- "Failed to get nic info %d\n", err);
- goto out;
- }
- npar_info->op_type = cmd.rsp.arg[1];
- npar_info->pci_func = cmd.rsp.arg[2] & 0xFFFF;
- npar_info->op_mode = (cmd.rsp.arg[2] & 0xFFFF0000) >> 16;
- npar_info->phys_port = cmd.rsp.arg[3] & 0xFFFF;
- npar_info->switch_mode = (cmd.rsp.arg[3] & 0xFFFF0000) >> 16;
- npar_info->capabilities = cmd.rsp.arg[4];
- npar_info->max_mac_filters = cmd.rsp.arg[5] & 0xFF;
- npar_info->max_mtu = (cmd.rsp.arg[5] & 0xFFFF0000) >> 16;
- npar_info->max_tx_ques = cmd.rsp.arg[6] & 0xFFFF;
- npar_info->max_rx_ques = (cmd.rsp.arg[6] & 0xFFFF0000) >> 16;
- npar_info->min_tx_bw = cmd.rsp.arg[7] & 0xFFFF;
- npar_info->max_tx_bw = (cmd.rsp.arg[7] & 0xFFFF0000) >> 16;
- if (cmd.rsp.arg[8] & 0x1)
- npar_info->max_bw_reg_offset = (cmd.rsp.arg[8] & 0x7FFE) >> 1;
- if (cmd.rsp.arg[8] & 0x10000) {
- temp = (cmd.rsp.arg[8] & 0x7FFE0000) >> 17;
- npar_info->max_linkspeed_reg_offset = temp;
- }
- out:
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_get_pci_info(struct qlcnic_adapter *adapter,
- struct qlcnic_pci_info *pci_info)
- {
- int i, err = 0, j = 0;
- u32 temp;
- struct qlcnic_cmd_args cmd;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_PCI_INFO);
- err = qlcnic_issue_cmd(adapter, &cmd);
- adapter->ahw->act_pci_func = 0;
- if (err == QLCNIC_RCODE_SUCCESS) {
- pci_info->func_count = cmd.rsp.arg[1] & 0xFF;
- dev_info(&adapter->pdev->dev,
- "%s: total functions = %d\n",
- __func__, pci_info->func_count);
- for (i = 2, j = 0; j < QLCNIC_MAX_PCI_FUNC; j++, pci_info++) {
- pci_info->id = cmd.rsp.arg[i] & 0xFFFF;
- pci_info->active = (cmd.rsp.arg[i] & 0xFFFF0000) >> 16;
- i++;
- pci_info->type = cmd.rsp.arg[i] & 0xFFFF;
- if (pci_info->type == QLCNIC_TYPE_NIC)
- adapter->ahw->act_pci_func++;
- temp = (cmd.rsp.arg[i] & 0xFFFF0000) >> 16;
- pci_info->default_port = temp;
- i++;
- pci_info->tx_min_bw = cmd.rsp.arg[i] & 0xFFFF;
- temp = (cmd.rsp.arg[i] & 0xFFFF0000) >> 16;
- pci_info->tx_max_bw = temp;
- i = i + 2;
- memcpy(pci_info->mac, &cmd.rsp.arg[i], ETH_ALEN - 2);
- i++;
- memcpy(pci_info->mac + sizeof(u32), &cmd.rsp.arg[i], 2);
- i = i + 3;
- dev_info(&adapter->pdev->dev, "%s:\n"
- "\tid = %d active = %d type = %d\n"
- "\tport = %d min bw = %d max bw = %d\n"
- "\tmac_addr = %pM\n", __func__,
- pci_info->id, pci_info->active, pci_info->type,
- pci_info->default_port, pci_info->tx_min_bw,
- pci_info->tx_max_bw, pci_info->mac);
- }
- } else {
- dev_err(&adapter->pdev->dev, "Failed to get PCI Info%d\n",
- err);
- err = -EIO;
- }
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_config_intrpt(struct qlcnic_adapter *adapter, bool op_type)
- {
- int i, index, err;
- bool type;
- u8 max_ints;
- u32 val, temp;
- struct qlcnic_cmd_args cmd;
- max_ints = adapter->ahw->num_msix - 1;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_CONFIG_INTRPT);
- cmd.req.arg[1] = max_ints;
- for (i = 0, index = 2; i < max_ints; i++) {
- type = op_type ? QLCNIC_INTRPT_ADD : QLCNIC_INTRPT_DEL;
- val = type | (adapter->ahw->intr_tbl[i].type << 4);
- if (adapter->ahw->intr_tbl[i].type == QLCNIC_INTRPT_MSIX)
- val |= (adapter->ahw->intr_tbl[i].id << 16);
- cmd.req.arg[index++] = val;
- }
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err) {
- dev_err(&adapter->pdev->dev,
- "Failed to configure interrupts 0x%x\n", err);
- goto out;
- }
- max_ints = cmd.rsp.arg[1];
- for (i = 0, index = 2; i < max_ints; i++, index += 2) {
- val = cmd.rsp.arg[index];
- if (LSB(val)) {
- dev_info(&adapter->pdev->dev,
- "Can't configure interrupt %d\n",
- adapter->ahw->intr_tbl[i].id);
- continue;
- }
- if (op_type) {
- adapter->ahw->intr_tbl[i].id = MSW(val);
- adapter->ahw->intr_tbl[i].enabled = 1;
- temp = cmd.rsp.arg[index + 1];
- adapter->ahw->intr_tbl[i].src = temp;
- } else {
- adapter->ahw->intr_tbl[i].id = i;
- adapter->ahw->intr_tbl[i].enabled = 0;
- adapter->ahw->intr_tbl[i].src = 0;
- }
- }
- out:
- qlcnic_free_mbx_args(&cmd);
- return err;
- }
- int qlcnic_83xx_lock_flash(struct qlcnic_adapter *adapter)
- {
- int id, timeout = 0;
- u32 status = 0;
- while (status == 0) {
- status = QLC_SHARED_REG_RD32(adapter, QLCNIC_FLASH_LOCK);
- if (status)
- break;
- if (++timeout >= QLC_83XX_FLASH_LOCK_TIMEOUT) {
- id = QLC_SHARED_REG_RD32(adapter,
- QLCNIC_FLASH_LOCK_OWNER);
- dev_err(&adapter->pdev->dev,
- "%s: failed, lock held by %d\n", __func__, id);
- return -EIO;
- }
- usleep_range(1000, 2000);
- }
- QLC_SHARED_REG_WR32(adapter, QLCNIC_FLASH_LOCK_OWNER, adapter->portnum);
- return 0;
- }
- void qlcnic_83xx_unlock_flash(struct qlcnic_adapter *adapter)
- {
- QLC_SHARED_REG_RD32(adapter, QLCNIC_FLASH_UNLOCK);
- QLC_SHARED_REG_WR32(adapter, QLCNIC_FLASH_LOCK_OWNER, 0xFF);
- }
- int qlcnic_83xx_lockless_flash_read32(struct qlcnic_adapter *adapter,
- u32 flash_addr, u8 *p_data,
- int count)
- {
- int i, ret;
- u32 word, range, flash_offset, addr = flash_addr;
- ulong indirect_add, direct_window;
- flash_offset = addr & (QLCNIC_FLASH_SECTOR_SIZE - 1);
- if (addr & 0x3) {
- dev_err(&adapter->pdev->dev, "Illegal addr = 0x%x\n", addr);
- return -EIO;
- }
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_DIRECT_WINDOW,
- (addr));
- range = flash_offset + (count * sizeof(u32));
- /* Check if data is spread across multiple sectors */
- if (range > (QLCNIC_FLASH_SECTOR_SIZE - 1)) {
- /* Multi sector read */
- for (i = 0; i < count; i++) {
- indirect_add = QLC_83XX_FLASH_DIRECT_DATA(addr);
- ret = qlcnic_83xx_rd_reg_indirect(adapter,
- indirect_add);
- if (ret == -EIO)
- return -EIO;
- word = ret;
- *(u32 *)p_data = word;
- p_data = p_data + 4;
- addr = addr + 4;
- flash_offset = flash_offset + 4;
- if (flash_offset > (QLCNIC_FLASH_SECTOR_SIZE - 1)) {
- direct_window = QLC_83XX_FLASH_DIRECT_WINDOW;
- /* This write is needed once for each sector */
- qlcnic_83xx_wrt_reg_indirect(adapter,
- direct_window,
- (addr));
- flash_offset = 0;
- }
- }
- } else {
- /* Single sector read */
- for (i = 0; i < count; i++) {
- indirect_add = QLC_83XX_FLASH_DIRECT_DATA(addr);
- ret = qlcnic_83xx_rd_reg_indirect(adapter,
- indirect_add);
- if (ret == -EIO)
- return -EIO;
- word = ret;
- *(u32 *)p_data = word;
- p_data = p_data + 4;
- addr = addr + 4;
- }
- }
- return 0;
- }
- static int qlcnic_83xx_poll_flash_status_reg(struct qlcnic_adapter *adapter)
- {
- u32 status;
- int retries = QLC_83XX_FLASH_READ_RETRY_COUNT;
- do {
- status = qlcnic_83xx_rd_reg_indirect(adapter,
- QLC_83XX_FLASH_STATUS);
- if ((status & QLC_83XX_FLASH_STATUS_READY) ==
- QLC_83XX_FLASH_STATUS_READY)
- break;
- msleep(QLC_83XX_FLASH_STATUS_REG_POLL_DELAY);
- } while (--retries);
- if (!retries)
- return -EIO;
- return 0;
- }
- static int qlcnic_83xx_enable_flash_write_op(struct qlcnic_adapter *adapter)
- {
- int ret;
- u32 cmd;
- cmd = adapter->ahw->fdt.write_statusreg_cmd;
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
- (QLC_83XX_FLASH_FDT_WRITE_DEF_SIG | cmd));
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
- adapter->ahw->fdt.write_enable_bits);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
- QLC_83XX_FLASH_SECOND_ERASE_MS_VAL);
- ret = qlcnic_83xx_poll_flash_status_reg(adapter);
- if (ret)
- return -EIO;
- return 0;
- }
- static int qlcnic_83xx_disable_flash_write_op(struct qlcnic_adapter *adapter)
- {
- int ret;
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
- (QLC_83XX_FLASH_FDT_WRITE_DEF_SIG |
- adapter->ahw->fdt.write_statusreg_cmd));
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
- adapter->ahw->fdt.write_disable_bits);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
- QLC_83XX_FLASH_SECOND_ERASE_MS_VAL);
- ret = qlcnic_83xx_poll_flash_status_reg(adapter);
- if (ret)
- return -EIO;
- return 0;
- }
- int qlcnic_83xx_read_flash_mfg_id(struct qlcnic_adapter *adapter)
- {
- int ret, mfg_id;
- if (qlcnic_83xx_lock_flash(adapter))
- return -EIO;
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
- QLC_83XX_FLASH_FDT_READ_MFG_ID_VAL);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
- QLC_83XX_FLASH_READ_CTRL);
- ret = qlcnic_83xx_poll_flash_status_reg(adapter);
- if (ret) {
- qlcnic_83xx_unlock_flash(adapter);
- return -EIO;
- }
- mfg_id = qlcnic_83xx_rd_reg_indirect(adapter, QLC_83XX_FLASH_RDDATA);
- if (mfg_id == -EIO)
- return -EIO;
- adapter->flash_mfg_id = (mfg_id & 0xFF);
- qlcnic_83xx_unlock_flash(adapter);
- return 0;
- }
- int qlcnic_83xx_read_flash_descriptor_table(struct qlcnic_adapter *adapter)
- {
- int count, fdt_size, ret = 0;
- fdt_size = sizeof(struct qlcnic_fdt);
- count = fdt_size / sizeof(u32);
- if (qlcnic_83xx_lock_flash(adapter))
- return -EIO;
- memset(&adapter->ahw->fdt, 0, fdt_size);
- ret = qlcnic_83xx_lockless_flash_read32(adapter, QLCNIC_FDT_LOCATION,
- (u8 *)&adapter->ahw->fdt,
- count);
- qlcnic_83xx_unlock_flash(adapter);
- return ret;
- }
- int qlcnic_83xx_erase_flash_sector(struct qlcnic_adapter *adapter,
- u32 sector_start_addr)
- {
- u32 reversed_addr, addr1, addr2, cmd;
- int ret = -EIO;
- if (qlcnic_83xx_lock_flash(adapter) != 0)
- return -EIO;
- if (adapter->ahw->fdt.mfg_id == adapter->flash_mfg_id) {
- ret = qlcnic_83xx_enable_flash_write_op(adapter);
- if (ret) {
- qlcnic_83xx_unlock_flash(adapter);
- dev_err(&adapter->pdev->dev,
- "%s failed at %d\n",
- __func__, __LINE__);
- return ret;
- }
- }
- ret = qlcnic_83xx_poll_flash_status_reg(adapter);
- if (ret) {
- qlcnic_83xx_unlock_flash(adapter);
- dev_err(&adapter->pdev->dev,
- "%s: failed at %d\n", __func__, __LINE__);
- return -EIO;
- }
- addr1 = (sector_start_addr & 0xFF) << 16;
- addr2 = (sector_start_addr & 0xFF0000) >> 16;
- reversed_addr = addr1 | addr2;
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
- reversed_addr);
- cmd = QLC_83XX_FLASH_FDT_ERASE_DEF_SIG | adapter->ahw->fdt.erase_cmd;
- if (adapter->ahw->fdt.mfg_id == adapter->flash_mfg_id)
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR, cmd);
- else
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
- QLC_83XX_FLASH_OEM_ERASE_SIG);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
- QLC_83XX_FLASH_LAST_ERASE_MS_VAL);
- ret = qlcnic_83xx_poll_flash_status_reg(adapter);
- if (ret) {
- qlcnic_83xx_unlock_flash(adapter);
- dev_err(&adapter->pdev->dev,
- "%s: failed at %d\n", __func__, __LINE__);
- return -EIO;
- }
- if (adapter->ahw->fdt.mfg_id == adapter->flash_mfg_id) {
- ret = qlcnic_83xx_disable_flash_write_op(adapter);
- if (ret) {
- qlcnic_83xx_unlock_flash(adapter);
- dev_err(&adapter->pdev->dev,
- "%s: failed at %d\n", __func__, __LINE__);
- return ret;
- }
- }
- qlcnic_83xx_unlock_flash(adapter);
- return 0;
- }
- int qlcnic_83xx_flash_write32(struct qlcnic_adapter *adapter, u32 addr,
- u32 *p_data)
- {
- int ret = -EIO;
- u32 addr1 = 0x00800000 | (addr >> 2);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR, addr1);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA, *p_data);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
- QLC_83XX_FLASH_LAST_ERASE_MS_VAL);
- ret = qlcnic_83xx_poll_flash_status_reg(adapter);
- if (ret) {
- dev_err(&adapter->pdev->dev,
- "%s: failed at %d\n", __func__, __LINE__);
- return -EIO;
- }
- return 0;
- }
- int qlcnic_83xx_flash_bulk_write(struct qlcnic_adapter *adapter, u32 addr,
- u32 *p_data, int count)
- {
- u32 temp;
- int ret = -EIO;
- if ((count < QLC_83XX_FLASH_BULK_WRITE_MIN) ||
- (count > QLC_83XX_FLASH_BULK_WRITE_MAX)) {
- dev_err(&adapter->pdev->dev,
- "%s: Invalid word count\n", __func__);
- return -EIO;
- }
- temp = qlcnic_83xx_rd_reg_indirect(adapter,
- QLC_83XX_FLASH_SPI_CONTROL);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_SPI_CONTROL,
- (temp | QLC_83XX_FLASH_SPI_CTRL));
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
- QLC_83XX_FLASH_ADDR_TEMP_VAL);
- /* First DWORD write */
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA, *p_data++);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
- QLC_83XX_FLASH_FIRST_MS_PATTERN);
- ret = qlcnic_83xx_poll_flash_status_reg(adapter);
- if (ret) {
- dev_err(&adapter->pdev->dev,
- "%s: failed at %d\n", __func__, __LINE__);
- return -EIO;
- }
- count--;
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
- QLC_83XX_FLASH_ADDR_SECOND_TEMP_VAL);
- /* Second to N-1 DWORD writes */
- while (count != 1) {
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA,
- *p_data++);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
- QLC_83XX_FLASH_SECOND_MS_PATTERN);
- ret = qlcnic_83xx_poll_flash_status_reg(adapter);
- if (ret) {
- dev_err(&adapter->pdev->dev,
- "%s: failed at %d\n", __func__, __LINE__);
- return -EIO;
- }
- count--;
- }
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
- QLC_83XX_FLASH_ADDR_TEMP_VAL |
- (addr >> 2));
- /* Last DWORD write */
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_WRDATA, *p_data++);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
- QLC_83XX_FLASH_LAST_MS_PATTERN);
- ret = qlcnic_83xx_poll_flash_status_reg(adapter);
- if (ret) {
- dev_err(&adapter->pdev->dev,
- "%s: failed at %d\n", __func__, __LINE__);
- return -EIO;
- }
- ret = qlcnic_83xx_rd_reg_indirect(adapter, QLC_83XX_FLASH_SPI_STATUS);
- if ((ret & QLC_83XX_FLASH_SPI_CTRL) == QLC_83XX_FLASH_SPI_CTRL) {
- dev_err(&adapter->pdev->dev, "%s: failed at %d\n",
- __func__, __LINE__);
- /* Operation failed, clear error bit */
- temp = qlcnic_83xx_rd_reg_indirect(adapter,
- QLC_83XX_FLASH_SPI_CONTROL);
- qlcnic_83xx_wrt_reg_indirect(adapter,
- QLC_83XX_FLASH_SPI_CONTROL,
- (temp | QLC_83XX_FLASH_SPI_CTRL));
- }
- return 0;
- }
- static void qlcnic_83xx_recover_driver_lock(struct qlcnic_adapter *adapter)
- {
- u32 val, id;
- val = QLCRDX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK);
- /* Check if recovery need to be performed by the calling function */
- if ((val & QLC_83XX_DRV_LOCK_RECOVERY_STATUS_MASK) == 0) {
- val = val & ~0x3F;
- val = val | ((adapter->portnum << 2) |
- QLC_83XX_NEED_DRV_LOCK_RECOVERY);
- QLCWRX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK, val);
- dev_info(&adapter->pdev->dev,
- "%s: lock recovery initiated\n", __func__);
- msleep(QLC_83XX_DRV_LOCK_RECOVERY_DELAY);
- val = QLCRDX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK);
- id = ((val >> 2) & 0xF);
- if (id == adapter->portnum) {
- val = val & ~QLC_83XX_DRV_LOCK_RECOVERY_STATUS_MASK;
- val = val | QLC_83XX_DRV_LOCK_RECOVERY_IN_PROGRESS;
- QLCWRX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK, val);
- /* Force release the lock */
- QLCRDX(adapter->ahw, QLC_83XX_DRV_UNLOCK);
- /* Clear recovery bits */
- val = val & ~0x3F;
- QLCWRX(adapter->ahw, QLC_83XX_RECOVER_DRV_LOCK, val);
- dev_info(&adapter->pdev->dev,
- "%s: lock recovery completed\n", __func__);
- } else {
- dev_info(&adapter->pdev->dev,
- "%s: func %d to resume lock recovery process\n",
- __func__, id);
- }
- } else {
- dev_info(&adapter->pdev->dev,
- "%s: lock recovery initiated by other functions\n",
- __func__);
- }
- }
- int qlcnic_83xx_lock_driver(struct qlcnic_adapter *adapter)
- {
- u32 lock_alive_counter, val, id, i = 0, status = 0, temp = 0;
- int max_attempt = 0;
- while (status == 0) {
- status = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK);
- if (status)
- break;
- msleep(QLC_83XX_DRV_LOCK_WAIT_DELAY);
- i++;
- if (i == 1)
- temp = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
- if (i == QLC_83XX_DRV_LOCK_WAIT_COUNTER) {
- val = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
- if (val == temp) {
- id = val & 0xFF;
- dev_info(&adapter->pdev->dev,
- "%s: lock to be recovered from %d\n",
- __func__, id);
- qlcnic_83xx_recover_driver_lock(adapter);
- i = 0;
- max_attempt++;
- } else {
- dev_err(&adapter->pdev->dev,
- "%s: failed to get lock\n", __func__);
- return -EIO;
- }
- }
- /* Force exit from while loop after few attempts */
- if (max_attempt == QLC_83XX_MAX_DRV_LOCK_RECOVERY_ATTEMPT) {
- dev_err(&adapter->pdev->dev,
- "%s: failed to get lock\n", __func__);
- return -EIO;
- }
- }
- val = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
- lock_alive_counter = val >> 8;
- lock_alive_counter++;
- val = lock_alive_counter << 8 | adapter->portnum;
- QLCWRX(adapter->ahw, QLC_83XX_DRV_LOCK_ID, val);
- return 0;
- }
- void qlcnic_83xx_unlock_driver(struct qlcnic_adapter *adapter)
- {
- u32 val, lock_alive_counter, id;
- val = QLCRDX(adapter->ahw, QLC_83XX_DRV_LOCK_ID);
- id = val & 0xFF;
- lock_alive_counter = val >> 8;
- if (id != adapter->portnum)
- dev_err(&adapter->pdev->dev,
- "%s:Warning func %d is unlocking lock owned by %d\n",
- __func__, adapter->portnum, id);
- val = (lock_alive_counter << 8) | 0xFF;
- QLCWRX(adapter->ahw, QLC_83XX_DRV_LOCK_ID, val);
- QLCRDX(adapter->ahw, QLC_83XX_DRV_UNLOCK);
- }
- int qlcnic_83xx_ms_mem_write128(struct qlcnic_adapter *adapter, u64 addr,
- u32 *data, u32 count)
- {
- int i, j, ret = 0;
- u32 temp;
- /* Check alignment */
- if (addr & 0xF)
- return -EIO;
- mutex_lock(&adapter->ahw->mem_lock);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_ADDR_HI, 0);
- for (i = 0; i < count; i++, addr += 16) {
- if (!((ADDR_IN_RANGE(addr, QLCNIC_ADDR_QDR_NET,
- QLCNIC_ADDR_QDR_NET_MAX)) ||
- (ADDR_IN_RANGE(addr, QLCNIC_ADDR_DDR_NET,
- QLCNIC_ADDR_DDR_NET_MAX)))) {
- mutex_unlock(&adapter->ahw->mem_lock);
- return -EIO;
- }
- qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_ADDR_LO, addr);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_WRTDATA_LO,
- *data++);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_WRTDATA_HI,
- *data++);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_WRTDATA_ULO,
- *data++);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_WRTDATA_UHI,
- *data++);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_CTRL,
- QLCNIC_TA_WRITE_ENABLE);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLCNIC_MS_CTRL,
- QLCNIC_TA_WRITE_START);
- for (j = 0; j < MAX_CTL_CHECK; j++) {
- temp = qlcnic_83xx_rd_reg_indirect(adapter,
- QLCNIC_MS_CTRL);
- if ((temp & TA_CTL_BUSY) == 0)
- break;
- }
- /* Status check failure */
- if (j >= MAX_CTL_CHECK) {
- printk_ratelimited(KERN_WARNING
- "MS memory write failed\n");
- mutex_unlock(&adapter->ahw->mem_lock);
- return -EIO;
- }
- }
- mutex_unlock(&adapter->ahw->mem_lock);
- return ret;
- }
- int qlcnic_83xx_flash_read32(struct qlcnic_adapter *adapter, u32 flash_addr,
- u8 *p_data, int count)
- {
- int i, ret;
- u32 word, addr = flash_addr;
- ulong indirect_addr;
- if (qlcnic_83xx_lock_flash(adapter) != 0)
- return -EIO;
- if (addr & 0x3) {
- dev_err(&adapter->pdev->dev, "Illegal addr = 0x%x\n", addr);
- qlcnic_83xx_unlock_flash(adapter);
- return -EIO;
- }
- for (i = 0; i < count; i++) {
- if (qlcnic_83xx_wrt_reg_indirect(adapter,
- QLC_83XX_FLASH_DIRECT_WINDOW,
- (addr))) {
- qlcnic_83xx_unlock_flash(adapter);
- return -EIO;
- }
- indirect_addr = QLC_83XX_FLASH_DIRECT_DATA(addr);
- ret = qlcnic_83xx_rd_reg_indirect(adapter,
- indirect_addr);
- if (ret == -EIO)
- return -EIO;
- word = ret;
- *(u32 *)p_data = word;
- p_data = p_data + 4;
- addr = addr + 4;
- }
- qlcnic_83xx_unlock_flash(adapter);
- return 0;
- }
- int qlcnic_83xx_test_link(struct qlcnic_adapter *adapter)
- {
- int err;
- u32 config = 0, state;
- struct qlcnic_cmd_args cmd;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- state = readl(ahw->pci_base0 + QLC_83XX_LINK_STATE(ahw->pci_func));
- if (!QLC_83xx_FUNC_VAL(state, ahw->pci_func)) {
- dev_info(&adapter->pdev->dev, "link state down\n");
- return config;
- }
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_LINK_STATUS);
- err = qlcnic_issue_cmd(adapter, &cmd);
- if (err) {
- dev_info(&adapter->pdev->dev,
- "Get Link Status Command failed: 0x%x\n", err);
- goto out;
- } else {
- config = cmd.rsp.arg[1];
- switch (QLC_83XX_CURRENT_LINK_SPEED(config)) {
- case QLC_83XX_10M_LINK:
- ahw->link_speed = SPEED_10;
- break;
- case QLC_83XX_100M_LINK:
- ahw->link_speed = SPEED_100;
- break;
- case QLC_83XX_1G_LINK:
- ahw->link_speed = SPEED_1000;
- break;
- case QLC_83XX_10G_LINK:
- ahw->link_speed = SPEED_10000;
- break;
- default:
- ahw->link_speed = 0;
- break;
- }
- config = cmd.rsp.arg[3];
- if (config & 1)
- err = 1;
- }
- out:
- qlcnic_free_mbx_args(&cmd);
- return config;
- }
- int qlcnic_83xx_get_settings(struct qlcnic_adapter *adapter)
- {
- u32 config = 0;
- int status = 0;
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- /* Get port configuration info */
- status = qlcnic_83xx_get_port_info(adapter);
- /* Get Link Status related info */
- config = qlcnic_83xx_test_link(adapter);
- ahw->module_type = QLC_83XX_SFP_MODULE_TYPE(config);
- /* hard code until there is a way to get it from flash */
- ahw->board_type = QLCNIC_BRDTYPE_83XX_10G;
- return status;
- }
- int qlcnic_83xx_set_settings(struct qlcnic_adapter *adapter,
- struct ethtool_cmd *ecmd)
- {
- int status = 0;
- u32 config = adapter->ahw->port_config;
- if (ecmd->autoneg)
- adapter->ahw->port_config |= BIT_15;
- switch (ethtool_cmd_speed(ecmd)) {
- case SPEED_10:
- adapter->ahw->port_config |= BIT_8;
- break;
- case SPEED_100:
- adapter->ahw->port_config |= BIT_9;
- break;
- case SPEED_1000:
- adapter->ahw->port_config |= BIT_10;
- break;
- case SPEED_10000:
- adapter->ahw->port_config |= BIT_11;
- break;
- default:
- return -EINVAL;
- }
- status = qlcnic_83xx_set_port_config(adapter);
- if (status) {
- dev_info(&adapter->pdev->dev,
- "Faild to Set Link Speed and autoneg.\n");
- adapter->ahw->port_config = config;
- }
- return status;
- }
- static inline u64 *qlcnic_83xx_copy_stats(struct qlcnic_cmd_args *cmd,
- u64 *data, int index)
- {
- u32 low, hi;
- u64 val;
- low = cmd->rsp.arg[index];
- hi = cmd->rsp.arg[index + 1];
- val = (((u64) low) | (((u64) hi) << 32));
- *data++ = val;
- return data;
- }
- static u64 *qlcnic_83xx_fill_stats(struct qlcnic_adapter *adapter,
- struct qlcnic_cmd_args *cmd, u64 *data,
- int type, int *ret)
- {
- int err, k, total_regs;
- *ret = 0;
- err = qlcnic_issue_cmd(adapter, cmd);
- if (err != QLCNIC_RCODE_SUCCESS) {
- dev_info(&adapter->pdev->dev,
- "Error in get statistics mailbox command\n");
- *ret = -EIO;
- return data;
- }
- total_regs = cmd->rsp.num;
- switch (type) {
- case QLC_83XX_STAT_MAC:
- /* fill in MAC tx counters */
- for (k = 2; k < 28; k += 2)
- data = qlcnic_83xx_copy_stats(cmd, data, k);
- /* skip 24 bytes of reserved area */
- /* fill in MAC rx counters */
- for (k += 6; k < 60; k += 2)
- data = qlcnic_83xx_copy_stats(cmd, data, k);
- /* skip 24 bytes of reserved area */
- /* fill in MAC rx frame stats */
- for (k += 6; k < 80; k += 2)
- data = qlcnic_83xx_copy_stats(cmd, data, k);
- break;
- case QLC_83XX_STAT_RX:
- for (k = 2; k < 8; k += 2)
- data = qlcnic_83xx_copy_stats(cmd, data, k);
- /* skip 8 bytes of reserved data */
- for (k += 2; k < 24; k += 2)
- data = qlcnic_83xx_copy_stats(cmd, data, k);
- /* skip 8 bytes containing RE1FBQ error data */
- for (k += 2; k < total_regs; k += 2)
- data = qlcnic_83xx_copy_stats(cmd, data, k);
- break;
- case QLC_83XX_STAT_TX:
- for (k = 2; k < 10; k += 2)
- data = qlcnic_83xx_copy_stats(cmd, data, k);
- /* skip 8 bytes of reserved data */
- for (k += 2; k < total_regs; k += 2)
- data = qlcnic_83xx_copy_stats(cmd, data, k);
- break;
- default:
- dev_warn(&adapter->pdev->dev, "Unknown get statistics mode\n");
- *ret = -EIO;
- }
- return data;
- }
- void qlcnic_83xx_get_stats(struct qlcnic_adapter *adapter, u64 *data)
- {
- struct qlcnic_cmd_args cmd;
- int ret = 0;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_GET_STATISTICS);
- /* Get Tx stats */
- cmd.req.arg[1] = BIT_1 | (adapter->tx_ring->ctx_id << 16);
- cmd.rsp.num = QLC_83XX_TX_STAT_REGS;
- data = qlcnic_83xx_fill_stats(adapter, &cmd, data,
- QLC_83XX_STAT_TX, &ret);
- if (ret) {
- dev_info(&adapter->pdev->dev, "Error getting MAC stats\n");
- goto out;
- }
- /* Get MAC stats */
- cmd.req.arg[1] = BIT_2 | (adapter->portnum << 16);
- cmd.rsp.num = QLC_83XX_MAC_STAT_REGS;
- memset(cmd.rsp.arg, 0, sizeof(u32) * cmd.rsp.num);
- data = qlcnic_83xx_fill_stats(adapter, &cmd, data,
- QLC_83XX_STAT_MAC, &ret);
- if (ret) {
- dev_info(&adapter->pdev->dev,
- "Error getting Rx stats\n");
- goto out;
- }
- /* Get Rx stats */
- cmd.req.arg[1] = adapter->recv_ctx->context_id << 16;
- cmd.rsp.num = QLC_83XX_RX_STAT_REGS;
- memset(cmd.rsp.arg, 0, sizeof(u32) * cmd.rsp.num);
- data = qlcnic_83xx_fill_stats(adapter, &cmd, data,
- QLC_83XX_STAT_RX, &ret);
- if (ret)
- dev_info(&adapter->pdev->dev,
- "Error getting Tx stats\n");
- out:
- qlcnic_free_mbx_args(&cmd);
- }
- int qlcnic_83xx_reg_test(struct qlcnic_adapter *adapter)
- {
- u32 major, minor, sub;
- major = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MAJOR);
- minor = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_MINOR);
- sub = QLC_SHARED_REG_RD32(adapter, QLCNIC_FW_VERSION_SUB);
- if (adapter->fw_version != QLCNIC_VERSION_CODE(major, minor, sub)) {
- dev_info(&adapter->pdev->dev, "%s: Reg test failed\n",
- __func__);
- return 1;
- }
- return 0;
- }
- int qlcnic_83xx_get_regs_len(struct qlcnic_adapter *adapter)
- {
- return (ARRAY_SIZE(qlcnic_83xx_ext_reg_tbl) *
- sizeof(adapter->ahw->ext_reg_tbl)) +
- (ARRAY_SIZE(qlcnic_83xx_reg_tbl) +
- sizeof(adapter->ahw->reg_tbl));
- }
- int qlcnic_83xx_get_registers(struct qlcnic_adapter *adapter, u32 *regs_buff)
- {
- int i, j = 0;
- for (i = QLCNIC_DEV_INFO_SIZE + 1;
- j < ARRAY_SIZE(qlcnic_83xx_reg_tbl); i++, j++)
- regs_buff[i] = QLC_SHARED_REG_RD32(adapter, j);
- for (j = 0; j < ARRAY_SIZE(qlcnic_83xx_ext_reg_tbl); j++)
- regs_buff[i++] = QLCRDX(adapter->ahw, j);
- return i;
- }
- int qlcnic_83xx_interrupt_test(struct net_device *netdev)
- {
- struct qlcnic_adapter *adapter = netdev_priv(netdev);
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- struct qlcnic_cmd_args cmd;
- u32 data;
- u16 intrpt_id, id;
- u8 val;
- int ret, max_sds_rings = adapter->max_sds_rings;
- if (test_and_set_bit(__QLCNIC_RESETTING, &adapter->state))
- return -EIO;
- ret = qlcnic_83xx_diag_alloc_res(netdev, QLCNIC_INTERRUPT_TEST);
- if (ret)
- goto fail_diag_irq;
- ahw->diag_cnt = 0;
- qlcnic_alloc_mbx_args(&cmd, adapter, QLCNIC_CMD_INTRPT_TEST);
- if (adapter->flags & QLCNIC_MSIX_ENABLED)
- intrpt_id = ahw->intr_tbl[0].id;
- else
- intrpt_id = QLCRDX(ahw, QLCNIC_DEF_INT_ID);
- cmd.req.arg[1] = 1;
- cmd.req.arg[2] = intrpt_id;
- cmd.req.arg[3] = BIT_0;
- ret = qlcnic_issue_cmd(adapter, &cmd);
- data = cmd.rsp.arg[2];
- id = LSW(data);
- val = LSB(MSW(data));
- if (id != intrpt_id)
- dev_info(&adapter->pdev->dev,
- "Interrupt generated: 0x%x, requested:0x%x\n",
- id, intrpt_id);
- if (val)
- dev_err(&adapter->pdev->dev,
- "Interrupt test error: 0x%x\n", val);
- if (ret)
- goto done;
- msleep(20);
- ret = !ahw->diag_cnt;
- done:
- qlcnic_free_mbx_args(&cmd);
- qlcnic_83xx_diag_free_res(netdev, max_sds_rings);
- fail_diag_irq:
- adapter->max_sds_rings = max_sds_rings;
- clear_bit(__QLCNIC_RESETTING, &adapter->state);
- return ret;
- }
- void qlcnic_83xx_get_pauseparam(struct qlcnic_adapter *adapter,
- struct ethtool_pauseparam *pause)
- {
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- int status = 0;
- u32 config;
- status = qlcnic_83xx_get_port_config(adapter);
- if (status) {
- dev_err(&adapter->pdev->dev,
- "%s: Get Pause Config failed\n", __func__);
- return;
- }
- config = ahw->port_config;
- if (config & QLC_83XX_CFG_STD_PAUSE) {
- if (config & QLC_83XX_CFG_STD_TX_PAUSE)
- pause->tx_pause = 1;
- if (config & QLC_83XX_CFG_STD_RX_PAUSE)
- pause->rx_pause = 1;
- }
- if (QLC_83XX_AUTONEG(config))
- pause->autoneg = 1;
- }
- int qlcnic_83xx_set_pauseparam(struct qlcnic_adapter *adapter,
- struct ethtool_pauseparam *pause)
- {
- struct qlcnic_hardware_context *ahw = adapter->ahw;
- int status = 0;
- u32 config;
- status = qlcnic_83xx_get_port_config(adapter);
- if (status) {
- dev_err(&adapter->pdev->dev,
- "%s: Get Pause Config failed.\n", __func__);
- return status;
- }
- config = ahw->port_config;
- if (ahw->port_type == QLCNIC_GBE) {
- if (pause->autoneg)
- ahw->port_config |= QLC_83XX_ENABLE_AUTONEG;
- if (!pause->autoneg)
- ahw->port_config &= ~QLC_83XX_ENABLE_AUTONEG;
- } else if ((ahw->port_type == QLCNIC_XGBE) && (pause->autoneg)) {
- return -EOPNOTSUPP;
- }
- if (!(config & QLC_83XX_CFG_STD_PAUSE))
- ahw->port_config |= QLC_83XX_CFG_STD_PAUSE;
- if (pause->rx_pause && pause->tx_pause) {
- ahw->port_config |= QLC_83XX_CFG_STD_TX_RX_PAUSE;
- } else if (pause->rx_pause && !pause->tx_pause) {
- ahw->port_config &= ~QLC_83XX_CFG_STD_TX_PAUSE;
- ahw->port_config |= QLC_83XX_CFG_STD_RX_PAUSE;
- } else if (pause->tx_pause && !pause->rx_pause) {
- ahw->port_config &= ~QLC_83XX_CFG_STD_RX_PAUSE;
- ahw->port_config |= QLC_83XX_CFG_STD_TX_PAUSE;
- } else if (!pause->rx_pause && !pause->tx_pause) {
- ahw->port_config &= ~QLC_83XX_CFG_STD_TX_RX_PAUSE;
- }
- status = qlcnic_83xx_set_port_config(adapter);
- if (status) {
- dev_err(&adapter->pdev->dev,
- "%s: Set Pause Config failed.\n", __func__);
- ahw->port_config = config;
- }
- return status;
- }
- static int qlcnic_83xx_read_flash_status_reg(struct qlcnic_adapter *adapter)
- {
- int ret;
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_ADDR,
- QLC_83XX_FLASH_OEM_READ_SIG);
- qlcnic_83xx_wrt_reg_indirect(adapter, QLC_83XX_FLASH_CONTROL,
- QLC_83XX_FLASH_READ_CTRL);
- ret = qlcnic_83xx_poll_flash_status_reg(adapter);
- if (ret)
- return -EIO;
- ret = qlcnic_83xx_rd_reg_indirect(adapter, QLC_83XX_FLASH_RDDATA);
- return ret & 0xFF;
- }
- int qlcnic_83xx_flash_test(struct qlcnic_adapter *adapter)
- {
- int status;
- status = qlcnic_83xx_read_flash_status_reg(adapter);
- if (status == -EIO) {
- dev_info(&adapter->pdev->dev, "%s: EEPROM test failed.\n",
- __func__);
- return 1;
- }
- return 0;
- }
|