PageRenderTime 43ms CodeModel.GetById 16ms RepoModel.GetById 0ms app.codeStats 1ms

/net/core/datagram.c

https://gitlab.com/webhaikal/SenseiOneplus3
C | 884 lines | 581 code | 102 blank | 201 comment | 130 complexity | cf043de8254ef22a3af745b19b07c01c MD5 | raw file
  1. /*
  2. * SUCS NET3:
  3. *
  4. * Generic datagram handling routines. These are generic for all
  5. * protocols. Possibly a generic IP version on top of these would
  6. * make sense. Not tonight however 8-).
  7. * This is used because UDP, RAW, PACKET, DDP, IPX, AX.25 and
  8. * NetROM layer all have identical poll code and mostly
  9. * identical recvmsg() code. So we share it here. The poll was
  10. * shared before but buried in udp.c so I moved it.
  11. *
  12. * Authors: Alan Cox <alan@lxorguk.ukuu.org.uk>. (datagram_poll() from old
  13. * udp.c code)
  14. *
  15. * Fixes:
  16. * Alan Cox : NULL return from skb_peek_copy()
  17. * understood
  18. * Alan Cox : Rewrote skb_read_datagram to avoid the
  19. * skb_peek_copy stuff.
  20. * Alan Cox : Added support for SOCK_SEQPACKET.
  21. * IPX can no longer use the SO_TYPE hack
  22. * but AX.25 now works right, and SPX is
  23. * feasible.
  24. * Alan Cox : Fixed write poll of non IP protocol
  25. * crash.
  26. * Florian La Roche: Changed for my new skbuff handling.
  27. * Darryl Miles : Fixed non-blocking SOCK_SEQPACKET.
  28. * Linus Torvalds : BSD semantic fixes.
  29. * Alan Cox : Datagram iovec handling
  30. * Darryl Miles : Fixed non-blocking SOCK_STREAM.
  31. * Alan Cox : POSIXisms
  32. * Pete Wyckoff : Unconnected accept() fix.
  33. *
  34. */
  35. #include <linux/module.h>
  36. #include <linux/types.h>
  37. #include <linux/kernel.h>
  38. #include <asm/uaccess.h>
  39. #include <linux/mm.h>
  40. #include <linux/interrupt.h>
  41. #include <linux/errno.h>
  42. #include <linux/sched.h>
  43. #include <linux/inet.h>
  44. #include <linux/netdevice.h>
  45. #include <linux/rtnetlink.h>
  46. #include <linux/poll.h>
  47. #include <linux/highmem.h>
  48. #include <linux/spinlock.h>
  49. #include <linux/slab.h>
  50. #include <linux/pagemap.h>
  51. #include <net/protocol.h>
  52. #include <linux/skbuff.h>
  53. #include <net/checksum.h>
  54. #include <net/sock.h>
  55. #include <net/tcp_states.h>
  56. #include <trace/events/skb.h>
  57. #include <net/busy_poll.h>
  58. /*
  59. * Is a socket 'connection oriented' ?
  60. */
  61. static inline int connection_based(struct sock *sk)
  62. {
  63. return sk->sk_type == SOCK_SEQPACKET || sk->sk_type == SOCK_STREAM;
  64. }
  65. static int receiver_wake_function(wait_queue_t *wait, unsigned int mode, int sync,
  66. void *key)
  67. {
  68. unsigned long bits = (unsigned long)key;
  69. /*
  70. * Avoid a wakeup if event not interesting for us
  71. */
  72. if (bits && !(bits & (POLLIN | POLLERR)))
  73. return 0;
  74. return autoremove_wake_function(wait, mode, sync, key);
  75. }
  76. /*
  77. * Wait for the last received packet to be different from skb
  78. */
  79. static int wait_for_more_packets(struct sock *sk, int *err, long *timeo_p,
  80. const struct sk_buff *skb)
  81. {
  82. int error;
  83. DEFINE_WAIT_FUNC(wait, receiver_wake_function);
  84. prepare_to_wait_exclusive(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
  85. /* Socket errors? */
  86. error = sock_error(sk);
  87. if (error)
  88. goto out_err;
  89. if (sk->sk_receive_queue.prev != skb)
  90. goto out;
  91. /* Socket shut down? */
  92. if (sk->sk_shutdown & RCV_SHUTDOWN)
  93. goto out_noerr;
  94. /* Sequenced packets can come disconnected.
  95. * If so we report the problem
  96. */
  97. error = -ENOTCONN;
  98. if (connection_based(sk) &&
  99. !(sk->sk_state == TCP_ESTABLISHED || sk->sk_state == TCP_LISTEN))
  100. goto out_err;
  101. /* handle signals */
  102. if (signal_pending(current))
  103. goto interrupted;
  104. error = 0;
  105. *timeo_p = schedule_timeout(*timeo_p);
  106. out:
  107. finish_wait(sk_sleep(sk), &wait);
  108. return error;
  109. interrupted:
  110. error = sock_intr_errno(*timeo_p);
  111. out_err:
  112. *err = error;
  113. goto out;
  114. out_noerr:
  115. *err = 0;
  116. error = 1;
  117. goto out;
  118. }
  119. /**
  120. * __skb_recv_datagram - Receive a datagram skbuff
  121. * @sk: socket
  122. * @flags: MSG_ flags
  123. * @peeked: returns non-zero if this packet has been seen before
  124. * @off: an offset in bytes to peek skb from. Returns an offset
  125. * within an skb where data actually starts
  126. * @err: error code returned
  127. *
  128. * Get a datagram skbuff, understands the peeking, nonblocking wakeups
  129. * and possible races. This replaces identical code in packet, raw and
  130. * udp, as well as the IPX AX.25 and Appletalk. It also finally fixes
  131. * the long standing peek and read race for datagram sockets. If you
  132. * alter this routine remember it must be re-entrant.
  133. *
  134. * This function will lock the socket if a skb is returned, so the caller
  135. * needs to unlock the socket in that case (usually by calling
  136. * skb_free_datagram)
  137. *
  138. * * It does not lock socket since today. This function is
  139. * * free of race conditions. This measure should/can improve
  140. * * significantly datagram socket latencies at high loads,
  141. * * when data copying to user space takes lots of time.
  142. * * (BTW I've just killed the last cli() in IP/IPv6/core/netlink/packet
  143. * * 8) Great win.)
  144. * * --ANK (980729)
  145. *
  146. * The order of the tests when we find no data waiting are specified
  147. * quite explicitly by POSIX 1003.1g, don't change them without having
  148. * the standard around please.
  149. */
  150. struct sk_buff *__skb_recv_datagram(struct sock *sk, unsigned int flags,
  151. int *peeked, int *off, int *err)
  152. {
  153. struct sk_buff *skb, *last;
  154. long timeo;
  155. /*
  156. * Caller is allowed not to check sk->sk_err before skb_recv_datagram()
  157. */
  158. int error = sock_error(sk);
  159. if (error)
  160. goto no_packet;
  161. timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
  162. do {
  163. /* Again only user level code calls this function, so nothing
  164. * interrupt level will suddenly eat the receive_queue.
  165. *
  166. * Look at current nfs client by the way...
  167. * However, this function was correct in any case. 8)
  168. */
  169. unsigned long cpu_flags;
  170. struct sk_buff_head *queue = &sk->sk_receive_queue;
  171. int _off = *off;
  172. last = (struct sk_buff *)queue;
  173. spin_lock_irqsave(&queue->lock, cpu_flags);
  174. skb_queue_walk(queue, skb) {
  175. last = skb;
  176. *peeked = skb->peeked;
  177. if (flags & MSG_PEEK) {
  178. if (_off >= skb->len && (skb->len || _off ||
  179. skb->peeked)) {
  180. _off -= skb->len;
  181. continue;
  182. }
  183. skb->peeked = 1;
  184. atomic_inc(&skb->users);
  185. } else
  186. __skb_unlink(skb, queue);
  187. spin_unlock_irqrestore(&queue->lock, cpu_flags);
  188. *off = _off;
  189. return skb;
  190. }
  191. spin_unlock_irqrestore(&queue->lock, cpu_flags);
  192. if (sk_can_busy_loop(sk) &&
  193. sk_busy_loop(sk, flags & MSG_DONTWAIT))
  194. continue;
  195. /* User doesn't want to wait */
  196. error = -EAGAIN;
  197. if (!timeo)
  198. goto no_packet;
  199. } while (!wait_for_more_packets(sk, err, &timeo, last));
  200. return NULL;
  201. no_packet:
  202. *err = error;
  203. return NULL;
  204. }
  205. EXPORT_SYMBOL(__skb_recv_datagram);
  206. struct sk_buff *skb_recv_datagram(struct sock *sk, unsigned int flags,
  207. int noblock, int *err)
  208. {
  209. int peeked, off = 0;
  210. return __skb_recv_datagram(sk, flags | (noblock ? MSG_DONTWAIT : 0),
  211. &peeked, &off, err);
  212. }
  213. EXPORT_SYMBOL(skb_recv_datagram);
  214. void skb_free_datagram(struct sock *sk, struct sk_buff *skb)
  215. {
  216. consume_skb(skb);
  217. sk_mem_reclaim_partial(sk);
  218. }
  219. EXPORT_SYMBOL(skb_free_datagram);
  220. void skb_free_datagram_locked(struct sock *sk, struct sk_buff *skb)
  221. {
  222. bool slow;
  223. if (likely(atomic_read(&skb->users) == 1))
  224. smp_rmb();
  225. else if (likely(!atomic_dec_and_test(&skb->users)))
  226. return;
  227. slow = lock_sock_fast(sk);
  228. skb_orphan(skb);
  229. sk_mem_reclaim_partial(sk);
  230. unlock_sock_fast(sk, slow);
  231. /* skb is now orphaned, can be freed outside of locked section */
  232. __kfree_skb(skb);
  233. }
  234. EXPORT_SYMBOL(skb_free_datagram_locked);
  235. /**
  236. * skb_kill_datagram - Free a datagram skbuff forcibly
  237. * @sk: socket
  238. * @skb: datagram skbuff
  239. * @flags: MSG_ flags
  240. *
  241. * This function frees a datagram skbuff that was received by
  242. * skb_recv_datagram. The flags argument must match the one
  243. * used for skb_recv_datagram.
  244. *
  245. * If the MSG_PEEK flag is set, and the packet is still on the
  246. * receive queue of the socket, it will be taken off the queue
  247. * before it is freed.
  248. *
  249. * This function currently only disables BH when acquiring the
  250. * sk_receive_queue lock. Therefore it must not be used in a
  251. * context where that lock is acquired in an IRQ context.
  252. *
  253. * It returns 0 if the packet was removed by us.
  254. */
  255. int skb_kill_datagram(struct sock *sk, struct sk_buff *skb, unsigned int flags)
  256. {
  257. int err = 0;
  258. if (flags & MSG_PEEK) {
  259. err = -ENOENT;
  260. spin_lock_bh(&sk->sk_receive_queue.lock);
  261. if (skb == skb_peek(&sk->sk_receive_queue)) {
  262. __skb_unlink(skb, &sk->sk_receive_queue);
  263. atomic_dec(&skb->users);
  264. err = 0;
  265. }
  266. spin_unlock_bh(&sk->sk_receive_queue.lock);
  267. }
  268. kfree_skb(skb);
  269. atomic_inc(&sk->sk_drops);
  270. sk_mem_reclaim_partial(sk);
  271. return err;
  272. }
  273. EXPORT_SYMBOL(skb_kill_datagram);
  274. /**
  275. * skb_copy_datagram_iovec - Copy a datagram to an iovec.
  276. * @skb: buffer to copy
  277. * @offset: offset in the buffer to start copying from
  278. * @to: io vector to copy to
  279. * @len: amount of data to copy from buffer to iovec
  280. *
  281. * Note: the iovec is modified during the copy.
  282. */
  283. int skb_copy_datagram_iovec(const struct sk_buff *skb, int offset,
  284. struct iovec *to, int len)
  285. {
  286. int start = skb_headlen(skb);
  287. int i, copy = start - offset;
  288. struct sk_buff *frag_iter;
  289. trace_skb_copy_datagram_iovec(skb, len);
  290. /* Copy header. */
  291. if (copy > 0) {
  292. if (copy > len)
  293. copy = len;
  294. if (memcpy_toiovec(to, skb->data + offset, copy))
  295. goto fault;
  296. if ((len -= copy) == 0)
  297. return 0;
  298. offset += copy;
  299. }
  300. /* Copy paged appendix. Hmm... why does this look so complicated? */
  301. for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
  302. int end;
  303. const skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
  304. WARN_ON(start > offset + len);
  305. end = start + skb_frag_size(frag);
  306. if ((copy = end - offset) > 0) {
  307. int err;
  308. u8 *vaddr;
  309. struct page *page = skb_frag_page(frag);
  310. if (copy > len)
  311. copy = len;
  312. vaddr = kmap(page);
  313. err = memcpy_toiovec(to, vaddr + frag->page_offset +
  314. offset - start, copy);
  315. kunmap(page);
  316. if (err)
  317. goto fault;
  318. if (!(len -= copy))
  319. return 0;
  320. offset += copy;
  321. }
  322. start = end;
  323. }
  324. skb_walk_frags(skb, frag_iter) {
  325. int end;
  326. WARN_ON(start > offset + len);
  327. end = start + frag_iter->len;
  328. if ((copy = end - offset) > 0) {
  329. if (copy > len)
  330. copy = len;
  331. if (skb_copy_datagram_iovec(frag_iter,
  332. offset - start,
  333. to, copy))
  334. goto fault;
  335. if ((len -= copy) == 0)
  336. return 0;
  337. offset += copy;
  338. }
  339. start = end;
  340. }
  341. if (!len)
  342. return 0;
  343. fault:
  344. return -EFAULT;
  345. }
  346. EXPORT_SYMBOL(skb_copy_datagram_iovec);
  347. /**
  348. * skb_copy_datagram_const_iovec - Copy a datagram to an iovec.
  349. * @skb: buffer to copy
  350. * @offset: offset in the buffer to start copying from
  351. * @to: io vector to copy to
  352. * @to_offset: offset in the io vector to start copying to
  353. * @len: amount of data to copy from buffer to iovec
  354. *
  355. * Returns 0 or -EFAULT.
  356. * Note: the iovec is not modified during the copy.
  357. */
  358. int skb_copy_datagram_const_iovec(const struct sk_buff *skb, int offset,
  359. const struct iovec *to, int to_offset,
  360. int len)
  361. {
  362. int start = skb_headlen(skb);
  363. int i, copy = start - offset;
  364. struct sk_buff *frag_iter;
  365. /* Copy header. */
  366. if (copy > 0) {
  367. if (copy > len)
  368. copy = len;
  369. if (memcpy_toiovecend(to, skb->data + offset, to_offset, copy))
  370. goto fault;
  371. if ((len -= copy) == 0)
  372. return 0;
  373. offset += copy;
  374. to_offset += copy;
  375. }
  376. /* Copy paged appendix. Hmm... why does this look so complicated? */
  377. for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
  378. int end;
  379. const skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
  380. WARN_ON(start > offset + len);
  381. end = start + skb_frag_size(frag);
  382. if ((copy = end - offset) > 0) {
  383. int err;
  384. u8 *vaddr;
  385. struct page *page = skb_frag_page(frag);
  386. if (copy > len)
  387. copy = len;
  388. vaddr = kmap(page);
  389. err = memcpy_toiovecend(to, vaddr + frag->page_offset +
  390. offset - start, to_offset, copy);
  391. kunmap(page);
  392. if (err)
  393. goto fault;
  394. if (!(len -= copy))
  395. return 0;
  396. offset += copy;
  397. to_offset += copy;
  398. }
  399. start = end;
  400. }
  401. skb_walk_frags(skb, frag_iter) {
  402. int end;
  403. WARN_ON(start > offset + len);
  404. end = start + frag_iter->len;
  405. if ((copy = end - offset) > 0) {
  406. if (copy > len)
  407. copy = len;
  408. if (skb_copy_datagram_const_iovec(frag_iter,
  409. offset - start,
  410. to, to_offset,
  411. copy))
  412. goto fault;
  413. if ((len -= copy) == 0)
  414. return 0;
  415. offset += copy;
  416. to_offset += copy;
  417. }
  418. start = end;
  419. }
  420. if (!len)
  421. return 0;
  422. fault:
  423. return -EFAULT;
  424. }
  425. EXPORT_SYMBOL(skb_copy_datagram_const_iovec);
  426. /**
  427. * skb_copy_datagram_from_iovec - Copy a datagram from an iovec.
  428. * @skb: buffer to copy
  429. * @offset: offset in the buffer to start copying to
  430. * @from: io vector to copy to
  431. * @from_offset: offset in the io vector to start copying from
  432. * @len: amount of data to copy to buffer from iovec
  433. *
  434. * Returns 0 or -EFAULT.
  435. * Note: the iovec is not modified during the copy.
  436. */
  437. int skb_copy_datagram_from_iovec(struct sk_buff *skb, int offset,
  438. const struct iovec *from, int from_offset,
  439. int len)
  440. {
  441. int start = skb_headlen(skb);
  442. int i, copy = start - offset;
  443. struct sk_buff *frag_iter;
  444. /* Copy header. */
  445. if (copy > 0) {
  446. if (copy > len)
  447. copy = len;
  448. if (memcpy_fromiovecend(skb->data + offset, from, from_offset,
  449. copy))
  450. goto fault;
  451. if ((len -= copy) == 0)
  452. return 0;
  453. offset += copy;
  454. from_offset += copy;
  455. }
  456. /* Copy paged appendix. Hmm... why does this look so complicated? */
  457. for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
  458. int end;
  459. const skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
  460. WARN_ON(start > offset + len);
  461. end = start + skb_frag_size(frag);
  462. if ((copy = end - offset) > 0) {
  463. int err;
  464. u8 *vaddr;
  465. struct page *page = skb_frag_page(frag);
  466. if (copy > len)
  467. copy = len;
  468. vaddr = kmap(page);
  469. err = memcpy_fromiovecend(vaddr + frag->page_offset +
  470. offset - start,
  471. from, from_offset, copy);
  472. kunmap(page);
  473. if (err)
  474. goto fault;
  475. if (!(len -= copy))
  476. return 0;
  477. offset += copy;
  478. from_offset += copy;
  479. }
  480. start = end;
  481. }
  482. skb_walk_frags(skb, frag_iter) {
  483. int end;
  484. WARN_ON(start > offset + len);
  485. end = start + frag_iter->len;
  486. if ((copy = end - offset) > 0) {
  487. if (copy > len)
  488. copy = len;
  489. if (skb_copy_datagram_from_iovec(frag_iter,
  490. offset - start,
  491. from,
  492. from_offset,
  493. copy))
  494. goto fault;
  495. if ((len -= copy) == 0)
  496. return 0;
  497. offset += copy;
  498. from_offset += copy;
  499. }
  500. start = end;
  501. }
  502. if (!len)
  503. return 0;
  504. fault:
  505. return -EFAULT;
  506. }
  507. EXPORT_SYMBOL(skb_copy_datagram_from_iovec);
  508. /**
  509. * zerocopy_sg_from_iovec - Build a zerocopy datagram from an iovec
  510. * @skb: buffer to copy
  511. * @from: io vector to copy from
  512. * @offset: offset in the io vector to start copying from
  513. * @count: amount of vectors to copy to buffer from
  514. *
  515. * The function will first copy up to headlen, and then pin the userspace
  516. * pages and build frags through them.
  517. *
  518. * Returns 0, -EFAULT or -EMSGSIZE.
  519. * Note: the iovec is not modified during the copy
  520. */
  521. int zerocopy_sg_from_iovec(struct sk_buff *skb, const struct iovec *from,
  522. int offset, size_t count)
  523. {
  524. int len = iov_length(from, count) - offset;
  525. int copy = min_t(int, skb_headlen(skb), len);
  526. int size;
  527. int i = 0;
  528. /* copy up to skb headlen */
  529. if (skb_copy_datagram_from_iovec(skb, 0, from, offset, copy))
  530. return -EFAULT;
  531. if (len == copy)
  532. return 0;
  533. offset += copy;
  534. while (count--) {
  535. struct page *page[MAX_SKB_FRAGS];
  536. int num_pages;
  537. unsigned long base;
  538. unsigned long truesize;
  539. /* Skip over from offset and copied */
  540. if (offset >= from->iov_len) {
  541. offset -= from->iov_len;
  542. ++from;
  543. continue;
  544. }
  545. len = from->iov_len - offset;
  546. base = (unsigned long)from->iov_base + offset;
  547. size = ((base & ~PAGE_MASK) + len + ~PAGE_MASK) >> PAGE_SHIFT;
  548. if (i + size > MAX_SKB_FRAGS)
  549. return -EMSGSIZE;
  550. num_pages = get_user_pages_fast(base, size, 0, &page[i]);
  551. if (num_pages != size) {
  552. release_pages(&page[i], num_pages, 0);
  553. return -EFAULT;
  554. }
  555. truesize = size * PAGE_SIZE;
  556. skb->data_len += len;
  557. skb->len += len;
  558. skb->truesize += truesize;
  559. atomic_add(truesize, &skb->sk->sk_wmem_alloc);
  560. while (len) {
  561. int off = base & ~PAGE_MASK;
  562. int size = min_t(int, len, PAGE_SIZE - off);
  563. skb_fill_page_desc(skb, i, page[i], off, size);
  564. base += size;
  565. len -= size;
  566. i++;
  567. }
  568. offset = 0;
  569. ++from;
  570. }
  571. return 0;
  572. }
  573. EXPORT_SYMBOL(zerocopy_sg_from_iovec);
  574. static int skb_copy_and_csum_datagram(const struct sk_buff *skb, int offset,
  575. u8 __user *to, int len,
  576. __wsum *csump)
  577. {
  578. int start = skb_headlen(skb);
  579. int i, copy = start - offset;
  580. struct sk_buff *frag_iter;
  581. int pos = 0;
  582. /* Copy header. */
  583. if (copy > 0) {
  584. int err = 0;
  585. if (copy > len)
  586. copy = len;
  587. *csump = csum_and_copy_to_user(skb->data + offset, to, copy,
  588. *csump, &err);
  589. if (err)
  590. goto fault;
  591. if ((len -= copy) == 0)
  592. return 0;
  593. offset += copy;
  594. to += copy;
  595. pos = copy;
  596. }
  597. for (i = 0; i < skb_shinfo(skb)->nr_frags; i++) {
  598. int end;
  599. const skb_frag_t *frag = &skb_shinfo(skb)->frags[i];
  600. WARN_ON(start > offset + len);
  601. end = start + skb_frag_size(frag);
  602. if ((copy = end - offset) > 0) {
  603. __wsum csum2;
  604. int err = 0;
  605. u8 *vaddr;
  606. struct page *page = skb_frag_page(frag);
  607. if (copy > len)
  608. copy = len;
  609. vaddr = kmap(page);
  610. csum2 = csum_and_copy_to_user(vaddr +
  611. frag->page_offset +
  612. offset - start,
  613. to, copy, 0, &err);
  614. kunmap(page);
  615. if (err)
  616. goto fault;
  617. *csump = csum_block_add(*csump, csum2, pos);
  618. if (!(len -= copy))
  619. return 0;
  620. offset += copy;
  621. to += copy;
  622. pos += copy;
  623. }
  624. start = end;
  625. }
  626. skb_walk_frags(skb, frag_iter) {
  627. int end;
  628. WARN_ON(start > offset + len);
  629. end = start + frag_iter->len;
  630. if ((copy = end - offset) > 0) {
  631. __wsum csum2 = 0;
  632. if (copy > len)
  633. copy = len;
  634. if (skb_copy_and_csum_datagram(frag_iter,
  635. offset - start,
  636. to, copy,
  637. &csum2))
  638. goto fault;
  639. *csump = csum_block_add(*csump, csum2, pos);
  640. if ((len -= copy) == 0)
  641. return 0;
  642. offset += copy;
  643. to += copy;
  644. pos += copy;
  645. }
  646. start = end;
  647. }
  648. if (!len)
  649. return 0;
  650. fault:
  651. return -EFAULT;
  652. }
  653. __sum16 __skb_checksum_complete_head(struct sk_buff *skb, int len)
  654. {
  655. __sum16 sum;
  656. sum = csum_fold(skb_checksum(skb, 0, len, skb->csum));
  657. if (likely(!sum)) {
  658. if (unlikely(skb->ip_summed == CHECKSUM_COMPLETE) &&
  659. !skb->csum_complete_sw)
  660. netdev_rx_csum_fault(skb->dev);
  661. }
  662. skb->csum_valid = !sum;
  663. return sum;
  664. }
  665. EXPORT_SYMBOL(__skb_checksum_complete_head);
  666. __sum16 __skb_checksum_complete(struct sk_buff *skb)
  667. {
  668. __wsum csum;
  669. __sum16 sum;
  670. csum = skb_checksum(skb, 0, skb->len, 0);
  671. /* skb->csum holds pseudo checksum */
  672. sum = csum_fold(csum_add(skb->csum, csum));
  673. if (likely(!sum)) {
  674. if (unlikely(skb->ip_summed == CHECKSUM_COMPLETE) &&
  675. !skb->csum_complete_sw)
  676. netdev_rx_csum_fault(skb->dev);
  677. }
  678. /* Save full packet checksum */
  679. skb->csum = csum;
  680. skb->ip_summed = CHECKSUM_COMPLETE;
  681. skb->csum_complete_sw = 1;
  682. skb->csum_valid = !sum;
  683. return sum;
  684. }
  685. EXPORT_SYMBOL(__skb_checksum_complete);
  686. /**
  687. * skb_copy_and_csum_datagram_iovec - Copy and checksum skb to user iovec.
  688. * @skb: skbuff
  689. * @hlen: hardware length
  690. * @iov: io vector
  691. *
  692. * Caller _must_ check that skb will fit to this iovec.
  693. *
  694. * Returns: 0 - success.
  695. * -EINVAL - checksum failure.
  696. * -EFAULT - fault during copy. Beware, in this case iovec
  697. * can be modified!
  698. */
  699. int skb_copy_and_csum_datagram_iovec(struct sk_buff *skb,
  700. int hlen, struct iovec *iov)
  701. {
  702. __wsum csum;
  703. int chunk = skb->len - hlen;
  704. if (!chunk)
  705. return 0;
  706. /* Skip filled elements.
  707. * Pretty silly, look at memcpy_toiovec, though 8)
  708. */
  709. while (!iov->iov_len)
  710. iov++;
  711. if (iov->iov_len < chunk) {
  712. if (__skb_checksum_complete(skb))
  713. goto csum_error;
  714. if (skb_copy_datagram_iovec(skb, hlen, iov, chunk))
  715. goto fault;
  716. } else {
  717. csum = csum_partial(skb->data, hlen, skb->csum);
  718. if (skb_copy_and_csum_datagram(skb, hlen, iov->iov_base,
  719. chunk, &csum))
  720. goto fault;
  721. if (csum_fold(csum))
  722. goto csum_error;
  723. if (unlikely(skb->ip_summed == CHECKSUM_COMPLETE))
  724. netdev_rx_csum_fault(skb->dev);
  725. iov->iov_len -= chunk;
  726. iov->iov_base += chunk;
  727. }
  728. return 0;
  729. csum_error:
  730. return -EINVAL;
  731. fault:
  732. return -EFAULT;
  733. }
  734. EXPORT_SYMBOL(skb_copy_and_csum_datagram_iovec);
  735. /**
  736. * datagram_poll - generic datagram poll
  737. * @file: file struct
  738. * @sock: socket
  739. * @wait: poll table
  740. *
  741. * Datagram poll: Again totally generic. This also handles
  742. * sequenced packet sockets providing the socket receive queue
  743. * is only ever holding data ready to receive.
  744. *
  745. * Note: when you _don't_ use this routine for this protocol,
  746. * and you use a different write policy from sock_writeable()
  747. * then please supply your own write_space callback.
  748. */
  749. unsigned int datagram_poll(struct file *file, struct socket *sock,
  750. poll_table *wait)
  751. {
  752. struct sock *sk = sock->sk;
  753. unsigned int mask;
  754. sock_poll_wait(file, sk_sleep(sk), wait);
  755. mask = 0;
  756. /* exceptional events? */
  757. if (sk->sk_err || !skb_queue_empty(&sk->sk_error_queue))
  758. mask |= POLLERR |
  759. (sock_flag(sk, SOCK_SELECT_ERR_QUEUE) ? POLLPRI : 0);
  760. if (sk->sk_shutdown & RCV_SHUTDOWN)
  761. mask |= POLLRDHUP | POLLIN | POLLRDNORM;
  762. if (sk->sk_shutdown == SHUTDOWN_MASK)
  763. mask |= POLLHUP;
  764. /* readable? */
  765. if (!skb_queue_empty(&sk->sk_receive_queue))
  766. mask |= POLLIN | POLLRDNORM;
  767. /* Connection-based need to check for termination and startup */
  768. if (connection_based(sk)) {
  769. if (sk->sk_state == TCP_CLOSE)
  770. mask |= POLLHUP;
  771. /* connection hasn't started yet? */
  772. if (sk->sk_state == TCP_SYN_SENT)
  773. return mask;
  774. }
  775. /* writable? */
  776. if (sock_writeable(sk))
  777. mask |= POLLOUT | POLLWRNORM | POLLWRBAND;
  778. else
  779. set_bit(SOCK_ASYNC_NOSPACE, &sk->sk_socket->flags);
  780. return mask;
  781. }
  782. EXPORT_SYMBOL(datagram_poll);