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
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
446
447
448
449
450
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
473
474
475
476
477
478
479
480
481
482
483
|
/***************************************************************************/
/* Copyright (c) 2024 Microsoft Corporation */
/* Copyright (c) 2026 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 */
/***************************************************************************/
/* This NetX test concentrates on the basic BSD RAW blocking operation. */
#include "tx_api.h"
#include "nx_api.h"
#if defined(__PRODUCT_NETXDUO__) && !defined(NX_DISABLE_IPV4)
#ifdef NX_BSD_ENABLE
#include "nxd_bsd.h"
#include "nx_icmpv6.h"
#define DEMO_STACK_SIZE 8192
/* Define the ThreadX and NetX object control blocks... */
static TX_THREAD ntest_0;
static TX_THREAD ntest_1;
static NX_PACKET_POOL pool_0;
static NX_IP ip_0;
static NX_IP ip_1;
static ULONG bsd_thread_area[DEMO_STACK_SIZE / sizeof(ULONG)];
#define BSD_THREAD_PRIORITY 2
#define NUM_CLIENTS 20
/* Define the counters used in the test application... */
static ULONG error_counter;
/* Define thread prototypes. */
static void ntest_0_entry(ULONG thread_input);
static void ntest_1_entry(ULONG thread_input);
extern void test_control_return(UINT status);
extern void _nx_ram_network_driver_256(struct NX_IP_DRIVER_STRUCT *driver_req);
static void validate_bsd_structure(void);
#ifdef FEATURE_NX_IPV6
static NXD_ADDRESS ipv6_address_ip0;
static NXD_ADDRESS ipv6_address_ip1;
#endif /* FEATURE_NX_IPV6 */
static char *requests[4] = {"Request1", "Request2", "Request3", "Request4"};
static char *response[4] = {"Response1", "Response2", "Response3", "Response4"};
extern UINT _nxd_ip_raw_packet_send(NX_IP *ip_ptr, NX_PACKET *packet_ptr, NXD_ADDRESS *destination_ip, ULONG protocol, UINT ttl, ULONG tos);
/* Define what the initial system looks like. */
#ifdef CTEST
VOID test_application_define(void *first_unused_memory)
#else
void netx_bsd_raw_basic_blocking_test_application_define(void *first_unused_memory)
#endif
{
CHAR *pointer;
UINT status;
/* Setup the working pointer. */
pointer = (CHAR *) first_unused_memory;
error_counter = 0;
/* Create the main thread. */
tx_thread_create(&ntest_0, "thread 0", ntest_0_entry, 0,
pointer, DEMO_STACK_SIZE,
3, 3, TX_NO_TIME_SLICE, TX_AUTO_START);
pointer = pointer + DEMO_STACK_SIZE;
/* Create the main thread. */
tx_thread_create(&ntest_1, "thread 1", ntest_1_entry, 0,
pointer, DEMO_STACK_SIZE,
4, 4, TX_NO_TIME_SLICE, TX_AUTO_START);
pointer = pointer + DEMO_STACK_SIZE;
/* Initialize the NetX system. */
nx_system_initialize();
/* Create a packet pool. */
status = nx_packet_pool_create(&pool_0, "NetX Main Packet Pool", 256, pointer, (256 + sizeof(NX_PACKET)) * (NUM_CLIENTS + 4) * 2);
pointer = pointer + (256 + sizeof(NX_PACKET)) * (NUM_CLIENTS + 4) * 2;
if (status)
error_counter++;
/* Create an IP instance. */
status = nx_ip_create(&ip_0, "NetX IP Instance 0", IP_ADDRESS(1, 2, 3, 4), 0xFFFFFF00UL, &pool_0, _nx_ram_network_driver_256,
pointer, 2048, 1);
pointer = pointer + 2048;
/* Create another IP instance. */
status += nx_ip_create(&ip_1, "NetX IP Instance 1", IP_ADDRESS(1, 2, 3, 5), 0xFFFFFF00UL, &pool_0, _nx_ram_network_driver_256,
pointer, 2048, 2);
pointer = pointer + 2048;
if (status)
error_counter++;
/* Enable ARP and supply ARP cache memory for IP Instance 0. */
status = nx_arp_enable(&ip_0, (void *) pointer, 1024);
pointer = pointer + 1024;
if (status)
error_counter++;
/* Enable ARP and supply ARP cache memory for IP Instance 1. */
status = nx_arp_enable(&ip_1, (void *) pointer, 1024);
pointer = pointer + 1024;
if (status)
error_counter++;
/* Enable raw processing for both IP instances. */
status += nx_ip_raw_packet_enable(&ip_0);
status += nx_ip_raw_packet_enable(&ip_1);
/* Enable BSD */
status += bsd_initialize(&ip_0, &pool_0, (CHAR*)&bsd_thread_area[0], sizeof(bsd_thread_area), BSD_THREAD_PRIORITY);
/* Check RAW enable and BSD init status. */
if (status)
error_counter++;
}
static void test_raw_server_ipv4(void)
{
int sockfd;
struct sockaddr_in remote_addr;
struct sockaddr_ll sock_addr;
int ret;
char buf[30];
int addrlen;
sockfd = socket(AF_INET, SOCK_RAW, 100);
if(sockfd < 0)
error_counter++;
/* Receive data from the client. */
addrlen = sizeof(remote_addr);
ret = recvfrom(sockfd, buf, sizeof(buf), 0, (struct sockaddr*)&remote_addr, &addrlen);
if(ret <= 0)
error_counter++;
if(addrlen != sizeof(struct sockaddr_in))
error_counter++;
if((remote_addr.sin_family != AF_INET) ||
(remote_addr.sin_addr.s_addr != htonl(IP_ADDRESS(1,2,3,5))))
error_counter++;
/* Validate the data. */
if((ret != (int)(strlen(requests[0]) + 20)) || strncmp((buf + 20), requests[0], (ret - 20)))
error_counter++;
/* Send a response back. */
ret = sendto(sockfd, response[0], strlen(response[0]), 0, (struct sockaddr*)&remote_addr, addrlen);
if(ret != (int)strlen(response[0]))
error_counter++;
/* Close downt he socket. */
ret = soc_close(sockfd);
if(ret < 0)
error_counter++;
#ifdef NX_BSD_RAW_SUPPORT
/* Test raw packet type. */
sockfd = socket(AF_PACKET, SOCK_RAW, 200);
if(sockfd < 0)
error_counter++;
sock_addr.sll_family = AF_PACKET;
sock_addr.sll_ifindex = 0;
ret = sendto(sockfd, response[0], strlen(response[0]), 0, (struct sockaddr*)&sock_addr, sizeof(sock_addr));
if(ret != (int)strlen(response[0]))
error_counter++;
/* Close downt he socket. */
ret = soc_close(sockfd);
if(ret < 0)
error_counter++;
#endif
/* Give the reciever a chance to receive the raw data. */
tx_thread_sleep(2);
}
#ifdef FEATURE_NX_IPV6
static void test_raw_server_ipv6(void)
{
int sockfd;
struct sockaddr_in6 remote_addr;
int ret;
char buf[50];
int addrlen;
sockfd = socket(AF_INET6, SOCK_RAW, 100);
if(sockfd < 0)
error_counter++;
/* Receive data from the client. */
addrlen = sizeof(remote_addr);
ret = recvfrom(sockfd, buf, sizeof(buf), 0, (struct sockaddr*)&remote_addr, &addrlen);
if(ret <= 0)
error_counter++;
if(addrlen != sizeof(struct sockaddr_in6))
error_counter++;
if((remote_addr.sin6_family != AF_INET6) ||
(remote_addr.sin6_addr._S6_un._S6_u32[0] != htonl(ipv6_address_ip1.nxd_ip_address.v6[0])) ||
(remote_addr.sin6_addr._S6_un._S6_u32[1] != htonl(ipv6_address_ip1.nxd_ip_address.v6[1])) ||
(remote_addr.sin6_addr._S6_un._S6_u32[2] != htonl(ipv6_address_ip1.nxd_ip_address.v6[2])) ||
(remote_addr.sin6_addr._S6_un._S6_u32[3] != htonl(ipv6_address_ip1.nxd_ip_address.v6[3])))
error_counter++;
/* Validate the data. */
if((ret != (INT)(strlen(requests[0]) )) || strncmp((buf ), requests[0], ret ))
error_counter++;
/* Send a response back. */
ret = sendto(sockfd, response[0], strlen(response[0]), 0, (struct sockaddr*)&remote_addr, addrlen);
if(ret != (INT)strlen(response[0]))
error_counter++;
/* Close downt he socket. */
ret = soc_close(sockfd);
if(ret < 0)
error_counter++;
/* Give the reciever a chance to receive the raw data. */
tx_thread_sleep(2);
}
#endif
/* Define the test threads. */
static void ntest_0_entry(ULONG thread_input)
{
#ifdef FEATURE_NX_IPV6
UINT status;
char mac_ip0[6];
char mac_ip1[6];
#endif
printf("NetX Test: Basic BSD Raw Blocking Test...................");
/* Check for earlier error. */
if (error_counter)
{
printf("ERROR!\n");
test_control_return(1);
}
#ifdef FEATURE_NX_IPV6
/* First set up IPv6 addresses. */
ipv6_address_ip0.nxd_ip_version = NX_IP_VERSION_V6;
ipv6_address_ip0.nxd_ip_address.v6[0] = 0xfe800000;
ipv6_address_ip0.nxd_ip_address.v6[1] = 0x00000000;
ipv6_address_ip0.nxd_ip_address.v6[2] = 0x021122ff;
ipv6_address_ip0.nxd_ip_address.v6[3] = 0xfe334456;
ipv6_address_ip1.nxd_ip_version = NX_IP_VERSION_V6;
ipv6_address_ip1.nxd_ip_address.v6[0] = 0xfe800000;
ipv6_address_ip1.nxd_ip_address.v6[1] = 0x00000000;
ipv6_address_ip1.nxd_ip_address.v6[2] = 0x021122ff;
ipv6_address_ip1.nxd_ip_address.v6[3] = 0xfe334457;
status = nxd_ipv6_address_set(&ip_0, 0, &ipv6_address_ip0, 64, NX_NULL);
status += nxd_ipv6_address_set(&ip_1, 0, &ipv6_address_ip1, 64, NX_NULL);
status += nxd_ipv6_enable(&ip_0);
status += nxd_ipv6_enable(&ip_1);
mac_ip0[0] = ip_0.nx_ip_interface[0].nx_interface_physical_address_msw >> 8;
mac_ip0[1] = ip_0.nx_ip_interface[0].nx_interface_physical_address_msw & 0xFF;
mac_ip0[2] = (ip_0.nx_ip_interface[0].nx_interface_physical_address_lsw >> 24) & 0xff;
mac_ip0[3] = (ip_0.nx_ip_interface[0].nx_interface_physical_address_lsw >> 16) & 0xff;
mac_ip0[4] = (ip_0.nx_ip_interface[0].nx_interface_physical_address_lsw >> 8) & 0xff;
mac_ip0[5] = ip_0.nx_ip_interface[0].nx_interface_physical_address_lsw & 0xff;
mac_ip1[0] = ip_1.nx_ip_interface[0].nx_interface_physical_address_msw >> 8;
mac_ip1[1] = ip_1.nx_ip_interface[0].nx_interface_physical_address_msw & 0xFF;
mac_ip1[2] = (ip_1.nx_ip_interface[0].nx_interface_physical_address_lsw >> 24) & 0xff;
mac_ip1[3] = (ip_1.nx_ip_interface[0].nx_interface_physical_address_lsw >> 16) & 0xff;
mac_ip1[4] = (ip_1.nx_ip_interface[0].nx_interface_physical_address_lsw >> 8) & 0xff;
mac_ip1[5] = ip_1.nx_ip_interface[0].nx_interface_physical_address_lsw & 0xff;
status += nxd_nd_cache_entry_set(&ip_0, ipv6_address_ip1.nxd_ip_address.v6, 0, mac_ip1);
status += nxd_nd_cache_entry_set(&ip_1, ipv6_address_ip0.nxd_ip_address.v6, 0, mac_ip0);
if(status)
error_counter++;
#endif
test_raw_server_ipv4();
/* Now open another socket and attempt to connect to the correct remote
host but an unexpected port so we expect an unsuccessful connections. */
#if 0
sockfd = socket(AF_INET, SOCK_DGRAM, 0);
if(sockfd < 0)
error_counter++;
#endif
/* Allow the stateless autoaddress configuration/DAD to finish */
tx_thread_sleep(3);
#ifdef FEATURE_NX_IPV6
test_raw_server_ipv6();
#endif
validate_bsd_structure();
tx_thread_sleep(2);
if(error_counter)
printf("ERROR!\n");
else
printf("SUCCESS!\n");
if(error_counter)
test_control_return(1);
test_control_return(0);
}
static void ntest_1_entry(ULONG thread_input)
{
UINT status;
NX_PACKET *packet_ptr;
ULONG actual_status;
NXD_ADDRESS dest_addr;
/* Ensure the IP instance has been initialized. */
status = nx_ip_status_check(&ip_1, NX_IP_INITIALIZE_DONE, &actual_status, 1 * NX_IP_PERIODIC_RATE);
/* Check status... */
if (status != NX_SUCCESS)
{
printf("ERROR!\n");
test_control_return(3);
}
/* Allocate a packet. */
status = nx_packet_allocate(&pool_0, &packet_ptr, NX_IP_PACKET, NX_WAIT_FOREVER);
if (status)
error_counter++;
/* Fill in the packet with data */
memcpy(packet_ptr -> nx_packet_prepend_ptr, requests[0], strlen(requests[0]));
packet_ptr -> nx_packet_length = strlen(requests[0]);
packet_ptr -> nx_packet_append_ptr = packet_ptr -> nx_packet_prepend_ptr + packet_ptr -> nx_packet_length;
/* Send a RAW packet */
dest_addr.nxd_ip_version = NX_IP_VERSION_V4;
dest_addr.nxd_ip_address.v4 = IP_ADDRESS(1,2,3,4);
status = _nxd_ip_raw_packet_send(&ip_1, packet_ptr, &dest_addr, 100, 128, 0);
if(status)
error_counter++;
error_counter++;
tx_thread_sleep(1);
/* Ready to reaceive a message */
status = nx_ip_raw_packet_receive(&ip_1, &packet_ptr, NX_IP_PERIODIC_RATE);
if(status)
error_counter++;
/* Validate the content. */
if(packet_ptr -> nx_packet_length != strlen(response[0]))
error_counter++;
else if(strncmp((char*)packet_ptr -> nx_packet_prepend_ptr, response[0], strlen(response[0])))
error_counter++;
else
error_counter--;
#ifdef FEATURE_NX_IPV6
/* Test IPv6 */
tx_thread_sleep(5);
/* Allocate a packet. */
status = nx_packet_allocate(&pool_0, &packet_ptr, NX_IP_PACKET, NX_WAIT_FOREVER);
if (status)
error_counter++;
/* Fill in the packet with data */
memcpy(packet_ptr -> nx_packet_prepend_ptr, requests[0], strlen(requests[0]));
packet_ptr -> nx_packet_length = strlen(requests[0]);
packet_ptr -> nx_packet_append_ptr = packet_ptr -> nx_packet_prepend_ptr + packet_ptr -> nx_packet_length;
status = _nxd_ip_raw_packet_send(&ip_1, packet_ptr, &ipv6_address_ip0, 100, 128, 0);
if(status)
error_counter++;
error_counter++;
tx_thread_sleep(1);
/* Ready to reaceive a message */
status = nx_ip_raw_packet_receive(&ip_1, &packet_ptr, NX_IP_PERIODIC_RATE);
if(status)
error_counter++;
/* Validate the content. */
if(packet_ptr -> nx_packet_length != strlen(response[0]))
error_counter++;
else if(strncmp((char*)packet_ptr -> nx_packet_prepend_ptr, response[0], strlen(response[0])))
error_counter++;
else
error_counter--;
#endif
}
extern NX_BSD_SOCKET nx_bsd_socket_array[NX_BSD_MAX_SOCKETS];
extern TX_BLOCK_POOL nx_bsd_socket_block_pool;
static void validate_bsd_structure(void)
{
int i;
/* Make sure every BSD socket should be free by now. */
for(i = 0; i < NX_BSD_MAX_SOCKETS; i++)
{
if(nx_bsd_socket_array[i].nx_bsd_socket_status_flags & NX_BSD_SOCKET_IN_USE)
{
error_counter++;
}
if(nx_bsd_socket_array[i].nx_bsd_socket_tcp_socket ||
nx_bsd_socket_array[i].nx_bsd_socket_udp_socket)
{
error_counter++;
}
}
/* Make sure all the NX SOCKET control blocks are released. */
if(nx_bsd_socket_block_pool.tx_block_pool_available !=
nx_bsd_socket_block_pool.tx_block_pool_total)
{
error_counter++;
}
/* Make sure all the sockets are released */
if(ip_0.nx_ip_tcp_created_sockets_ptr ||
ip_0.nx_ip_udp_created_sockets_ptr)
{
error_counter++;
return;
}
}
#endif /* NX_BSD_ENABLE */
#else /* __PRODUCT_NETXDUO__ */
extern void test_control_return(UINT status);
#ifdef CTEST
VOID test_application_define(void *first_unused_memory)
#else
void netx_bsd_raw_basic_blocking_test_application_define(void *first_unused_memory)
#endif
{
printf("NetX Test: Basic BSD Raw Blocking Test...................N/A\n");
test_control_return(3);
}
#endif /* __PRODUCT_NETXDUO__ */
|