123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250 |
- /*
- * Copyright (C) 2010 Michael Brown <mbrown@fensystems.co.uk>.
- *
- * This program is free software; you can redistribute it and/or
- * modify it under the terms of the GNU General Public License as
- * published by the Free Software Foundation; either version 2 of the
- * License, or any later version.
- *
- * This program is distributed in the hope that it will be useful, but
- * WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
- * General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
- * 02110-1301, USA.
- */
-
- FILE_LICENCE ( GPL2_OR_LATER );
-
- #include <stdint.h>
- #include <stdlib.h>
- #include <string.h>
- #include <stdio.h>
- #include <errno.h>
- #include <byteswap.h>
- #include <ipxe/iobuf.h>
- #include <ipxe/netdevice.h>
- #include <ipxe/if_ether.h>
- #include <ipxe/keys.h>
- #include <ipxe/console.h>
- #include <usr/ifmgmt.h>
- #include <usr/lotest.h>
-
- /** @file
- *
- * Loopback testing
- *
- */
-
- #define LINK_WAIT_MS 15000
-
- /**
- * Process received packet
- *
- * @v iobuf I/O buffer
- * @v netdev Network device
- * @v ll_dest Link-layer destination address
- * @v ll_source Link-layer source address
- * @v flags Packet flags
- * @ret rc Return status code
- */
- static int lotest_rx ( struct io_buffer *iobuf,
- struct net_device *netdev __unused,
- const void *ll_dest __unused,
- const void *ll_source __unused,
- unsigned int flags __unused ) {
- free_iob ( iobuf );
- return -ENOTSUP;
- }
-
- /**
- * Transcribe network-layer address
- *
- * @v net_addr Network-layer address
- * @ret string Human-readable transcription of address
- */
- static const char * lotest_ntoa ( const void *net_addr __unused ) {
- return "<INVALID>";
- }
-
- /**
- * Loopback test network-layer protocol
- *
- * Using a dedicated network-layer protocol avoids problems caused by
- * cards supporting features such as IPv4 checksum offload trying to
- * interpret the (randomly generated) network-layer content.
- */
- static struct net_protocol lotest_protocol __net_protocol = {
- .name = "LOTEST",
- .rx = lotest_rx,
- .ntoa = lotest_ntoa,
- .net_proto = htons ( 0x6950 ), /* Not a genuine protocol number */
- .net_addr_len = 0,
- };
-
- /**
- * Wait for packet to be received
- *
- * @v receiver Receiving network device*
- * @v data Expected data
- * @v len Expected data length
- * @ret rc Return status code
- */
- static int loopback_wait ( struct net_device *receiver, void *data,
- size_t len ) {
- struct ll_protocol *ll_protocol = receiver->ll_protocol;
- struct io_buffer *iobuf;
- const void *ll_dest;
- const void *ll_source;
- uint16_t net_proto;
- unsigned int flags;
- int rc;
-
- /* Poll until packet arrives */
- while ( 1 ) {
-
- /* Check for cancellation */
- if ( iskey() && ( getchar() == CTRL_C ) )
- return -ECANCELED;
-
- /* Poll network devices */
- net_poll();
-
- /* Dequeue packet, if available */
- iobuf = netdev_rx_dequeue ( receiver );
- if ( ! iobuf )
- continue;
-
- /* Strip link-layer header */
- if ( ( rc = ll_protocol->pull ( receiver, iobuf, &ll_dest,
- &ll_source, &net_proto,
- &flags ) ) != 0 ) {
- printf ( "\nFailed to strip link-layer header: %s",
- strerror ( rc ) );
- free_iob ( iob_disown ( iobuf ) );
- return rc;
- }
-
- /* Ignore non-loopback packets */
- if ( net_proto != lotest_protocol.net_proto ) {
- printf ( "\nReceived spurious packet type %04x\n",
- ntohs ( net_proto ) );
- free_iob ( iob_disown ( iobuf ) );
- continue;
- }
-
- /* Check packet length */
- if ( iob_len ( iobuf ) != len ) {
- printf ( "\nLength mismatch: sent %zd, received %zd",
- len, iob_len ( iobuf ) );
- DBG ( "\nSent:\n" );
- DBG_HDA ( 0, data, len );
- DBG ( "Received:\n" );
- DBG_HDA ( 0, iobuf->data, iob_len ( iobuf ) );
- free_iob ( iob_disown ( iobuf ) );
- return -EINVAL;
- }
-
- /* Check packet content */
- if ( memcmp ( iobuf->data, data, len ) != 0 ) {
- printf ( "\nContent mismatch" );
- DBG ( "\nSent:\n" );
- DBG_HDA ( 0, data, len );
- DBG ( "Received:\n" );
- DBG_HDA ( 0, iobuf->data, iob_len ( iobuf ) );
- free_iob ( iob_disown ( iobuf ) );
- return -EINVAL;
- }
-
- /* Discard packet and return */
- free_iob ( iob_disown ( iobuf ) );
- return 0;
- }
- }
-
- /**
- * Perform loopback test between two network devices
- *
- * @v sender Sending network device
- * @v receiver Received network device
- * @v mtu Packet size (excluding link-layer headers)
- * @ret rc Return status code
- */
- int loopback_test ( struct net_device *sender, struct net_device *receiver,
- size_t mtu ) {
- uint8_t buf[mtu];
- struct io_buffer *iobuf;
- unsigned int i;
- unsigned int successes;
- int rc;
-
- /* Open network devices */
- if ( ( rc = ifopen ( sender ) ) != 0 )
- return rc;
- if ( ( rc = ifopen ( receiver ) ) != 0 )
- return rc;
-
- /* Wait for link-up */
- if ( ( rc = iflinkwait ( sender, LINK_WAIT_MS ) ) != 0 )
- return rc;
- if ( ( rc = iflinkwait ( receiver, LINK_WAIT_MS ) ) != 0 )
- return rc;
-
- /* Print initial statistics */
- printf ( "Performing loopback test from %s to %s with %zd byte MTU\n",
- sender->name, receiver->name, mtu );
- ifstat ( sender );
- ifstat ( receiver );
-
- /* Freeze receive queue processing on the receiver, so that we
- * can extract all received packets.
- */
- netdev_rx_freeze ( receiver );
-
- /* Perform loopback test */
- for ( successes = 0 ; ; successes++ ) {
-
- /* Print running total */
- printf ( "\r%d", successes );
-
- /* Generate random packet */
- for ( i = 0 ; i < sizeof ( buf ) ; i++ )
- buf[i] = random();
- iobuf = alloc_iob ( MAX_LL_HEADER_LEN + sizeof ( buf ) );
- if ( ! iobuf ) {
- printf ( "\nFailed to allocate I/O buffer" );
- rc = -ENOMEM;
- break;
- }
- iob_reserve ( iobuf, MAX_LL_HEADER_LEN );
- memcpy ( iob_put ( iobuf, sizeof ( buf ) ),
- buf, sizeof ( buf ) );
-
- /* Transmit packet */
- if ( ( rc = net_tx ( iob_disown ( iobuf ), sender,
- &lotest_protocol, receiver->ll_addr,
- sender->ll_addr ) ) != 0 ) {
- printf ( "\nFailed to transmit packet: %s",
- strerror ( rc ) );
- break;
- }
-
- /* Wait for received packet */
- if ( ( rc = loopback_wait ( receiver, buf,
- sizeof ( buf ) ) ) != 0 ) {
- break;
- }
- }
-
- printf ( "\n");
- netdev_rx_unfreeze ( receiver );
-
- /* Dump final statistics */
- ifstat ( sender );
- ifstat ( receiver );
-
- return 0;
- }
|