PageRenderTime 58ms CodeModel.GetById 34ms RepoModel.GetById 0ms app.codeStats 0ms

/uClinux-dist/user/sendip/ipv6.c

https://bitbucket.org/__wp__/mb-linux-msli
C | 131 lines | 111 code | 11 blank | 9 comment | 11 complexity | 700c446b40c4e8f2b1bc7458830d8739 MD5 | raw file
Possible License(s): AGPL-3.0, GPL-2.0, LGPL-2.0, MPL-2.0, ISC, BSD-3-Clause, LGPL-2.1, MPL-2.0-no-copyleft-exception, 0BSD, CC-BY-SA-3.0, GPL-3.0, LGPL-3.0, AGPL-1.0, Unlicense 
    

  1. /* ipv6.c - sendip IPv6 code
    2. 

  2.  * Taken from code by Antti Tuominen <ajtuomin@tml.hut.fi>
    3. 

  3.  * ChangeLog since 2.0 release:
    4. 

  4.  * 09/08/2002 Setting src/dst now works (Pekka Savola <pekkas@netcore.fi>)
    5. 

  5.  */
    6. 

  6. 

  7. #include <sys/types.h>
    8. 

  8. #include <sys/socket.h>
    9. 

  9. #include <netinet/in.h>
    10. 

  10. #include <netdb.h>
    11. 

  11. #include <arpa/inet.h>
    12. 

  12. #include <stdlib.h>
    13. 

  13. #include <string.h>
    14. 

  14. #include "sendip_module.h"
    15. 

  15. #include "ipv6.h"
    16. 

  16. 

  17. /* Character that identifies our options
    18. 

  18.  */
    19. 

  19. const char opt_char='6';
    20. 

  20. 

  21. sendip_data *initialize(void) {
    22. 

  22. 	sendip_data *ret = malloc(sizeof(sendip_data));
    23. 

  23. 	ipv6_header *ipv6 = malloc(sizeof(ipv6_header));
    24. 

  24. 	memset(ipv6,0,sizeof(ipv6_header));
    25. 

  25. 	ret->alloc_len = sizeof(ipv6_header);
    26. 

  26. 	ret->data = (void *)ipv6;
    27. 

  27. 	ret->modified=0;
    28. 

  28. 	return ret;
    29. 

  29. }
    30. 

  30. 

  31. bool set_addr(char *hostname, sendip_data *pack) {
    32. 

  32. 	ipv6_header *ipv6 = (ipv6_header *)pack->data;
    33. 

  33. 	struct hostent *host = gethostbyname2(hostname,AF_INET6);
    34. 

  34. 	if(!(pack->modified & IPV6_MOD_SRC)) {
    35. 

  35. 		ipv6->ip6_src = in6addr_loopback;
    36. 

  36. 	}
    37. 

  37. 	if(!(pack->modified & IPV6_MOD_DST)) {
    38. 

  38. 		if(host==NULL) return FALSE;
    39. 

  39. 		if(host->h_length != sizeof(ipv6->ip6_dst)) {
    40. 

  40. 			fprintf(stderr,"IPV6 destination address is the wrong size!!!");
    41. 

  41. 			return FALSE;
    42. 

  42. 		}
    43. 

  43. 		memcpy(&(ipv6->ip6_dst),host->h_addr,host->h_length);
    44. 

  44. 	}
    45. 

  45. 	return TRUE;
    46. 

  46. }
    47. 

  47. 

  48. bool do_opt(char *opt, char *arg, sendip_data *pack) {
    49. 

  49. 	ipv6_header *hdr = (ipv6_header *)pack->data;
    50. 

  50. 	struct in6_addr addr;
    51. 

  51. 

  52. 	switch(opt[1]) {
    53. 

  53. 	case 'f':
    54. 

  54. 		/* TODO : This looks byte-order dependant */
    55. 

  55. 		hdr->ip6_flow |= htonl((u_int32_t)strtoul(arg, (char **)NULL, 0) & 0xFFF00000);
    56. 

  56. 		pack->modified |= IPV6_MOD_FLOW;
    57. 

  57. 		break;
    58. 

  58. 	case 'v':
    59. 

  59. 		hdr->ip6_vfc &= 0x0F;
    60. 

  60. 		hdr->ip6_vfc |= (u_int8_t)(strtoul(arg, (char **)NULL, 0) &0x0F) << 4;
    61. 

  61. 		pack->modified |= IPV6_MOD_VERSION;
    62. 

  62. 		break;
    63. 

  63. 	case 'p':
    64. 

  64. 		hdr->ip6_vfc &= 0xF0;
    65. 

  65. 		hdr->ip6_vfc |= (u_int8_t)strtoul(arg, (char **)NULL, 0) & 0x0F;
    66. 

  66. 		pack->modified |= IPV6_MOD_PRIORITY;
    67. 

  67. 		break;
    68. 

  68. 	case 't':
    69. 

  69. 		/* TODO : This looks byte-order dependant */
    70. 

  70. 		hdr->ip6_flow |= htonl(((u_int32_t)strtoul(arg, (char **)NULL, 0) << 20) & 0x0F000000);
    71. 

  71. 		pack->modified |= IPV6_MOD_FLOW;
    72. 

  72. 		break;
    73. 

  73. 	case 'l':
    74. 

  74. 		hdr->ip6_plen = htons((u_int16_t)strtoul(arg, (char **)NULL, 0));
    75. 

  75. 		pack->modified |= IPV6_MOD_PLEN;
    76. 

  76. 		break;
    77. 

  77. 	case 'h':
    78. 

  78. 		hdr->ip6_hlim = (u_int8_t)strtoul(arg, (char **)NULL, 0);
    79. 

  79. 		pack->modified |= IPV6_MOD_HLIM;
    80. 

  80. 		break;
    81. 

  81. 	case 'n':
    82. 

  82. 		hdr->ip6_nxt = (u_int8_t)strtoul(arg, (char **)NULL, 0);
    83. 

  83. 		pack->modified |= IPV6_MOD_NXT;
    84. 

  84. 		break;
    85. 

  85. 	case 's':
    86. 

  86. 		if (inet_pton(AF_INET6, arg, &addr)) {
    87. 

  87. 			memcpy(&hdr->ip6_src, &addr, sizeof(struct in6_addr));
    88. 

  88. 		}
    89. 

  89. 		pack->modified |= IPV6_MOD_SRC;
    90. 

  90. 		break;
    91. 

  91. 	case 'd':
    92. 

  92. 		if (inet_pton(AF_INET6, arg, &addr)) {
    93. 

  93. 			memcpy(&hdr->ip6_dst, &addr, sizeof(struct in6_addr));
    94. 

  94. 		}
    95. 

  95. 		pack->modified |= IPV6_MOD_DST;
    96. 

  96. 		break;
    97. 

  97. 	}
    98. 

  98. 	return TRUE;
    99. 

  99. 

  100. }
    101. 

  101. 

  102. bool finalize(char *hdrs, sendip_data *headers[], sendip_data *data,
    103. 

  103. 				  sendip_data *pack) {
    104. 

  104. 	ipv6_header *ipv6 = (ipv6_header *)pack->data;
    105. 

  105. 

  106. 	if(!(pack->modified&IPV6_MOD_VERSION)) {
    107. 

  107. 		ipv6->ip6_vfc &= 0x0F;
    108. 

  108. 		ipv6->ip6_vfc |= (6 << 4);
    109. 

  109. 	}
    110. 

  110. 	if(!(pack->modified&IPV6_MOD_PLEN)) {
    111. 

  111. 		ipv6->ip6_plen = htons(data->alloc_len);
    112. 

  112. 	}
    113. 

  113. 	if(!(pack->modified&IPV6_MOD_NXT)) {
    114. 

  114. 		ipv6->ip6_nxt = (u_int8_t)IPPROTO_NONE;
    115. 

  115. 	}
    116. 

  116. 	if(!(pack->modified&IPV6_MOD_HLIM)) {
    117. 

  117. 		ipv6->ip6_hlim = 32;
    118. 

  118. 	}
    119. 

  119. 

  120. 	return TRUE;
    121. 

  121. }
    122. 

  122. 

  123. int num_opts() {
    124. 

  124. 	return sizeof(ipv6_opts)/sizeof(sendip_option); 
    125. 

  125. }
    126. 

  126. sendip_option *get_opts() {
    127. 

  127. 	return ipv6_opts;
    128. 

  128. }
    129. 

  129. char get_optchar() {
    130. 

  130. 	return opt_char;
    131. 

  131. }
    132. 

  132.