URL
https://opencores.org/ocsvn/or1k/or1k/trunk
Subversion Repositories or1k
[/] [or1k/] [branches/] [stable_0_2_x/] [or1ksim/] [peripheral/] [eth.c] - Rev 1358
Go to most recent revision | Compare with Previous | Blame | View Log
/* ethernet.c -- Simulation of Ethernet MAC Copyright (C) 2001 by Erez Volk, erez@opencores.org Ivan Guzvinec, ivang@opencores.org This file is part of OpenRISC 1000 Architectural Simulator. 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 (at your option) 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., 675 Mass Ave, Cambridge, MA 02139, USA. */ #include <stdlib.h> #include <stdio.h> #include <string.h> #include <sys/types.h> #include <sys/stat.h> #include <fcntl.h> #include <sys/poll.h> #include <sys/time.h> #include <unistd.h> #include <errno.h> #include <netinet/in.h> #include "config.h" #ifdef HAVE_INTTYPES_H #include <inttypes.h> #endif #include "port.h" #include "arch.h" #include "config.h" #include "abstract.h" #include "ethernet_i.h" #include "dma.h" #include "sim-config.h" #include "fields.h" #include "crc32.h" #include "vapi.h" #include "pic.h" #include "debug.h" static struct eth_device eths[MAX_ETHERNETS]; /* simulator interface */ static void eth_reset_controller( struct eth_device *eth); static void eth_vapi_read( unsigned long id, unsigned long data); /* register interface */ static void eth_write32( oraddr_t addr, uint32_t value ); static uint32_t eth_read32( oraddr_t addr ); /* clock */ static void eth_controller_tx_clock( struct eth_device * ); static void eth_controller_rx_clock( struct eth_device * ); /* utility functions */ static int eth_find_controller( oraddr_t addr, struct eth_device **eth, oraddr_t *reladdr ); struct eth_device *eth_find_vapi_device (unsigned long id, unsigned long *which); static ssize_t eth_read_rx_file( struct eth_device *, void *, size_t ); static void eth_skip_rx_file( struct eth_device *, off_t ); static void eth_rewind_rx_file( struct eth_device *, off_t ); static void eth_rx_next_packet( struct eth_device * ); static void eth_write_tx_bd_num( struct eth_device *, unsigned long value ); /* ========================================================================= */ /* TX LOGIC */ /*---------------------------------------------------------------------------*/ /* * TX clock * Responsible for starting and finishing TX */ void eth_controller_tx_clock( struct eth_device *eth ) { int breakpoint = 0; int bAdvance = 1; #if HAVE_ETH_PHY struct sockaddr_ll sll; #endif /* HAVE_ETH_PHY */ long nwritten; unsigned long read_word; switch (eth->tx.state) { case ETH_TXSTATE_IDLE: if ( TEST_FLAG( eth->regs.moder, ETH_MODER, TXEN ) ) { /* wait for TxBuffer to be ready */ debug (3, "TX - entering state WAIT4BD (%ld)\n", eth->tx.bd_index); eth->tx.state = ETH_TXSTATE_WAIT4BD; } break; case ETH_TXSTATE_WAIT4BD: /* Read buffer descriptor */ eth->tx.bd = eth->regs.bd_ram[eth->tx.bd_index]; eth->tx.bd_addr = eth->regs.bd_ram[eth->tx.bd_index + 1]; if ( TEST_FLAG( eth->tx.bd, ETH_TX_BD, READY ) ) { /*****************/ /* initialize TX */ eth->tx.bytes_left = eth->tx.packet_length = GET_FIELD( eth->tx.bd, ETH_TX_BD, LENGTH ); eth->tx.bytes_sent = 0; /* Initialize error status bits */ CLEAR_FLAG( eth->tx.bd, ETH_TX_BD, DEFER ); CLEAR_FLAG( eth->tx.bd, ETH_TX_BD, COLLISION ); CLEAR_FLAG( eth->tx.bd, ETH_TX_BD, RETRANSMIT ); CLEAR_FLAG( eth->tx.bd, ETH_TX_BD, UNDERRUN ); CLEAR_FLAG( eth->tx.bd, ETH_TX_BD, NO_CARRIER ); SET_FIELD ( eth->tx.bd, ETH_TX_BD, RETRY, 0 ); /* Find out minimum length */ if ( TEST_FLAG( eth->tx.bd, ETH_TX_BD, PAD ) || TEST_FLAG( eth->regs.moder, ETH_MODER, PAD ) ) eth->tx.minimum_length = GET_FIELD( eth->regs.packetlen, ETH_PACKETLEN, MINFL ); else eth->tx.minimum_length = eth->tx.packet_length; /* Find out maximum length */ if ( TEST_FLAG( eth->regs.moder, ETH_MODER, HUGEN ) ) eth->tx.maximum_length = eth->tx.packet_length; else eth->tx.maximum_length = GET_FIELD( eth->regs.packetlen, ETH_PACKETLEN, MAXFL ); /* Do we need CRC on this packet? */ if ( TEST_FLAG( eth->regs.moder, ETH_MODER, CRCEN ) || (TEST_FLAG( eth->tx.bd, ETH_TX_BD, CRC) && TEST_FLAG( eth->tx.bd, ETH_TX_BD, LAST)) ) eth->tx.add_crc = 1; else eth->tx.add_crc = 0; if ( TEST_FLAG( eth->regs.moder, ETH_MODER, DLYCRCEN ) ) eth->tx.crc_dly = 1; else eth->tx.crc_dly = 0; /* XXX - For now we skip CRC calculation */ debug( 3, "Ethernet: Starting TX of %lu bytes (min. %u, max. %u)\n", eth->tx.packet_length, eth->tx.minimum_length, eth->tx.maximum_length ); if (eth->rtx_type == ETH_RTX_FILE) { /* write packet length to file */ nwritten = write( eth->txfd, &(eth->tx.packet_length), sizeof(eth->tx.packet_length) ); } /************************************************/ /* start transmit with reading packet into FIFO */ debug (3, "TX - entering state READFIFO\n"); eth->tx.state = ETH_TXSTATE_READFIFO; } else if ( !TEST_FLAG( eth->regs.moder, ETH_MODER, TXEN ) ) { /* stop TX logic */ debug (3, "TX - entering state IDLE\n"); eth->tx.state = ETH_TXSTATE_IDLE; } /* stay in this state if (TXEN && !READY) */ break; case ETH_TXSTATE_READFIFO: #if 1 if ( eth->tx.bytes_sent < eth->tx.packet_length ) { read_word = eval_direct32(eth->tx.bytes_sent + eth->tx.bd_addr, &breakpoint, 0, 0); eth->tx_buff[eth->tx.bytes_sent] = (unsigned char)(read_word >> 24); eth->tx_buff[eth->tx.bytes_sent+1] = (unsigned char)(read_word >> 16); eth->tx_buff[eth->tx.bytes_sent+2] = (unsigned char)(read_word >> 8); eth->tx_buff[eth->tx.bytes_sent+3] = (unsigned char)(read_word); eth->tx.bytes_sent += 4; } #else if ( eth->tx.bytes_sent < eth->tx.packet_length ) { eth->tx_buff[eth->tx.bytes_sent] = eval_direct8(eth->tx.bytes_sent + eth->tx.bd_addr, &breakpoint, 0, 0); eth->tx.bytes_sent += 1; } #endif else { debug (3, "TX - entering state TRANSMIT\n"); eth->tx.state = ETH_TXSTATE_TRANSMIT; } break; case ETH_TXSTATE_TRANSMIT: /* send packet */ switch (eth->rtx_type) { case ETH_RTX_FILE: nwritten = write( eth->txfd, eth->tx_buff, eth->tx.packet_length ); break; #if HAVE_ETH_PHY case ETH_RTX_SOCK: memset(&sll, 0, sizeof(sll)); sll.sll_ifindex = eth->ifr.ifr_ifindex; nwritten = sendto(eth->rtx_sock, eth->tx_buff, eth->tx.packet_length, 0, (struct sockaddr *)&sll, sizeof(sll)); #endif /* HAVE_ETH_PHY */ } /* set BD status */ if (nwritten == eth->tx.packet_length) { CLEAR_FLAG (eth->tx.bd, ETH_TX_BD, READY); SET_FLAG (eth->regs.int_source, ETH_INT_SOURCE, TXB); debug (4, "ETH_INT_SOURCE = %0lx\n", eth->regs.int_source); debug (3, "TX - entering state IDLE\n"); eth->tx.state = ETH_TXSTATE_IDLE; debug (3, "send (%ld)bytes OK\n", nwritten); } else { /* XXX - implement retry mechanism here! */ CLEAR_FLAG (eth->tx.bd, ETH_TX_BD, READY); CLEAR_FLAG (eth->tx.bd, ETH_TX_BD, COLLISION); SET_FLAG (eth->regs.int_source, ETH_INT_SOURCE, TXE); debug (4, "ETH_INT_SOURCE = %0lx\n", eth->regs.int_source); debug (3, "TX - entering state IDLE\n"); eth->tx.state = ETH_TXSTATE_IDLE; debug (3, "send FAILED!\n"); } eth->regs.bd_ram[eth->tx.bd_index] = eth->tx.bd; /* generate OK interrupt */ if ( TEST_FLAG(eth->regs.int_mask, ETH_INT_MASK, TXE_M) || TEST_FLAG(eth->regs.int_mask, ETH_INT_MASK, TXB_M) ) { if ( TEST_FLAG( eth->tx.bd, ETH_TX_BD, IRQ ) ) report_interrupt( eth->mac_int ); } /* advance to next BD */ if (bAdvance) { if ( TEST_FLAG( eth->tx.bd, ETH_TX_BD, WRAP ) || eth->tx.bd_index >= ETH_BD_COUNT ) eth->tx.bd_index = 0; else eth->tx.bd_index += 2; } break; } } /* ========================================================================= */ /* ========================================================================= */ /* RX LOGIC */ /*---------------------------------------------------------------------------*/ /* * RX clock * Responsible for starting and finishing RX */ void eth_controller_rx_clock( struct eth_device *eth ) { int breakpoint = 0; long nread; unsigned long send_word; switch (eth->rx.state) { case ETH_RXSTATE_IDLE: if ( TEST_FLAG( eth->regs.moder, ETH_MODER, RXEN) ) { debug (3, "RX - entering state WAIT4BD (%ld)\n", eth->rx.bd_index); eth->rx.state = ETH_RXSTATE_WAIT4BD; } break; case ETH_RXSTATE_WAIT4BD: eth->rx.bd = eth->regs.bd_ram[eth->rx.bd_index]; eth->rx.bd_addr = eth->regs.bd_ram[eth->rx.bd_index + 1]; if ( TEST_FLAG( eth->rx.bd, ETH_RX_BD, READY ) ) { /*****************/ /* Initialize RX */ CLEAR_FLAG( eth->rx.bd, ETH_RX_BD, MISS ); CLEAR_FLAG( eth->rx.bd, ETH_RX_BD, INVALID ); CLEAR_FLAG( eth->rx.bd, ETH_RX_BD, DRIBBLE ); CLEAR_FLAG( eth->rx.bd, ETH_RX_BD, UVERRUN ); CLEAR_FLAG( eth->rx.bd, ETH_RX_BD, COLLISION ); CLEAR_FLAG( eth->rx.bd, ETH_RX_BD, TOOBIG ); CLEAR_FLAG( eth->rx.bd, ETH_RX_BD, TOOSHORT ); debug( 3, "Ethernet: Starting RX\n" ); /* Setup file to read from */ if ( TEST_FLAG( eth->regs.moder, ETH_MODER, LOOPBCK ) ) { eth->rx.fd = eth->txfd; eth->rx.offset = &(eth->loopback_offset); } else { eth->rx.fd = eth->rxfd; eth->rx.offset = 0; } debug (3, "RX - entering state RECV\n"); eth->rx.state = ETH_RXSTATE_RECV; } else if (!TEST_FLAG( eth->regs.moder, ETH_MODER, RXEN)) { debug (3, "RX - entering state IDLE\n"); eth->rx.state = ETH_RXSTATE_IDLE; } else { nread = recv(eth->rtx_sock, eth->rx_buff, ETH_MAXPL, /*MSG_PEEK | */MSG_DONTWAIT); if (nread > 0) { SET_FLAG (eth->regs.int_source, ETH_INT_SOURCE, BUSY); if ( TEST_FLAG(eth->regs.int_mask, ETH_INT_MASK, BUSY_M) ) report_interrupt(eth->mac_int); } } break; case ETH_RXSTATE_RECV: switch (eth->rtx_type) { case ETH_RTX_FILE: /* Read packet length */ if ( eth_read_rx_file( eth, &(eth->rx.packet_length), sizeof(eth->rx.packet_length) ) < sizeof(eth->rx.packet_length) ) { /* TODO: just do what real ethernet would do (some kind of error state) */ debug (4, "eth_start_rx(): File does not have a packet ready for RX (len = %ld)\n", eth->rx.packet_length ); runtime.sim.cont_run = 0; break; } /* Packet must be big enough to hold a header */ if ( eth->rx.packet_length < ETHER_HDR_LEN ){ debug( 3, "eth_start_rx(): Packet too small\n" ); eth_rx_next_packet( eth ); debug (3, "RX - entering state IDLE\n"); eth->rx.state = ETH_RXSTATE_IDLE; break; } eth->rx.bytes_read = 0; eth->rx.bytes_left = eth->rx.packet_length; /* for now Read entire packet into memory */ nread = eth_read_rx_file( eth, eth->rx_buff, eth->rx.bytes_left ); if ( nread < eth->rx.bytes_left ) { debug (3, "Read %ld from %ld. Error!\n", nread, eth->rx.bytes_left); eth->rx.error = 1; break; } eth->rx.packet_length = nread; eth->rx.bytes_left = nread; eth->rx.bytes_read = 0; debug (3, "RX - entering state WRITEFIFO\n"); eth->rx.state = ETH_RXSTATE_WRITEFIFO; break; case ETH_RTX_SOCK: nread = recv(eth->rtx_sock, eth->rx_buff, ETH_MAXPL, MSG_DONTWAIT); if (nread == 0) break; else if (nread < 0) { if ( errno != EAGAIN ) { debug (3, "recv() FAILED!\n"); break; } else break; } /* If not promiscouos mode, check the destination address */ if (!TEST_FLAG(eth->regs.moder, ETH_MODER, PRO)) { if (TEST_FLAG(eth->regs.moder, ETH_MODER, IAM) && (eth->rx_buff[0] & 1)) { /* Nothing for now */ } if (eth->mac_address[5] != eth->rx_buff[0] || eth->mac_address[4] != eth->rx_buff[1] || eth->mac_address[3] != eth->rx_buff[2] || eth->mac_address[2] != eth->rx_buff[3] || eth->mac_address[1] != eth->rx_buff[4] || eth->mac_address[0] != eth->rx_buff[5]) break; } eth->rx.packet_length = nread; eth->rx.bytes_left = nread; eth->rx.bytes_read = 0; debug (3, "RX - entering state WRITEFIFO\n"); eth->rx.state = ETH_RXSTATE_WRITEFIFO; break; case ETH_RTX_VAPI: break; } break; case ETH_RXSTATE_WRITEFIFO: #if 1 send_word = ((unsigned long)eth->rx_buff[eth->rx.bytes_read] << 24) | ((unsigned long)eth->rx_buff[eth->rx.bytes_read+1] << 16) | ((unsigned long)eth->rx_buff[eth->rx.bytes_read+2] << 8) | ((unsigned long)eth->rx_buff[eth->rx.bytes_read+3] ); set_direct32( eth->rx.bd_addr + eth->rx.bytes_read, send_word, &breakpoint, 0, 0); /* update counters */ debug (3, "Write %ld, left %ld - %08lXd\n", eth->rx.bytes_read, eth->rx.bytes_left, send_word); eth->rx.bytes_left -= 4; eth->rx.bytes_read += 4; #else set_direct8( eth->rx.bd_addr + eth->rx.bytes_read, eth->rx_buff[eth->rx.bytes_read], &breakpoint, 0, 0); eth->rx.bytes_left -= 1; eth->rx.bytes_read += 1; #endif if ( eth->rx.bytes_left <= 0 ) { /* Write result to bd */ SET_FIELD( eth->rx.bd, ETH_RX_BD, LENGTH, eth->rx.packet_length ); CLEAR_FLAG( eth->rx.bd, ETH_RX_BD, READY); SET_FLAG( eth->regs.int_source, ETH_INT_SOURCE, RXB); debug (4, "ETH_INT_SOURCE = %0lx\n", eth->regs.int_source); if ( eth->rx.packet_length < (GET_FIELD( eth->regs.packetlen, ETH_PACKETLEN, MINFL ) - 4) ) SET_FLAG( eth->rx.bd, ETH_RX_BD, TOOSHORT); if ( eth->rx.packet_length > GET_FIELD( eth->regs.packetlen, ETH_PACKETLEN, MAXFL ) ) SET_FLAG( eth->rx.bd, ETH_RX_BD, TOOBIG); eth->regs.bd_ram[eth->rx.bd_index] = eth->rx.bd; /* advance to next BD */ if ( TEST_FLAG( eth->rx.bd, ETH_RX_BD, WRAP ) || eth->rx.bd_index >= ETH_BD_COUNT ) eth->rx.bd_index = eth->regs.tx_bd_num << 1; else eth->rx.bd_index += 2; if ( ( TEST_FLAG( eth->regs.int_mask, ETH_INT_MASK, RXB_M ) ) && ( TEST_FLAG( eth->rx.bd, ETH_RX_BD, IRQ ) ) ) { report_interrupt( eth->mac_int ); } /* ready to receive next packet */ debug (3, "RX - entering state IDLE\n"); eth->rx.state = ETH_RXSTATE_IDLE; } break; } } /* ========================================================================= */ /* Move to next RX BD */ void eth_rx_next_packet( struct eth_device *eth ) { /* Skip any possible leftovers */ if ( eth->rx.bytes_left ) eth_skip_rx_file( eth, eth->rx.bytes_left ); } /* "Skip" bytes in RX file */ void eth_skip_rx_file( struct eth_device *eth, off_t count ) { eth->rx.offset += count; } /* Move RX file position back */ void eth_rewind_rx_file( struct eth_device *eth, off_t count ) { eth->rx.offset -= count; } /* * Utility function to read from the ethernet RX file * This function moves the file pointer to the current place in the packet before reading */ ssize_t eth_read_rx_file( struct eth_device *eth, void *buf, size_t count ) { ssize_t result; if ( eth->rx.fd <= 0 ) { debug( 3, "Ethernet: No RX file\n" ); return 0; } if ( eth->rx.offset ) if ( lseek( eth->rx.fd, *(eth->rx.offset), SEEK_SET ) == (off_t)-1 ) { debug( 3, "Ethernet: Error seeking RX file\n" ); return 0; } result = read( eth->rx.fd, buf, count ); debug (4, "Ethernet: read result = %d \n", result); if ( eth->rx.offset && result >= 0 ) *(eth->rx.offset) += result; return result; } /* ========================================================================= */ /* Reset. Initializes all registers to default and places devices in memory address space. */ void eth_reset() { static int first_time = 1; unsigned i; if (!config.nethernets) return; if ( first_time ) memset( eths, 0, sizeof(eths) ); for ( i = 0; i < MAX_ETHERNETS; ++ i ) { struct eth_device *eth = &(eths[i]); if (!HAVE_ETH_PHY && eth->rtx_type == ETH_RTX_SOCK) { fprintf (stderr, "Ethernet phy not enabled in this configuration. Configure with --enable-ethphy.\n"); exit (1); } eth->eth_number = i; eth_reset_controller( eth ); if ( eth->baseaddr && first_time ) register_memoryarea( eth->baseaddr, ETH_ADDR_SPACE, 4, 0, eth_read32, eth_write32 ); } if ( first_time ) first_time = 0; } /* ========================================================================= */ static void eth_reset_controller(struct eth_device *eth) { int i = eth->eth_number; #if HAVE_ETH_PHY int j; struct sockaddr_ll sll; #endif /* HAVE_ETH_PHY */ eth->baseaddr = config.ethernets[i].baseaddr; if ( eth->baseaddr != 0 ) { /* Mark which DMA controller and channels */ eth->dma = config.ethernets[i].dma; eth->mac_int = config.ethernets[i].irq; eth->tx_channel = config.ethernets[i].tx_channel; eth->rx_channel = config.ethernets[i].rx_channel; eth->rtx_type = config.ethernets[i].rtx_type; switch (eth->rtx_type) { case ETH_RTX_FILE: /* (Re-)open TX/RX files */ eth->rxfile = config.ethernets[i].rxfile; eth->txfile = config.ethernets[i].txfile; if ( eth->rxfd > 0 ) close( eth->rxfd ); if ( eth->txfd > 0 ) close( eth->txfd ); eth->rxfd = eth->txfd = -1; if ( (eth->rxfd = open( eth->rxfile, O_RDONLY )) < 0 ) fprintf( stderr, "Cannot open Ethernet RX file \"%s\"\n", eth->rxfile ); if ( (eth->txfd = open( eth->txfile, O_RDWR | O_CREAT | O_APPEND #if defined(O_SYNC) /* BSD / Mac OS X manual doesn't know about O_SYNC */ | O_SYNC #endif , S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH )) < 0 ) fprintf( stderr, "Cannot open Ethernet TX file \"%s\"\n", eth->txfile ); eth->loopback_offset = lseek( eth->txfd, 0, SEEK_END ); break; #if HAVE_ETH_PHY case ETH_RTX_SOCK: /* (Re-)open TX/RX sockets */ if (eth->rtx_sock != 0) break; debug (3, "RTX oppening socket...\n"); eth->rtx_sock = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL)); if (eth->rtx_sock == -1) { fprintf( stderr, "Cannot open rtx_sock.\n"); return; } /* get interface index number */ debug (3, "RTX getting interface...\n"); memset(&(eth->ifr), 0, sizeof(eth->ifr)); strncpy(eth->ifr.ifr_name, config.ethernets[i].sockif, IFNAMSIZ); if (ioctl(eth->rtx_sock, SIOCGIFINDEX, &(eth->ifr)) == -1) { fprintf( stderr, "SIOCGIFINDEX failed!\n"); return; } debug (3, "RTX Socket Interface : %d\n", eth->ifr.ifr_ifindex); /* Bind to interface... */ debug (3, "Binding to the interface ifindex=%d\n", eth->ifr.ifr_ifindex); memset(&sll, 0xff, sizeof(sll)); sll.sll_family = AF_PACKET; /* allways AF_PACKET */ sll.sll_protocol = htons(ETH_P_ALL); sll.sll_ifindex = eth->ifr.ifr_ifindex; if (bind(eth->rtx_sock, (struct sockaddr *)&sll, sizeof(sll)) == -1) { fprintf( stderr, "Error bind().\n"); return; } /* first, flush all received packets. */ debug (3, "Flush"); do { fd_set fds; struct timeval t; debug( 3, "."); FD_ZERO(&fds); FD_SET(eth->rtx_sock, &fds); memset(&t, 0, sizeof(t)); j = select(FD_SETSIZE, &fds, NULL, NULL, &t); if (j > 0) recv(eth->rtx_sock, eth->rx_buff, j, 0); } while (j); debug (3, "\n"); break; #endif /* HAVE_ETH_PHY */ } /* Set registers to default values */ memset( &(eth->regs), 0, sizeof(eth->regs) ); eth->regs.moder = 0x0000A000; eth->regs.ipgt = 0x00000012; eth->regs.ipgr1 = 0x0000000C; eth->regs.ipgr2 = 0x00000012; eth->regs.packetlen = 0x003C0600; eth->regs.collconf = 0x000F003F; eth->regs.miimoder = 0x00000064; eth->regs.tx_bd_num = 0x00000040; /* Initialize TX/RX status */ memset( &(eth->tx), 0, sizeof(eth->tx) ); memset( &(eth->rx), 0, sizeof(eth->rx) ); eth->rx.bd_index = eth->regs.tx_bd_num << 1; /* Initialize VAPI */ if (config.ethernets[i].base_vapi_id) { eth->base_vapi_id = config.ethernets[i].base_vapi_id; vapi_install_multi_handler( eth->base_vapi_id, ETH_NUM_VAPI_IDS, eth_vapi_read ); } } } /* ========================================================================= */ /* Print register values on stdout */ void eth_status( void ) { unsigned i; for ( i = 0; i < MAX_ETHERNETS; ++ i ) { struct eth_device *eth = &(eths[i]); if ( eth->baseaddr == 0 ) continue; PRINTF( "\nEthernet MAC %u at 0x%"PRIxADDR":\n", i, eth->baseaddr ); PRINTF( "MODER : 0x%08lX\n", eth->regs.moder ); PRINTF( "INT_SOURCE : 0x%08lX\n", eth->regs.int_source ); PRINTF( "INT_MASK : 0x%08lX\n", eth->regs.int_mask ); PRINTF( "IPGT : 0x%08lX\n", eth->regs.ipgt ); PRINTF( "IPGR1 : 0x%08lX\n", eth->regs.ipgr1 ); PRINTF( "IPGR2 : 0x%08lX\n", eth->regs.ipgr2 ); PRINTF( "PACKETLEN : 0x%08lX\n", eth->regs.packetlen ); PRINTF( "COLLCONF : 0x%08lX\n", eth->regs.collconf ); PRINTF( "TX_BD_NUM : 0x%08lX\n", eth->regs.tx_bd_num ); PRINTF( "CTRLMODER : 0x%08lX\n", eth->regs.controlmoder ); PRINTF( "MIIMODER : 0x%08lX\n", eth->regs.miimoder ); PRINTF( "MIICOMMAND : 0x%08lX\n", eth->regs.miicommand ); PRINTF( "MIIADDRESS : 0x%08lX\n", eth->regs.miiaddress ); PRINTF( "MIITX_DATA : 0x%08lX\n", eth->regs.miitx_data ); PRINTF( "MIIRX_DATA : 0x%08lX\n", eth->regs.miirx_data ); PRINTF( "MIISTATUS : 0x%08lX\n", eth->regs.miistatus ); PRINTF( "MAC Address : %02X:%02X:%02X:%02X:%02X:%02X\n", eth->mac_address[0], eth->mac_address[1], eth->mac_address[2], eth->mac_address[3], eth->mac_address[4], eth->mac_address[5] ); PRINTF( "HASH0 : 0x%08lX\n", eth->regs.hash0 ); PRINTF( "HASH1 : 0x%08lX\n", eth->regs.hash1 ); } } /* ========================================================================= */ /* Simulation hook. Must be called every clock cycle to simulate Ethernet MAC. */ void eth_clock() { unsigned i; for ( i = 0; i < config.nethernets; ++ i ) { eth_controller_tx_clock( &(eths[i]) ); eth_controller_rx_clock( &(eths[i]) ); } } /* ========================================================================= */ /* Read a register */ uint32_t eth_read32( oraddr_t addr ) { struct eth_device *eth; if ( !eth_find_controller( addr, ð, &addr ) ) { PRINTF( "eth_read32( 0x%"PRIxADDR" ): Not in registered range(s)\n", addr ); return 0; } switch( addr ) { case ETH_MODER: return eth->regs.moder; case ETH_INT_SOURCE: return eth->regs.int_source; case ETH_INT_MASK: return eth->regs.int_mask; case ETH_IPGT: return eth->regs.ipgt; case ETH_IPGR1: return eth->regs.ipgr1; case ETH_IPGR2: return eth->regs.ipgr2; case ETH_PACKETLEN: return eth->regs.packetlen; case ETH_COLLCONF: return eth->regs.collconf; case ETH_TX_BD_NUM: return eth->regs.tx_bd_num; case ETH_CTRLMODER: return eth->regs.controlmoder; case ETH_MIIMODER: return eth->regs.miimoder; case ETH_MIICOMMAND: return eth->regs.miicommand; case ETH_MIIADDRESS: return eth->regs.miiaddress; case ETH_MIITX_DATA: return eth->regs.miitx_data; case ETH_MIIRX_DATA: return eth->regs.miirx_data; case ETH_MIISTATUS: return eth->regs.miistatus; case ETH_MAC_ADDR0: return (((unsigned long)eth->mac_address[3]) << 24) | (((unsigned long)eth->mac_address[2]) << 16) | (((unsigned long)eth->mac_address[1]) << 8) | (unsigned long)eth->mac_address[0]; case ETH_MAC_ADDR1: return (((unsigned long)eth->mac_address[5]) << 8) | (unsigned long)eth->mac_address[4]; case ETH_HASH0: return eth->regs.hash0; case ETH_HASH1: return eth->regs.hash1; /*case ETH_DMA_RX_TX: return eth_rx( eth );*/ } if ( (addr >= ETH_BD_BASE) && (addr < ETH_BD_BASE + ETH_BD_SPACE) ) return eth->regs.bd_ram[(addr - ETH_BD_BASE) / 4]; PRINTF( "eth_read32( 0x%"PRIxADDR" ): Illegal address\n", addr + eth->baseaddr ); runtime.sim.cont_run = 0; return 0; } /* ========================================================================= */ /* Write a register */ void eth_write32( oraddr_t addr, uint32_t value ) { struct eth_device *eth; if ( !eth_find_controller( addr, ð, &addr ) ) { PRINTF( "eth_write32( 0x%"PRIxADDR" ): Not in registered range(s)\n", addr ); return; } switch( addr ) { case ETH_MODER: eth->regs.moder = value; if (TEST_FLAG(value, ETH_MODER, RST)) eth_reset(); return; case ETH_INT_SOURCE: eth->regs.int_source &= ~value; return; case ETH_INT_MASK: eth->regs.int_mask = value; return; case ETH_IPGT: eth->regs.ipgt = value; return; case ETH_IPGR1: eth->regs.ipgr1 = value; return; case ETH_IPGR2: eth->regs.ipgr2 = value; return; case ETH_PACKETLEN: eth->regs.packetlen = value; return; case ETH_COLLCONF: eth->regs.collconf = value; return; case ETH_TX_BD_NUM: eth_write_tx_bd_num( eth, value ); return; case ETH_CTRLMODER: eth->regs.controlmoder = value; return; case ETH_MIIMODER: eth->regs.miimoder = value; return; case ETH_MIICOMMAND: eth->regs.miicommand = value; return; case ETH_MIIADDRESS: eth->regs.miiaddress = value; return; case ETH_MIITX_DATA: eth->regs.miitx_data = value; return; case ETH_MIIRX_DATA: eth->regs.miirx_data = value; return; case ETH_MIISTATUS: eth->regs.miistatus = value; return; case ETH_MAC_ADDR0: eth->mac_address[0] = value & 0xFF; eth->mac_address[1] = (value >> 8) & 0xFF; eth->mac_address[2] = (value >> 16) & 0xFF; eth->mac_address[3] = (value >> 24) & 0xFF; return; case ETH_MAC_ADDR1: eth->mac_address[4] = value & 0xFF; eth->mac_address[5] = (value >> 8) & 0xFF; return; case ETH_HASH0: eth->regs.hash0 = value; return; case ETH_HASH1: eth->regs.hash1 = value; return; /*case ETH_DMA_RX_TX: eth_tx( eth, value ); return;*/ } if ( (addr >= ETH_BD_BASE) && (addr < ETH_BD_BASE + ETH_BD_SPACE) ) { eth->regs.bd_ram[(addr - ETH_BD_BASE) / 4] = value; return; } PRINTF( "eth_write32( 0x%"PRIxADDR" ): Illegal address\n", addr + eth->baseaddr ); runtime.sim.cont_run = 0; return; } /* ========================================================================= */ /* * VAPI connection to outside */ static void eth_vapi_read (unsigned long id, unsigned long data) { unsigned long which; struct eth_device *eth = eth_find_vapi_device( id, &which ); debug( 5, "ETH: id %08lx, data %08lx\n", id, data ); if ( !eth ) { debug( 1, "ETH: VAPI ID %08lx is not ours!\n", id ); return; } switch( which ) { case ETH_VAPI_DATA: break; case ETH_VAPI_CTRL: break; } } /* ========================================================================= */ /* When TX_BD_NUM is written, also reset current RX BD index */ void eth_write_tx_bd_num( struct eth_device *eth, unsigned long value ) { eth->regs.tx_bd_num = value & 0xFF; eth->rx.bd_index = eth->regs.tx_bd_num << 1; } /* ========================================================================= */ /* Convert a memory address to a oontroller struct and relative address. Return nonzero on success */ int eth_find_controller( oraddr_t addr, struct eth_device **eth, oraddr_t *reladdr ) { unsigned i; *eth = NULL; for ( i = 0; i < MAX_ETHERNETS && *eth == NULL; ++ i ) { if ( (addr >= eths[i].baseaddr) && (addr < eths[i].baseaddr + ETH_ADDR_SPACE) ) *eth = &(eths[i]); } /* verify we found a controller */ if ( *eth == NULL ) return 0; /* Verify legal address */ if ( (addr - (*eth)->baseaddr) % 4 != 0 ) return 0; *reladdr = addr - (*eth)->baseaddr; return 1; } /* * Convert VAPI id to controller struct and relative address. */ struct eth_device *eth_find_vapi_device( unsigned long id, unsigned long *which ) { unsigned i; for ( i=0; i<config.nethernets; i++) { if ( (id>=eths[i].base_vapi_id) && (id < eths[i].base_vapi_id + ETH_NUM_VAPI_IDS)) { *which = id - eths[i].base_vapi_id; return &(eths[i]); } } return NULL; } /*-----------------------------------------------[ Ethernet configuration ]---*/ void eth_nethernets (union param_val val, void *dat) { if (val.int_val >= 0 && val.int_val < MAX_ETHERNETS) config.nethernets = val.int_val; else CONFIG_ERROR("invalid number of devices."); } void eth_baseaddr (union param_val val, void *dat) { if (current_device >= 0 && current_device < config.nethernets) config.ethernets[current_device].baseaddr = val.addr_val; else CONFIG_ERROR("invalid device number."); } void eth_dma (union param_val val, void *dat) { if (current_device >= 0 && current_device < config.nethernets) config.ethernets[current_device].dma = val.int_val; else CONFIG_ERROR("invalid device number."); } void eth_rtx_type (union param_val val, void *dat) { if (current_device >= 0 && current_device < config.nethernets) config.ethernets[current_device].rtx_type = val.int_val; else CONFIG_ERROR("invalid device number."); } void eth_rx_channel (union param_val val, void *dat) { if (current_device >= 0 && current_device < config.nethernets) config.ethernets[current_device].rx_channel = val.int_val; else CONFIG_ERROR("invalid device number."); } void eth_tx_channel (union param_val val, void *dat) { if (current_device >= 0 && current_device < config.nethernets) config.ethernets[current_device].rx_channel = val.int_val; else CONFIG_ERROR("invalid device number."); } void eth_rxfile (union param_val val, void *dat) { if (current_device >= 0 && current_device < config.nethernets) strcpy (config.ethernets[current_device].rxfile, val.str_val); else CONFIG_ERROR("invalid device number."); } void eth_txfile(union param_val val, void *dat) { if (current_device >= 0 && current_device < config.nethernets) strcpy (config.ethernets[current_device].txfile, val.str_val); else CONFIG_ERROR("invalid device number."); } void eth_sockif(union param_val val, void *dat) { if (current_device >= 0 && current_device < config.nethernets) strcpy (config.ethernets[current_device].sockif, val.str_val); else CONFIG_ERROR("invalid device number."); } void eth_irq(union param_val val, void *dat) { if (current_device >= 0 && current_device < config.nethernets) config.ethernets[current_device].irq = val.int_val; else CONFIG_ERROR("invalid device number."); } void eth_vapi_id(union param_val val, void *dat) { if (current_device >= 0 && current_device < config.nethernets) config.ethernets[current_device].base_vapi_id = val.int_val; else CONFIG_ERROR("invalid device number."); } void reg_ethernet_sec(void) { struct config_section *sec = reg_config_sec("ethernet", NULL, NULL); reg_config_param(sec, "nethernets", paramt_int, eth_nethernets); reg_config_param(sec, "device", paramt_int, change_device); reg_config_param(sec, "irq", paramt_int, eth_irq); reg_config_param(sec, "enddevice", paramt_int, end_device); reg_config_param(sec, "baseaddr", paramt_int, eth_baseaddr); reg_config_param(sec, "dma", paramt_int, eth_dma); reg_config_param(sec, "rtx_type", paramt_int, eth_rtx_type); reg_config_param(sec, "rx_channel", paramt_int, eth_rx_channel); reg_config_param(sec, "tx_channel", paramt_int, eth_tx_channel); reg_config_param(sec, "rxfile", paramt_str, eth_rxfile); reg_config_param(sec, "txfile", paramt_str, eth_txfile); reg_config_param(sec, "sockif", paramt_str, eth_sockif); reg_config_param(sec, "vapi_id", paramt_int, eth_vapi_id); }
Go to most recent revision | Compare with Previous | Blame | View Log