net_utils.c 2.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106
  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. struct in_addr string_to_ip(const char *s)
  13. {
  14. struct in_addr addr;
  15. char *e;
  16. int i;
  17. addr.s_addr = 0;
  18. if (s == NULL)
  19. return addr;
  20. for (addr.s_addr = 0, i = 0; i < 4; ++i) {
  21. ulong val = s ? simple_strtoul(s, &e, 10) : 0;
  22. if (val > 255) {
  23. addr.s_addr = 0;
  24. return addr;
  25. }
  26. if (i != 3 && *e != '.') {
  27. addr.s_addr = 0;
  28. return addr;
  29. }
  30. addr.s_addr <<= 8;
  31. addr.s_addr |= (val & 0xFF);
  32. if (s) {
  33. s = (*e) ? e+1 : e;
  34. }
  35. }
  36. addr.s_addr = htonl(addr.s_addr);
  37. return addr;
  38. }
  39. void string_to_enetaddr(const char *addr, uint8_t *enetaddr)
  40. {
  41. char *end;
  42. int i;
  43. if (!enetaddr)
  44. return;
  45. for (i = 0; i < 6; ++i) {
  46. enetaddr[i] = addr ? simple_strtoul(addr, &end, 16) : 0;
  47. if (addr)
  48. addr = (*end) ? end + 1 : end;
  49. }
  50. }
  51. uint compute_ip_checksum(const void *vptr, uint nbytes)
  52. {
  53. int sum, oddbyte;
  54. const unsigned short *ptr = vptr;
  55. sum = 0;
  56. while (nbytes > 1) {
  57. sum += *ptr++;
  58. nbytes -= 2;
  59. }
  60. if (nbytes == 1) {
  61. oddbyte = 0;
  62. ((u8 *)&oddbyte)[0] = *(u8 *)ptr;
  63. ((u8 *)&oddbyte)[1] = 0;
  64. sum += oddbyte;
  65. }
  66. sum = (sum >> 16) + (sum & 0xffff);
  67. sum += (sum >> 16);
  68. sum = ~sum & 0xffff;
  69. return sum;
  70. }
  71. uint add_ip_checksums(uint offset, uint sum, uint new)
  72. {
  73. ulong checksum;
  74. sum = ~sum & 0xffff;
  75. new = ~new & 0xffff;
  76. if (offset & 1) {
  77. /*
  78. * byte-swap the sum if it came from an odd offset; since the
  79. * computation is endian-independent this works.
  80. */
  81. new = ((new >> 8) & 0xff) | ((new << 8) & 0xff00);
  82. }
  83. checksum = sum + new;
  84. if (checksum > 0xffff)
  85. checksum -= 0xffff;
  86. return (~checksum) & 0xffff;
  87. }
  88. int ip_checksum_ok(const void *addr, uint nbytes)
  89. {
  90. return !(compute_ip_checksum(addr, nbytes) & 0xfffe);
  91. }