URL
https://opencores.org/ocsvn/openrisc/openrisc/trunk
Subversion Repositories openrisc
[/] [openrisc/] [trunk/] [rtos/] [ecos-2.0/] [packages/] [net/] [common/] [v2_0/] [tests/] [ping_lo_test.c] - Rev 593
Go to most recent revision | Compare with Previous | Blame | View Log
//========================================================================== // // tests/ping_lo_test.c // // Simple test of PING (ICMP) and networking support // //========================================================================== //####BSDCOPYRIGHTBEGIN#### // // ------------------------------------------- // // Portions of this software may have been derived from OpenBSD or other sources, // and are covered by the appropriate copyright disclaimers included herein. // // ------------------------------------------- // //####BSDCOPYRIGHTEND#### //========================================================================== //#####DESCRIPTIONBEGIN#### // // Author(s): gthomas, sorin@netappi.com // Contributors: gthomas, sorin@netappi.com // Date: 2000-01-10 // Purpose: // Description: // // //####DESCRIPTIONEND#### // //========================================================================== // PING test code #include <network.h> #include <cyg/infra/testcase.h> #ifndef CYGPKG_LIBC_STDIO #define perror(s) diag_printf(#s ": %s\n", strerror(errno)) #endif #define STACK_SIZE (CYGNUM_HAL_STACK_SIZE_TYPICAL + 0x1000) static char stack[STACK_SIZE]; static cyg_thread thread_data; static cyg_handle_t thread_handle; #define NUM_PINGS 16 #define MAX_PACKET 4096 static unsigned char pkt1[MAX_PACKET], pkt2[MAX_PACKET]; #define UNIQUEID 0x1234 void pexit(char *s) { CYG_TEST_FAIL_FINISH( s ); } // Compute INET checksum int inet_cksum(u_short *addr, int len) { register int nleft = len; register u_short *w = addr; register u_short answer; register u_int sum = 0; u_short odd_byte = 0; /* * Our algorithm is simple, using a 32 bit accumulator (sum), * we add sequential 16 bit words to it, and at the end, fold * back all the carry bits from the top 16 bits into the lower * 16 bits. */ while( nleft > 1 ) { sum += *w++; nleft -= 2; } /* mop up an odd byte, if necessary */ if( nleft == 1 ) { *(u_char *)(&odd_byte) = *(u_char *)w; sum += odd_byte; } /* * add back carry outs from top 16 bits to low 16 bits */ sum = (sum >> 16) + (sum & 0x0000ffff); /* add hi 16 to low 16 */ sum += (sum >> 16); /* add carry */ answer = ~sum; /* truncate to 16 bits */ return (answer); } static int show_icmp(unsigned char *pkt, int len, struct sockaddr_in *from, struct sockaddr_in *to) { cyg_tick_count_t *tp, tv; struct ip *ip; struct icmp *icmp; tv = cyg_current_time(); ip = (struct ip *)pkt; if ((len < sizeof(*ip)) || ip->ip_v != IPVERSION) { diag_printf("%s: Short packet or not IP! - Len: %d, Version: %d\n", inet_ntoa(from->sin_addr), len, ip->ip_v); return 0; } icmp = (struct icmp *)(pkt + sizeof(*ip)); len -= (sizeof(*ip) + 8); tp = (cyg_tick_count_t *)&icmp->icmp_data; if (icmp->icmp_type != ICMP_ECHOREPLY) { diag_printf("%s: Invalid ICMP - type: %d\n", inet_ntoa(from->sin_addr), icmp->icmp_type); return 0; } if (icmp->icmp_id != UNIQUEID) { diag_printf("%s: ICMP received for wrong id - sent: %x, recvd: %x\n", inet_ntoa(from->sin_addr), UNIQUEID, icmp->icmp_id); } diag_printf("%d bytes from %s: ", len, inet_ntoa(from->sin_addr)); diag_printf("icmp_seq=%d", icmp->icmp_seq); diag_printf(", time=%dms\n", (int)(tv - *tp)*10); return (from->sin_addr.s_addr == to->sin_addr.s_addr); } static void ping_host(int s, struct sockaddr_in *host) { struct icmp *icmp = (struct icmp *)pkt1; int icmp_len = 64; int seq, ok_recv, bogus_recv; cyg_tick_count_t *tp; long *dp; struct sockaddr_in from; int i, len, fromlen; ok_recv = 0; bogus_recv = 0; diag_printf("PING server %s\n", inet_ntoa(host->sin_addr)); for (seq = 0; seq < NUM_PINGS; seq++) { // Build ICMP packet icmp->icmp_type = ICMP_ECHO; icmp->icmp_code = 0; icmp->icmp_cksum = 0; icmp->icmp_seq = seq; icmp->icmp_id = 0x1234; // Set up ping data tp = (cyg_tick_count_t *)&icmp->icmp_data; *tp++ = cyg_current_time(); dp = (long *)tp; for (i = sizeof(*tp); i < icmp_len; i += sizeof(*dp)) { *dp++ = i; } // Add checksum icmp->icmp_cksum = inet_cksum( (u_short *)icmp, icmp_len+8); // Send it off if (sendto(s, icmp, icmp_len+8, 0, (struct sockaddr *)host, sizeof(*host)) < 0) { perror("sendto"); continue; } // Wait for a response fromlen = sizeof(from); len = recvfrom(s, pkt2, sizeof(pkt2), 0, (struct sockaddr *)&from, &fromlen); if (len < 0) { perror("recvfrom"); } else { if (show_icmp(pkt2, len, &from, host)) { ok_recv++; } else { bogus_recv++; } } } diag_printf("Sent %d packets, received %d OK, %d bad\n", NUM_PINGS, ok_recv, bogus_recv); } static void ping_test_loopback( int lo ) { struct protoent *p; struct timeval tv; struct sockaddr_in host; int s; if ((p = getprotobyname("icmp")) == (struct protoent *)0) { perror("getprotobyname"); return; } s = socket(AF_INET, SOCK_RAW, p->p_proto); if (s < 0) { perror("socket"); return; } tv.tv_sec = 1; tv.tv_usec = 0; setsockopt(s, SOL_SOCKET, SO_RCVTIMEO, &tv, sizeof(tv)); // Set up host address host.sin_family = AF_INET; host.sin_len = sizeof(host); host.sin_addr.s_addr = htonl(INADDR_LOOPBACK + (0x100 * lo)); host.sin_port = 0; ping_host(s, &host); // Now try a bogus host host.sin_addr.s_addr = htonl(ntohl(host.sin_addr.s_addr) + 32); ping_host(s, &host); } void net_test(cyg_addrword_t p) { int i; diag_printf("Start PING test\n"); init_all_network_interfaces(); #if NLOOP > 0 for ( i = 0; i < NLOOP; i++ ) ping_test_loopback( i ); for ( i = 0; i < NLOOP; i++ ) ping_test_loopback( i ); CYG_TEST_PASS_FINISH( "Done pinging loopback" ); #endif CYG_TEST_NA( "No loopback devs" ); } void cyg_start(void) { CYG_TEST_INIT(); // Create a main thread, so we can run the scheduler and have time 'pass' cyg_thread_create(CYGPKG_NET_THREAD_PRIORITY-4,// Priority - just a number net_test, // entry 0, // entry parameter "Loopback ping test", // Name &stack[0], // Stack STACK_SIZE, // Size &thread_handle, // Handle &thread_data // Thread data structure ); cyg_thread_resume(thread_handle); // Start it cyg_scheduler_start(); }
Go to most recent revision | Compare with Previous | Blame | View Log