ip6_checksum.c 3.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116
  1. // SPDX-License-Identifier: GPL-2.0
  2. #include <net/ip.h>
  3. #include <net/udp.h>
  4. #include <net/udplite.h>
  5. #include <asm/checksum.h>
  6. #ifndef _HAVE_ARCH_IPV6_CSUM
  7. __sum16 csum_ipv6_magic(const struct in6_addr *saddr,
  8. const struct in6_addr *daddr,
  9. __u32 len, __u8 proto, __wsum csum)
  10. {
  11. int carry;
  12. __u32 ulen;
  13. __u32 uproto;
  14. __u32 sum = (__force u32)csum;
  15. sum += (__force u32)saddr->s6_addr32[0];
  16. carry = (sum < (__force u32)saddr->s6_addr32[0]);
  17. sum += carry;
  18. sum += (__force u32)saddr->s6_addr32[1];
  19. carry = (sum < (__force u32)saddr->s6_addr32[1]);
  20. sum += carry;
  21. sum += (__force u32)saddr->s6_addr32[2];
  22. carry = (sum < (__force u32)saddr->s6_addr32[2]);
  23. sum += carry;
  24. sum += (__force u32)saddr->s6_addr32[3];
  25. carry = (sum < (__force u32)saddr->s6_addr32[3]);
  26. sum += carry;
  27. sum += (__force u32)daddr->s6_addr32[0];
  28. carry = (sum < (__force u32)daddr->s6_addr32[0]);
  29. sum += carry;
  30. sum += (__force u32)daddr->s6_addr32[1];
  31. carry = (sum < (__force u32)daddr->s6_addr32[1]);
  32. sum += carry;
  33. sum += (__force u32)daddr->s6_addr32[2];
  34. carry = (sum < (__force u32)daddr->s6_addr32[2]);
  35. sum += carry;
  36. sum += (__force u32)daddr->s6_addr32[3];
  37. carry = (sum < (__force u32)daddr->s6_addr32[3]);
  38. sum += carry;
  39. ulen = (__force u32)htonl((__u32) len);
  40. sum += ulen;
  41. carry = (sum < ulen);
  42. sum += carry;
  43. uproto = (__force u32)htonl(proto);
  44. sum += uproto;
  45. carry = (sum < uproto);
  46. sum += carry;
  47. return csum_fold((__force __wsum)sum);
  48. }
  49. EXPORT_SYMBOL(csum_ipv6_magic);
  50. #endif
  51. int udp6_csum_init(struct sk_buff *skb, struct udphdr *uh, int proto)
  52. {
  53. int err;
  54. UDP_SKB_CB(skb)->partial_cov = 0;
  55. UDP_SKB_CB(skb)->cscov = skb->len;
  56. if (proto == IPPROTO_UDPLITE) {
  57. err = udplite_checksum_init(skb, uh);
  58. if (err)
  59. return err;
  60. }
  61. /* To support RFC 6936 (allow zero checksum in UDP/IPV6 for tunnels)
  62. * we accept a checksum of zero here. When we find the socket
  63. * for the UDP packet we'll check if that socket allows zero checksum
  64. * for IPv6 (set by socket option).
  65. *
  66. * Note, we are only interested in != 0 or == 0, thus the
  67. * force to int.
  68. */
  69. return (__force int)skb_checksum_init_zero_check(skb, proto, uh->check,
  70. ip6_compute_pseudo);
  71. }
  72. EXPORT_SYMBOL(udp6_csum_init);
  73. /* Function to set UDP checksum for an IPv6 UDP packet. This is intended
  74. * for the simple case like when setting the checksum for a UDP tunnel.
  75. */
  76. void udp6_set_csum(bool nocheck, struct sk_buff *skb,
  77. const struct in6_addr *saddr,
  78. const struct in6_addr *daddr, int len)
  79. {
  80. struct udphdr *uh = udp_hdr(skb);
  81. if (nocheck)
  82. uh->check = 0;
  83. else if (skb_is_gso(skb))
  84. uh->check = ~udp_v6_check(len, saddr, daddr, 0);
  85. else if (skb->ip_summed == CHECKSUM_PARTIAL) {
  86. uh->check = 0;
  87. uh->check = udp_v6_check(len, saddr, daddr, lco_csum(skb));
  88. if (uh->check == 0)
  89. uh->check = CSUM_MANGLED_0;
  90. } else {
  91. skb->ip_summed = CHECKSUM_PARTIAL;
  92. skb->csum_start = skb_transport_header(skb) - skb->head;
  93. skb->csum_offset = offsetof(struct udphdr, check);
  94. uh->check = ~udp_v6_check(len, saddr, daddr, 0);
  95. }
  96. }
  97. EXPORT_SYMBOL(udp6_set_csum);