qlcnic_io.c 52 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931
  1. /*
  2. * QLogic qlcnic NIC Driver
  3. * Copyright (c) 2009-2013 QLogic Corporation
  4. *
  5. * See LICENSE.qlcnic for copyright and licensing details.
  6. */
  7. #include <linux/netdevice.h>
  8. #include <linux/if_vlan.h>
  9. #include <net/ip.h>
  10. #include <linux/ipv6.h>
  11. #include "qlcnic.h"
  12. #define TX_ETHER_PKT 0x01
  13. #define TX_TCP_PKT 0x02
  14. #define TX_UDP_PKT 0x03
  15. #define TX_IP_PKT 0x04
  16. #define TX_TCP_LSO 0x05
  17. #define TX_TCP_LSO6 0x06
  18. #define TX_TCPV6_PKT 0x0b
  19. #define TX_UDPV6_PKT 0x0c
  20. #define FLAGS_VLAN_TAGGED 0x10
  21. #define FLAGS_VLAN_OOB 0x40
  22. #define qlcnic_set_tx_vlan_tci(cmd_desc, v) \
  23. (cmd_desc)->vlan_TCI = cpu_to_le16(v);
  24. #define qlcnic_set_cmd_desc_port(cmd_desc, var) \
  25. ((cmd_desc)->port_ctxid |= ((var) & 0x0F))
  26. #define qlcnic_set_cmd_desc_ctxid(cmd_desc, var) \
  27. ((cmd_desc)->port_ctxid |= ((var) << 4 & 0xF0))
  28. #define qlcnic_set_tx_port(_desc, _port) \
  29. ((_desc)->port_ctxid = ((_port) & 0xf) | (((_port) << 4) & 0xf0))
  30. #define qlcnic_set_tx_flags_opcode(_desc, _flags, _opcode) \
  31. ((_desc)->flags_opcode |= \
  32. cpu_to_le16(((_flags) & 0x7f) | (((_opcode) & 0x3f) << 7)))
  33. #define qlcnic_set_tx_frags_len(_desc, _frags, _len) \
  34. ((_desc)->nfrags__length = \
  35. cpu_to_le32(((_frags) & 0xff) | (((_len) & 0xffffff) << 8)))
  36. /* owner bits of status_desc */
  37. #define STATUS_OWNER_HOST (0x1ULL << 56)
  38. #define STATUS_OWNER_PHANTOM (0x2ULL << 56)
  39. /* Status descriptor:
  40. 0-3 port, 4-7 status, 8-11 type, 12-27 total_length
  41. 28-43 reference_handle, 44-47 protocol, 48-52 pkt_offset
  42. 53-55 desc_cnt, 56-57 owner, 58-63 opcode
  43. */
  44. #define qlcnic_get_sts_port(sts_data) \
  45. ((sts_data) & 0x0F)
  46. #define qlcnic_get_sts_status(sts_data) \
  47. (((sts_data) >> 4) & 0x0F)
  48. #define qlcnic_get_sts_type(sts_data) \
  49. (((sts_data) >> 8) & 0x0F)
  50. #define qlcnic_get_sts_totallength(sts_data) \
  51. (((sts_data) >> 12) & 0xFFFF)
  52. #define qlcnic_get_sts_refhandle(sts_data) \
  53. (((sts_data) >> 28) & 0xFFFF)
  54. #define qlcnic_get_sts_prot(sts_data) \
  55. (((sts_data) >> 44) & 0x0F)
  56. #define qlcnic_get_sts_pkt_offset(sts_data) \
  57. (((sts_data) >> 48) & 0x1F)
  58. #define qlcnic_get_sts_desc_cnt(sts_data) \
  59. (((sts_data) >> 53) & 0x7)
  60. #define qlcnic_get_sts_opcode(sts_data) \
  61. (((sts_data) >> 58) & 0x03F)
  62. #define qlcnic_get_lro_sts_refhandle(sts_data) \
  63. ((sts_data) & 0x07FFF)
  64. #define qlcnic_get_lro_sts_length(sts_data) \
  65. (((sts_data) >> 16) & 0x0FFFF)
  66. #define qlcnic_get_lro_sts_l2_hdr_offset(sts_data) \
  67. (((sts_data) >> 32) & 0x0FF)
  68. #define qlcnic_get_lro_sts_l4_hdr_offset(sts_data) \
  69. (((sts_data) >> 40) & 0x0FF)
  70. #define qlcnic_get_lro_sts_timestamp(sts_data) \
  71. (((sts_data) >> 48) & 0x1)
  72. #define qlcnic_get_lro_sts_type(sts_data) \
  73. (((sts_data) >> 49) & 0x7)
  74. #define qlcnic_get_lro_sts_push_flag(sts_data) \
  75. (((sts_data) >> 52) & 0x1)
  76. #define qlcnic_get_lro_sts_seq_number(sts_data) \
  77. ((sts_data) & 0x0FFFFFFFF)
  78. #define qlcnic_get_lro_sts_mss(sts_data1) \
  79. ((sts_data1 >> 32) & 0x0FFFF)
  80. #define qlcnic_83xx_get_lro_sts_mss(sts) ((sts) & 0xffff)
  81. /* opcode field in status_desc */
  82. #define QLCNIC_SYN_OFFLOAD 0x03
  83. #define QLCNIC_RXPKT_DESC 0x04
  84. #define QLCNIC_OLD_RXPKT_DESC 0x3f
  85. #define QLCNIC_RESPONSE_DESC 0x05
  86. #define QLCNIC_LRO_DESC 0x12
  87. #define QLCNIC_TX_POLL_BUDGET 128
  88. #define QLCNIC_TCP_HDR_SIZE 20
  89. #define QLCNIC_TCP_TS_OPTION_SIZE 12
  90. #define QLCNIC_FETCH_RING_ID(handle) ((handle) >> 63)
  91. #define QLCNIC_DESC_OWNER_FW cpu_to_le64(STATUS_OWNER_PHANTOM)
  92. #define QLCNIC_TCP_TS_HDR_SIZE (QLCNIC_TCP_HDR_SIZE + QLCNIC_TCP_TS_OPTION_SIZE)
  93. /* for status field in status_desc */
  94. #define STATUS_CKSUM_LOOP 0
  95. #define STATUS_CKSUM_OK 2
  96. #define qlcnic_83xx_pktln(sts) ((sts >> 32) & 0x3FFF)
  97. #define qlcnic_83xx_hndl(sts) ((sts >> 48) & 0x7FFF)
  98. #define qlcnic_83xx_csum_status(sts) ((sts >> 39) & 7)
  99. #define qlcnic_83xx_opcode(sts) ((sts >> 42) & 0xF)
  100. #define qlcnic_83xx_vlan_tag(sts) (((sts) >> 48) & 0xFFFF)
  101. #define qlcnic_83xx_lro_pktln(sts) (((sts) >> 32) & 0x3FFF)
  102. #define qlcnic_83xx_l2_hdr_off(sts) (((sts) >> 16) & 0xFF)
  103. #define qlcnic_83xx_l4_hdr_off(sts) (((sts) >> 24) & 0xFF)
  104. #define qlcnic_83xx_pkt_cnt(sts) (((sts) >> 16) & 0x7)
  105. #define qlcnic_83xx_is_tstamp(sts) (((sts) >> 40) & 1)
  106. #define qlcnic_83xx_is_psh_bit(sts) (((sts) >> 41) & 1)
  107. #define qlcnic_83xx_is_ip_align(sts) (((sts) >> 46) & 1)
  108. #define qlcnic_83xx_has_vlan_tag(sts) (((sts) >> 47) & 1)
  109. struct sk_buff *qlcnic_process_rxbuf(struct qlcnic_adapter *,
  110. struct qlcnic_host_rds_ring *, u16, u16);
  111. inline void qlcnic_83xx_enable_tx_intr(struct qlcnic_adapter *adapter,
  112. struct qlcnic_host_tx_ring *tx_ring)
  113. {
  114. writel(0, tx_ring->crb_intr_mask);
  115. }
  116. inline void qlcnic_83xx_disable_tx_intr(struct qlcnic_adapter *adapter,
  117. struct qlcnic_host_tx_ring *tx_ring)
  118. {
  119. writel(1, tx_ring->crb_intr_mask);
  120. }
  121. static inline u8 qlcnic_mac_hash(u64 mac)
  122. {
  123. return (u8)((mac & 0xff) ^ ((mac >> 40) & 0xff));
  124. }
  125. static inline u32 qlcnic_get_ref_handle(struct qlcnic_adapter *adapter,
  126. u16 handle, u8 ring_id)
  127. {
  128. if (adapter->pdev->device == PCI_DEVICE_ID_QLOGIC_QLE834X)
  129. return handle | (ring_id << 15);
  130. else
  131. return handle;
  132. }
  133. static inline int qlcnic_82xx_is_lb_pkt(u64 sts_data)
  134. {
  135. return (qlcnic_get_sts_status(sts_data) == STATUS_CKSUM_LOOP) ? 1 : 0;
  136. }
  137. void qlcnic_add_lb_filter(struct qlcnic_adapter *adapter, struct sk_buff *skb,
  138. int loopback_pkt, __le16 vlan_id)
  139. {
  140. struct ethhdr *phdr = (struct ethhdr *)(skb->data);
  141. struct qlcnic_filter *fil, *tmp_fil;
  142. struct hlist_node *n;
  143. struct hlist_head *head;
  144. unsigned long time;
  145. u64 src_addr = 0;
  146. u8 hindex, found = 0, op;
  147. int ret;
  148. memcpy(&src_addr, phdr->h_source, ETH_ALEN);
  149. if (loopback_pkt) {
  150. if (adapter->rx_fhash.fnum >= adapter->rx_fhash.fmax)
  151. return;
  152. hindex = qlcnic_mac_hash(src_addr) &
  153. (adapter->fhash.fbucket_size - 1);
  154. head = &(adapter->rx_fhash.fhead[hindex]);
  155. hlist_for_each_entry_safe(tmp_fil, n, head, fnode) {
  156. if (!memcmp(tmp_fil->faddr, &src_addr, ETH_ALEN) &&
  157. tmp_fil->vlan_id == vlan_id) {
  158. time = tmp_fil->ftime;
  159. if (jiffies > (QLCNIC_READD_AGE * HZ + time))
  160. tmp_fil->ftime = jiffies;
  161. return;
  162. }
  163. }
  164. fil = kzalloc(sizeof(struct qlcnic_filter), GFP_ATOMIC);
  165. if (!fil)
  166. return;
  167. fil->ftime = jiffies;
  168. memcpy(fil->faddr, &src_addr, ETH_ALEN);
  169. fil->vlan_id = vlan_id;
  170. spin_lock(&adapter->rx_mac_learn_lock);
  171. hlist_add_head(&(fil->fnode), head);
  172. adapter->rx_fhash.fnum++;
  173. spin_unlock(&adapter->rx_mac_learn_lock);
  174. } else {
  175. hindex = qlcnic_mac_hash(src_addr) &
  176. (adapter->fhash.fbucket_size - 1);
  177. head = &(adapter->rx_fhash.fhead[hindex]);
  178. spin_lock(&adapter->rx_mac_learn_lock);
  179. hlist_for_each_entry_safe(tmp_fil, n, head, fnode) {
  180. if (!memcmp(tmp_fil->faddr, &src_addr, ETH_ALEN) &&
  181. tmp_fil->vlan_id == vlan_id) {
  182. found = 1;
  183. break;
  184. }
  185. }
  186. if (!found) {
  187. spin_unlock(&adapter->rx_mac_learn_lock);
  188. return;
  189. }
  190. op = vlan_id ? QLCNIC_MAC_VLAN_ADD : QLCNIC_MAC_ADD;
  191. ret = qlcnic_sre_macaddr_change(adapter, (u8 *)&src_addr,
  192. vlan_id, op);
  193. if (!ret) {
  194. op = vlan_id ? QLCNIC_MAC_VLAN_DEL : QLCNIC_MAC_DEL;
  195. ret = qlcnic_sre_macaddr_change(adapter,
  196. (u8 *)&src_addr,
  197. vlan_id, op);
  198. if (!ret) {
  199. hlist_del(&(tmp_fil->fnode));
  200. adapter->rx_fhash.fnum--;
  201. }
  202. }
  203. spin_unlock(&adapter->rx_mac_learn_lock);
  204. }
  205. }
  206. void qlcnic_82xx_change_filter(struct qlcnic_adapter *adapter, u64 *uaddr,
  207. __le16 vlan_id)
  208. {
  209. struct cmd_desc_type0 *hwdesc;
  210. struct qlcnic_nic_req *req;
  211. struct qlcnic_mac_req *mac_req;
  212. struct qlcnic_vlan_req *vlan_req;
  213. struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
  214. u32 producer;
  215. u64 word;
  216. producer = tx_ring->producer;
  217. hwdesc = &tx_ring->desc_head[tx_ring->producer];
  218. req = (struct qlcnic_nic_req *)hwdesc;
  219. memset(req, 0, sizeof(struct qlcnic_nic_req));
  220. req->qhdr = cpu_to_le64(QLCNIC_REQUEST << 23);
  221. word = QLCNIC_MAC_EVENT | ((u64)(adapter->portnum) << 16);
  222. req->req_hdr = cpu_to_le64(word);
  223. mac_req = (struct qlcnic_mac_req *)&(req->words[0]);
  224. mac_req->op = vlan_id ? QLCNIC_MAC_VLAN_ADD : QLCNIC_MAC_ADD;
  225. memcpy(mac_req->mac_addr, &uaddr, ETH_ALEN);
  226. vlan_req = (struct qlcnic_vlan_req *)&req->words[1];
  227. vlan_req->vlan_id = vlan_id;
  228. tx_ring->producer = get_next_index(producer, tx_ring->num_desc);
  229. smp_mb();
  230. }
  231. static void qlcnic_send_filter(struct qlcnic_adapter *adapter,
  232. struct cmd_desc_type0 *first_desc,
  233. struct sk_buff *skb)
  234. {
  235. struct qlcnic_filter *fil, *tmp_fil;
  236. struct hlist_node *n;
  237. struct hlist_head *head;
  238. struct net_device *netdev = adapter->netdev;
  239. struct ethhdr *phdr = (struct ethhdr *)(skb->data);
  240. u64 src_addr = 0;
  241. __le16 vlan_id = 0;
  242. u8 hindex;
  243. if (ether_addr_equal(phdr->h_source, adapter->mac_addr))
  244. return;
  245. if (adapter->fhash.fnum >= adapter->fhash.fmax) {
  246. adapter->stats.mac_filter_limit_overrun++;
  247. netdev_info(netdev, "Can not add more than %d mac addresses\n",
  248. adapter->fhash.fmax);
  249. return;
  250. }
  251. memcpy(&src_addr, phdr->h_source, ETH_ALEN);
  252. hindex = qlcnic_mac_hash(src_addr) & (adapter->fhash.fbucket_size - 1);
  253. head = &(adapter->fhash.fhead[hindex]);
  254. hlist_for_each_entry_safe(tmp_fil, n, head, fnode) {
  255. if (!memcmp(tmp_fil->faddr, &src_addr, ETH_ALEN) &&
  256. tmp_fil->vlan_id == vlan_id) {
  257. if (jiffies > (QLCNIC_READD_AGE * HZ + tmp_fil->ftime))
  258. qlcnic_change_filter(adapter, &src_addr,
  259. vlan_id);
  260. tmp_fil->ftime = jiffies;
  261. return;
  262. }
  263. }
  264. fil = kzalloc(sizeof(struct qlcnic_filter), GFP_ATOMIC);
  265. if (!fil)
  266. return;
  267. qlcnic_change_filter(adapter, &src_addr, vlan_id);
  268. fil->ftime = jiffies;
  269. fil->vlan_id = vlan_id;
  270. memcpy(fil->faddr, &src_addr, ETH_ALEN);
  271. spin_lock(&adapter->mac_learn_lock);
  272. hlist_add_head(&(fil->fnode), head);
  273. adapter->fhash.fnum++;
  274. spin_unlock(&adapter->mac_learn_lock);
  275. }
  276. static int qlcnic_tx_pkt(struct qlcnic_adapter *adapter,
  277. struct cmd_desc_type0 *first_desc, struct sk_buff *skb)
  278. {
  279. u8 l4proto, opcode = 0, hdr_len = 0;
  280. u16 flags = 0, vlan_tci = 0;
  281. int copied, offset, copy_len, size;
  282. struct cmd_desc_type0 *hwdesc;
  283. struct vlan_ethhdr *vh;
  284. struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
  285. u16 protocol = ntohs(skb->protocol);
  286. u32 producer = tx_ring->producer;
  287. if (protocol == ETH_P_8021Q) {
  288. vh = (struct vlan_ethhdr *)skb->data;
  289. flags = FLAGS_VLAN_TAGGED;
  290. vlan_tci = ntohs(vh->h_vlan_TCI);
  291. protocol = ntohs(vh->h_vlan_encapsulated_proto);
  292. } else if (vlan_tx_tag_present(skb)) {
  293. flags = FLAGS_VLAN_OOB;
  294. vlan_tci = vlan_tx_tag_get(skb);
  295. }
  296. if (unlikely(adapter->pvid)) {
  297. if (vlan_tci && !(adapter->flags & QLCNIC_TAGGING_ENABLED))
  298. return -EIO;
  299. if (vlan_tci && (adapter->flags & QLCNIC_TAGGING_ENABLED))
  300. goto set_flags;
  301. flags = FLAGS_VLAN_OOB;
  302. vlan_tci = adapter->pvid;
  303. }
  304. set_flags:
  305. qlcnic_set_tx_vlan_tci(first_desc, vlan_tci);
  306. qlcnic_set_tx_flags_opcode(first_desc, flags, opcode);
  307. if (*(skb->data) & BIT_0) {
  308. flags |= BIT_0;
  309. memcpy(&first_desc->eth_addr, skb->data, ETH_ALEN);
  310. }
  311. opcode = TX_ETHER_PKT;
  312. if (skb_is_gso(skb)) {
  313. hdr_len = skb_transport_offset(skb) + tcp_hdrlen(skb);
  314. first_desc->mss = cpu_to_le16(skb_shinfo(skb)->gso_size);
  315. first_desc->total_hdr_length = hdr_len;
  316. opcode = (protocol == ETH_P_IPV6) ? TX_TCP_LSO6 : TX_TCP_LSO;
  317. /* For LSO, we need to copy the MAC/IP/TCP headers into
  318. * the descriptor ring */
  319. copied = 0;
  320. offset = 2;
  321. if (flags & FLAGS_VLAN_OOB) {
  322. first_desc->total_hdr_length += VLAN_HLEN;
  323. first_desc->tcp_hdr_offset = VLAN_HLEN;
  324. first_desc->ip_hdr_offset = VLAN_HLEN;
  325. /* Only in case of TSO on vlan device */
  326. flags |= FLAGS_VLAN_TAGGED;
  327. /* Create a TSO vlan header template for firmware */
  328. hwdesc = &tx_ring->desc_head[producer];
  329. tx_ring->cmd_buf_arr[producer].skb = NULL;
  330. copy_len = min((int)sizeof(struct cmd_desc_type0) -
  331. offset, hdr_len + VLAN_HLEN);
  332. vh = (struct vlan_ethhdr *)((char *) hwdesc + 2);
  333. skb_copy_from_linear_data(skb, vh, 12);
  334. vh->h_vlan_proto = htons(ETH_P_8021Q);
  335. vh->h_vlan_TCI = htons(vlan_tci);
  336. skb_copy_from_linear_data_offset(skb, 12,
  337. (char *)vh + 16,
  338. copy_len - 16);
  339. copied = copy_len - VLAN_HLEN;
  340. offset = 0;
  341. producer = get_next_index(producer, tx_ring->num_desc);
  342. }
  343. while (copied < hdr_len) {
  344. size = (int)sizeof(struct cmd_desc_type0) - offset;
  345. copy_len = min(size, (hdr_len - copied));
  346. hwdesc = &tx_ring->desc_head[producer];
  347. tx_ring->cmd_buf_arr[producer].skb = NULL;
  348. skb_copy_from_linear_data_offset(skb, copied,
  349. (char *)hwdesc +
  350. offset, copy_len);
  351. copied += copy_len;
  352. offset = 0;
  353. producer = get_next_index(producer, tx_ring->num_desc);
  354. }
  355. tx_ring->producer = producer;
  356. smp_mb();
  357. adapter->stats.lso_frames++;
  358. } else if (skb->ip_summed == CHECKSUM_PARTIAL) {
  359. if (protocol == ETH_P_IP) {
  360. l4proto = ip_hdr(skb)->protocol;
  361. if (l4proto == IPPROTO_TCP)
  362. opcode = TX_TCP_PKT;
  363. else if (l4proto == IPPROTO_UDP)
  364. opcode = TX_UDP_PKT;
  365. } else if (protocol == ETH_P_IPV6) {
  366. l4proto = ipv6_hdr(skb)->nexthdr;
  367. if (l4proto == IPPROTO_TCP)
  368. opcode = TX_TCPV6_PKT;
  369. else if (l4proto == IPPROTO_UDP)
  370. opcode = TX_UDPV6_PKT;
  371. }
  372. }
  373. first_desc->tcp_hdr_offset += skb_transport_offset(skb);
  374. first_desc->ip_hdr_offset += skb_network_offset(skb);
  375. qlcnic_set_tx_flags_opcode(first_desc, flags, opcode);
  376. return 0;
  377. }
  378. static int qlcnic_map_tx_skb(struct pci_dev *pdev, struct sk_buff *skb,
  379. struct qlcnic_cmd_buffer *pbuf)
  380. {
  381. struct qlcnic_skb_frag *nf;
  382. struct skb_frag_struct *frag;
  383. int i, nr_frags;
  384. dma_addr_t map;
  385. nr_frags = skb_shinfo(skb)->nr_frags;
  386. nf = &pbuf->frag_array[0];
  387. map = pci_map_single(pdev, skb->data, skb_headlen(skb),
  388. PCI_DMA_TODEVICE);
  389. if (pci_dma_mapping_error(pdev, map))
  390. goto out_err;
  391. nf->dma = map;
  392. nf->length = skb_headlen(skb);
  393. for (i = 0; i < nr_frags; i++) {
  394. frag = &skb_shinfo(skb)->frags[i];
  395. nf = &pbuf->frag_array[i+1];
  396. map = skb_frag_dma_map(&pdev->dev, frag, 0, skb_frag_size(frag),
  397. DMA_TO_DEVICE);
  398. if (dma_mapping_error(&pdev->dev, map))
  399. goto unwind;
  400. nf->dma = map;
  401. nf->length = skb_frag_size(frag);
  402. }
  403. return 0;
  404. unwind:
  405. while (--i >= 0) {
  406. nf = &pbuf->frag_array[i+1];
  407. pci_unmap_page(pdev, nf->dma, nf->length, PCI_DMA_TODEVICE);
  408. }
  409. nf = &pbuf->frag_array[0];
  410. pci_unmap_single(pdev, nf->dma, skb_headlen(skb), PCI_DMA_TODEVICE);
  411. out_err:
  412. return -ENOMEM;
  413. }
  414. static void qlcnic_unmap_buffers(struct pci_dev *pdev, struct sk_buff *skb,
  415. struct qlcnic_cmd_buffer *pbuf)
  416. {
  417. struct qlcnic_skb_frag *nf = &pbuf->frag_array[0];
  418. int i, nr_frags = skb_shinfo(skb)->nr_frags;
  419. for (i = 0; i < nr_frags; i++) {
  420. nf = &pbuf->frag_array[i+1];
  421. pci_unmap_page(pdev, nf->dma, nf->length, PCI_DMA_TODEVICE);
  422. }
  423. nf = &pbuf->frag_array[0];
  424. pci_unmap_single(pdev, nf->dma, skb_headlen(skb), PCI_DMA_TODEVICE);
  425. pbuf->skb = NULL;
  426. }
  427. static inline void qlcnic_clear_cmddesc(u64 *desc)
  428. {
  429. desc[0] = 0ULL;
  430. desc[2] = 0ULL;
  431. desc[7] = 0ULL;
  432. }
  433. netdev_tx_t qlcnic_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
  434. {
  435. struct qlcnic_adapter *adapter = netdev_priv(netdev);
  436. struct qlcnic_host_tx_ring *tx_ring = adapter->tx_ring;
  437. struct qlcnic_cmd_buffer *pbuf;
  438. struct qlcnic_skb_frag *buffrag;
  439. struct cmd_desc_type0 *hwdesc, *first_desc;
  440. struct pci_dev *pdev;
  441. struct ethhdr *phdr;
  442. int i, k, frag_count, delta = 0;
  443. u32 producer, num_txd;
  444. num_txd = tx_ring->num_desc;
  445. if (!test_bit(__QLCNIC_DEV_UP, &adapter->state)) {
  446. netif_stop_queue(netdev);
  447. return NETDEV_TX_BUSY;
  448. }
  449. if (adapter->flags & QLCNIC_MACSPOOF) {
  450. phdr = (struct ethhdr *)skb->data;
  451. if (!ether_addr_equal(phdr->h_source, adapter->mac_addr))
  452. goto drop_packet;
  453. }
  454. frag_count = skb_shinfo(skb)->nr_frags + 1;
  455. /* 14 frags supported for normal packet and
  456. * 32 frags supported for TSO packet
  457. */
  458. if (!skb_is_gso(skb) && frag_count > QLCNIC_MAX_FRAGS_PER_TX) {
  459. for (i = 0; i < (frag_count - QLCNIC_MAX_FRAGS_PER_TX); i++)
  460. delta += skb_frag_size(&skb_shinfo(skb)->frags[i]);
  461. if (!__pskb_pull_tail(skb, delta))
  462. goto drop_packet;
  463. frag_count = 1 + skb_shinfo(skb)->nr_frags;
  464. }
  465. if (unlikely(qlcnic_tx_avail(tx_ring) <= TX_STOP_THRESH)) {
  466. netif_stop_queue(netdev);
  467. if (qlcnic_tx_avail(tx_ring) > TX_STOP_THRESH) {
  468. netif_start_queue(netdev);
  469. } else {
  470. adapter->stats.xmit_off++;
  471. return NETDEV_TX_BUSY;
  472. }
  473. }
  474. producer = tx_ring->producer;
  475. pbuf = &tx_ring->cmd_buf_arr[producer];
  476. pdev = adapter->pdev;
  477. first_desc = &tx_ring->desc_head[producer];
  478. hwdesc = &tx_ring->desc_head[producer];
  479. qlcnic_clear_cmddesc((u64 *)hwdesc);
  480. if (qlcnic_map_tx_skb(pdev, skb, pbuf)) {
  481. adapter->stats.tx_dma_map_error++;
  482. goto drop_packet;
  483. }
  484. pbuf->skb = skb;
  485. pbuf->frag_count = frag_count;
  486. qlcnic_set_tx_frags_len(first_desc, frag_count, skb->len);
  487. qlcnic_set_tx_port(first_desc, adapter->portnum);
  488. for (i = 0; i < frag_count; i++) {
  489. k = i % 4;
  490. if ((k == 0) && (i > 0)) {
  491. /* move to next desc.*/
  492. producer = get_next_index(producer, num_txd);
  493. hwdesc = &tx_ring->desc_head[producer];
  494. qlcnic_clear_cmddesc((u64 *)hwdesc);
  495. tx_ring->cmd_buf_arr[producer].skb = NULL;
  496. }
  497. buffrag = &pbuf->frag_array[i];
  498. hwdesc->buffer_length[k] = cpu_to_le16(buffrag->length);
  499. switch (k) {
  500. case 0:
  501. hwdesc->addr_buffer1 = cpu_to_le64(buffrag->dma);
  502. break;
  503. case 1:
  504. hwdesc->addr_buffer2 = cpu_to_le64(buffrag->dma);
  505. break;
  506. case 2:
  507. hwdesc->addr_buffer3 = cpu_to_le64(buffrag->dma);
  508. break;
  509. case 3:
  510. hwdesc->addr_buffer4 = cpu_to_le64(buffrag->dma);
  511. break;
  512. }
  513. }
  514. tx_ring->producer = get_next_index(producer, num_txd);
  515. smp_mb();
  516. if (unlikely(qlcnic_tx_pkt(adapter, first_desc, skb)))
  517. goto unwind_buff;
  518. if (adapter->drv_mac_learn)
  519. qlcnic_send_filter(adapter, first_desc, skb);
  520. adapter->stats.txbytes += skb->len;
  521. adapter->stats.xmitcalled++;
  522. qlcnic_update_cmd_producer(tx_ring);
  523. return NETDEV_TX_OK;
  524. unwind_buff:
  525. qlcnic_unmap_buffers(pdev, skb, pbuf);
  526. drop_packet:
  527. adapter->stats.txdropped++;
  528. dev_kfree_skb_any(skb);
  529. return NETDEV_TX_OK;
  530. }
  531. void qlcnic_advert_link_change(struct qlcnic_adapter *adapter, int linkup)
  532. {
  533. struct net_device *netdev = adapter->netdev;
  534. if (adapter->ahw->linkup && !linkup) {
  535. netdev_info(netdev, "NIC Link is down\n");
  536. adapter->ahw->linkup = 0;
  537. if (netif_running(netdev)) {
  538. netif_carrier_off(netdev);
  539. netif_stop_queue(netdev);
  540. }
  541. } else if (!adapter->ahw->linkup && linkup) {
  542. netdev_info(netdev, "NIC Link is up\n");
  543. adapter->ahw->linkup = 1;
  544. if (netif_running(netdev)) {
  545. netif_carrier_on(netdev);
  546. netif_wake_queue(netdev);
  547. }
  548. }
  549. }
  550. static int qlcnic_alloc_rx_skb(struct qlcnic_adapter *adapter,
  551. struct qlcnic_host_rds_ring *rds_ring,
  552. struct qlcnic_rx_buffer *buffer)
  553. {
  554. struct sk_buff *skb;
  555. dma_addr_t dma;
  556. struct pci_dev *pdev = adapter->pdev;
  557. skb = netdev_alloc_skb(adapter->netdev, rds_ring->skb_size);
  558. if (!skb) {
  559. adapter->stats.skb_alloc_failure++;
  560. return -ENOMEM;
  561. }
  562. skb_reserve(skb, NET_IP_ALIGN);
  563. dma = pci_map_single(pdev, skb->data,
  564. rds_ring->dma_size, PCI_DMA_FROMDEVICE);
  565. if (pci_dma_mapping_error(pdev, dma)) {
  566. adapter->stats.rx_dma_map_error++;
  567. dev_kfree_skb_any(skb);
  568. return -ENOMEM;
  569. }
  570. buffer->skb = skb;
  571. buffer->dma = dma;
  572. return 0;
  573. }
  574. static void qlcnic_post_rx_buffers_nodb(struct qlcnic_adapter *adapter,
  575. struct qlcnic_host_rds_ring *rds_ring,
  576. u8 ring_id)
  577. {
  578. struct rcv_desc *pdesc;
  579. struct qlcnic_rx_buffer *buffer;
  580. int count = 0;
  581. uint32_t producer, handle;
  582. struct list_head *head;
  583. if (!spin_trylock(&rds_ring->lock))
  584. return;
  585. producer = rds_ring->producer;
  586. head = &rds_ring->free_list;
  587. while (!list_empty(head)) {
  588. buffer = list_entry(head->next, struct qlcnic_rx_buffer, list);
  589. if (!buffer->skb) {
  590. if (qlcnic_alloc_rx_skb(adapter, rds_ring, buffer))
  591. break;
  592. }
  593. count++;
  594. list_del(&buffer->list);
  595. /* make a rcv descriptor */
  596. pdesc = &rds_ring->desc_head[producer];
  597. handle = qlcnic_get_ref_handle(adapter,
  598. buffer->ref_handle, ring_id);
  599. pdesc->reference_handle = cpu_to_le16(handle);
  600. pdesc->buffer_length = cpu_to_le32(rds_ring->dma_size);
  601. pdesc->addr_buffer = cpu_to_le64(buffer->dma);
  602. producer = get_next_index(producer, rds_ring->num_desc);
  603. }
  604. if (count) {
  605. rds_ring->producer = producer;
  606. writel((producer - 1) & (rds_ring->num_desc - 1),
  607. rds_ring->crb_rcv_producer);
  608. }
  609. spin_unlock(&rds_ring->lock);
  610. }
  611. static int qlcnic_process_cmd_ring(struct qlcnic_adapter *adapter,
  612. struct qlcnic_host_tx_ring *tx_ring,
  613. int budget)
  614. {
  615. u32 sw_consumer, hw_consumer;
  616. int i, done, count = 0;
  617. struct qlcnic_cmd_buffer *buffer;
  618. struct pci_dev *pdev = adapter->pdev;
  619. struct net_device *netdev = adapter->netdev;
  620. struct qlcnic_skb_frag *frag;
  621. if (!spin_trylock(&adapter->tx_clean_lock))
  622. return 1;
  623. sw_consumer = tx_ring->sw_consumer;
  624. hw_consumer = le32_to_cpu(*(tx_ring->hw_consumer));
  625. while (sw_consumer != hw_consumer) {
  626. buffer = &tx_ring->cmd_buf_arr[sw_consumer];
  627. if (buffer->skb) {
  628. frag = &buffer->frag_array[0];
  629. pci_unmap_single(pdev, frag->dma, frag->length,
  630. PCI_DMA_TODEVICE);
  631. frag->dma = 0ULL;
  632. for (i = 1; i < buffer->frag_count; i++) {
  633. frag++;
  634. pci_unmap_page(pdev, frag->dma, frag->length,
  635. PCI_DMA_TODEVICE);
  636. frag->dma = 0ULL;
  637. }
  638. adapter->stats.xmitfinished++;
  639. dev_kfree_skb_any(buffer->skb);
  640. buffer->skb = NULL;
  641. }
  642. sw_consumer = get_next_index(sw_consumer, tx_ring->num_desc);
  643. if (++count >= budget)
  644. break;
  645. }
  646. if (count && netif_running(netdev)) {
  647. tx_ring->sw_consumer = sw_consumer;
  648. smp_mb();
  649. if (netif_queue_stopped(netdev) && netif_carrier_ok(netdev)) {
  650. if (qlcnic_tx_avail(tx_ring) > TX_STOP_THRESH) {
  651. netif_wake_queue(netdev);
  652. adapter->stats.xmit_on++;
  653. }
  654. }
  655. adapter->tx_timeo_cnt = 0;
  656. }
  657. /*
  658. * If everything is freed up to consumer then check if the ring is full
  659. * If the ring is full then check if more needs to be freed and
  660. * schedule the call back again.
  661. *
  662. * This happens when there are 2 CPUs. One could be freeing and the
  663. * other filling it. If the ring is full when we get out of here and
  664. * the card has already interrupted the host then the host can miss the
  665. * interrupt.
  666. *
  667. * There is still a possible race condition and the host could miss an
  668. * interrupt. The card has to take care of this.
  669. */
  670. hw_consumer = le32_to_cpu(*(tx_ring->hw_consumer));
  671. done = (sw_consumer == hw_consumer);
  672. spin_unlock(&adapter->tx_clean_lock);
  673. return done;
  674. }
  675. static int qlcnic_poll(struct napi_struct *napi, int budget)
  676. {
  677. int tx_complete, work_done;
  678. struct qlcnic_host_sds_ring *sds_ring;
  679. struct qlcnic_adapter *adapter;
  680. sds_ring = container_of(napi, struct qlcnic_host_sds_ring, napi);
  681. adapter = sds_ring->adapter;
  682. tx_complete = qlcnic_process_cmd_ring(adapter, adapter->tx_ring,
  683. budget);
  684. work_done = qlcnic_process_rcv_ring(sds_ring, budget);
  685. if ((work_done < budget) && tx_complete) {
  686. napi_complete(&sds_ring->napi);
  687. if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
  688. qlcnic_enable_int(sds_ring);
  689. }
  690. return work_done;
  691. }
  692. static int qlcnic_rx_poll(struct napi_struct *napi, int budget)
  693. {
  694. struct qlcnic_host_sds_ring *sds_ring;
  695. struct qlcnic_adapter *adapter;
  696. int work_done;
  697. sds_ring = container_of(napi, struct qlcnic_host_sds_ring, napi);
  698. adapter = sds_ring->adapter;
  699. work_done = qlcnic_process_rcv_ring(sds_ring, budget);
  700. if (work_done < budget) {
  701. napi_complete(&sds_ring->napi);
  702. if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
  703. qlcnic_enable_int(sds_ring);
  704. }
  705. return work_done;
  706. }
  707. static void qlcnic_handle_linkevent(struct qlcnic_adapter *adapter,
  708. struct qlcnic_fw_msg *msg)
  709. {
  710. u32 cable_OUI;
  711. u16 cable_len, link_speed;
  712. u8 link_status, module, duplex, autoneg, lb_status = 0;
  713. struct net_device *netdev = adapter->netdev;
  714. adapter->ahw->has_link_events = 1;
  715. cable_OUI = msg->body[1] & 0xffffffff;
  716. cable_len = (msg->body[1] >> 32) & 0xffff;
  717. link_speed = (msg->body[1] >> 48) & 0xffff;
  718. link_status = msg->body[2] & 0xff;
  719. duplex = (msg->body[2] >> 16) & 0xff;
  720. autoneg = (msg->body[2] >> 24) & 0xff;
  721. lb_status = (msg->body[2] >> 32) & 0x3;
  722. module = (msg->body[2] >> 8) & 0xff;
  723. if (module == LINKEVENT_MODULE_TWINAX_UNSUPPORTED_CABLE)
  724. dev_info(&netdev->dev,
  725. "unsupported cable: OUI 0x%x, length %d\n",
  726. cable_OUI, cable_len);
  727. else if (module == LINKEVENT_MODULE_TWINAX_UNSUPPORTED_CABLELEN)
  728. dev_info(&netdev->dev, "unsupported cable length %d\n",
  729. cable_len);
  730. if (!link_status && (lb_status == QLCNIC_ILB_MODE ||
  731. lb_status == QLCNIC_ELB_MODE))
  732. adapter->ahw->loopback_state |= QLCNIC_LINKEVENT;
  733. qlcnic_advert_link_change(adapter, link_status);
  734. if (duplex == LINKEVENT_FULL_DUPLEX)
  735. adapter->ahw->link_duplex = DUPLEX_FULL;
  736. else
  737. adapter->ahw->link_duplex = DUPLEX_HALF;
  738. adapter->ahw->module_type = module;
  739. adapter->ahw->link_autoneg = autoneg;
  740. if (link_status) {
  741. adapter->ahw->link_speed = link_speed;
  742. } else {
  743. adapter->ahw->link_speed = SPEED_UNKNOWN;
  744. adapter->ahw->link_duplex = DUPLEX_UNKNOWN;
  745. }
  746. }
  747. static void qlcnic_handle_fw_message(int desc_cnt, int index,
  748. struct qlcnic_host_sds_ring *sds_ring)
  749. {
  750. struct qlcnic_fw_msg msg;
  751. struct status_desc *desc;
  752. struct qlcnic_adapter *adapter;
  753. struct device *dev;
  754. int i = 0, opcode, ret;
  755. while (desc_cnt > 0 && i < 8) {
  756. desc = &sds_ring->desc_head[index];
  757. msg.words[i++] = le64_to_cpu(desc->status_desc_data[0]);
  758. msg.words[i++] = le64_to_cpu(desc->status_desc_data[1]);
  759. index = get_next_index(index, sds_ring->num_desc);
  760. desc_cnt--;
  761. }
  762. adapter = sds_ring->adapter;
  763. dev = &adapter->pdev->dev;
  764. opcode = qlcnic_get_nic_msg_opcode(msg.body[0]);
  765. switch (opcode) {
  766. case QLCNIC_C2H_OPCODE_GET_LINKEVENT_RESPONSE:
  767. qlcnic_handle_linkevent(adapter, &msg);
  768. break;
  769. case QLCNIC_C2H_OPCODE_CONFIG_LOOPBACK:
  770. ret = (u32)(msg.body[1]);
  771. switch (ret) {
  772. case 0:
  773. adapter->ahw->loopback_state |= QLCNIC_LB_RESPONSE;
  774. break;
  775. case 1:
  776. dev_info(dev, "loopback already in progress\n");
  777. adapter->ahw->diag_cnt = -QLCNIC_TEST_IN_PROGRESS;
  778. break;
  779. case 2:
  780. dev_info(dev, "loopback cable is not connected\n");
  781. adapter->ahw->diag_cnt = -QLCNIC_LB_CABLE_NOT_CONN;
  782. break;
  783. default:
  784. dev_info(dev,
  785. "loopback configure request failed, err %x\n",
  786. ret);
  787. adapter->ahw->diag_cnt = -QLCNIC_UNDEFINED_ERROR;
  788. break;
  789. }
  790. break;
  791. default:
  792. break;
  793. }
  794. }
  795. struct sk_buff *qlcnic_process_rxbuf(struct qlcnic_adapter *adapter,
  796. struct qlcnic_host_rds_ring *ring,
  797. u16 index, u16 cksum)
  798. {
  799. struct qlcnic_rx_buffer *buffer;
  800. struct sk_buff *skb;
  801. buffer = &ring->rx_buf_arr[index];
  802. if (unlikely(buffer->skb == NULL)) {
  803. WARN_ON(1);
  804. return NULL;
  805. }
  806. pci_unmap_single(adapter->pdev, buffer->dma, ring->dma_size,
  807. PCI_DMA_FROMDEVICE);
  808. skb = buffer->skb;
  809. if (likely((adapter->netdev->features & NETIF_F_RXCSUM) &&
  810. (cksum == STATUS_CKSUM_OK || cksum == STATUS_CKSUM_LOOP))) {
  811. adapter->stats.csummed++;
  812. skb->ip_summed = CHECKSUM_UNNECESSARY;
  813. } else {
  814. skb_checksum_none_assert(skb);
  815. }
  816. buffer->skb = NULL;
  817. return skb;
  818. }
  819. static inline int qlcnic_check_rx_tagging(struct qlcnic_adapter *adapter,
  820. struct sk_buff *skb, u16 *vlan_tag)
  821. {
  822. struct ethhdr *eth_hdr;
  823. if (!__vlan_get_tag(skb, vlan_tag)) {
  824. eth_hdr = (struct ethhdr *)skb->data;
  825. memmove(skb->data + VLAN_HLEN, eth_hdr, ETH_ALEN * 2);
  826. skb_pull(skb, VLAN_HLEN);
  827. }
  828. if (!adapter->pvid)
  829. return 0;
  830. if (*vlan_tag == adapter->pvid) {
  831. /* Outer vlan tag. Packet should follow non-vlan path */
  832. *vlan_tag = 0xffff;
  833. return 0;
  834. }
  835. if (adapter->flags & QLCNIC_TAGGING_ENABLED)
  836. return 0;
  837. return -EINVAL;
  838. }
  839. static struct qlcnic_rx_buffer *
  840. qlcnic_process_rcv(struct qlcnic_adapter *adapter,
  841. struct qlcnic_host_sds_ring *sds_ring, int ring,
  842. u64 sts_data0)
  843. {
  844. struct net_device *netdev = adapter->netdev;
  845. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  846. struct qlcnic_rx_buffer *buffer;
  847. struct sk_buff *skb;
  848. struct qlcnic_host_rds_ring *rds_ring;
  849. int index, length, cksum, pkt_offset, is_lb_pkt;
  850. u16 vid = 0xffff, t_vid;
  851. if (unlikely(ring >= adapter->max_rds_rings))
  852. return NULL;
  853. rds_ring = &recv_ctx->rds_rings[ring];
  854. index = qlcnic_get_sts_refhandle(sts_data0);
  855. if (unlikely(index >= rds_ring->num_desc))
  856. return NULL;
  857. buffer = &rds_ring->rx_buf_arr[index];
  858. length = qlcnic_get_sts_totallength(sts_data0);
  859. cksum = qlcnic_get_sts_status(sts_data0);
  860. pkt_offset = qlcnic_get_sts_pkt_offset(sts_data0);
  861. skb = qlcnic_process_rxbuf(adapter, rds_ring, index, cksum);
  862. if (!skb)
  863. return buffer;
  864. if (adapter->drv_mac_learn &&
  865. (adapter->flags & QLCNIC_ESWITCH_ENABLED)) {
  866. t_vid = 0;
  867. is_lb_pkt = qlcnic_82xx_is_lb_pkt(sts_data0);
  868. qlcnic_add_lb_filter(adapter, skb, is_lb_pkt,
  869. cpu_to_le16(t_vid));
  870. }
  871. if (length > rds_ring->skb_size)
  872. skb_put(skb, rds_ring->skb_size);
  873. else
  874. skb_put(skb, length);
  875. if (pkt_offset)
  876. skb_pull(skb, pkt_offset);
  877. if (unlikely(qlcnic_check_rx_tagging(adapter, skb, &vid))) {
  878. adapter->stats.rxdropped++;
  879. dev_kfree_skb(skb);
  880. return buffer;
  881. }
  882. skb->protocol = eth_type_trans(skb, netdev);
  883. if (vid != 0xffff)
  884. __vlan_hwaccel_put_tag(skb, vid);
  885. napi_gro_receive(&sds_ring->napi, skb);
  886. adapter->stats.rx_pkts++;
  887. adapter->stats.rxbytes += length;
  888. return buffer;
  889. }
  890. #define QLC_TCP_HDR_SIZE 20
  891. #define QLC_TCP_TS_OPTION_SIZE 12
  892. #define QLC_TCP_TS_HDR_SIZE (QLC_TCP_HDR_SIZE + QLC_TCP_TS_OPTION_SIZE)
  893. static struct qlcnic_rx_buffer *
  894. qlcnic_process_lro(struct qlcnic_adapter *adapter,
  895. int ring, u64 sts_data0, u64 sts_data1)
  896. {
  897. struct net_device *netdev = adapter->netdev;
  898. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  899. struct qlcnic_rx_buffer *buffer;
  900. struct sk_buff *skb;
  901. struct qlcnic_host_rds_ring *rds_ring;
  902. struct iphdr *iph;
  903. struct ipv6hdr *ipv6h;
  904. struct tcphdr *th;
  905. bool push, timestamp;
  906. int index, l2_hdr_offset, l4_hdr_offset, is_lb_pkt;
  907. u16 lro_length, length, data_offset, t_vid, vid = 0xffff;
  908. u32 seq_number;
  909. if (unlikely(ring > adapter->max_rds_rings))
  910. return NULL;
  911. rds_ring = &recv_ctx->rds_rings[ring];
  912. index = qlcnic_get_lro_sts_refhandle(sts_data0);
  913. if (unlikely(index > rds_ring->num_desc))
  914. return NULL;
  915. buffer = &rds_ring->rx_buf_arr[index];
  916. timestamp = qlcnic_get_lro_sts_timestamp(sts_data0);
  917. lro_length = qlcnic_get_lro_sts_length(sts_data0);
  918. l2_hdr_offset = qlcnic_get_lro_sts_l2_hdr_offset(sts_data0);
  919. l4_hdr_offset = qlcnic_get_lro_sts_l4_hdr_offset(sts_data0);
  920. push = qlcnic_get_lro_sts_push_flag(sts_data0);
  921. seq_number = qlcnic_get_lro_sts_seq_number(sts_data1);
  922. skb = qlcnic_process_rxbuf(adapter, rds_ring, index, STATUS_CKSUM_OK);
  923. if (!skb)
  924. return buffer;
  925. if (adapter->drv_mac_learn &&
  926. (adapter->flags & QLCNIC_ESWITCH_ENABLED)) {
  927. t_vid = 0;
  928. is_lb_pkt = qlcnic_82xx_is_lb_pkt(sts_data0);
  929. qlcnic_add_lb_filter(adapter, skb, is_lb_pkt,
  930. cpu_to_le16(t_vid));
  931. }
  932. if (timestamp)
  933. data_offset = l4_hdr_offset + QLC_TCP_TS_HDR_SIZE;
  934. else
  935. data_offset = l4_hdr_offset + QLC_TCP_HDR_SIZE;
  936. skb_put(skb, lro_length + data_offset);
  937. skb_pull(skb, l2_hdr_offset);
  938. if (unlikely(qlcnic_check_rx_tagging(adapter, skb, &vid))) {
  939. adapter->stats.rxdropped++;
  940. dev_kfree_skb(skb);
  941. return buffer;
  942. }
  943. skb->protocol = eth_type_trans(skb, netdev);
  944. if (ntohs(skb->protocol) == ETH_P_IPV6) {
  945. ipv6h = (struct ipv6hdr *)skb->data;
  946. th = (struct tcphdr *)(skb->data + sizeof(struct ipv6hdr));
  947. length = (th->doff << 2) + lro_length;
  948. ipv6h->payload_len = htons(length);
  949. } else {
  950. iph = (struct iphdr *)skb->data;
  951. th = (struct tcphdr *)(skb->data + (iph->ihl << 2));
  952. length = (iph->ihl << 2) + (th->doff << 2) + lro_length;
  953. iph->tot_len = htons(length);
  954. iph->check = 0;
  955. iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl);
  956. }
  957. th->psh = push;
  958. th->seq = htonl(seq_number);
  959. length = skb->len;
  960. if (adapter->flags & QLCNIC_FW_LRO_MSS_CAP) {
  961. skb_shinfo(skb)->gso_size = qlcnic_get_lro_sts_mss(sts_data1);
  962. if (skb->protocol == htons(ETH_P_IPV6))
  963. skb_shinfo(skb)->gso_type = SKB_GSO_TCPV6;
  964. else
  965. skb_shinfo(skb)->gso_type = SKB_GSO_TCPV4;
  966. }
  967. if (vid != 0xffff)
  968. __vlan_hwaccel_put_tag(skb, vid);
  969. netif_receive_skb(skb);
  970. adapter->stats.lro_pkts++;
  971. adapter->stats.lrobytes += length;
  972. return buffer;
  973. }
  974. int qlcnic_process_rcv_ring(struct qlcnic_host_sds_ring *sds_ring, int max)
  975. {
  976. struct qlcnic_host_rds_ring *rds_ring;
  977. struct qlcnic_adapter *adapter = sds_ring->adapter;
  978. struct list_head *cur;
  979. struct status_desc *desc;
  980. struct qlcnic_rx_buffer *rxbuf;
  981. int opcode, desc_cnt, count = 0;
  982. u64 sts_data0, sts_data1;
  983. u8 ring;
  984. u32 consumer = sds_ring->consumer;
  985. while (count < max) {
  986. desc = &sds_ring->desc_head[consumer];
  987. sts_data0 = le64_to_cpu(desc->status_desc_data[0]);
  988. if (!(sts_data0 & STATUS_OWNER_HOST))
  989. break;
  990. desc_cnt = qlcnic_get_sts_desc_cnt(sts_data0);
  991. opcode = qlcnic_get_sts_opcode(sts_data0);
  992. switch (opcode) {
  993. case QLCNIC_RXPKT_DESC:
  994. case QLCNIC_OLD_RXPKT_DESC:
  995. case QLCNIC_SYN_OFFLOAD:
  996. ring = qlcnic_get_sts_type(sts_data0);
  997. rxbuf = qlcnic_process_rcv(adapter, sds_ring, ring,
  998. sts_data0);
  999. break;
  1000. case QLCNIC_LRO_DESC:
  1001. ring = qlcnic_get_lro_sts_type(sts_data0);
  1002. sts_data1 = le64_to_cpu(desc->status_desc_data[1]);
  1003. rxbuf = qlcnic_process_lro(adapter, ring, sts_data0,
  1004. sts_data1);
  1005. break;
  1006. case QLCNIC_RESPONSE_DESC:
  1007. qlcnic_handle_fw_message(desc_cnt, consumer, sds_ring);
  1008. default:
  1009. goto skip;
  1010. }
  1011. WARN_ON(desc_cnt > 1);
  1012. if (likely(rxbuf))
  1013. list_add_tail(&rxbuf->list, &sds_ring->free_list[ring]);
  1014. else
  1015. adapter->stats.null_rxbuf++;
  1016. skip:
  1017. for (; desc_cnt > 0; desc_cnt--) {
  1018. desc = &sds_ring->desc_head[consumer];
  1019. desc->status_desc_data[0] = QLCNIC_DESC_OWNER_FW;
  1020. consumer = get_next_index(consumer, sds_ring->num_desc);
  1021. }
  1022. count++;
  1023. }
  1024. for (ring = 0; ring < adapter->max_rds_rings; ring++) {
  1025. rds_ring = &adapter->recv_ctx->rds_rings[ring];
  1026. if (!list_empty(&sds_ring->free_list[ring])) {
  1027. list_for_each(cur, &sds_ring->free_list[ring]) {
  1028. rxbuf = list_entry(cur, struct qlcnic_rx_buffer,
  1029. list);
  1030. qlcnic_alloc_rx_skb(adapter, rds_ring, rxbuf);
  1031. }
  1032. spin_lock(&rds_ring->lock);
  1033. list_splice_tail_init(&sds_ring->free_list[ring],
  1034. &rds_ring->free_list);
  1035. spin_unlock(&rds_ring->lock);
  1036. }
  1037. qlcnic_post_rx_buffers_nodb(adapter, rds_ring, ring);
  1038. }
  1039. if (count) {
  1040. sds_ring->consumer = consumer;
  1041. writel(consumer, sds_ring->crb_sts_consumer);
  1042. }
  1043. return count;
  1044. }
  1045. void qlcnic_post_rx_buffers(struct qlcnic_adapter *adapter,
  1046. struct qlcnic_host_rds_ring *rds_ring, u8 ring_id)
  1047. {
  1048. struct rcv_desc *pdesc;
  1049. struct qlcnic_rx_buffer *buffer;
  1050. int count = 0;
  1051. u32 producer, handle;
  1052. struct list_head *head;
  1053. producer = rds_ring->producer;
  1054. head = &rds_ring->free_list;
  1055. while (!list_empty(head)) {
  1056. buffer = list_entry(head->next, struct qlcnic_rx_buffer, list);
  1057. if (!buffer->skb) {
  1058. if (qlcnic_alloc_rx_skb(adapter, rds_ring, buffer))
  1059. break;
  1060. }
  1061. count++;
  1062. list_del(&buffer->list);
  1063. /* make a rcv descriptor */
  1064. pdesc = &rds_ring->desc_head[producer];
  1065. pdesc->addr_buffer = cpu_to_le64(buffer->dma);
  1066. handle = qlcnic_get_ref_handle(adapter, buffer->ref_handle,
  1067. ring_id);
  1068. pdesc->reference_handle = cpu_to_le16(handle);
  1069. pdesc->buffer_length = cpu_to_le32(rds_ring->dma_size);
  1070. producer = get_next_index(producer, rds_ring->num_desc);
  1071. }
  1072. if (count) {
  1073. rds_ring->producer = producer;
  1074. writel((producer-1) & (rds_ring->num_desc-1),
  1075. rds_ring->crb_rcv_producer);
  1076. }
  1077. }
  1078. static void dump_skb(struct sk_buff *skb, struct qlcnic_adapter *adapter)
  1079. {
  1080. int i;
  1081. unsigned char *data = skb->data;
  1082. pr_info(KERN_INFO "\n");
  1083. for (i = 0; i < skb->len; i++) {
  1084. QLCDB(adapter, DRV, "%02x ", data[i]);
  1085. if ((i & 0x0f) == 8)
  1086. pr_info(KERN_INFO "\n");
  1087. }
  1088. }
  1089. static void qlcnic_process_rcv_diag(struct qlcnic_adapter *adapter, int ring,
  1090. u64 sts_data0)
  1091. {
  1092. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1093. struct sk_buff *skb;
  1094. struct qlcnic_host_rds_ring *rds_ring;
  1095. int index, length, cksum, pkt_offset;
  1096. if (unlikely(ring >= adapter->max_rds_rings))
  1097. return;
  1098. rds_ring = &recv_ctx->rds_rings[ring];
  1099. index = qlcnic_get_sts_refhandle(sts_data0);
  1100. length = qlcnic_get_sts_totallength(sts_data0);
  1101. if (unlikely(index >= rds_ring->num_desc))
  1102. return;
  1103. cksum = qlcnic_get_sts_status(sts_data0);
  1104. pkt_offset = qlcnic_get_sts_pkt_offset(sts_data0);
  1105. skb = qlcnic_process_rxbuf(adapter, rds_ring, index, cksum);
  1106. if (!skb)
  1107. return;
  1108. if (length > rds_ring->skb_size)
  1109. skb_put(skb, rds_ring->skb_size);
  1110. else
  1111. skb_put(skb, length);
  1112. if (pkt_offset)
  1113. skb_pull(skb, pkt_offset);
  1114. if (!qlcnic_check_loopback_buff(skb->data, adapter->mac_addr))
  1115. adapter->ahw->diag_cnt++;
  1116. else
  1117. dump_skb(skb, adapter);
  1118. dev_kfree_skb_any(skb);
  1119. adapter->stats.rx_pkts++;
  1120. adapter->stats.rxbytes += length;
  1121. return;
  1122. }
  1123. void qlcnic_82xx_process_rcv_ring_diag(struct qlcnic_host_sds_ring *sds_ring)
  1124. {
  1125. struct qlcnic_adapter *adapter = sds_ring->adapter;
  1126. struct status_desc *desc;
  1127. u64 sts_data0;
  1128. int ring, opcode, desc_cnt;
  1129. u32 consumer = sds_ring->consumer;
  1130. desc = &sds_ring->desc_head[consumer];
  1131. sts_data0 = le64_to_cpu(desc->status_desc_data[0]);
  1132. if (!(sts_data0 & STATUS_OWNER_HOST))
  1133. return;
  1134. desc_cnt = qlcnic_get_sts_desc_cnt(sts_data0);
  1135. opcode = qlcnic_get_sts_opcode(sts_data0);
  1136. switch (opcode) {
  1137. case QLCNIC_RESPONSE_DESC:
  1138. qlcnic_handle_fw_message(desc_cnt, consumer, sds_ring);
  1139. break;
  1140. default:
  1141. ring = qlcnic_get_sts_type(sts_data0);
  1142. qlcnic_process_rcv_diag(adapter, ring, sts_data0);
  1143. break;
  1144. }
  1145. for (; desc_cnt > 0; desc_cnt--) {
  1146. desc = &sds_ring->desc_head[consumer];
  1147. desc->status_desc_data[0] = cpu_to_le64(STATUS_OWNER_PHANTOM);
  1148. consumer = get_next_index(consumer, sds_ring->num_desc);
  1149. }
  1150. sds_ring->consumer = consumer;
  1151. writel(consumer, sds_ring->crb_sts_consumer);
  1152. }
  1153. int qlcnic_82xx_napi_add(struct qlcnic_adapter *adapter,
  1154. struct net_device *netdev)
  1155. {
  1156. int ring, max_sds_rings;
  1157. struct qlcnic_host_sds_ring *sds_ring;
  1158. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1159. if (qlcnic_alloc_sds_rings(recv_ctx, adapter->max_sds_rings))
  1160. return -ENOMEM;
  1161. max_sds_rings = adapter->max_sds_rings;
  1162. for (ring = 0; ring < adapter->max_sds_rings; ring++) {
  1163. sds_ring = &recv_ctx->sds_rings[ring];
  1164. if (ring == adapter->max_sds_rings - 1)
  1165. netif_napi_add(netdev, &sds_ring->napi, qlcnic_poll,
  1166. QLCNIC_NETDEV_WEIGHT / max_sds_rings);
  1167. else
  1168. netif_napi_add(netdev, &sds_ring->napi, qlcnic_rx_poll,
  1169. QLCNIC_NETDEV_WEIGHT*2);
  1170. }
  1171. if (qlcnic_alloc_tx_rings(adapter, netdev)) {
  1172. qlcnic_free_sds_rings(recv_ctx);
  1173. return -ENOMEM;
  1174. }
  1175. return 0;
  1176. }
  1177. void qlcnic_82xx_napi_del(struct qlcnic_adapter *adapter)
  1178. {
  1179. int ring;
  1180. struct qlcnic_host_sds_ring *sds_ring;
  1181. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1182. for (ring = 0; ring < adapter->max_sds_rings; ring++) {
  1183. sds_ring = &recv_ctx->sds_rings[ring];
  1184. netif_napi_del(&sds_ring->napi);
  1185. }
  1186. qlcnic_free_sds_rings(adapter->recv_ctx);
  1187. qlcnic_free_tx_rings(adapter);
  1188. }
  1189. void qlcnic_82xx_napi_enable(struct qlcnic_adapter *adapter)
  1190. {
  1191. int ring;
  1192. struct qlcnic_host_sds_ring *sds_ring;
  1193. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1194. if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
  1195. return;
  1196. for (ring = 0; ring < adapter->max_sds_rings; ring++) {
  1197. sds_ring = &recv_ctx->sds_rings[ring];
  1198. napi_enable(&sds_ring->napi);
  1199. qlcnic_enable_int(sds_ring);
  1200. }
  1201. }
  1202. void qlcnic_82xx_napi_disable(struct qlcnic_adapter *adapter)
  1203. {
  1204. int ring;
  1205. struct qlcnic_host_sds_ring *sds_ring;
  1206. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1207. if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
  1208. return;
  1209. for (ring = 0; ring < adapter->max_sds_rings; ring++) {
  1210. sds_ring = &recv_ctx->sds_rings[ring];
  1211. qlcnic_disable_int(sds_ring);
  1212. napi_synchronize(&sds_ring->napi);
  1213. napi_disable(&sds_ring->napi);
  1214. }
  1215. }
  1216. #define QLC_83XX_NORMAL_LB_PKT (1ULL << 36)
  1217. #define QLC_83XX_LRO_LB_PKT (1ULL << 46)
  1218. static inline int qlcnic_83xx_is_lb_pkt(u64 sts_data, int lro_pkt)
  1219. {
  1220. if (lro_pkt)
  1221. return (sts_data & QLC_83XX_LRO_LB_PKT) ? 1 : 0;
  1222. else
  1223. return (sts_data & QLC_83XX_NORMAL_LB_PKT) ? 1 : 0;
  1224. }
  1225. static struct qlcnic_rx_buffer *
  1226. qlcnic_83xx_process_rcv(struct qlcnic_adapter *adapter,
  1227. struct qlcnic_host_sds_ring *sds_ring,
  1228. u8 ring, u64 sts_data[])
  1229. {
  1230. struct net_device *netdev = adapter->netdev;
  1231. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1232. struct qlcnic_rx_buffer *buffer;
  1233. struct sk_buff *skb;
  1234. struct qlcnic_host_rds_ring *rds_ring;
  1235. int index, length, cksum, is_lb_pkt;
  1236. u16 vid = 0xffff, t_vid;
  1237. if (unlikely(ring >= adapter->max_rds_rings))
  1238. return NULL;
  1239. rds_ring = &recv_ctx->rds_rings[ring];
  1240. index = qlcnic_83xx_hndl(sts_data[0]);
  1241. if (unlikely(index >= rds_ring->num_desc))
  1242. return NULL;
  1243. buffer = &rds_ring->rx_buf_arr[index];
  1244. length = qlcnic_83xx_pktln(sts_data[0]);
  1245. cksum = qlcnic_83xx_csum_status(sts_data[1]);
  1246. skb = qlcnic_process_rxbuf(adapter, rds_ring, index, cksum);
  1247. if (!skb)
  1248. return buffer;
  1249. if (adapter->drv_mac_learn &&
  1250. (adapter->flags & QLCNIC_ESWITCH_ENABLED)) {
  1251. t_vid = 0;
  1252. is_lb_pkt = qlcnic_83xx_is_lb_pkt(sts_data[1], 0);
  1253. qlcnic_add_lb_filter(adapter, skb, is_lb_pkt,
  1254. cpu_to_le16(t_vid));
  1255. }
  1256. if (length > rds_ring->skb_size)
  1257. skb_put(skb, rds_ring->skb_size);
  1258. else
  1259. skb_put(skb, length);
  1260. if (unlikely(qlcnic_check_rx_tagging(adapter, skb, &vid))) {
  1261. adapter->stats.rxdropped++;
  1262. dev_kfree_skb(skb);
  1263. return buffer;
  1264. }
  1265. skb->protocol = eth_type_trans(skb, netdev);
  1266. if (vid != 0xffff)
  1267. __vlan_hwaccel_put_tag(skb, vid);
  1268. napi_gro_receive(&sds_ring->napi, skb);
  1269. adapter->stats.rx_pkts++;
  1270. adapter->stats.rxbytes += length;
  1271. return buffer;
  1272. }
  1273. static struct qlcnic_rx_buffer *
  1274. qlcnic_83xx_process_lro(struct qlcnic_adapter *adapter,
  1275. u8 ring, u64 sts_data[])
  1276. {
  1277. struct net_device *netdev = adapter->netdev;
  1278. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1279. struct qlcnic_rx_buffer *buffer;
  1280. struct sk_buff *skb;
  1281. struct qlcnic_host_rds_ring *rds_ring;
  1282. struct iphdr *iph;
  1283. struct ipv6hdr *ipv6h;
  1284. struct tcphdr *th;
  1285. bool push;
  1286. int l2_hdr_offset, l4_hdr_offset;
  1287. int index, is_lb_pkt;
  1288. u16 lro_length, length, data_offset, gso_size;
  1289. u16 vid = 0xffff, t_vid;
  1290. if (unlikely(ring > adapter->max_rds_rings))
  1291. return NULL;
  1292. rds_ring = &recv_ctx->rds_rings[ring];
  1293. index = qlcnic_83xx_hndl(sts_data[0]);
  1294. if (unlikely(index > rds_ring->num_desc))
  1295. return NULL;
  1296. buffer = &rds_ring->rx_buf_arr[index];
  1297. lro_length = qlcnic_83xx_lro_pktln(sts_data[0]);
  1298. l2_hdr_offset = qlcnic_83xx_l2_hdr_off(sts_data[1]);
  1299. l4_hdr_offset = qlcnic_83xx_l4_hdr_off(sts_data[1]);
  1300. push = qlcnic_83xx_is_psh_bit(sts_data[1]);
  1301. skb = qlcnic_process_rxbuf(adapter, rds_ring, index, STATUS_CKSUM_OK);
  1302. if (!skb)
  1303. return buffer;
  1304. if (adapter->drv_mac_learn &&
  1305. (adapter->flags & QLCNIC_ESWITCH_ENABLED)) {
  1306. t_vid = 0;
  1307. is_lb_pkt = qlcnic_83xx_is_lb_pkt(sts_data[1], 1);
  1308. qlcnic_add_lb_filter(adapter, skb, is_lb_pkt,
  1309. cpu_to_le16(t_vid));
  1310. }
  1311. if (qlcnic_83xx_is_tstamp(sts_data[1]))
  1312. data_offset = l4_hdr_offset + QLCNIC_TCP_TS_HDR_SIZE;
  1313. else
  1314. data_offset = l4_hdr_offset + QLCNIC_TCP_HDR_SIZE;
  1315. skb_put(skb, lro_length + data_offset);
  1316. skb_pull(skb, l2_hdr_offset);
  1317. if (unlikely(qlcnic_check_rx_tagging(adapter, skb, &vid))) {
  1318. adapter->stats.rxdropped++;
  1319. dev_kfree_skb(skb);
  1320. return buffer;
  1321. }
  1322. skb->protocol = eth_type_trans(skb, netdev);
  1323. if (ntohs(skb->protocol) == ETH_P_IPV6) {
  1324. ipv6h = (struct ipv6hdr *)skb->data;
  1325. th = (struct tcphdr *)(skb->data + sizeof(struct ipv6hdr));
  1326. length = (th->doff << 2) + lro_length;
  1327. ipv6h->payload_len = htons(length);
  1328. } else {
  1329. iph = (struct iphdr *)skb->data;
  1330. th = (struct tcphdr *)(skb->data + (iph->ihl << 2));
  1331. length = (iph->ihl << 2) + (th->doff << 2) + lro_length;
  1332. iph->tot_len = htons(length);
  1333. iph->check = 0;
  1334. iph->check = ip_fast_csum((unsigned char *)iph, iph->ihl);
  1335. }
  1336. th->psh = push;
  1337. length = skb->len;
  1338. if (adapter->flags & QLCNIC_FW_LRO_MSS_CAP) {
  1339. gso_size = qlcnic_83xx_get_lro_sts_mss(sts_data[0]);
  1340. skb_shinfo(skb)->gso_size = gso_size;
  1341. if (skb->protocol == htons(ETH_P_IPV6))
  1342. skb_shinfo(skb)->gso_type = SKB_GSO_TCPV6;
  1343. else
  1344. skb_shinfo(skb)->gso_type = SKB_GSO_TCPV4;
  1345. }
  1346. if (vid != 0xffff)
  1347. __vlan_hwaccel_put_tag(skb, vid);
  1348. netif_receive_skb(skb);
  1349. adapter->stats.lro_pkts++;
  1350. adapter->stats.lrobytes += length;
  1351. return buffer;
  1352. }
  1353. static int qlcnic_83xx_process_rcv_ring(struct qlcnic_host_sds_ring *sds_ring,
  1354. int max)
  1355. {
  1356. struct qlcnic_host_rds_ring *rds_ring;
  1357. struct qlcnic_adapter *adapter = sds_ring->adapter;
  1358. struct list_head *cur;
  1359. struct status_desc *desc;
  1360. struct qlcnic_rx_buffer *rxbuf = NULL;
  1361. u8 ring;
  1362. u64 sts_data[2];
  1363. int count = 0, opcode;
  1364. u32 consumer = sds_ring->consumer;
  1365. while (count < max) {
  1366. desc = &sds_ring->desc_head[consumer];
  1367. sts_data[1] = le64_to_cpu(desc->status_desc_data[1]);
  1368. opcode = qlcnic_83xx_opcode(sts_data[1]);
  1369. if (!opcode)
  1370. break;
  1371. sts_data[0] = le64_to_cpu(desc->status_desc_data[0]);
  1372. ring = QLCNIC_FETCH_RING_ID(sts_data[0]);
  1373. switch (opcode) {
  1374. case QLC_83XX_REG_DESC:
  1375. rxbuf = qlcnic_83xx_process_rcv(adapter, sds_ring,
  1376. ring, sts_data);
  1377. break;
  1378. case QLC_83XX_LRO_DESC:
  1379. rxbuf = qlcnic_83xx_process_lro(adapter, ring,
  1380. sts_data);
  1381. break;
  1382. default:
  1383. dev_info(&adapter->pdev->dev,
  1384. "Unkonwn opcode: 0x%x\n", opcode);
  1385. goto skip;
  1386. }
  1387. if (likely(rxbuf))
  1388. list_add_tail(&rxbuf->list, &sds_ring->free_list[ring]);
  1389. else
  1390. adapter->stats.null_rxbuf++;
  1391. skip:
  1392. desc = &sds_ring->desc_head[consumer];
  1393. /* Reset the descriptor */
  1394. desc->status_desc_data[1] = 0;
  1395. consumer = get_next_index(consumer, sds_ring->num_desc);
  1396. count++;
  1397. }
  1398. for (ring = 0; ring < adapter->max_rds_rings; ring++) {
  1399. rds_ring = &adapter->recv_ctx->rds_rings[ring];
  1400. if (!list_empty(&sds_ring->free_list[ring])) {
  1401. list_for_each(cur, &sds_ring->free_list[ring]) {
  1402. rxbuf = list_entry(cur, struct qlcnic_rx_buffer,
  1403. list);
  1404. qlcnic_alloc_rx_skb(adapter, rds_ring, rxbuf);
  1405. }
  1406. spin_lock(&rds_ring->lock);
  1407. list_splice_tail_init(&sds_ring->free_list[ring],
  1408. &rds_ring->free_list);
  1409. spin_unlock(&rds_ring->lock);
  1410. }
  1411. qlcnic_post_rx_buffers_nodb(adapter, rds_ring, ring);
  1412. }
  1413. if (count) {
  1414. sds_ring->consumer = consumer;
  1415. writel(consumer, sds_ring->crb_sts_consumer);
  1416. }
  1417. return count;
  1418. }
  1419. static int qlcnic_83xx_poll(struct napi_struct *napi, int budget)
  1420. {
  1421. int tx_complete;
  1422. int work_done;
  1423. struct qlcnic_host_sds_ring *sds_ring;
  1424. struct qlcnic_adapter *adapter;
  1425. struct qlcnic_host_tx_ring *tx_ring;
  1426. sds_ring = container_of(napi, struct qlcnic_host_sds_ring, napi);
  1427. adapter = sds_ring->adapter;
  1428. /* tx ring count = 1 */
  1429. tx_ring = adapter->tx_ring;
  1430. tx_complete = qlcnic_process_cmd_ring(adapter, tx_ring, budget);
  1431. work_done = qlcnic_83xx_process_rcv_ring(sds_ring, budget);
  1432. if ((work_done < budget) && tx_complete) {
  1433. napi_complete(&sds_ring->napi);
  1434. qlcnic_83xx_enable_intr(adapter, sds_ring);
  1435. }
  1436. return work_done;
  1437. }
  1438. static int qlcnic_83xx_msix_tx_poll(struct napi_struct *napi, int budget)
  1439. {
  1440. int work_done;
  1441. struct qlcnic_host_tx_ring *tx_ring;
  1442. struct qlcnic_adapter *adapter;
  1443. budget = QLCNIC_TX_POLL_BUDGET;
  1444. tx_ring = container_of(napi, struct qlcnic_host_tx_ring, napi);
  1445. adapter = tx_ring->adapter;
  1446. work_done = qlcnic_process_cmd_ring(adapter, tx_ring, budget);
  1447. if (work_done) {
  1448. napi_complete(&tx_ring->napi);
  1449. if (test_bit(__QLCNIC_DEV_UP , &adapter->state))
  1450. qlcnic_83xx_enable_tx_intr(adapter, tx_ring);
  1451. }
  1452. return work_done;
  1453. }
  1454. static int qlcnic_83xx_rx_poll(struct napi_struct *napi, int budget)
  1455. {
  1456. int work_done;
  1457. struct qlcnic_host_sds_ring *sds_ring;
  1458. struct qlcnic_adapter *adapter;
  1459. sds_ring = container_of(napi, struct qlcnic_host_sds_ring, napi);
  1460. adapter = sds_ring->adapter;
  1461. work_done = qlcnic_83xx_process_rcv_ring(sds_ring, budget);
  1462. if (work_done < budget) {
  1463. napi_complete(&sds_ring->napi);
  1464. if (test_bit(__QLCNIC_DEV_UP, &adapter->state))
  1465. qlcnic_83xx_enable_intr(adapter, sds_ring);
  1466. }
  1467. return work_done;
  1468. }
  1469. void qlcnic_83xx_napi_enable(struct qlcnic_adapter *adapter)
  1470. {
  1471. int ring;
  1472. struct qlcnic_host_sds_ring *sds_ring;
  1473. struct qlcnic_host_tx_ring *tx_ring;
  1474. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1475. if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
  1476. return;
  1477. for (ring = 0; ring < adapter->max_sds_rings; ring++) {
  1478. sds_ring = &recv_ctx->sds_rings[ring];
  1479. napi_enable(&sds_ring->napi);
  1480. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  1481. qlcnic_83xx_enable_intr(adapter, sds_ring);
  1482. }
  1483. if (adapter->flags & QLCNIC_MSIX_ENABLED) {
  1484. for (ring = 0; ring < adapter->max_drv_tx_rings; ring++) {
  1485. tx_ring = &adapter->tx_ring[ring];
  1486. napi_enable(&tx_ring->napi);
  1487. qlcnic_83xx_enable_tx_intr(adapter, tx_ring);
  1488. }
  1489. }
  1490. }
  1491. void qlcnic_83xx_napi_disable(struct qlcnic_adapter *adapter)
  1492. {
  1493. int ring;
  1494. struct qlcnic_host_sds_ring *sds_ring;
  1495. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1496. struct qlcnic_host_tx_ring *tx_ring;
  1497. if (adapter->is_up != QLCNIC_ADAPTER_UP_MAGIC)
  1498. return;
  1499. for (ring = 0; ring < adapter->max_sds_rings; ring++) {
  1500. sds_ring = &recv_ctx->sds_rings[ring];
  1501. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  1502. qlcnic_83xx_disable_intr(adapter, sds_ring);
  1503. napi_synchronize(&sds_ring->napi);
  1504. napi_disable(&sds_ring->napi);
  1505. }
  1506. if (adapter->flags & QLCNIC_MSIX_ENABLED) {
  1507. for (ring = 0; ring < adapter->max_drv_tx_rings; ring++) {
  1508. tx_ring = &adapter->tx_ring[ring];
  1509. qlcnic_83xx_disable_tx_intr(adapter, tx_ring);
  1510. napi_synchronize(&tx_ring->napi);
  1511. napi_disable(&tx_ring->napi);
  1512. }
  1513. }
  1514. }
  1515. int qlcnic_83xx_napi_add(struct qlcnic_adapter *adapter,
  1516. struct net_device *netdev)
  1517. {
  1518. int ring, max_sds_rings;
  1519. struct qlcnic_host_sds_ring *sds_ring;
  1520. struct qlcnic_host_tx_ring *tx_ring;
  1521. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1522. if (qlcnic_alloc_sds_rings(recv_ctx, adapter->max_sds_rings))
  1523. return -ENOMEM;
  1524. max_sds_rings = adapter->max_sds_rings;
  1525. for (ring = 0; ring < adapter->max_sds_rings; ring++) {
  1526. sds_ring = &recv_ctx->sds_rings[ring];
  1527. if (adapter->flags & QLCNIC_MSIX_ENABLED)
  1528. netif_napi_add(netdev, &sds_ring->napi,
  1529. qlcnic_83xx_rx_poll,
  1530. QLCNIC_NETDEV_WEIGHT * 2);
  1531. else
  1532. netif_napi_add(netdev, &sds_ring->napi,
  1533. qlcnic_83xx_poll,
  1534. QLCNIC_NETDEV_WEIGHT / max_sds_rings);
  1535. }
  1536. if (qlcnic_alloc_tx_rings(adapter, netdev)) {
  1537. qlcnic_free_sds_rings(recv_ctx);
  1538. return -ENOMEM;
  1539. }
  1540. if (adapter->flags & QLCNIC_MSIX_ENABLED) {
  1541. for (ring = 0; ring < adapter->max_drv_tx_rings; ring++) {
  1542. tx_ring = &adapter->tx_ring[ring];
  1543. netif_napi_add(netdev, &tx_ring->napi,
  1544. qlcnic_83xx_msix_tx_poll,
  1545. QLCNIC_NETDEV_WEIGHT);
  1546. }
  1547. }
  1548. return 0;
  1549. }
  1550. void qlcnic_83xx_napi_del(struct qlcnic_adapter *adapter)
  1551. {
  1552. int ring;
  1553. struct qlcnic_host_sds_ring *sds_ring;
  1554. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1555. struct qlcnic_host_tx_ring *tx_ring;
  1556. for (ring = 0; ring < adapter->max_sds_rings; ring++) {
  1557. sds_ring = &recv_ctx->sds_rings[ring];
  1558. netif_napi_del(&sds_ring->napi);
  1559. }
  1560. qlcnic_free_sds_rings(adapter->recv_ctx);
  1561. if ((adapter->flags & QLCNIC_MSIX_ENABLED)) {
  1562. for (ring = 0; ring < adapter->max_drv_tx_rings; ring++) {
  1563. tx_ring = &adapter->tx_ring[ring];
  1564. netif_napi_del(&tx_ring->napi);
  1565. }
  1566. }
  1567. qlcnic_free_tx_rings(adapter);
  1568. }
  1569. void qlcnic_83xx_process_rcv_diag(struct qlcnic_adapter *adapter,
  1570. int ring, u64 sts_data[])
  1571. {
  1572. struct qlcnic_recv_context *recv_ctx = adapter->recv_ctx;
  1573. struct sk_buff *skb;
  1574. struct qlcnic_host_rds_ring *rds_ring;
  1575. int index, length;
  1576. if (unlikely(ring >= adapter->max_rds_rings))
  1577. return;
  1578. rds_ring = &recv_ctx->rds_rings[ring];
  1579. index = qlcnic_83xx_hndl(sts_data[0]);
  1580. if (unlikely(index >= rds_ring->num_desc))
  1581. return;
  1582. length = qlcnic_83xx_pktln(sts_data[0]);
  1583. skb = qlcnic_process_rxbuf(adapter, rds_ring, index, STATUS_CKSUM_OK);
  1584. if (!skb)
  1585. return;
  1586. if (length > rds_ring->skb_size)
  1587. skb_put(skb, rds_ring->skb_size);
  1588. else
  1589. skb_put(skb, length);
  1590. if (!qlcnic_check_loopback_buff(skb->data, adapter->mac_addr))
  1591. adapter->ahw->diag_cnt++;
  1592. else
  1593. dump_skb(skb, adapter);
  1594. dev_kfree_skb_any(skb);
  1595. return;
  1596. }
  1597. void qlcnic_83xx_process_rcv_ring_diag(struct qlcnic_host_sds_ring *sds_ring)
  1598. {
  1599. struct qlcnic_adapter *adapter = sds_ring->adapter;
  1600. struct status_desc *desc;
  1601. u64 sts_data[2];
  1602. int ring, opcode;
  1603. u32 consumer = sds_ring->consumer;
  1604. desc = &sds_ring->desc_head[consumer];
  1605. sts_data[0] = le64_to_cpu(desc->status_desc_data[0]);
  1606. sts_data[1] = le64_to_cpu(desc->status_desc_data[1]);
  1607. opcode = qlcnic_83xx_opcode(sts_data[1]);
  1608. if (!opcode)
  1609. return;
  1610. ring = QLCNIC_FETCH_RING_ID(qlcnic_83xx_hndl(sts_data[0]));
  1611. qlcnic_83xx_process_rcv_diag(adapter, ring, sts_data);
  1612. desc = &sds_ring->desc_head[consumer];
  1613. desc->status_desc_data[0] = cpu_to_le64(STATUS_OWNER_PHANTOM);
  1614. consumer = get_next_index(consumer, sds_ring->num_desc);
  1615. sds_ring->consumer = consumer;
  1616. writel(consumer, sds_ring->crb_sts_consumer);
  1617. }