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

annotate packages/io/eth/current/src/net/eth_drv.c @ 828:a6926bb063e1

* src/net/eth_drv.c: Added calls to cyg_net_show_mbufs() whenever we see an out-of-mbufs problem.

author	nickg
date	Mon, 17 Mar 2003 18:37:21 +0000
parents	e2b797ca39b4
children	b56e22bed6a2

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.
256 1eb79d208648 Fix compile error. gthomas parents: 251 diff changeset	12 // Copyright (C) 2002 Gary Thomas
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	13 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	14 // 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	15 // 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	16 // 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	17 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	18 // 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	19 // 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	20 // 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	21 // for more details.
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	22 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	23 // 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	24 // 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	25 // 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	26 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	27 // 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	28 // 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	29 // 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	30 // 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	31 // 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	32 // 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	33 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	34 // 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	35 // 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	36 //
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	37 // Alternative licenses for eCos may be arranged by contacting Red Hat, Inc.
210 d2c90368aeef Merge from eCos master repository on 2002-05-23-21:39:14-BST jlarmour parents: 208 diff changeset	38 // at http://sources.redhat.com/ecos/ecos-license/
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	39 // -------------------------------------------
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	40 //####ECOSGPLCOPYRIGHTEND####
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	41 //==========================================================================
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	42 //#####DESCRIPTIONBEGIN####
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	43 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	44 // Author(s): gthomas
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	45 // Contributors: gthomas
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	46 // Date: 2000-01-10
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	47 // Purpose: Hardware independent ethernet driver
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	48 // Description:
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 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	51 //####DESCRIPTIONEND####
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
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	55 // High-level ethernet driver
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	56
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	57 #include <sys/param.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	58 #include <sys/errno.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	59 #include <sys/ioctl.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	60 #include <sys/mbuf.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	61 #include <sys/socket.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	62
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	63 #include <net/if.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	64 #include <net/if_dl.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	65 #include <net/if_types.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	66 #include <net/netisr.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	67
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	68 #ifdef INET
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	69 #include <netinet/in.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	70 #include <netinet/in_systm.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	71 #include <netinet/in_var.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	72 #include <netinet/ip.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	73 #include <netinet/if_ether.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	74 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	75
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	76 #if NBPFILTER > 0
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	77 #include <net/bpf.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	78 #include <net/bpfdesc.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	79 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	80
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	81 #include <cyg/infra/cyg_ass.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	82 #include <cyg/hal/drv_api.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	83 #include <pkgconf/hal.h>
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	84 #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	85 #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	86 #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	87
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	88 #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	89 #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	90
188 ab68c1701603 Merge from eCos master repository on 2001-10-06-22:03:08-BST jlarmour parents: 184 diff changeset	91 #ifndef min
ab68c1701603 Merge from eCos master repository on 2001-10-06-22:03:08-BST jlarmour parents: 184 diff changeset	92 #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	93 #endif
126 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 // ------------------------------------------------------------------------
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	96 #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	97
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	98 #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	99 #ifdef LOG_RANDOM
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	100 static struct {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	101 unsigned int *which;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	102 unsigned int random;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	103 unsigned int r100;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	104 } random_log[LOG_RANDOM];
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	105
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	106 static int random_index = 0;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	107 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	108
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	109 static unsigned int
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	110 randomize( unsigned int *p )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	111 {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	112 unsigned int r100;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	113 HAL_CLOCK_READ( &r100 );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	114 r100 ^= *p;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	115 p = (r100 1103515245) + 12345;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	116 r100 &= 127;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	117 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	118 r100 = 4 * (r100 - 100);
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	119 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	120 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	121 #ifdef LOG_RANDOM
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	122 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	123 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	124 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	125 random_index++;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	126 random_index &= (LOG_RANDOM-1);
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	127 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	128 return r100;
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
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	131 #define SIMULATE_FAIL_SEND 1
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	132 #define SIMULATE_FAIL_RECV 2
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	133 #define SIMULATE_FAIL_CORRUPT 3
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	134
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	135 static struct simulated_failure_state {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	136 struct eth_drv_sc *sc;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	137 unsigned int r_tx_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_fail;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	139 unsigned int r_rx_corrupt;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	140 cyg_tick_count_t droptime;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	141 cyg_tick_count_t passtime;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	142 } 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	143
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	144 static int
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	145 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	146 {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	147 struct simulated_failure_state *s;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	148
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	149 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	150 s++ ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	151 if ( 0 == s->sc ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	152 s->sc = sc;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	153 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	154 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	155 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	156 s->droptime = 0;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	157 s->passtime = 0;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	158 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	159 if ( sc == s->sc )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	160 break;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	161 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	162 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	163 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	164 return 1; // always fail
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
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	167 #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	168 // 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	169 // unpluggedness...
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	170 {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	171 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	172 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	173 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	174 (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	175 (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	176 (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	177 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	178 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	179 s->passtime += now;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	180 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	181 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	182 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	183 (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	184 (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	185 (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	186 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	187 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	188 s->droptime += now;
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
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	191 if ( now < s->droptime )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	192 return 1; // Say "no"
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	193 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	194 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	195
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	196 switch ( which ) {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	197 #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	198 case SIMULATE_FAIL_SEND: {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	199 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	200 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	201 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	202 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	203 #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	204 case SIMULATE_FAIL_RECV: {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	205 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	206 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	207 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	208 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	209 #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	210 case SIMULATE_FAIL_CORRUPT: {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	211 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	212 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	213 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	214 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	215 default:
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	216 // 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	217 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	218 return 0;
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
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	221 #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	222 #ifdef LOG_CORRUPTION
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	223 static struct {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	224 int len;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	225 int thislen;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	226 int off;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	227 unsigned char xor;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	228 unsigned char idx;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	229 } corruption_log[LOG_CORRUPTION];
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	230
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	231 static int corruption_index = 0;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	232 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	233
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	234 static void
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	235 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	236 {
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	237 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	238 HAL_CLOCK_READ( &z );
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	239 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	240 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	241
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	242 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	243
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	244 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	245 len =+ sg_list[i].len;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	246
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	247 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	248 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	249 return;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	250
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	251 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	252 while ( off > len )
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	253 off -= len;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	254
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	255 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	256 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	257 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	258 p[off] ^= (0xff & (z >> 11));
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	259 #ifdef LOG_CORRUPTION
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	260 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	261 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	262 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	263 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	264 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	265 corruption_index++;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	266 corruption_index &= (LOG_CORRUPTION-1);
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	267 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	268 return;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	269 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	270 off -= sg_list[i].len;
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	271 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	272 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	273 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	274
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	275 #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	276 // ------------------------------------------------------------------------
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	277
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	278 #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	279
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	280 #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	281
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	282 // 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	283 #define START_CONSOLE() \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	284 { /* NEW BLOCK */ \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	285 int _cur_console = \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	286 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	287 { \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	288 int i; \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	289 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	290 "info_console_force", &i, \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	291 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	292 if ( i ) { \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	293 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	294 "info_console_number", &i, \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	295 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	296 /* 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	297 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	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 } \
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	301 }
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	302
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	303 #define END_CONSOLE() \
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	304 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	305 } /* END BLOCK */
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	306
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	307 #else
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	308 #define START_CONSOLE()
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	309 #define END_CONSOLE()
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	310 #endif
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	311 // ------------------------------------------------------------------------
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	312
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	313 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	314 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	315 typedef void void_fun(void *);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	316 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	317
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	318 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	319 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	320 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	321
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	322 #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	323 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	324 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	325
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	326 // Interfaces exported to drivers
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	327
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	328 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	329 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	330 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	331
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	332 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	333
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	334 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	335 // 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	336 // network interface with the system.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	337 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	338 static void
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	339 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	340 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	341 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	342 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	343 int unit;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	344 char np, xp;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	345 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	346
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	347 // Set up hardware address
149 52c99470ec11 Merge from eCos master repository on 2001-01-19-06:43:03-GMT jlarmour parents: 147 diff changeset	348 if (NULL != enaddr)
52c99470ec11 Merge from eCos master repository on 2001-01-19-06:43:03-GMT jlarmour parents: 147 diff changeset	349 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	350
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	351 // Initialize ifnet structure
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	352 ifp->if_softc = sc;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	353 ifp->if_start = eth_drv_send;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	354 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	355 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	356 #ifdef IFF_NOTRAILERS
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	357 ifp->if_flags \|= IFF_NOTRAILERS;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	358 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	359 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	360 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	361 np = (char *)sc->dev_name;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	362 unit = 0;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	363 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	364 if (*np) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	365 *xp = '\0';
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	366 while (*np) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	367 unit = (unit * 10) + (*np++ - '0');
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	368 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	369 ifp->if_unit = unit;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	370 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	371 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	372 ifp->if_output = ether_output;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	373 #else
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	374 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	375 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	376 sc->state = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	377
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	378 // Attach the interface
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	379 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	380 ether_ifattach(ifp, 0);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	381 #else
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	382 if_attach(ifp);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	383 ether_ifattach(ifp);
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	384 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	385
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	386 #ifdef CYGSEM_HAL_VIRTUAL_VECTOR_DIAG
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	387 // 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	388 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	389 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	390 if (!dbg) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	391 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	392 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	393 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	394 #endif
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 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	398 // 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	399 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	400 static void
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	401 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	402 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	403 (sc->funs->stop)(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	404 sc->state &= ~ETH_DRV_STATE_ACTIVE;
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 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	408 // 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	409 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	410 static void
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	411 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	412 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	413 struct ifnet *ifp = &sc->sc_arpcom.ac_if;
256 1eb79d208648 Fix compile error. gthomas parents: 251 diff changeset	414
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	415 // Perform any hardware initialization
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	416 (sc->funs->start)(sc, (unsigned char *)&sc->sc_arpcom.ac_enaddr, 0);
256 1eb79d208648 Fix compile error. gthomas parents: 251 diff changeset	417 #ifdef CYGPKG_NET_FREEBSD_STACK
251 c8e3659acd62 Fix from Red Hat: reconfigure multicast addresses if present on startup. gthomas parents: 210 diff changeset	418 // resend multicast addresses if present
c8e3659acd62 Fix from Red Hat: reconfigure multicast addresses if present on startup. gthomas parents: 210 diff changeset	419 if(ifp->if_multiaddrs.lh_first && ifp->if_ioctl) {
256 1eb79d208648 Fix compile error. gthomas parents: 251 diff changeset	420 int s = splimp();
251 c8e3659acd62 Fix from Red Hat: reconfigure multicast addresses if present on startup. gthomas parents: 210 diff changeset	421 ifp->if_ioctl(ifp, SIOCADDMULTI, 0);
c8e3659acd62 Fix from Red Hat: reconfigure multicast addresses if present on startup. gthomas parents: 210 diff changeset	422 splx(s);
c8e3659acd62 Fix from Red Hat: reconfigure multicast addresses if present on startup. gthomas parents: 210 diff changeset	423 }
256 1eb79d208648 Fix compile error. gthomas parents: 251 diff changeset	424 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	425 // 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	426 ifp->if_flags \|= IFF_RUNNING;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	427 ifp->if_flags &= ~IFF_OACTIVE;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	428 sc->state \|= ETH_DRV_STATE_ACTIVE;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	429 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	430 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	431
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	432 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	433 // 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	434 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	435 static int
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	436 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	437 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	438 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	439 #ifndef CYGPKG_NET_FREEBSD_STACK
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	440 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	441 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	442 struct ifreq ifr = (struct ifreq )data;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	443 int s, error = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	444
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	445 // DEBUG
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	446 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	447 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	448 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	449 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	450 // DEBUG
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	451
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	452 s = splnet();
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	453
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	454 #ifdef CYGPKG_NET_FREEBSD_STACK
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	455 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	456 #else
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	457 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	458 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	459 splx(s);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	460 return error;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	461 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	462
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	463 switch (cmd) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	464
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	465 case SIOCSIFADDR:
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	466 #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	467 ifp->if_flags \|= IFF_UP;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	468
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	469 switch (ifa->ifa_addr->sa_family) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	470 #ifdef INET
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	471 case AF_INET:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	472 eth_drv_start(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	473 arp_ifinit(&sc->sc_arpcom, ifa);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	474 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	475 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	476 default:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	477 eth_drv_start(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	478 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	479 }
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	480 #endif // CYGPKG_NET_FREEBSD_STACK
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	481 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	482
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	483 case SIOCGIFHWADDR:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	484 // Get hardware (MAC) address
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	485 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	486 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	487 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	488
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	489 case SIOCSIFHWADDR:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	490 // Set hardware (MAC) address
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	491 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	492 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	493 &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	494 error = EINVAL;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	495 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	496 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	497
117 bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	498 #ifdef SIOCGIFSTATS
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	499 case SIOCGIFSTATS:
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	500 #ifdef SIOCGIFSTATSUD
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	501 case SIOCGIFSTATSUD:
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	502 #endif
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	503 // Get interface statistics:
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	504 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	505 ? ETH_DRV_GET_IF_STATS
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	506 : 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	507 data, 0 ) ) {
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	508 error = EINVAL;
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	509 }
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	510 break;
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	511 #endif // SIOCGIFSTATS
bd1a71e3e476 Merge from eCos master repository on 2000-08-25-19:22:58-BST jlarmour parents: 115 diff changeset	512
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	513 case SIOCSIFFLAGS:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	514 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	515 (ifp->if_flags & IFF_RUNNING) != 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	516 /*
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	517 * 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	518 * stop it.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	519 */
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	520 eth_drv_stop(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	521 ifp->if_flags &= ~IFF_RUNNING;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	522 } else
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	523 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	524 (ifp->if_flags & IFF_RUNNING) == 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	525 /*
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	526 * 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	527 * start it.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	528 */
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	529 eth_drv_start(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	530 } else {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	531 /*
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	532 * 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	533 * flags that affect hardware registers.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	534 */
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	535 eth_drv_stop(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	536 eth_drv_start(sc);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	537 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	538 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	539
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	540 #ifdef CYGPKG_NET_FREEBSD_STACK
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	541 case SIOCADDMULTI:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	542 case SIOCDELMULTI:
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	543 {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	544 struct ifmultiaddr *ifma;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	545 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	546 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	547 ETH_DRV_SET_MC_LIST;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	548
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	549 #ifdef DEBUG
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	550 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	551 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	552 mc_list.len = 0;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	553 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	554 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	555 continue;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	556 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	557 #ifdef DEBUG
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	558 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	559 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	560 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	561 #ifdef DEBUG
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	562 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	563 #endif
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	564 continue;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	565 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	566 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	567 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	568 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	569 mc_list.len++;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	570 } else {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	571 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	572 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	573 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	574 // 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	575 // 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	576 if ((sc->funs->control)(sc, mode, &mc_list, sizeof(mc_list))) {
581 e2b797ca39b4 * src/net/eth_drv.c: If driver can't set multi-cast, indicate it's jlarmour parents: 289 diff changeset	577 diag_printf( "[%s] Warning: Driver can't set multi-cast mode\n",
e2b797ca39b4 * src/net/eth_drv.c: If driver can't set multi-cast, indicate it's jlarmour parents: 289 diff changeset	578 __FUNCTION__ );
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	579 error = EINVAL;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	580 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	581 break;
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	582 }
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	583 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	584
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	585 default:
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	586 error = EINVAL;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	587 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	588 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	589
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	590 splx(s);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	591 return (error);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	592 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	593
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	594 //
179 391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	595 // 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	596 // 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	597 //
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	598 #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	599 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	600 !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	601
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	602 // 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	603 #define _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	604
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	605 // 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	606 // 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	607 #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	608
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	609 // 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	610 // 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	611 // 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	612 //#define _LOCK_USING_INTERRUPTS
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	613 #endif
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	614
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	615 //
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	616 // 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	617 // available.
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	618 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	619 static void
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	620 eth_drv_send(struct ifnet *ifp)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	621 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	622 struct eth_drv_sc *sc = ifp->if_softc;
289 bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	623 #if MAX_ETH_DRV_SG > 64
bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	624 static // Avoid large stack requirements
bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	625 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	626 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	627 int sg_len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	628 struct mbuf m0, m;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	629 int len, total_len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	630 unsigned char *data;
179 391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	631 #ifdef _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	632 #ifdef _LOCK_USING_INTERRUPTS
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	633 cyg_uint32 ints;
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	634 #endif
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	635 bool need_lock = false;
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	636 int debug_chan;
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	637 #endif // _LOCK_WITH_ROM_MONITOR
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	638
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	639 // 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	640 // 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	641
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	642 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	643 return;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	644 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	645
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	646 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	647 IF_DEQUEUE(&ifp->if_snd, m0);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	648 if (m0 == 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	649 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	650 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	651
126 518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	652 #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	653 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	654 // must free the mbufs
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	655 m_freem(m0);
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	656 continue; // next packet to send
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	657 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	658 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	659
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	660 #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	661 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	662 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	663 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	664 END_CONSOLE();
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	665 }
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	666 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	667
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	668 /* 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	669 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	670 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	671
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	672 #if NBPFILTER > 0
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	673 /* 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	674 if (ifp->if_bpf)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	675 bpf_mtap(ifp->if_bpf, m0);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	676 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	677
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	678 // 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	679 sg_len = 0; total_len = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	680 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	681 data = mtod(m, u_char *);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	682 len = m->m_len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	683 total_len += len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	684 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	685 sg_list[sg_len].len = len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	686 if ( len )
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	687 sg_len++;
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	688 #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	689 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	690 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	691 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	692 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	693 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	694 END_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	695 }
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	696 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	697 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	698 #ifdef CYGPKG_IO_ETH_DRIVERS_WARN_NO_MBUFS
289 bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	699 int needed = 0;
bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	700 struct mbuf *m1;
bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	701 for (m1 = m0; m1 ; m1 = m1->m_next) needed++;
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	702 START_CONSOLE();
289 bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	703 diag_printf("too many mbufs to tx, %d > %d, need %d\n",
bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	704 sg_len, MAX_ETH_DRV_SG, needed );
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	705 END_CONSOLE();
920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	706 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	707 sg_len = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	708 break; // drop it on the floor
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	709 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	710 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	711
179 391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	712 #ifdef _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	713 // 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	714 // 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	715 // 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	716 // 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	717 // 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	718 // 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	719 // 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	720 // 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	721 // 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	722
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	723 // 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	724 // 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	725 // 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	726 // hooked to.
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	727 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	728 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	729 need_lock = true;
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	730 #ifdef _LOCK_USING_INTERRUPTS
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	731 HAL_DISABLE_INTERRUPTS(ints);
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	732 #endif
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	733 cyg_drv_dsr_lock();
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	734 }
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	735 #endif // _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	736
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	737 // Tell hardware to send this packet
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	738 if ( sg_len )
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	739 (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	740
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	741 #ifdef _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	742 // 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	743 if (need_lock) {
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	744 cyg_drv_dsr_unlock();
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	745 #ifdef _LOCK_USING_INTERRUPTS
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	746 HAL_RESTORE_INTERRUPTS(ints);
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	747 #endif
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	748 }
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	749 #endif // _LOCK_WITH_ROM_MONITOR
391299f9e541 Merge from eCos master repository on 2001-08-17-16:31:54-BST jlarmour parents: 177 diff changeset	750 #undef _LOCK_WITH_ROM_MONITOR
180 2bdd82a025e1 Quick fix for eth driver build problem jlarmour parents: 179 diff changeset	751 }
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	752 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	753
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	754 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	755 // 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	756 // 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	757 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	758 static struct mbuf *mbuf_key;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	759
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	760 static void
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	761 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	762 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	763 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	764 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	765 CYGARC_HAL_SAVE_GP();
147 d397fc472bcf Merge from eCos master repository on 2001-01-05-06:43:02-GMT jlarmour parents: 145 diff changeset	766
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	767 // 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	768 ifp->if_opackets++;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	769 // Done with packet
182 f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	770
f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	771 // 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	772 // 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	773 if (m0) {
f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	774 mbuf_key = m0;
f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	775 m_freem(m0);
f62680ef1804 Merge from eCos master repository on 2001-09-07-06:43:02-BST jlarmour parents: 180 diff changeset	776 }
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	777 // Start another if possible
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	778 eth_drv_send(ifp);
177 4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	779 CYGARC_HAL_RESTORE_GP();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	780 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	781
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 // 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	784 // 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	785 // (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	786 //
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	787 static void
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	788 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	789 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	790 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	791 struct ether_header _eh, *eh=&_eh;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	792 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	793 int mlen;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	794 unsigned char *data;
289 bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	795 #if MAX_ETH_DRV_SG > 64
bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	796 static // Avoid large stack requirements
bd1db6a90df9 Fix problems with overflowing scatter-gather lists. gthomas parents: 256 diff changeset	797 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	798 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	799 int sg_len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	800
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	801 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	802 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	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 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	806 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	807 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	808 "No ether header here!" );
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	809
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	810 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	811 // Our arithmetic below would go wrong
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	812 return;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	813
177 4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	814 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	815
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	816 /* Pull packet off interface. */
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	817 MGETHDR(m, M_DONTWAIT, MT_DATA);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	818 if (m == 0) {
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	819 #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	820 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	821 diag_printf("warning: eth_recv out of MBUFs\n");
828 a6926bb063e1 * src/net/eth_drv.c: Added calls to cyg_net_show_mbufs() whenever nickg parents: 581 diff changeset	822 #ifdef CYGDBG_NET_SHOW_MBUFS
a6926bb063e1 * src/net/eth_drv.c: Added calls to cyg_net_show_mbufs() whenever nickg parents: 581 diff changeset	823 cyg_net_show_mbufs();
a6926bb063e1 * src/net/eth_drv.c: Added calls to cyg_net_show_mbufs() whenever nickg parents: 581 diff changeset	824 #endif
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	825 END_CONSOLE();
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	826 #endif
115 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
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	829 // Set up buffers
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	830 // 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	831 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	832 sg_list[0].len = sizeof(*eh);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	833 sg_len = 1;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	834
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	835 // Compute total length (minus ethernet header)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	836 total_len -= sizeof(*eh);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	837
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	838 top = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	839 mlen = MHLEN;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	840 mp = &top;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	841
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	842 if (m) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	843 m->m_pkthdr.rcvif = ifp;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	844 m->m_pkthdr.len = total_len;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	845 } else {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	846 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	847 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	848 sg_len++;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	849 total_len = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	850 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	851
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	852 while (total_len > 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	853 if (top) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	854 MGET(m, M_DONTWAIT, MT_DATA);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	855 if (m == 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	856 m_freem(top);
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	857 #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	858 START_CONSOLE();
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	859 diag_printf("out of MBUFs [2]");
828 a6926bb063e1 * src/net/eth_drv.c: Added calls to cyg_net_show_mbufs() whenever nickg parents: 581 diff changeset	860 #ifdef CYGDBG_NET_SHOW_MBUFS
a6926bb063e1 * src/net/eth_drv.c: Added calls to cyg_net_show_mbufs() whenever nickg parents: 581 diff changeset	861 cyg_net_show_mbufs();
a6926bb063e1 * src/net/eth_drv.c: Added calls to cyg_net_show_mbufs() whenever nickg parents: 581 diff changeset	862 #endif
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	863 END_CONSOLE();
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	864 #endif
eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	865 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	866 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	867 sg_len++;
11b54a94cf58 Merge from eCos master repository on 2001-07-06-06:43:02-BST jlarmour parents: 160 diff changeset	868 top = 0;
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	869 break;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	870 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	871 mlen = MLEN;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	872 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	873 if (total_len >= MINCLSIZE) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	874 MCLGET(m, M_DONTWAIT);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	875 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	876 m_freem(top);
160 0d0f03f76f6a Merge from eCos master repository on 2001-06-01-18:52:13-BST jlarmour parents: 149 diff changeset	877 m_free(m);
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	878 #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	879 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	880 diag_printf("warning: eth_recv out of MBUFs\n");
828 a6926bb063e1 * src/net/eth_drv.c: Added calls to cyg_net_show_mbufs() whenever nickg parents: 581 diff changeset	881 #ifdef CYGDBG_NET_SHOW_MBUFS
a6926bb063e1 * src/net/eth_drv.c: Added calls to cyg_net_show_mbufs() whenever nickg parents: 581 diff changeset	882 cyg_net_show_mbufs();
a6926bb063e1 * src/net/eth_drv.c: Added calls to cyg_net_show_mbufs() whenever nickg parents: 581 diff changeset	883 #endif
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	884 END_CONSOLE();
130 eb9fd8c04db3 Merge from eCos master repository on 2000-10-23-17:01:37-BST jlarmour parents: 128 diff changeset	885 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	886 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	887 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	888 sg_len++;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	889 top = 0;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	890 break;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	891 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	892 mlen = MCLBYTES;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	893 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	894 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	895 total_len -= mlen;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	896 data = mtod(m, caddr_t);
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	897 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	898 sg_list[sg_len].len = mlen;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	899 sg_len++;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	900 *mp = m;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	901 mp = &m->m_next;
160 0d0f03f76f6a Merge from eCos master repository on 2001-06-01-18:52:13-BST jlarmour parents: 149 diff changeset	902 } // endwhile
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	903
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	904 // Ask hardware to unload buffers
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	905 (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	906
126 518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	907 #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	908 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	909 // 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	910 // 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	911 // 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	912 if (top) {
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	913 m_free(top);
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	914 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	915 ifp->if_ierrors++;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	916 return;
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	917 }
e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	918
126 518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	919 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	920 // Corrupt the data
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	921 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	922 }
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	923 #endif
518f42066aba Merge from eCos master repository on 2000-09-19-06:25:26-BST jlarmour parents: 121 diff changeset	924
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	925 #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	926 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	927 int i;
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	928 START_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	929 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	930 if (sg_list[i].buf) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	931 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	932 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	933 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	934 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	935 }
199 920b9b754b53 Merge from eCos master repository on 2001-12-15-12:00:33-GMT jlarmour parents: 195 diff changeset	936 END_CONSOLE();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	937 }
191 678094f34118 Merge from eCos master repository on 2001-10-19-06:43:02-BST jlarmour parents: 188 diff changeset	938 #endif
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	939 m = top;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	940 if (m == 0) {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	941 ifp->if_ierrors++;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	942 }
177 4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	943 else {
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	944 ifp->if_ipackets++;
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	945
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	946 #if NBPFILTER > 0
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	947 #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	948 /*
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	949 * 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	950 * 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	951 */
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	952 if (ifp->if_bpf)
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	953 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	954 #endif
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	955
177 4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	956 // Push data into protocol stacks
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	957 ether_input(ifp, eh, m);
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	958 }
4c750ce71ae3 Merge from eCos master repository on 2001-08-10-19:22:57-BST jlarmour parents: 169 diff changeset	959 CYGARC_HAL_RESTORE_GP();
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	960 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	961
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	962
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 // 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	965
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	966 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	967
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	968 void
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	969 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	970 cyg_ucount32 count,
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	971 cyg_addrword_t data)
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	972 {
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	973 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	974
184 022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	975 #ifdef CYGDBG_USE_ASSERTS
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	976 // 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	977 {
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	978 cyg_netdevtab_entry_t *t;
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	979 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	980 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	981 break; // found it
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	982 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	983 }
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	984 #endif // Checking code
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	985
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	986 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	987
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	988 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	989 }
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	990
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	991 // 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	992 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	993 {
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	994 cyg_netdevtab_entry_t *t;
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	995 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	996 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	997 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	998 #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	999 cyg_bool was_ctrlc_int;
2e9a636d9de9 Merge from eCos master repository on 2000-12-21-14:18:40-GMT jlarmour parents: 130 diff changeset	1000 #endif
128 0c2b7be0d798 Merge from eCos master repository on 2000-10-12-08:46:24-BST jlarmour parents: 126 diff changeset	1001 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	1002 #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	1003 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	1004 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	1005 #endif
121 6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	1006 (*sc->funs->deliver)(sc);
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	1007 }
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	1008 }
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	1009 }
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	1010
184 022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	1011 // 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	1012 // no network activity.
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	1013 #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	1014 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	1015 {
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	1016 cyg_netdevtab_entry_t *t;
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	1017 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	1018 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	1019 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	1020 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	1021 // 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	1022 // 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	1023 // 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	1024 // 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	1025 // This call fixes that.
67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	1026 eth_drv_send(ifp);
67850532eebb Merge from eCos master repository on 2001-11-02-06:43:03-GMT jlarmour parents: 191 diff changeset	1027 }
184 022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	1028 }
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	1029 }
022f1e506033 Merge from eCos master repository on 2001-10-02-17:59:22-BST jlarmour parents: 182 diff changeset	1030 #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	1031
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	1032 // ------------------------------------------------------------------------
6bd9d475ed4b Merge from eCos master repository on 2000-09-04-20:50:20-BST jlarmour parents: 117 diff changeset	1033
115 6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1034 #ifdef CYGPKG_IO_PCMCIA
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1035 // 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	1036 cyg_netdevtab_entry_t *
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1037 eth_drv_netdev(char *name)
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1038 {
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1039 cyg_netdevtab_entry_t *t;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1040 struct eth_drv_sc *sc;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1041 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	1042 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	1043 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	1044 return t;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1045 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1046 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1047 return (cyg_netdevtab_entry_t *)NULL;
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1048 }
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1049 #endif // CYGPKG_IO_PCMCIA
6ed91473a1cd Merge from eCos master repository on 2000-08-21-22:40:54-BST jlarmour parents: diff changeset	1050
208 e0c0827131d1 Merge from eCos master repository on 2002-05-20-20:11:54-BST jlarmour parents: 199 diff changeset	1051 // EOF src/net/eth_drv.c

Mercurial > flash_v2

annotate packages/io/eth/current/src/net/eth_drv.c @ 828:a6926bb063e1