1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
|
/***************************************************************************
* Copyright (c) 2024 Microsoft Corporation
* Copyright (c) 2025-present Eclipse ThreadX Contributors
*
* This program and the accompanying materials are made available under the
* terms of the MIT License which is available at
* https://opensource.org/licenses/MIT.
*
* SPDX-License-Identifier: MIT
**************************************************************************/
/**************************************************************************/
/**************************************************************************/
/** */
/** NetX Component */
/** */
/** Internet Control Message Protocol (ICMP) */
/** */
/**************************************************************************/
/**************************************************************************/
#define NX_SOURCE_CODE
/* Include necessary system files. */
#include "nx_api.h"
#include "nx_packet.h"
#include "nx_ip.h"
#include "nx_ipv6.h"
#include "nx_icmpv6.h"
#ifdef NX_IPSEC_ENABLE
#include "nx_ipsec.h"
#endif /* NX_IPSEC_ENABLE */
#ifdef FEATURE_NX_IPV6
/**************************************************************************/
/* */
/* FUNCTION RELEASE */
/* */
/* _nx_icmpv6_packet_process PORTABLE C */
/* 6.4.3 */
/* AUTHOR */
/* */
/* Yuxin Zhou, Microsoft Corporation */
/* */
/* DESCRIPTION */
/* */
/* This function processes the ICMPv6 received packet, computes the */
/* ICMP header checksum, and determines ICMPv6 message type and which */
/* handler to process it. It also lifts any associated threads */
/* suspended on it. */
/* */
/* INPUT */
/* */
/* ip_ptr Pointer to IP control block */
/* packet_ptr Received ICMP packet pointer */
/* */
/* OUTPUT */
/* */
/* None */
/* */
/* CALLS */
/* */
/* _nx_ip_checksum_compute Computer ICMP checksum */
/* _nx_packet_release Packet release function */
/* _tx_thread_system_preempt_check Check for preemption */
/* _nx_icmpv6_process_echo_reply Function that processes the */
/* echo reply message. */
/* _nx_icmpv6_process_echo_request Function that processes the */
/* echo request message. */
/* _nx_icmpv6_process_ra Function that processes the */
/* router advertisement */
/* message. */
/* _nx_icmpv6_process_na Function that processes the */
/* neighbor advertisement. */
/* _nx_icmpv6_process_ns Function that processes the */
/* neighbor solicitation */
/* message. */
/* */
/* CALLED BY */
/* */
/* _nx_icmp_packet_process Main ICMP packet processer */
/* */
/**************************************************************************/
VOID _nx_icmpv6_packet_process(NX_IP *ip_ptr, NX_PACKET *packet_ptr)
{
NX_ICMPV6_HEADER *header_ptr;
USHORT checksum;
#if defined(NX_DISABLE_ICMPV6_RX_CHECKSUM) || defined(NX_ENABLE_INTERFACE_CAPABILITY) || defined(NX_IPSEC_ENABLE)
UINT compute_checksum = 1;
#endif /* defined(NX_DISABLE_ICMPV6_RX_CHECKSUM) || defined(NX_ENABLE_INTERFACE_CAPABILITY) || defined(NX_IPSEC_ENABLE) */
NX_IPV6_HEADER *ipv6_header;
/* Add debug information. */
NX_PACKET_DEBUG(__FILE__, __LINE__, packet_ptr);
/* Check packet length is at least sizeof(NX_ICMPV6_HEADER). */
if ((UINT)(packet_ptr -> nx_packet_append_ptr - packet_ptr -> nx_packet_prepend_ptr) < sizeof(NX_ICMPV6_HEADER))
{
#ifndef NX_DISABLE_ICMP_INFO
/* Increment the ICMP invalid packet error. */
ip_ptr -> nx_ip_icmp_invalid_packets++;
#endif
_nx_packet_release(packet_ptr);
return;
}
/* Points to the ICMP message header. */
/*lint -e{927} -e{826} suppress cast of pointer to pointer, since it is necessary */
header_ptr = (NX_ICMPV6_HEADER *)packet_ptr -> nx_packet_prepend_ptr;
#ifdef NX_DISABLE_ICMPV6_RX_CHECKSUM
compute_checksum = 0;
#endif /* NX_DISABLE_ICMPV6_RX_CHECKSUM */
#ifdef NX_ENABLE_INTERFACE_CAPABILITY
if (packet_ptr -> nx_packet_address.nx_packet_ipv6_address_ptr -> nxd_ipv6_address_attached -> nx_interface_capability_flag & NX_INTERFACE_CAPABILITY_ICMPV6_RX_CHECKSUM)
{
compute_checksum = 0;
}
#endif /* NX_ENABLE_INTERFACE_CAPABILITY */
#ifdef NX_IPSEC_ENABLE
if ((packet_ptr -> nx_packet_ipsec_sa_ptr != NX_NULL) && (((NX_IPSEC_SA *)(packet_ptr -> nx_packet_ipsec_sa_ptr)) -> nx_ipsec_sa_encryption_method != NX_CRYPTO_NONE))
{
compute_checksum = 1;
}
#endif
#if defined(NX_DISABLE_ICMPV6_RX_CHECKSUM) || defined(NX_ENABLE_INTERFACE_CAPABILITY) || defined(NX_IPSEC_ENABLE)
if (compute_checksum)
#endif /* defined(NX_DISABLE_ICMPV6_RX_CHECKSUM) || defined(NX_ENABLE_INTERFACE_CAPABILITY) || defined(NX_IPSEC_ENABLE) */
{
/* Points to the IPv6 header. */
/*lint -e{927} -e{826} suppress cast of pointer to pointer, since it is necessary */
ipv6_header = (NX_IPV6_HEADER *)packet_ptr -> nx_packet_ip_header;
/* Calculate the ICMP message checksum. */
checksum = _nx_ip_checksum_compute(packet_ptr, NX_PROTOCOL_ICMPV6,
(UINT)packet_ptr -> nx_packet_length,
(ipv6_header -> nx_ip_header_source_ip),
(ipv6_header -> nx_ip_header_destination_ip));
checksum = (USHORT)(~checksum) & NX_LOWER_16_MASK;
/* Determine if the checksum is valid. */
if (checksum)
{
#ifndef NX_DISABLE_ICMP_INFO
/* Increment the ICMP invalid packet error. */
ip_ptr -> nx_ip_icmp_invalid_packets++;
/* Increment the ICMP checksum error count. */
ip_ptr -> nx_ip_icmp_checksum_errors++;
#endif
/* Nope, the checksum is invalid. Toss this ICMP packet out. */
_nx_packet_release(packet_ptr);
return;
}
}
/* Determine the message type and call the appropriate handler. */
if (header_ptr -> nx_icmpv6_header_type == NX_ICMPV6_ECHO_REPLY_TYPE)
{
_nx_icmpv6_process_echo_reply(ip_ptr, packet_ptr);
}
else if (header_ptr -> nx_icmpv6_header_type == NX_ICMPV6_ECHO_REQUEST_TYPE)
{
_nx_icmpv6_process_echo_request(ip_ptr, packet_ptr);
}
else if (header_ptr -> nx_icmpv6_header_type == NX_ICMPV6_NEIGHBOR_SOLICITATION_TYPE)
{
_nx_icmpv6_process_ns(ip_ptr, packet_ptr);
}
#ifndef NX_DISABLE_ICMPV6_ROUTER_ADVERTISEMENT_PROCESS
else if (header_ptr -> nx_icmpv6_header_type == NX_ICMPV6_ROUTER_ADVERTISEMENT_TYPE)
{
_nx_icmpv6_process_ra(ip_ptr, packet_ptr);
}
#endif
else if (header_ptr -> nx_icmpv6_header_type == NX_ICMPV6_NEIGHBOR_ADVERTISEMENT_TYPE)
{
_nx_icmpv6_process_na(ip_ptr, packet_ptr);
}
#ifndef NX_DISABLE_ICMPV6_REDIRECT_PROCESS
else if (header_ptr -> nx_icmpv6_header_type == NX_ICMPV6_REDIRECT_MESSAGE_TYPE)
{
_nx_icmpv6_process_redirect(ip_ptr, packet_ptr);
}
#endif
#ifdef NX_ENABLE_IPV6_PATH_MTU_DISCOVERY
else if (header_ptr -> nx_icmpv6_header_type == NX_ICMPV6_PACKET_TOO_BIG_TYPE)
{
_nx_icmpv6_process_packet_too_big(ip_ptr, packet_ptr);
}
#endif /* NX_ENABLE_IPV6_PATH_MTU_DISCOVERY */
else
{
#ifndef NX_DISABLE_ICMP_INFO
/* Increment the ICMP unhandled message count. */
ip_ptr -> nx_ip_icmp_unhandled_messages++;
#endif
/* Unhandled ICMP message, just release it. */
_nx_packet_release(packet_ptr);
}
}
#endif /* FEATURE_NX_IPV6 */
|
