gro.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835
  1. // SPDX-License-Identifier: GPL-2.0-or-later
  2. #include <net/psp.h>
  3. #include <net/gro.h>
  4. #include <net/dst_metadata.h>
  5. #include <net/busy_poll.h>
  6. #include <trace/events/net.h>
  7. #include <linux/skbuff_ref.h>
  8. #define MAX_GRO_SKBS 8
  9. static DEFINE_SPINLOCK(offload_lock);
  10. /**
  11. * dev_add_offload - register offload handlers
  12. * @po: protocol offload declaration
  13. *
  14. * Add protocol offload handlers to the networking stack. The passed
  15. * &proto_offload is linked into kernel lists and may not be freed until
  16. * it has been removed from the kernel lists.
  17. *
  18. * This call does not sleep therefore it can not
  19. * guarantee all CPU's that are in middle of receiving packets
  20. * will see the new offload handlers (until the next received packet).
  21. */
  22. void dev_add_offload(struct packet_offload *po)
  23. {
  24. struct packet_offload *elem;
  25. spin_lock(&offload_lock);
  26. list_for_each_entry(elem, &net_hotdata.offload_base, list) {
  27. if (po->priority < elem->priority)
  28. break;
  29. }
  30. list_add_rcu(&po->list, elem->list.prev);
  31. spin_unlock(&offload_lock);
  32. }
  33. EXPORT_SYMBOL(dev_add_offload);
  34. /**
  35. * __dev_remove_offload - remove offload handler
  36. * @po: packet offload declaration
  37. *
  38. * Remove a protocol offload handler that was previously added to the
  39. * kernel offload handlers by dev_add_offload(). The passed &offload_type
  40. * is removed from the kernel lists and can be freed or reused once this
  41. * function returns.
  42. *
  43. * The packet type might still be in use by receivers
  44. * and must not be freed until after all the CPU's have gone
  45. * through a quiescent state.
  46. */
  47. static void __dev_remove_offload(struct packet_offload *po)
  48. {
  49. struct list_head *head = &net_hotdata.offload_base;
  50. struct packet_offload *po1;
  51. spin_lock(&offload_lock);
  52. list_for_each_entry(po1, head, list) {
  53. if (po == po1) {
  54. list_del_rcu(&po->list);
  55. goto out;
  56. }
  57. }
  58. pr_warn("dev_remove_offload: %p not found\n", po);
  59. out:
  60. spin_unlock(&offload_lock);
  61. }
  62. /**
  63. * dev_remove_offload - remove packet offload handler
  64. * @po: packet offload declaration
  65. *
  66. * Remove a packet offload handler that was previously added to the kernel
  67. * offload handlers by dev_add_offload(). The passed &offload_type is
  68. * removed from the kernel lists and can be freed or reused once this
  69. * function returns.
  70. *
  71. * This call sleeps to guarantee that no CPU is looking at the packet
  72. * type after return.
  73. */
  74. void dev_remove_offload(struct packet_offload *po)
  75. {
  76. __dev_remove_offload(po);
  77. synchronize_net();
  78. }
  79. EXPORT_SYMBOL(dev_remove_offload);
  80. int skb_gro_receive(struct sk_buff *p, struct sk_buff *skb)
  81. {
  82. struct skb_shared_info *pinfo, *skbinfo = skb_shinfo(skb);
  83. unsigned int offset = skb_gro_offset(skb);
  84. unsigned int headlen = skb_headlen(skb);
  85. unsigned int len = skb_gro_len(skb);
  86. unsigned int delta_truesize;
  87. unsigned int new_truesize;
  88. struct sk_buff *lp;
  89. int segs;
  90. /* Do not splice page pool based packets w/ non-page pool
  91. * packets. This can result in reference count issues as page
  92. * pool pages will not decrement the reference count and will
  93. * instead be immediately returned to the pool or have frag
  94. * count decremented.
  95. */
  96. if (p->pp_recycle != skb->pp_recycle)
  97. return -ETOOMANYREFS;
  98. if (unlikely(p->len + len >= netif_get_gro_max_size(p->dev, p) ||
  99. NAPI_GRO_CB(skb)->flush))
  100. return -E2BIG;
  101. if (unlikely(p->len + len >= GRO_LEGACY_MAX_SIZE)) {
  102. if (NAPI_GRO_CB(skb)->proto != IPPROTO_TCP ||
  103. p->encapsulation)
  104. return -E2BIG;
  105. }
  106. segs = NAPI_GRO_CB(skb)->count;
  107. lp = NAPI_GRO_CB(p)->last;
  108. pinfo = skb_shinfo(lp);
  109. if (headlen <= offset) {
  110. skb_frag_t *frag;
  111. skb_frag_t *frag2;
  112. int i = skbinfo->nr_frags;
  113. int nr_frags = pinfo->nr_frags + i;
  114. if (nr_frags > MAX_SKB_FRAGS)
  115. goto merge;
  116. offset -= headlen;
  117. pinfo->nr_frags = nr_frags;
  118. skbinfo->nr_frags = 0;
  119. frag = pinfo->frags + nr_frags;
  120. frag2 = skbinfo->frags + i;
  121. do {
  122. *--frag = *--frag2;
  123. } while (--i);
  124. skb_frag_off_add(frag, offset);
  125. skb_frag_size_sub(frag, offset);
  126. /* all fragments truesize : remove (head size + sk_buff) */
  127. new_truesize = SKB_TRUESIZE(skb_end_offset(skb));
  128. delta_truesize = skb->truesize - new_truesize;
  129. skb->truesize = new_truesize;
  130. skb->len -= skb->data_len;
  131. skb->data_len = 0;
  132. NAPI_GRO_CB(skb)->free = NAPI_GRO_FREE;
  133. goto done;
  134. } else if (skb->head_frag) {
  135. int nr_frags = pinfo->nr_frags;
  136. skb_frag_t *frag = pinfo->frags + nr_frags;
  137. struct page *page = virt_to_head_page(skb->head);
  138. unsigned int first_size = headlen - offset;
  139. unsigned int first_offset;
  140. if (nr_frags + 1 + skbinfo->nr_frags > MAX_SKB_FRAGS)
  141. goto merge;
  142. first_offset = skb->data -
  143. (unsigned char *)page_address(page) +
  144. offset;
  145. pinfo->nr_frags = nr_frags + 1 + skbinfo->nr_frags;
  146. skb_frag_fill_page_desc(frag, page, first_offset, first_size);
  147. memcpy(frag + 1, skbinfo->frags, sizeof(*frag) * skbinfo->nr_frags);
  148. /* We dont need to clear skbinfo->nr_frags here */
  149. new_truesize = SKB_DATA_ALIGN(sizeof(struct sk_buff));
  150. delta_truesize = skb->truesize - new_truesize;
  151. skb->truesize = new_truesize;
  152. NAPI_GRO_CB(skb)->free = NAPI_GRO_FREE_STOLEN_HEAD;
  153. goto done;
  154. }
  155. merge:
  156. /* sk ownership - if any - completely transferred to the aggregated packet */
  157. skb->destructor = NULL;
  158. skb->sk = NULL;
  159. delta_truesize = skb->truesize;
  160. if (offset > headlen) {
  161. unsigned int eat = offset - headlen;
  162. skb_frag_off_add(&skbinfo->frags[0], eat);
  163. skb_frag_size_sub(&skbinfo->frags[0], eat);
  164. skb->data_len -= eat;
  165. skb->len -= eat;
  166. offset = headlen;
  167. }
  168. __skb_pull(skb, offset);
  169. if (NAPI_GRO_CB(p)->last == p)
  170. skb_shinfo(p)->frag_list = skb;
  171. else
  172. NAPI_GRO_CB(p)->last->next = skb;
  173. NAPI_GRO_CB(p)->last = skb;
  174. __skb_header_release(skb);
  175. lp = p;
  176. done:
  177. NAPI_GRO_CB(p)->count += segs;
  178. p->data_len += len;
  179. p->truesize += delta_truesize;
  180. p->len += len;
  181. if (lp != p) {
  182. lp->data_len += len;
  183. lp->truesize += delta_truesize;
  184. lp->len += len;
  185. }
  186. NAPI_GRO_CB(skb)->same_flow = 1;
  187. return 0;
  188. }
  189. int skb_gro_receive_list(struct sk_buff *p, struct sk_buff *skb)
  190. {
  191. if (unlikely(p->len + skb->len >= 65536))
  192. return -E2BIG;
  193. if (NAPI_GRO_CB(p)->last == p)
  194. skb_shinfo(p)->frag_list = skb;
  195. else
  196. NAPI_GRO_CB(p)->last->next = skb;
  197. skb_pull(skb, skb_gro_offset(skb));
  198. NAPI_GRO_CB(p)->last = skb;
  199. NAPI_GRO_CB(p)->count++;
  200. p->data_len += skb->len;
  201. /* sk ownership - if any - completely transferred to the aggregated packet */
  202. skb->destructor = NULL;
  203. skb->sk = NULL;
  204. p->truesize += skb->truesize;
  205. p->len += skb->len;
  206. NAPI_GRO_CB(skb)->same_flow = 1;
  207. return 0;
  208. }
  209. static void gro_complete(struct gro_node *gro, struct sk_buff *skb)
  210. {
  211. struct list_head *head = &net_hotdata.offload_base;
  212. struct packet_offload *ptype;
  213. __be16 type = skb->protocol;
  214. int err = -ENOENT;
  215. BUILD_BUG_ON(sizeof(struct napi_gro_cb) > sizeof(skb->cb));
  216. if (NAPI_GRO_CB(skb)->count == 1) {
  217. skb_shinfo(skb)->gso_size = 0;
  218. goto out;
  219. }
  220. /* NICs can feed encapsulated packets into GRO */
  221. skb->encapsulation = 0;
  222. rcu_read_lock();
  223. list_for_each_entry_rcu(ptype, head, list) {
  224. if (ptype->type != type || !ptype->callbacks.gro_complete)
  225. continue;
  226. err = INDIRECT_CALL_INET(ptype->callbacks.gro_complete,
  227. ipv6_gro_complete, inet_gro_complete,
  228. skb, 0);
  229. break;
  230. }
  231. rcu_read_unlock();
  232. if (err) {
  233. WARN_ON(&ptype->list == head);
  234. kfree_skb(skb);
  235. return;
  236. }
  237. out:
  238. gro_normal_one(gro, skb, NAPI_GRO_CB(skb)->count);
  239. }
  240. static void __gro_flush_chain(struct gro_node *gro, u32 index, bool flush_old)
  241. {
  242. struct list_head *head = &gro->hash[index].list;
  243. struct sk_buff *skb, *p;
  244. list_for_each_entry_safe_reverse(skb, p, head, list) {
  245. if (flush_old && NAPI_GRO_CB(skb)->age == jiffies)
  246. return;
  247. skb_list_del_init(skb);
  248. gro_complete(gro, skb);
  249. gro->hash[index].count--;
  250. }
  251. if (!gro->hash[index].count)
  252. __clear_bit(index, &gro->bitmask);
  253. }
  254. /*
  255. * gro->hash[].list contains packets ordered by age.
  256. * youngest packets at the head of it.
  257. * Complete skbs in reverse order to reduce latencies.
  258. */
  259. void __gro_flush(struct gro_node *gro, bool flush_old)
  260. {
  261. unsigned long bitmask = gro->bitmask;
  262. unsigned int i, base = ~0U;
  263. while ((i = ffs(bitmask)) != 0) {
  264. bitmask >>= i;
  265. base += i;
  266. __gro_flush_chain(gro, base, flush_old);
  267. }
  268. }
  269. EXPORT_SYMBOL(__gro_flush);
  270. static unsigned long gro_list_prepare_tc_ext(const struct sk_buff *skb,
  271. const struct sk_buff *p,
  272. unsigned long diffs)
  273. {
  274. #if IS_ENABLED(CONFIG_NET_TC_SKB_EXT)
  275. struct tc_skb_ext *skb_ext;
  276. struct tc_skb_ext *p_ext;
  277. skb_ext = skb_ext_find(skb, TC_SKB_EXT);
  278. p_ext = skb_ext_find(p, TC_SKB_EXT);
  279. diffs |= (!!p_ext) ^ (!!skb_ext);
  280. if (!diffs && unlikely(skb_ext))
  281. diffs |= p_ext->chain ^ skb_ext->chain;
  282. #endif
  283. return diffs;
  284. }
  285. static void gro_list_prepare(const struct list_head *head,
  286. const struct sk_buff *skb)
  287. {
  288. unsigned int maclen = skb->dev->hard_header_len;
  289. u32 hash = skb_get_hash_raw(skb);
  290. struct sk_buff *p;
  291. list_for_each_entry(p, head, list) {
  292. unsigned long diffs;
  293. if (hash != skb_get_hash_raw(p)) {
  294. NAPI_GRO_CB(p)->same_flow = 0;
  295. continue;
  296. }
  297. diffs = (unsigned long)p->dev ^ (unsigned long)skb->dev;
  298. diffs |= p->vlan_all ^ skb->vlan_all;
  299. diffs |= skb_metadata_differs(p, skb);
  300. if (maclen == ETH_HLEN)
  301. diffs |= compare_ether_header(skb_mac_header(p),
  302. skb_mac_header(skb));
  303. else if (!diffs)
  304. diffs = memcmp(skb_mac_header(p),
  305. skb_mac_header(skb),
  306. maclen);
  307. /* in most common scenarios 'slow_gro' is 0
  308. * otherwise we are already on some slower paths
  309. * either skip all the infrequent tests altogether or
  310. * avoid trying too hard to skip each of them individually
  311. */
  312. if (!diffs && unlikely(skb->slow_gro | p->slow_gro)) {
  313. diffs |= p->sk != skb->sk;
  314. diffs |= skb_metadata_dst_cmp(p, skb);
  315. diffs |= skb_get_nfct(p) ^ skb_get_nfct(skb);
  316. diffs |= gro_list_prepare_tc_ext(skb, p, diffs);
  317. diffs |= __psp_skb_coalesce_diff(skb, p, diffs);
  318. }
  319. NAPI_GRO_CB(p)->same_flow = !diffs;
  320. }
  321. }
  322. static inline void skb_gro_reset_offset(struct sk_buff *skb, u32 nhoff)
  323. {
  324. const struct skb_shared_info *pinfo;
  325. const skb_frag_t *frag0;
  326. unsigned int headlen;
  327. NAPI_GRO_CB(skb)->network_offset = 0;
  328. NAPI_GRO_CB(skb)->data_offset = 0;
  329. headlen = skb_headlen(skb);
  330. NAPI_GRO_CB(skb)->frag0 = skb->data;
  331. NAPI_GRO_CB(skb)->frag0_len = headlen;
  332. if (headlen)
  333. return;
  334. pinfo = skb_shinfo(skb);
  335. frag0 = &pinfo->frags[0];
  336. if (pinfo->nr_frags && skb_frag_page(frag0) &&
  337. !PageHighMem(skb_frag_page(frag0)) &&
  338. (!NET_IP_ALIGN || !((skb_frag_off(frag0) + nhoff) & 3))) {
  339. NAPI_GRO_CB(skb)->frag0 = skb_frag_address(frag0);
  340. NAPI_GRO_CB(skb)->frag0_len = min_t(unsigned int,
  341. skb_frag_size(frag0),
  342. skb->end - skb->tail);
  343. }
  344. }
  345. static void gro_pull_from_frag0(struct sk_buff *skb, int grow)
  346. {
  347. struct skb_shared_info *pinfo = skb_shinfo(skb);
  348. DEBUG_NET_WARN_ON_ONCE(skb->end - skb->tail < grow);
  349. memcpy(skb_tail_pointer(skb), NAPI_GRO_CB(skb)->frag0, grow);
  350. skb->data_len -= grow;
  351. skb->tail += grow;
  352. skb_frag_off_add(&pinfo->frags[0], grow);
  353. skb_frag_size_sub(&pinfo->frags[0], grow);
  354. if (unlikely(!skb_frag_size(&pinfo->frags[0]))) {
  355. skb_frag_unref(skb, 0);
  356. memmove(pinfo->frags, pinfo->frags + 1,
  357. --pinfo->nr_frags * sizeof(pinfo->frags[0]));
  358. }
  359. }
  360. static void gro_try_pull_from_frag0(struct sk_buff *skb)
  361. {
  362. int grow = skb_gro_offset(skb) - skb_headlen(skb);
  363. if (grow > 0)
  364. gro_pull_from_frag0(skb, grow);
  365. }
  366. static void gro_flush_oldest(struct gro_node *gro, struct list_head *head)
  367. {
  368. struct sk_buff *oldest;
  369. oldest = list_last_entry(head, struct sk_buff, list);
  370. /* We are called with head length >= MAX_GRO_SKBS, so this is
  371. * impossible.
  372. */
  373. if (WARN_ON_ONCE(!oldest))
  374. return;
  375. /* Do not adjust napi->gro_hash[].count, caller is adding a new
  376. * SKB to the chain.
  377. */
  378. skb_list_del_init(oldest);
  379. gro_complete(gro, oldest);
  380. }
  381. static enum gro_result dev_gro_receive(struct gro_node *gro,
  382. struct sk_buff *skb)
  383. {
  384. u32 bucket = skb_get_hash_raw(skb) & (GRO_HASH_BUCKETS - 1);
  385. struct list_head *head = &net_hotdata.offload_base;
  386. struct gro_list *gro_list = &gro->hash[bucket];
  387. struct packet_offload *ptype;
  388. __be16 type = skb->protocol;
  389. struct sk_buff *pp = NULL;
  390. enum gro_result ret;
  391. int same_flow;
  392. if (netif_elide_gro(skb->dev))
  393. goto normal;
  394. gro_list_prepare(&gro_list->list, skb);
  395. rcu_read_lock();
  396. list_for_each_entry_rcu(ptype, head, list) {
  397. if (ptype->type == type && ptype->callbacks.gro_receive)
  398. goto found_ptype;
  399. }
  400. rcu_read_unlock();
  401. goto normal;
  402. found_ptype:
  403. skb_set_network_header(skb, skb_gro_offset(skb));
  404. skb_reset_mac_len(skb);
  405. BUILD_BUG_ON(sizeof_field(struct napi_gro_cb, zeroed) != sizeof(u32));
  406. BUILD_BUG_ON(!IS_ALIGNED(offsetof(struct napi_gro_cb, zeroed),
  407. sizeof(u32))); /* Avoid slow unaligned acc */
  408. *(u32 *)&NAPI_GRO_CB(skb)->zeroed = 0;
  409. NAPI_GRO_CB(skb)->flush = skb_has_frag_list(skb);
  410. NAPI_GRO_CB(skb)->count = 1;
  411. if (unlikely(skb_is_gso(skb))) {
  412. NAPI_GRO_CB(skb)->count = skb_shinfo(skb)->gso_segs;
  413. /* Only support TCP and non DODGY users. */
  414. if (!skb_is_gso_tcp(skb) ||
  415. (skb_shinfo(skb)->gso_type & SKB_GSO_DODGY))
  416. NAPI_GRO_CB(skb)->flush = 1;
  417. }
  418. /* Setup for GRO checksum validation */
  419. switch (skb->ip_summed) {
  420. case CHECKSUM_COMPLETE:
  421. NAPI_GRO_CB(skb)->csum = skb->csum;
  422. NAPI_GRO_CB(skb)->csum_valid = 1;
  423. break;
  424. case CHECKSUM_UNNECESSARY:
  425. NAPI_GRO_CB(skb)->csum_cnt = skb->csum_level + 1;
  426. break;
  427. }
  428. pp = INDIRECT_CALL_INET(ptype->callbacks.gro_receive,
  429. ipv6_gro_receive, inet_gro_receive,
  430. &gro_list->list, skb);
  431. rcu_read_unlock();
  432. if (PTR_ERR(pp) == -EINPROGRESS) {
  433. ret = GRO_CONSUMED;
  434. goto ok;
  435. }
  436. same_flow = NAPI_GRO_CB(skb)->same_flow;
  437. ret = NAPI_GRO_CB(skb)->free ? GRO_MERGED_FREE : GRO_MERGED;
  438. if (pp) {
  439. skb_list_del_init(pp);
  440. gro_complete(gro, pp);
  441. gro_list->count--;
  442. }
  443. if (same_flow)
  444. goto ok;
  445. if (NAPI_GRO_CB(skb)->flush)
  446. goto normal;
  447. if (unlikely(gro_list->count >= MAX_GRO_SKBS))
  448. gro_flush_oldest(gro, &gro_list->list);
  449. else
  450. gro_list->count++;
  451. /* Must be called before setting NAPI_GRO_CB(skb)->{age|last} */
  452. gro_try_pull_from_frag0(skb);
  453. NAPI_GRO_CB(skb)->age = jiffies;
  454. NAPI_GRO_CB(skb)->last = skb;
  455. if (!skb_is_gso(skb))
  456. skb_shinfo(skb)->gso_size = skb_gro_len(skb);
  457. list_add(&skb->list, &gro_list->list);
  458. ret = GRO_HELD;
  459. ok:
  460. if (gro_list->count) {
  461. if (!test_bit(bucket, &gro->bitmask))
  462. __set_bit(bucket, &gro->bitmask);
  463. } else if (test_bit(bucket, &gro->bitmask)) {
  464. __clear_bit(bucket, &gro->bitmask);
  465. }
  466. return ret;
  467. normal:
  468. ret = GRO_NORMAL;
  469. gro_try_pull_from_frag0(skb);
  470. goto ok;
  471. }
  472. struct packet_offload *gro_find_receive_by_type(__be16 type)
  473. {
  474. struct list_head *offload_head = &net_hotdata.offload_base;
  475. struct packet_offload *ptype;
  476. list_for_each_entry_rcu(ptype, offload_head, list) {
  477. if (ptype->type != type || !ptype->callbacks.gro_receive)
  478. continue;
  479. return ptype;
  480. }
  481. return NULL;
  482. }
  483. EXPORT_SYMBOL(gro_find_receive_by_type);
  484. struct packet_offload *gro_find_complete_by_type(__be16 type)
  485. {
  486. struct list_head *offload_head = &net_hotdata.offload_base;
  487. struct packet_offload *ptype;
  488. list_for_each_entry_rcu(ptype, offload_head, list) {
  489. if (ptype->type != type || !ptype->callbacks.gro_complete)
  490. continue;
  491. return ptype;
  492. }
  493. return NULL;
  494. }
  495. EXPORT_SYMBOL(gro_find_complete_by_type);
  496. static gro_result_t gro_skb_finish(struct gro_node *gro, struct sk_buff *skb,
  497. gro_result_t ret)
  498. {
  499. switch (ret) {
  500. case GRO_NORMAL:
  501. gro_normal_one(gro, skb, 1);
  502. break;
  503. case GRO_MERGED_FREE:
  504. if (NAPI_GRO_CB(skb)->free == NAPI_GRO_FREE_STOLEN_HEAD)
  505. napi_skb_free_stolen_head(skb);
  506. else if (skb->fclone != SKB_FCLONE_UNAVAILABLE)
  507. __kfree_skb(skb);
  508. else
  509. __napi_kfree_skb(skb, SKB_CONSUMED);
  510. break;
  511. case GRO_HELD:
  512. case GRO_MERGED:
  513. case GRO_CONSUMED:
  514. break;
  515. }
  516. return ret;
  517. }
  518. gro_result_t gro_receive_skb(struct gro_node *gro, struct sk_buff *skb)
  519. {
  520. gro_result_t ret;
  521. __skb_mark_napi_id(skb, gro);
  522. trace_napi_gro_receive_entry(skb);
  523. skb_gro_reset_offset(skb, 0);
  524. ret = gro_skb_finish(gro, skb, dev_gro_receive(gro, skb));
  525. trace_napi_gro_receive_exit(ret);
  526. return ret;
  527. }
  528. EXPORT_SYMBOL(gro_receive_skb);
  529. static void napi_reuse_skb(struct napi_struct *napi, struct sk_buff *skb)
  530. {
  531. struct skb_shared_info *shinfo;
  532. if (unlikely(skb->pfmemalloc)) {
  533. consume_skb(skb);
  534. return;
  535. }
  536. __skb_pull(skb, skb_headlen(skb));
  537. /* restore the reserve we had after netdev_alloc_skb_ip_align() */
  538. skb_reserve(skb, NET_SKB_PAD + NET_IP_ALIGN - skb_headroom(skb));
  539. __vlan_hwaccel_clear_tag(skb);
  540. skb->dev = napi->dev;
  541. skb->skb_iif = 0;
  542. /* eth_type_trans() assumes pkt_type is PACKET_HOST */
  543. skb->pkt_type = PACKET_HOST;
  544. skb->encapsulation = 0;
  545. skb->ip_summed = CHECKSUM_NONE;
  546. shinfo = skb_shinfo(skb);
  547. shinfo->gso_type = 0;
  548. shinfo->gso_size = 0;
  549. shinfo->hwtstamps.hwtstamp = 0;
  550. if (unlikely(skb->slow_gro)) {
  551. skb_orphan(skb);
  552. skb_ext_reset(skb);
  553. nf_reset_ct(skb);
  554. skb->slow_gro = 0;
  555. }
  556. napi->skb = skb;
  557. }
  558. struct sk_buff *napi_get_frags(struct napi_struct *napi)
  559. {
  560. struct sk_buff *skb = napi->skb;
  561. if (!skb) {
  562. skb = napi_alloc_skb(napi, GRO_MAX_HEAD);
  563. if (skb) {
  564. napi->skb = skb;
  565. skb_mark_napi_id(skb, napi);
  566. }
  567. }
  568. return skb;
  569. }
  570. EXPORT_SYMBOL(napi_get_frags);
  571. static gro_result_t napi_frags_finish(struct napi_struct *napi,
  572. struct sk_buff *skb,
  573. gro_result_t ret)
  574. {
  575. switch (ret) {
  576. case GRO_NORMAL:
  577. case GRO_HELD:
  578. __skb_push(skb, ETH_HLEN);
  579. skb->protocol = eth_type_trans(skb, skb->dev);
  580. if (ret == GRO_NORMAL)
  581. gro_normal_one(&napi->gro, skb, 1);
  582. break;
  583. case GRO_MERGED_FREE:
  584. if (NAPI_GRO_CB(skb)->free == NAPI_GRO_FREE_STOLEN_HEAD)
  585. napi_skb_free_stolen_head(skb);
  586. else
  587. napi_reuse_skb(napi, skb);
  588. break;
  589. case GRO_MERGED:
  590. case GRO_CONSUMED:
  591. break;
  592. }
  593. return ret;
  594. }
  595. /* Upper GRO stack assumes network header starts at gro_offset=0
  596. * Drivers could call both napi_gro_frags() and napi_gro_receive()
  597. * We copy ethernet header into skb->data to have a common layout.
  598. */
  599. static struct sk_buff *napi_frags_skb(struct napi_struct *napi)
  600. {
  601. struct sk_buff *skb = napi->skb;
  602. const struct ethhdr *eth;
  603. unsigned int hlen = sizeof(*eth);
  604. napi->skb = NULL;
  605. skb_reset_mac_header(skb);
  606. skb_gro_reset_offset(skb, hlen);
  607. if (unlikely(!skb_gro_may_pull(skb, hlen))) {
  608. eth = skb_gro_header_slow(skb, hlen, 0);
  609. if (unlikely(!eth)) {
  610. net_warn_ratelimited("%s: dropping impossible skb from %s\n",
  611. __func__, napi->dev->name);
  612. napi_reuse_skb(napi, skb);
  613. return NULL;
  614. }
  615. } else {
  616. eth = (const struct ethhdr *)skb->data;
  617. if (NAPI_GRO_CB(skb)->frag0 != skb->data)
  618. gro_pull_from_frag0(skb, hlen);
  619. NAPI_GRO_CB(skb)->frag0 += hlen;
  620. NAPI_GRO_CB(skb)->frag0_len -= hlen;
  621. }
  622. __skb_pull(skb, hlen);
  623. /*
  624. * This works because the only protocols we care about don't require
  625. * special handling.
  626. * We'll fix it up properly in napi_frags_finish()
  627. */
  628. skb->protocol = eth->h_proto;
  629. return skb;
  630. }
  631. gro_result_t napi_gro_frags(struct napi_struct *napi)
  632. {
  633. gro_result_t ret;
  634. struct sk_buff *skb = napi_frags_skb(napi);
  635. trace_napi_gro_frags_entry(skb);
  636. ret = napi_frags_finish(napi, skb, dev_gro_receive(&napi->gro, skb));
  637. trace_napi_gro_frags_exit(ret);
  638. return ret;
  639. }
  640. EXPORT_SYMBOL(napi_gro_frags);
  641. /* Compute the checksum from gro_offset and return the folded value
  642. * after adding in any pseudo checksum.
  643. */
  644. __sum16 __skb_gro_checksum_complete(struct sk_buff *skb)
  645. {
  646. __wsum wsum;
  647. __sum16 sum;
  648. wsum = skb_checksum(skb, skb_gro_offset(skb), skb_gro_len(skb), 0);
  649. /* NAPI_GRO_CB(skb)->csum holds pseudo checksum */
  650. sum = csum_fold(csum_add(NAPI_GRO_CB(skb)->csum, wsum));
  651. /* See comments in __skb_checksum_complete(). */
  652. if (likely(!sum)) {
  653. if (unlikely(skb->ip_summed == CHECKSUM_COMPLETE) &&
  654. !skb->csum_complete_sw)
  655. netdev_rx_csum_fault(skb->dev, skb);
  656. }
  657. NAPI_GRO_CB(skb)->csum = wsum;
  658. NAPI_GRO_CB(skb)->csum_valid = 1;
  659. return sum;
  660. }
  661. EXPORT_SYMBOL(__skb_gro_checksum_complete);
  662. void gro_init(struct gro_node *gro)
  663. {
  664. for (u32 i = 0; i < GRO_HASH_BUCKETS; i++) {
  665. INIT_LIST_HEAD(&gro->hash[i].list);
  666. gro->hash[i].count = 0;
  667. }
  668. gro->bitmask = 0;
  669. gro->cached_napi_id = 0;
  670. INIT_LIST_HEAD(&gro->rx_list);
  671. gro->rx_count = 0;
  672. }
  673. void gro_cleanup(struct gro_node *gro)
  674. {
  675. struct sk_buff *skb, *n;
  676. for (u32 i = 0; i < GRO_HASH_BUCKETS; i++) {
  677. list_for_each_entry_safe(skb, n, &gro->hash[i].list, list)
  678. kfree_skb(skb);
  679. gro->hash[i].count = 0;
  680. }
  681. gro->bitmask = 0;
  682. gro->cached_napi_id = 0;
  683. list_for_each_entry_safe(skb, n, &gro->rx_list, list)
  684. kfree_skb(skb);
  685. gro->rx_count = 0;
  686. }