net_utils.c 2.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * Generic network code. Moved from net.c
  4. *
  5. * Copyright 1994 - 2000 Neil Russell.
  6. * Copyright 2000 Roland Borde
  7. * Copyright 2000 Paolo Scaffardi
  8. * Copyright 2000-2002 Wolfgang Denk, wd@denx.de
  9. * Copyright 2009 Dirk Behme, dirk.behme@googlemail.com
  10. */
  11. #include <common.h>
  12. #include <net.h>
  13. struct in_addr string_to_ip(const char *s)
  14. {
  15. struct in_addr addr;
  16. char *e;
  17. int i;
  18. addr.s_addr = 0;
  19. if (s == NULL)
  20. return addr;
  21. for (addr.s_addr = 0, i = 0; i < 4; ++i) {
  22. ulong val = s ? simple_strtoul(s, &e, 10) : 0;
  23. if (val > 255) {
  24. addr.s_addr = 0;
  25. return addr;
  26. }
  27. if (i != 3 && *e != '.') {
  28. addr.s_addr = 0;
  29. return addr;
  30. }
  31. addr.s_addr <<= 8;
  32. addr.s_addr |= (val & 0xFF);
  33. if (s) {
  34. s = (*e) ? e+1 : e;
  35. }
  36. }
  37. addr.s_addr = htonl(addr.s_addr);
  38. return addr;
  39. }
  40. void string_to_enetaddr(const char *addr, uint8_t *enetaddr)
  41. {
  42. char *end;
  43. int i;
  44. if (!enetaddr)
  45. return;
  46. for (i = 0; i < 6; ++i) {
  47. enetaddr[i] = addr ? simple_strtoul(addr, &end, 16) : 0;
  48. if (addr)
  49. addr = (*end) ? end + 1 : end;
  50. }
  51. }
  52. uint compute_ip_checksum(const void *vptr, uint nbytes)
  53. {
  54. int sum, oddbyte;
  55. const unsigned short *ptr = vptr;
  56. sum = 0;
  57. while (nbytes > 1) {
  58. sum += *ptr++;
  59. nbytes -= 2;
  60. }
  61. if (nbytes == 1) {
  62. oddbyte = 0;
  63. ((u8 *)&oddbyte)[0] = *(u8 *)ptr;
  64. ((u8 *)&oddbyte)[1] = 0;
  65. sum += oddbyte;
  66. }
  67. sum = (sum >> 16) + (sum & 0xffff);
  68. sum += (sum >> 16);
  69. sum = ~sum & 0xffff;
  70. return sum;
  71. }
  72. uint add_ip_checksums(uint offset, uint sum, uint new)
  73. {
  74. ulong checksum;
  75. sum = ~sum & 0xffff;
  76. new = ~new & 0xffff;
  77. if (offset & 1) {
  78. /*
  79. * byte-swap the sum if it came from an odd offset; since the
  80. * computation is endian-independent this works.
  81. */
  82. new = ((new >> 8) & 0xff) | ((new << 8) & 0xff00);
  83. }
  84. checksum = sum + new;
  85. if (checksum > 0xffff)
  86. checksum -= 0xffff;
  87. return (~checksum) & 0xffff;
  88. }
  89. int ip_checksum_ok(const void *addr, uint nbytes)
  90. {
  91. return !(compute_ip_checksum(addr, nbytes) & 0xfffe);
  92. }