ecos: packages/io/eth/current/src/net/eth

annotate packages/io/eth/current/src/net/eth_drv.c @ 208:e0c0827131d1 ecos

Merge from eCos master repository on 2002-05-20-20:11:54-BST

author	jlarmour
date	Mon, 20 May 2002 22:19:26 +0000
parents	920b9b754b53
children	d2c90368aeef

rev	line source
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1 //==========================================================================
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	2 //
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	3 // src/net/eth_drv.c
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	4 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	5 // Hardware independent ethernet driver
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	6 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	7 //==========================================================================
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	8 //####ECOSGPLCOPYRIGHTBEGIN####
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	9 // -------------------------------------------
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	10 // This file is part of eCos, the Embedded Configurable Operating System.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	11 // Copyright (C) 1998, 1999, 2000, 2001, 2002 Red Hat, Inc.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	12 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	13 // eCos is free software; you can redistribute it and/or modify it under
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	14 // the terms of the GNU General Public License as published by the Free
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	15 // Software Foundation; either version 2 or (at your option) any later version.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	16 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	17 // eCos is distributed in the hope that it will be useful, but WITHOUT ANY
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	18 // WARRANTY; without even the implied warranty of MERCHANTABILITY or
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	19 // FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	20 // for more details.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	21 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	22 // You should have received a copy of the GNU General Public License along
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	23 // with eCos; if not, write to the Free Software Foundation, Inc.,
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	24 // 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	25 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	26 // As a special exception, if other files instantiate templates or use macros
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	27 // or inline functions from this file, or you compile this file and link it
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	28 // with other works to produce a work based on this file, this file does not
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	29 // by itself cause the resulting work to be covered by the GNU General Public
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	30 // License. However the source code for this file must still be made available
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	31 // in accordance with section (3) of the GNU General Public License.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	32 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	33 // This exception does not invalidate any other reasons why a work based on
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	34 // this file might be covered by the GNU General Public License.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	35 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	36 // Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	37 // at http://sources.redhat.com/ecos/ecos-license
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	38 // -------------------------------------------
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	39 //####ECOSGPLCOPYRIGHTEND####
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	40 //==========================================================================
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	41 //#####DESCRIPTIONBEGIN####
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	42 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	43 // Author(s): gthomas
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	44 // Contributors: gthomas
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	45 // Date: 2000-01-10
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	46 // Purpose: Hardware independent ethernet driver
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	47 // Description:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	48 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	49 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	50 //####DESCRIPTIONEND####
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	51 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	52 //==========================================================================
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	53
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	54 // High-level ethernet driver
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	55
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	56 #include <sys/param.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	57 #include <sys/errno.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	58 #include <sys/ioctl.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	59 #include <sys/mbuf.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	60 #include <sys/socket.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	61
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	62 #include <net/if.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	63 #include <net/if_dl.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	64 #include <net/if_types.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	65 #include <net/netisr.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	66
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	67 #ifdef INET
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	68 #include <netinet/in.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	69 #include <netinet/in_systm.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	70 #include <netinet/in_var.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	71 #include <netinet/ip.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	72 #include <netinet/if_ether.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	73 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	74
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	75 #if NBPFILTER > 0
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	76 #include <net/bpf.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	77 #include <net/bpfdesc.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	78 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	79
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	80 #include <cyg/infra/cyg_ass.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	81 #include <cyg/hal/drv_api.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	82 #include <pkgconf/hal.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	83 #include <cyg/hal/hal_if.h>
126 518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	84 #include <pkgconf/io_eth_drivers.h> // module configury; SIMULATED_FAILURES
184 022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	85 #include <pkgconf/net.h> // CYGPKG_NET_FAST_THREAD_TICKLE_DEVS?
126 518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	86
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	87 #include <cyg/io/eth/eth_drv.h>
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	88 #include <cyg/io/eth/netdev.h>
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	89
188 ab68c1701603 Merge from eCos master repository on 2001-10-06-22:03:08-BST jlarmour parents: 184 diff changeset	90 #ifndef min
ab68c1701603 Merge from eCos master repository on 2001-10-06-22:03:08-BST jlarmour parents: 184 diff changeset	91 #define min( _x_, _y_ ) ((_x_) < (_y_) ? (_x_) : (_y_))
ab68c1701603 Merge from eCos master repository on 2001-10-06-22:03:08-BST jlarmour parents: 184 diff changeset	92 #endif
126 518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	93
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	94 // ------------------------------------------------------------------------
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	95 #ifdef CYGPKG_IO_ETH_DRIVERS_SIMULATED_FAILURES
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	96
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	97 #define noLOG_RANDOM 32 // so you can tell this is really being random
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	98 #ifdef LOG_RANDOM
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	99 static struct {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	100 unsigned int *which;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	101 unsigned int random;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	102 unsigned int r100;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	103 } random_log[LOG_RANDOM];
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	104
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	105 static int random_index = 0;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	106 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	107
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	108 static unsigned int
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	109 randomize( unsigned int *p )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	110 {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	111 unsigned int r100;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	112 HAL_CLOCK_READ( &r100 );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	113 r100 ^= *p;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	114 p = (r100 1103515245) + 12345;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	115 r100 &= 127;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	116 if ( r100 >= 100 ) // spread the overflow around evenly
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	117 r100 = 4 * (r100 - 100);
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	118 if ( r100 >= 100 ) // and again - (125,126,127=>100,104,108)
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	119 r100 = 12 * (r100 - 100); // =>(0,48,96)
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	120 #ifdef LOG_RANDOM
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	121 random_log[random_index].which = p;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	122 random_log[random_index].random = *p;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	123 random_log[random_index].r100 = r100;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	124 random_index++;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	125 random_index &= (LOG_RANDOM-1);
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	126 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	127 return r100;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	128 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	129
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	130 #define SIMULATE_FAIL_SEND 1
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	131 #define SIMULATE_FAIL_RECV 2
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	132 #define SIMULATE_FAIL_CORRUPT 3
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	133
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	134 static struct simulated_failure_state {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	135 struct eth_drv_sc *sc;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	136 unsigned int r_tx_fail;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	137 unsigned int r_rx_fail;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	138 unsigned int r_rx_corrupt;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	139 cyg_tick_count_t droptime;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	140 cyg_tick_count_t passtime;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	141 } simulated_failure_states[2] = {{0},{0}};
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	142
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	143 static int
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	144 simulate_fail( struct eth_drv_sc *sc, int which )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	145 {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	146 struct simulated_failure_state *s;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	147
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	148 for ( s = &simulated_failure_states[0]; s < &simulated_failure_states[2];
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	149 s++ ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	150 if ( 0 == s->sc ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	151 s->sc = sc;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	152 s->r_tx_fail = (unsigned int)sc;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	153 s->r_rx_fail = (unsigned int)sc ^ 0x01234567;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	154 s->r_rx_corrupt = (unsigned int)sc ^ 0xdeadbeef;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	155 s->droptime = 0;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	156 s->passtime = 0;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	157 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	158 if ( sc == s->sc )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	159 break;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	160 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	161 if ( &simulated_failure_states[2] == s ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	162 CYG_FAIL( "No free slot in simulated_failure_states[]" );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	163 return 1; // always fail
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	164 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	165
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	166 #ifdef CYGPKG_IO_ETH_DRIVERS_SIMULATE_LINE_CUT
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	167 // Regardless of the question, we say "yes" during the period of
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	168 // unpluggedness...
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	169 {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	170 cyg_tick_count_t now = cyg_current_time();
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	171 if ( now > s->droptime && 0 == s->passtime ) { // [initial condition]
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	172 s->droptime = 0; // go into a passing phase
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	173 (void)randomize( &s->r_tx_fail );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	174 (void)randomize( &s->r_rx_fail );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	175 (void)randomize( &s->r_rx_corrupt );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	176 s->passtime = s->r_tx_fail + s->r_rx_fail + s->r_rx_corrupt;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	177 s->passtime &= 0x3fff; // 16k cS is up to 160S, about 2.5 minutes
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	178 s->passtime += now;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	179 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	180 else if ( now > s->passtime && 0 == s->droptime ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	181 s->passtime = 0; // go into a dropping phase
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	182 (void)randomize( &s->r_tx_fail );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	183 (void)randomize( &s->r_rx_fail );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	184 (void)randomize( &s->r_rx_corrupt );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	185 s->droptime = s->r_tx_fail + s->r_rx_fail + s->r_rx_corrupt;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	186 s->droptime &= 0x0fff; // 4k cS is up to 40S, about 1/2 a minute
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	187 s->droptime += now;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	188 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	189
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	190 if ( now < s->droptime )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	191 return 1; // Say "no"
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	192 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	193 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	194
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	195 switch ( which ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	196 #ifdef CYGPKG_IO_ETH_DRIVERS_SIMULATE_DROP_TX
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	197 case SIMULATE_FAIL_SEND: {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	198 unsigned int z = randomize( &s->r_tx_fail );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	199 return z < CYGPKG_IO_ETH_DRIVERS_SIMULATE_DROP_TX;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	200 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	201 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	202 #ifdef CYGPKG_IO_ETH_DRIVERS_SIMULATE_DROP_RX
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	203 case SIMULATE_FAIL_RECV: {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	204 unsigned int z = randomize( &s->r_rx_fail );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	205 return z < CYGPKG_IO_ETH_DRIVERS_SIMULATE_DROP_RX;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	206 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	207 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	208 #ifdef CYGPKG_IO_ETH_DRIVERS_SIMULATE_CORRUPT_RX
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	209 case SIMULATE_FAIL_CORRUPT: {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	210 unsigned int z = randomize( &s->r_rx_corrupt );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	211 return z < CYGPKG_IO_ETH_DRIVERS_SIMULATE_CORRUPT_RX;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	212 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	213 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	214 default:
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	215 // do nothing - for when options above are not enabled.
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	216 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	217 return 0;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	218 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	219
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	220 #define noLOG_CORRUPTION 32 // so you can tell this is really being random
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	221 #ifdef LOG_CORRUPTION
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	222 static struct {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	223 int len;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	224 int thislen;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	225 int off;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	226 unsigned char xor;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	227 unsigned char idx;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	228 } corruption_log[LOG_CORRUPTION];
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	229
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	230 static int corruption_index = 0;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	231 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	232
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	233 static void
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	234 simulate_fail_corrupt_sglist( struct eth_drv_sg *sg_list, int sg_len )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	235 {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	236 unsigned int z, len, i, off;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	237 HAL_CLOCK_READ( &z );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	238 z += simulated_failure_states[0].r_rx_corrupt;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	239 z += simulated_failure_states[1].r_rx_corrupt;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	240
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	241 CYG_ASSERT( MAX_ETH_DRV_SG >= sg_len, "sg_len overflow in corrupt" );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	242
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	243 for ( i = 0, len = 0; i < sg_len && sg_list[i].buf && sg_list[i].len; i++ )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	244 len =+ sg_list[i].len;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	245
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	246 CYG_ASSERT( 1500 >= len, "sg...len > ether MTU" );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	247 if ( 14 >= len ) // normal ether header
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	248 return;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	249
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	250 off = z & 2047; // next (2^N-1) > MTU
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	251 while ( off > len )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	252 off -= len;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	253
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	254 for ( i = 0; i < sg_len && sg_list[i].buf && sg_list[i].len; i++ ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	255 if ( off < sg_list[i].len ) { // corrupt this one
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	256 unsigned char p = (unsigned char )sg_list[i].buf;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	257 p[off] ^= (0xff & (z >> 11));
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	258 #ifdef LOG_CORRUPTION
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	259 corruption_log[corruption_index].len = len;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	260 corruption_log[corruption_index].thislen = sg_list[i].len;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	261 corruption_log[corruption_index].off = off;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	262 corruption_log[corruption_index].xor = (0xff & (z >> 11));
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	263 corruption_log[corruption_index].idx = i;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	264 corruption_index++;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	265 corruption_index &= (LOG_CORRUPTION-1);
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	266 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	267 return;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	268 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	269 off -= sg_list[i].len;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	270 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	271 CYG_FAIL( "Didn't corrupt anything" );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	272 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	273
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	274 #endif // CYGPKG_IO_ETH_DRIVERS_SIMULATED_FAILURES
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	275 // ------------------------------------------------------------------------
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	276
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	277 #ifdef CYGSEM_HAL_VIRTUAL_VECTOR_SUPPORT
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	278
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	279 #include <cyg/hal/hal_if.h>
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	280
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	281 // Use with care! Local variable defined!
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	282 #define START_CONSOLE() \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	283 { /* NEW BLOCK */ \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	284 int _cur_console = \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	285 CYGACC_CALL_IF_SET_CONSOLE_COMM(CYGNUM_CALL_IF_SET_COMM_ID_QUERY_CURRENT); \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	286 { \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	287 int i; \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	288 if ( CYGACC_CALL_IF_FLASH_CFG_OP( CYGNUM_CALL_IF_FLASH_CFG_GET, \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	289 "info_console_force", &i, \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	290 CYGNUM_FLASH_CFG_OP_CONFIG_BOOL ) ) { \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	291 if ( i ) { \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	292 if ( CYGACC_CALL_IF_FLASH_CFG_OP( CYGNUM_CALL_IF_FLASH_CFG_GET, \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	293 "info_console_number", &i, \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	294 CYGNUM_FLASH_CFG_OP_CONFIG_INT ) ) { \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	295 /* Then i is the console to force it to: */ \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	296 CYGACC_CALL_IF_SET_CONSOLE_COMM( i ); \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	297 } \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	298 } \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	299 } \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	300 }
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	301
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	302 #define END_CONSOLE() \
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	303 CYGACC_CALL_IF_SET_CONSOLE_COMM(_cur_console); \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	304 } /* END BLOCK */
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	305
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	306 #else
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	307 #define START_CONSOLE()
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	308 #define END_CONSOLE()
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	309 #endif
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	310 // ------------------------------------------------------------------------
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	311
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	312 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	313 extern char *_ioctl_name(u_long cmd);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	314 typedef void void_fun(void *);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	315 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	316
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	317 static int eth_drv_ioctl(struct ifnet *, u_long, caddr_t);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	318 static void eth_drv_send(struct ifnet *);
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	319 static void eth_drv_start(struct eth_drv_sc *sc);
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	320
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	321 #ifdef CYGDBG_IO_ETH_DRIVERS_DEBUG
678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	322 int cyg_io_eth_net_debug = CYGDBG_IO_ETH_DRIVERS_DEBUG_VERBOSITY;
678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	323 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	324
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	325 // Interfaces exported to drivers
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	326
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	327 static void eth_drv_init(struct eth_drv_sc sc, unsigned char enaddr);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	328 static void eth_drv_recv(struct eth_drv_sc *sc, int total_len);
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	329 static void eth_drv_tx_done(struct eth_drv_sc *sc, CYG_ADDRESS key, int status);
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	330
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	331 struct eth_drv_funs eth_drv_funs = {eth_drv_init, eth_drv_recv, eth_drv_tx_done};
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	332
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	333 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	334 // This function is called during system initialization to register a
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	335 // network interface with the system.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	336 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	337 static void
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	338 eth_drv_init(struct eth_drv_sc sc, unsigned char enaddr)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	339 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	340 struct ifnet *ifp = &sc->sc_arpcom.ac_if;
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	341 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	342 int unit;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	343 char np, xp;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	344 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	345
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	346 // Set up hardware address
149 52c99470ec11 Merge from eCos master repository on 2001-01-19-06:43:03-GMT jlarmour parents: 147 diff changeset	347 if (NULL != enaddr)
52c99470ec11 Merge from eCos master repository on 2001-01-19-06:43:03-GMT jlarmour parents: 147 diff changeset	348 bcopy(enaddr, &sc->sc_arpcom.ac_enaddr, ETHER_ADDR_LEN);
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	349
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	350 // Initialize ifnet structure
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	351 ifp->if_softc = sc;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	352 ifp->if_start = eth_drv_send;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	353 ifp->if_ioctl = eth_drv_ioctl;
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	354 ifp->if_flags = IFF_BROADCAST \| IFF_SIMPLEX \| IFF_MULTICAST;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	355 #ifdef IFF_NOTRAILERS
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	356 ifp->if_flags \|= IFF_NOTRAILERS;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	357 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	358 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	359 ifp->if_name = xp = ifp->if_xname;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	360 np = (char *)sc->dev_name;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	361 unit = 0;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	362 while (np && !((np >= '0') && (np <= '9'))) xp++ = *np++;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	363 if (*np) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	364 *xp = '\0';
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	365 while (*np) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	366 unit = (unit * 10) + (*np++ - '0');
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	367 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	368 ifp->if_unit = unit;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	369 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	370 ifp->if_init = (void_fun *)eth_drv_start;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	371 ifp->if_output = ether_output;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	372 #else
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	373 bcopy((void *)sc->dev_name, ifp->if_xname, IFNAMSIZ);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	374 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	375 sc->state = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	376
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	377 // Attach the interface
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	378 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	379 ether_ifattach(ifp, 0);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	380 #else
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	381 if_attach(ifp);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	382 ether_ifattach(ifp);
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	383 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	384
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	385 #ifdef CYGSEM_HAL_VIRTUAL_VECTOR_DIAG
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	386 // Set up interfaces so debug environment can share this device
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	387 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	388 void *dbg = CYGACC_CALL_IF_DBG_DATA();
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	389 if (!dbg) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	390 CYGACC_CALL_IF_DBG_DATA_SET((void *)sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	391 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	392 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	393 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	394 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	395
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	396 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	397 // This [internal] function will be called to stop activity on an interface.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	398 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	399 static void
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	400 eth_drv_stop(struct eth_drv_sc *sc)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	401 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	402 (sc->funs->stop)(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	403 sc->state &= ~ETH_DRV_STATE_ACTIVE;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	404 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	405
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	406 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	407 // This [internal] function will be called to start activity on an interface.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	408 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	409 static void
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	410 eth_drv_start(struct eth_drv_sc *sc)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	411 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	412 struct ifnet *ifp = &sc->sc_arpcom.ac_if;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	413 // Perform any hardware initialization
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	414 (sc->funs->start)(sc, (unsigned char *)&sc->sc_arpcom.ac_enaddr, 0);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	415 // Set 'running' flag, and clear output active flag.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	416 ifp->if_flags \|= IFF_RUNNING;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	417 ifp->if_flags &= ~IFF_OACTIVE;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	418 sc->state \|= ETH_DRV_STATE_ACTIVE;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	419 eth_drv_send(ifp); // Try and start up transmit
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	420 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	421
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	422 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	423 // This function supports "I/O control" operations on an interface.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	424 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	425 static int
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	426 eth_drv_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	427 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	428 struct eth_drv_sc *sc = ifp->if_softc;
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	429 #ifndef CYGPKG_NET_FREEBSD_STACK
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	430 struct ifaddr ifa = (struct ifaddr ) data;
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	431 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	432 struct ifreq ifr = (struct ifreq )data;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	433 int s, error = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	434
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	435 // DEBUG
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	436 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	437 log(LOG_IOCTL, "%s: cmd: %s, data:\n", __FUNCTION__, _ioctl_name(cmd));
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	438 log_dump(LOG_IOCTL, data, 32);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	439 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	440 // DEBUG
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	441
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	442 s = splnet();
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	443
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	444 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	445 if ((error = ether_ioctl(ifp, cmd, data)) > 0) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	446 #else
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	447 if ((error = ether_ioctl(ifp, &sc->sc_arpcom, cmd, data)) > 0) {
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	448 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	449 splx(s);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	450 return error;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	451 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	452
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	453 switch (cmd) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	454
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	455 case SIOCSIFADDR:
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	456 #ifndef CYGPKG_NET_FREEBSD_STACK // Now in if_ethersubr.c
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	457 ifp->if_flags \|= IFF_UP;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	458
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	459 switch (ifa->ifa_addr->sa_family) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	460 #ifdef INET
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	461 case AF_INET:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	462 eth_drv_start(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	463 arp_ifinit(&sc->sc_arpcom, ifa);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	464 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	465 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	466 default:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	467 eth_drv_start(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	468 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	469 }
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	470 #endif // CYGPKG_NET_FREEBSD_STACK
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	471 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	472
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	473 case SIOCGIFHWADDR:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	474 // Get hardware (MAC) address
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	475 ifr->ifr_hwaddr.sa_family = AF_INET;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	476 bcopy(&sc->sc_arpcom.ac_enaddr, &ifr->ifr_hwaddr.sa_data, ETHER_ADDR_LEN);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	477 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	478
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	479 case SIOCSIFHWADDR:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	480 // Set hardware (MAC) address
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	481 bcopy(&ifr->ifr_hwaddr.sa_data, &sc->sc_arpcom.ac_enaddr, ETHER_ADDR_LEN);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	482 if ((sc->funs->control)(sc, ETH_DRV_SET_MAC_ADDRESS,
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	483 &sc->sc_arpcom.ac_enaddr, ETHER_ADDR_LEN)) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	484 error = EINVAL;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	485 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	486 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	487
117 bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	488 #ifdef SIOCGIFSTATS
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	489 case SIOCGIFSTATS:
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	490 #ifdef SIOCGIFSTATSUD
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	491 case SIOCGIFSTATSUD:
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	492 #endif
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	493 // Get interface statistics:
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	494 if ((sc->funs->control)(sc, (cmd == SIOCGIFSTATS)
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	495 ? ETH_DRV_GET_IF_STATS
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	496 : ETH_DRV_GET_IF_STATS_UD,
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	497 data, 0 ) ) {
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	498 error = EINVAL;
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	499 }
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	500 break;
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	501 #endif // SIOCGIFSTATS
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	502
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	503 case SIOCSIFFLAGS:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	504 if ((ifp->if_flags & IFF_UP) == 0 &&
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	505 (ifp->if_flags & IFF_RUNNING) != 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	506 /*
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	507 * If interface is marked down and it is running, then
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	508 * stop it.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	509 */
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	510 eth_drv_stop(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	511 ifp->if_flags &= ~IFF_RUNNING;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	512 } else
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	513 if ((ifp->if_flags & IFF_UP) != 0 &&
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	514 (ifp->if_flags & IFF_RUNNING) == 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	515 /*
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	516 * If interface is marked up and it is stopped, then
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	517 * start it.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	518 */
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	519 eth_drv_start(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	520 } else {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	521 /*
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	522 * Reset the interface to pick up changes in any other
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	523 * flags that affect hardware registers.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	524 */
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	525 eth_drv_stop(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	526 eth_drv_start(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	527 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	528 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	529
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	530 #ifdef CYGPKG_NET_FREEBSD_STACK
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	531 case SIOCADDMULTI:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	532 case SIOCDELMULTI:
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	533 {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	534 struct ifmultiaddr *ifma;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	535 struct eth_drv_mc_list mc_list;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	536 int mode = (ifp->if_flags & IFF_ALLMULTI) ? ETH_DRV_SET_MC_ALL :
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	537 ETH_DRV_SET_MC_LIST;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	538
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	539 #ifdef DEBUG
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	540 log(LOG_ADDR, "%s Multi\n",(cmd == SIOCADDMULTI) ? "Add" : "Del");
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	541 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	542 mc_list.len = 0;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	543 LIST_FOREACH(ifma, &((ifp)->if_multiaddrs), ifma_link) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	544 if (ifma->ifma_addr->sa_family != AF_LINK) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	545 continue;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	546 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	547 #ifdef DEBUG
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	548 log_dump(LOG_ADDR, LLADDR((struct sockaddr_dl *)ifma->ifma_addr), 6);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	549 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	550 if ((LLADDR((struct sockaddr_dl *)ifma->ifma_addr)[0] & 0x01) == 0) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	551 #ifdef DEBUG
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	552 log(LOG_ADDR, "** Not a multicast address - ignored\n");
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	553 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	554 continue;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	555 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	556 if (mc_list.len < ETH_DRV_MAX_MC) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	557 bcopy(LLADDR((struct sockaddr_dl *)ifma->ifma_addr),
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	558 mc_list.addrs[mc_list.len], ETHER_ADDR_LEN);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	559 mc_list.len++;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	560 } else {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	561 mode = ETH_DRV_SET_MC_ALL;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	562 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	563 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	564 // Note: drivers may behave like IFF_ALLMULTI if the list is
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	565 // more than their hardware can handle, e.g. some can only handle 1.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	566 if ((sc->funs->control)(sc, mode, &mc_list, sizeof(mc_list))) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	567 diag_printf("Driver can't set multi-cast mode\n");
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	568 error = EINVAL;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	569 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	570 break;
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	571 }
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	572 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	573
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	574 default:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	575 error = EINVAL;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	576 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	577 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	578
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	579 splx(s);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	580 return (error);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	581 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	582
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	583 //
179 391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	584 // Control whether any special locking needs to take place if we intend to
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	585 // cooperate with a ROM monitor (e.g. RedBoot) using this hardware.
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	586 //
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	587 #if defined(CYGSEM_HAL_USE_ROM_MONITOR) && \
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	588 defined(CYGSEM_HAL_VIRTUAL_VECTOR_DIAG) && \
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	589 !defined(CYGSEM_HAL_VIRTUAL_VECTOR_CLAIM_COMMS)
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	590
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	591 // Indicate that special locking precautions are warranted.
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	592 #define _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	593
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	594 // This defines the [well known] channel that RedBoot will use when it is
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	595 // using the network hardware for the debug channel.
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	596 #define RedBoot_TCP_CHANNEL CYGNUM_HAL_VIRTUAL_VECTOR_COMM_CHANNELS
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	597
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	598 // Define this if you ever need to call 'diag_printf()' from interrupt level
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	599 // code (ISR) and the debug channel might be using the network hardware. If
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	600 // this is not the case, then disabling interrupts here is over-kill.
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	601 //#define _LOCK_USING_INTERRUPTS
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	602 #endif
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	603
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	604 //
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	605 // This routine is called to start transmitting if there is data
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	606 // available.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	607 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	608 static void
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	609 eth_drv_send(struct ifnet *ifp)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	610 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	611 struct eth_drv_sc *sc = ifp->if_softc;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	612 struct eth_drv_sg sg_list[MAX_ETH_DRV_SG];
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	613 int sg_len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	614 struct mbuf m0, m;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	615 int len, total_len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	616 unsigned char *data;
179 391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	617 #ifdef _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	618 #ifdef _LOCK_USING_INTERRUPTS
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	619 cyg_uint32 ints;
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	620 #endif
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	621 bool need_lock = false;
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	622 int debug_chan;
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	623 #endif // _LOCK_WITH_ROM_MONITOR
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	624
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	625 // This is now only called from network threads, so no guarding is
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	626 // required; locking is in place via the splfoo() mechanism already.
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	627
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	628 if ((ifp->if_flags & IFF_RUNNING) != IFF_RUNNING) {
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	629 return;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	630 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	631
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	632 while ((sc->funs->can_send)(sc) > 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	633 IF_DEQUEUE(&ifp->if_snd, m0);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	634 if (m0 == 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	635 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	636 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	637
126 518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	638 #ifdef CYGPKG_IO_ETH_DRIVERS_SIMULATED_FAILURES
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	639 if ( simulate_fail( sc, SIMULATE_FAIL_SEND ) ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	640 // must free the mbufs
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	641 m_freem(m0);
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	642 continue; // next packet to send
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	643 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	644 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	645
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	646 #ifdef CYGDBG_IO_ETH_DRIVERS_DEBUG
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	647 if (cyg_io_eth_net_debug) {
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	648 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	649 diag_printf("Sending %d bytes\n", m0->m_pkthdr.len);
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	650 END_CONSOLE();
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	651 }
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	652 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	653
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	654 /* We need to use m->m_pkthdr.len, so require the header */
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	655 if ((m0->m_flags & M_PKTHDR) == 0)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	656 panic("eth_drv_send: no header mbuf");
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	657
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	658 #if NBPFILTER > 0
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	659 /* Tap off here if there is a BPF listener. */
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	660 if (ifp->if_bpf)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	661 bpf_mtap(ifp->if_bpf, m0);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	662 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	663
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	664 // Extract data pointers (don't actually move data here)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	665 sg_len = 0; total_len = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	666 for (m = m0; m ; m = m->m_next) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	667 data = mtod(m, u_char *);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	668 len = m->m_len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	669 total_len += len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	670 sg_list[sg_len].buf = (CYG_ADDRESS)data;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	671 sg_list[sg_len].len = len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	672 if ( len )
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	673 sg_len++;
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	674 #ifdef CYGDBG_IO_ETH_DRIVERS_DEBUG
678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	675 if (cyg_io_eth_net_debug) {
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	676 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	677 diag_printf("xmit %d bytes at %x sg[%d]\n", len, data, sg_len);
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	678 if ( cyg_io_eth_net_debug > 1)
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	679 diag_dump_buf(data, len);
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	680 END_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	681 }
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	682 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	683 if ( MAX_ETH_DRV_SG < sg_len ) {
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	684 #ifdef CYGPKG_IO_ETH_DRIVERS_WARN_NO_MBUFS
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	685 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	686 diag_printf("too many mbufs to tx, %d > %d\n", sg_len, MAX_ETH_DRV_SG );
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	687 END_CONSOLE();
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	688 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	689 sg_len = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	690 break; // drop it on the floor
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	691 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	692 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	693
179 391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	694 #ifdef _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	695 // Firm lock on this portion of the driver. Since we are about to
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	696 // start messing with the actual hardware, it is imperative that the
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	697 // current thread not loose control of the CPU at this time. Otherwise,
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	698 // the hardware could be left in an unusable state. This caution is
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	699 // only warranted if there is a possibility of some other thread trying
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	700 // to use the hardware simultaneously. The network stack would prevent
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	701 // this implicitly since all accesses are controlled by the "splX()"
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	702 // locks, but if there is a ROM monitor, such as RedBoot, also using
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	703 // the hardware, all bets are off.
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	704
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	705 // Note: these operations can be avoided if it were well known that
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	706 // RedBoot was not using the network hardware for diagnostic I/O. This
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	707 // can be inferred by checking which I/O channel RedBoot is currently
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	708 // hooked to.
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	709 debug_chan = CYGACC_CALL_IF_SET_DEBUG_COMM(CYGNUM_CALL_IF_SET_COMM_ID_QUERY_CURRENT);
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	710 if (debug_chan == RedBoot_TCP_CHANNEL) {
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	711 need_lock = true;
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	712 #ifdef _LOCK_USING_INTERRUPTS
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	713 HAL_DISABLE_INTERRUPTS(ints);
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	714 #endif
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	715 cyg_drv_dsr_lock();
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	716 }
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	717 #endif // _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	718
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	719 // Tell hardware to send this packet
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	720 if ( sg_len )
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	721 (sc->funs->send)(sc, sg_list, sg_len, total_len, (unsigned long)m0);
179 391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	722
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	723 #ifdef _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	724 // Unlock the driver & hardware. It can once again be safely shared.
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	725 if (need_lock) {
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	726 cyg_drv_dsr_unlock();
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	727 #ifdef _LOCK_USING_INTERRUPTS
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	728 HAL_RESTORE_INTERRUPTS(ints);
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	729 #endif
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	730 }
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	731 #endif // _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	732 #undef _LOCK_WITH_ROM_MONITOR
180 2bdd82a025e1 Quick fix for eth driver build problem jlarmour parents: 179 diff changeset	733 }
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	734 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	735
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	736 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	737 // This function is called from the hardware driver when an output operation
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	738 // has completed - i.e. the packet has been sent.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	739 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	740 static struct mbuf *mbuf_key;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	741
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	742 static void
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	743 eth_drv_tx_done(struct eth_drv_sc *sc, CYG_ADDRESS key, int status)
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	744 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	745 struct ifnet *ifp = &sc->sc_arpcom.ac_if;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	746 struct mbuf m0 = (struct mbuf )key;
177 4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	747 CYGARC_HAL_SAVE_GP();
147 d397fc472bcf Merge from eCos master repository on 2001-01-05-06:43:02-GMT jlarmour parents: 145 diff changeset	748
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	749 // Check for errors here (via 'status')
147 d397fc472bcf Merge from eCos master repository on 2001-01-05-06:43:02-GMT jlarmour parents: 145 diff changeset	750 ifp->if_opackets++;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	751 // Done with packet
182 f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	752
f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	753 // Guard against a NULL return - can be caused by race conditions in
f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	754 // the driver, this is the neatest fixup:
f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	755 if (m0) {
f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	756 mbuf_key = m0;
f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	757 m_freem(m0);
f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	758 }
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	759 // Start another if possible
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	760 eth_drv_send(ifp);
177 4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	761 CYGARC_HAL_RESTORE_GP();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	762 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	763
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	764 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	765 // This function is called from a hardware driver to indicate that an input
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	766 // packet has arrived. The routine will set up appropriate network resources
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	767 // (mbuf's) to hold the data and call back into the driver to retrieve the data.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	768 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	769 static void
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	770 eth_drv_recv(struct eth_drv_sc *sc, int total_len)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	771 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	772 struct ifnet *ifp = &sc->sc_arpcom.ac_if;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	773 struct ether_header _eh, *eh=&_eh;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	774 struct mbuf top, mp, m;
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	775 int mlen;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	776 unsigned char *data;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	777 struct eth_drv_sg sg_list[MAX_ETH_DRV_SG];
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	778 int sg_len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	779
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	780 if ((ifp->if_flags & IFF_RUNNING) != IFF_RUNNING) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	781 return; // Interface not up, ignore this request
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	782 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	783
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	784 CYG_ASSERT( 0 != total_len, "total_len is zero!" );
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	785 CYG_ASSERT( 0 <= total_len, "total_len is negative!" );
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	786 CYG_ASSERT( sizeof( struct ether_header ) <= total_len,
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	787 "No ether header here!" );
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	788
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	789 if ( total_len < sizeof( struct ether_header ) )
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	790 // Our arithmetic below would go wrong
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	791 return;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	792
177 4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	793 CYGARC_HAL_SAVE_GP(); // This is down here to make matching restore neat
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	794
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	795 /* Pull packet off interface. */
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	796 MGETHDR(m, M_DONTWAIT, MT_DATA);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	797 if (m == 0) {
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	798 #ifdef CYGPKG_IO_ETH_DRIVERS_WARN_NO_MBUFS
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	799 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	800 diag_printf("warning: eth_recv out of MBUFs\n");
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	801 END_CONSOLE();
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	802 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	803 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	804
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	805 // Set up buffers
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	806 // Unload ethernet header separately so IP/UDP/TCP headers are aligned
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	807 sg_list[0].buf = (CYG_ADDRESS)eh;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	808 sg_list[0].len = sizeof(*eh);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	809 sg_len = 1;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	810
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	811 // Compute total length (minus ethernet header)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	812 total_len -= sizeof(*eh);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	813
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	814 top = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	815 mlen = MHLEN;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	816 mp = &top;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	817
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	818 if (m) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	819 m->m_pkthdr.rcvif = ifp;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	820 m->m_pkthdr.len = total_len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	821 } else {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	822 sg_list[sg_len].buf = (CYG_ADDRESS)0;
169 11b54a94cf58 Merge from eCos master repository on 2001-07-06-06:43:02-BST jlarmour parents: 160 diff changeset	823 sg_list[sg_len].len = total_len;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	824 sg_len++;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	825 total_len = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	826 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	827
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	828 while (total_len > 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	829 if (top) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	830 MGET(m, M_DONTWAIT, MT_DATA);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	831 if (m == 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	832 m_freem(top);
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	833 #ifdef CYGPKG_IO_ETH_DRIVERS_WARN_NO_MBUFS
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	834 START_CONSOLE();
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	835 diag_printf("out of MBUFs [2]");
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	836 END_CONSOLE();
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	837 #endif
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	838 sg_list[sg_len].buf = (CYG_ADDRESS)0;
169 11b54a94cf58 Merge from eCos master repository on 2001-07-06-06:43:02-BST jlarmour parents: 160 diff changeset	839 sg_list[sg_len].len = total_len;
11b54a94cf58 Merge from eCos master repository on 2001-07-06-06:43:02-BST jlarmour parents: 160 diff changeset	840 sg_len++;
11b54a94cf58 Merge from eCos master repository on 2001-07-06-06:43:02-BST jlarmour parents: 160 diff changeset	841 top = 0;
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	842 break;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	843 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	844 mlen = MLEN;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	845 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	846 if (total_len >= MINCLSIZE) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	847 MCLGET(m, M_DONTWAIT);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	848 if ((m->m_flags & M_EXT) == 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	849 m_freem(top);
160 0d0f03f76f6a Merge from eCos master repository on 2001-06-01-18:52:13-BST jlarmour parents: 149 diff changeset	850 m_free(m);
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	851 #ifdef CYGPKG_IO_ETH_DRIVERS_WARN_NO_MBUFS
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	852 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	853 diag_printf("warning: eth_recv out of MBUFs\n");
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	854 END_CONSOLE();
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	855 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	856 sg_list[sg_len].buf = (CYG_ADDRESS)0;
169 11b54a94cf58 Merge from eCos master repository on 2001-07-06-06:43:02-BST jlarmour parents: 160 diff changeset	857 sg_list[sg_len].len = total_len;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	858 sg_len++;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	859 top = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	860 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	861 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	862 mlen = MCLBYTES;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	863 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	864 m->m_len = mlen = min(total_len, mlen);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	865 total_len -= mlen;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	866 data = mtod(m, caddr_t);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	867 sg_list[sg_len].buf = (CYG_ADDRESS)data;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	868 sg_list[sg_len].len = mlen;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	869 sg_len++;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	870 *mp = m;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	871 mp = &m->m_next;
160 0d0f03f76f6a Merge from eCos master repository on 2001-06-01-18:52:13-BST jlarmour parents: 149 diff changeset	872 } // endwhile
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	873
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	874 // Ask hardware to unload buffers
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	875 (sc->funs->recv)(sc, sg_list, sg_len);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	876
126 518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	877 #ifdef CYGPKG_IO_ETH_DRIVERS_SIMULATED_FAILURES
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	878 if ( simulate_fail( sc, SIMULATE_FAIL_RECV ) ) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	879 // toss the packet - note that some hardware gets
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	880 // fussy if the packet isn't "unloaded", thus we
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	881 // have to wait until now to throw it away
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	882 if (top) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	883 m_free(top);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	884 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	885 ifp->if_ierrors++;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	886 return;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	887 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	888
126 518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	889 if ( simulate_fail( sc, SIMULATE_FAIL_CORRUPT ) ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	890 // Corrupt the data
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	891 simulate_fail_corrupt_sglist( sg_list, sg_len );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	892 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	893 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	894
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	895 #ifdef CYGDBG_IO_ETH_DRIVERS_DEBUG
678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	896 if (cyg_io_eth_net_debug) {
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	897 int i;
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	898 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	899 for (i = 0; i < sg_len; i++) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	900 if (sg_list[i].buf) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	901 diag_printf("rx %d bytes at %x sg[%d]\n", sg_list[i].len, sg_list[i].buf, i);
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	902 if ( cyg_io_eth_net_debug > 1 )
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	903 diag_dump_buf((void *)sg_list[i].buf, sg_list[i].len);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	904 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	905 }
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	906 END_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	907 }
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	908 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	909 m = top;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	910 if (m == 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	911 ifp->if_ierrors++;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	912 }
177 4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	913 else {
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	914 ifp->if_ipackets++;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	915
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	916 #if NBPFILTER > 0
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	917 #error FIXME - Need mbuf with ethernet header attached
177 4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	918 /*
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	919 * Check if there's a BPF listener on this interface.
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	920 * If so, hand off the raw packet to bpf.
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	921 */
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	922 if (ifp->if_bpf)
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	923 bpf_mtap(ifp->if_bpf, m);
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	924 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	925
177 4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	926 // Push data into protocol stacks
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	927 ether_input(ifp, eh, m);
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	928 }
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	929 CYGARC_HAL_RESTORE_GP();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	930 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	931
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	932
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	933 // ------------------------------------------------------------------------
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	934 // DSR to schedule network delivery thread
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	935
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	936 extern void ecos_synch_eth_drv_dsr(void); // from ecos/timeout.c in net stack
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	937
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	938 void
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	939 eth_drv_dsr(cyg_vector_t vector,
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	940 cyg_ucount32 count,
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	941 cyg_addrword_t data)
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	942 {
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	943 struct eth_drv_sc sc = (struct eth_drv_sc )data;
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	944
184 022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	945 #ifdef CYGDBG_USE_ASSERTS
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	946 // then check that this really is a "sc"
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	947 {
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	948 cyg_netdevtab_entry_t *t;
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	949 for (t = &__NETDEVTAB__[0]; t != &__NETDEVTAB_END__; t++)
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	950 if ( ((struct eth_drv_sc *)t->device_instance) == sc )
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	951 break; // found it
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	952 CYG_ASSERT( t != &__NETDEVTAB_END__, "eth_drv_dsr: Failed to find sc in NETDEVTAB" );
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	953 }
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	954 #endif // Checking code
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	955
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	956 sc->state \|= ETH_DRV_NEEDS_DELIVERY;
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	957
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	958 ecos_synch_eth_drv_dsr(); // [request] run delivery function for this dev
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	959 }
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	960
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	961 // This is called from the delivery thread, to do just that:
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	962 void eth_drv_run_deliveries( void )
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	963 {
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	964 cyg_netdevtab_entry_t *t;
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	965 for (t = &__NETDEVTAB__[0]; t != &__NETDEVTAB_END__; t++) {
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	966 struct eth_drv_sc sc = (struct eth_drv_sc )t->device_instance;
128 0c2b7be0d798 Merge from eCos master repository on 2000-10-12-08:46:24-BST jlarmour parents: 126 diff changeset	967 if ( ETH_DRV_NEEDS_DELIVERY & sc->state ) {
145 2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 130 diff changeset	968 #if defined(CYGDBG_HAL_DEBUG_GDB_CTRLC_SUPPORT)
2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 130 diff changeset	969 cyg_bool was_ctrlc_int;
2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 130 diff changeset	970 #endif
128 0c2b7be0d798 Merge from eCos master repository on 2000-10-12-08:46:24-BST jlarmour parents: 126 diff changeset	971 sc->state &=~ETH_DRV_NEEDS_DELIVERY;
145 2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 130 diff changeset	972 #if defined(CYGDBG_HAL_DEBUG_GDB_CTRLC_SUPPORT)
160 0d0f03f76f6a Merge from eCos master repository on 2001-06-01-18:52:13-BST jlarmour parents: 149 diff changeset	973 was_ctrlc_int = HAL_CTRLC_CHECK((*sc->funs->int_vector)(sc), (int)sc);
145 2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 130 diff changeset	974 if (!was_ctrlc_int) // Fall through and run normal code
2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 130 diff changeset	975 #endif
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	976 (*sc->funs->deliver)(sc);
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	977 }
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	978 }
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	979 }
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	980
184 022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	981 // This is called from the delivery thread, to unstick devices if there is
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	982 // no network activity.
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	983 #ifdef CYGPKG_NET_FAST_THREAD_TICKLE_DEVS
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	984 void eth_drv_tickle_devices( void )
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	985 {
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	986 cyg_netdevtab_entry_t *t;
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	987 for (t = &__NETDEVTAB__[0]; t != &__NETDEVTAB_END__; t++) {
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	988 struct eth_drv_sc sc = (struct eth_drv_sc )t->device_instance;
195 67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	989 if ( ETH_DRV_STATE_ACTIVE & sc->state ) {
67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	990 struct ifnet *ifp = &sc->sc_arpcom.ac_if;
67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	991 // Try to dequeue a packet for this interface, if we can. This
67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	992 // will call can_send() for active interfaces. It is calls to
67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	993 // this function from tx_done() which normally provide
67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	994 // continuous transmissions; otherwise we do not get control.
67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	995 // This call fixes that.
67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	996 eth_drv_send(ifp);
67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	997 }
184 022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	998 }
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	999 }
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	1000 #endif // CYGPKG_NET_FAST_THREAD_TICKLE_DEVS
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	1001
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	1002 // ------------------------------------------------------------------------
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	1003
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1004 #ifdef CYGPKG_IO_PCMCIA
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1005 // Lookup a 'netdev' entry, assuming that it is an ethernet device.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1006 cyg_netdevtab_entry_t *
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1007 eth_drv_netdev(char *name)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1008 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1009 cyg_netdevtab_entry_t *t;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1010 struct eth_drv_sc *sc;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1011 for (t = &__NETDEVTAB__[0]; t != &__NETDEVTAB_END__; t++) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1012 sc = (struct eth_drv_sc *)t->device_instance;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1013 if (strcmp(sc->dev_name, name) == 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1014 return t;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1015 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1016 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1017 return (cyg_netdevtab_entry_t *)NULL;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1018 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1019 #endif // CYGPKG_IO_PCMCIA
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1020
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	1021 // EOF src/net/eth_drv.c

Mercurial > ecos

annotate packages/io/eth/current/src/net/eth_drv.c @ 208:e0c0827131d1 ecos