Home | History | Annotate | Line # | Download | only in dev
if_smap.c revision 1.14.10.1
      1  1.14.10.1      yamt /*	$NetBSD: if_smap.c,v 1.14.10.1 2014/05/22 11:40:02 yamt Exp $	*/
      2        1.1       uch 
      3        1.1       uch /*-
      4        1.1       uch  * Copyright (c) 2001 The NetBSD Foundation, Inc.
      5        1.1       uch  * All rights reserved.
      6        1.1       uch  *
      7        1.1       uch  * This code is derived from software contributed to The NetBSD Foundation
      8        1.1       uch  * by UCHIYAMA Yasushi.
      9        1.1       uch  *
     10        1.1       uch  * Redistribution and use in source and binary forms, with or without
     11        1.1       uch  * modification, are permitted provided that the following conditions
     12        1.1       uch  * are met:
     13        1.1       uch  * 1. Redistributions of source code must retain the above copyright
     14        1.1       uch  *    notice, this list of conditions and the following disclaimer.
     15        1.1       uch  * 2. Redistributions in binary form must reproduce the above copyright
     16        1.1       uch  *    notice, this list of conditions and the following disclaimer in the
     17        1.1       uch  *    documentation and/or other materials provided with the distribution.
     18        1.1       uch  *
     19        1.1       uch  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20        1.1       uch  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21        1.1       uch  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22        1.1       uch  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23        1.1       uch  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24        1.1       uch  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25        1.1       uch  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26        1.1       uch  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27        1.1       uch  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28        1.1       uch  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29        1.1       uch  * POSSIBILITY OF SUCH DAMAGE.
     30        1.1       uch  */
     31        1.5     lukem 
     32        1.5     lukem #include <sys/cdefs.h>
     33  1.14.10.1      yamt __KERNEL_RCSID(0, "$NetBSD: if_smap.c,v 1.14.10.1 2014/05/22 11:40:02 yamt Exp $");
     34        1.1       uch 
     35        1.1       uch #include "debug_playstation2.h"
     36        1.1       uch 
     37        1.1       uch #include "bpfilter.h"
     38        1.1       uch #include "rnd.h"
     39        1.1       uch 
     40        1.1       uch #include <sys/param.h>
     41        1.1       uch #include <sys/systm.h>
     42        1.1       uch 
     43        1.1       uch #include <sys/syslog.h>
     44        1.1       uch #include <sys/mbuf.h>
     45        1.1       uch #include <sys/ioctl.h>
     46        1.1       uch #include <sys/socket.h>
     47        1.1       uch 
     48        1.1       uch #include <playstation2/ee/eevar.h>
     49        1.1       uch 
     50        1.1       uch #if NRND > 0
     51        1.1       uch #include <sys/rnd.h>
     52        1.1       uch #endif
     53        1.1       uch 
     54        1.1       uch #include <net/if.h>
     55        1.1       uch #include <net/if_dl.h>
     56        1.1       uch #include <net/if_types.h>
     57        1.1       uch 
     58        1.1       uch #include <net/if_ether.h>
     59        1.1       uch #include <net/if_media.h>
     60        1.1       uch 
     61        1.1       uch #include <dev/mii/mii.h>
     62        1.1       uch #include <dev/mii/miivar.h>
     63        1.1       uch 
     64        1.1       uch #include <netinet/in.h>
     65        1.1       uch #include <netinet/in_systm.h>
     66        1.1       uch #include <netinet/in_var.h>
     67        1.1       uch #include <netinet/ip.h>
     68        1.1       uch #include <netinet/if_inarp.h>
     69        1.1       uch 
     70        1.1       uch #if NBPFILTER > 0
     71        1.1       uch #include <net/bpf.h>
     72        1.1       uch #include <net/bpfdesc.h>
     73        1.1       uch #endif
     74        1.1       uch 
     75        1.1       uch #include <playstation2/dev/spdvar.h>
     76        1.1       uch #include <playstation2/dev/spdreg.h>
     77        1.1       uch #include <playstation2/dev/emac3var.h>
     78        1.1       uch #include <playstation2/dev/if_smapreg.h>
     79        1.1       uch 
     80        1.1       uch #ifdef SMAP_DEBUG
     81        1.1       uch #include <playstation2/ee/gsvar.h>
     82        1.1       uch int	smap_debug = 0;
     83        1.1       uch #define	DPRINTF(fmt, args...)						\
     84        1.1       uch 	if (smap_debug)							\
     85       1.10     perry 		printf("%s: " fmt, __func__ , ##args)
     86        1.1       uch #define	DPRINTFN(n, arg)						\
     87        1.1       uch 	if (smap_debug > (n))						\
     88       1.10     perry 		printf("%s: " fmt, __func__ , ##args)
     89        1.1       uch #define STATIC
     90        1.1       uch struct smap_softc *__sc;
     91        1.1       uch void __smap_status(int);
     92        1.1       uch void __smap_lock_check(const char *, int);
     93       1.10     perry #define FUNC_ENTER()	__smap_lock_check(__func__, 1)
     94       1.10     perry #define FUNC_EXIT()	__smap_lock_check(__func__, 0)
     95        1.1       uch #else
     96        1.1       uch #define	DPRINTF(arg...)		((void)0)
     97        1.1       uch #define DPRINTFN(n, arg...)	((void)0)
     98        1.1       uch #define STATIC			static
     99        1.1       uch #define FUNC_ENTER()		((void)0)
    100        1.1       uch #define FUNC_EXIT()		((void)0)
    101        1.1       uch #endif
    102        1.1       uch 
    103        1.1       uch struct smap_softc {
    104        1.1       uch 	struct emac3_softc emac3;
    105        1.1       uch 	struct ethercom ethercom;
    106        1.1       uch 
    107        1.1       uch 	u_int32_t *tx_buf;
    108        1.1       uch 	u_int32_t *rx_buf;
    109        1.1       uch 	struct smap_desc *tx_desc;
    110        1.1       uch 	struct smap_desc *rx_desc;
    111        1.1       uch 
    112        1.1       uch #define	SMAP_FIFO_ALIGN		4
    113        1.1       uch 	int tx_buf_freesize;	/* buffer usage */
    114        1.1       uch 	int tx_desc_cnt;	/* descriptor usage */
    115        1.1       uch 	u_int16_t tx_fifo_ptr;
    116        1.1       uch 	int tx_done_index, tx_start_index;
    117        1.1       uch 	int rx_done_index;
    118        1.1       uch 
    119        1.1       uch #if NRND > 0
    120        1.1       uch 	rndsource_element_t rnd_source;
    121        1.1       uch #endif
    122        1.1       uch };
    123        1.1       uch 
    124        1.1       uch #define DEVNAME		(sc->emac3.dev.dv_xname)
    125        1.1       uch #define ROUND4(x)	(((x) + 3) & ~3)
    126        1.1       uch #define ROUND16(x)	(((x) + 15) & ~15)
    127        1.1       uch 
    128        1.1       uch STATIC int smap_match(struct device *, struct cfdata *, void *);
    129        1.1       uch STATIC void smap_attach(struct device *, struct device *, void *);
    130        1.1       uch 
    131        1.3   thorpej CFATTACH_DECL(smap, sizeof (struct smap_softc),
    132        1.3   thorpej     smap_match, smap_attach, NULL, NULL);
    133        1.1       uch 
    134        1.1       uch STATIC int smap_intr(void *);
    135        1.1       uch STATIC void smap_rxeof(void *);
    136        1.1       uch STATIC void smap_txeof(void *);
    137        1.1       uch STATIC void smap_start(struct ifnet *);
    138        1.1       uch STATIC void smap_watchdog(struct ifnet *);
    139        1.9  christos STATIC int smap_ioctl(struct ifnet *, u_long, void *);
    140        1.1       uch STATIC int smap_init(struct ifnet *);
    141        1.1       uch STATIC void smap_stop(struct ifnet *, int);
    142        1.1       uch 
    143        1.1       uch STATIC int smap_get_eaddr(struct smap_softc *, u_int8_t *);
    144        1.1       uch STATIC int smap_fifo_init(struct smap_softc *);
    145        1.1       uch STATIC int smap_fifo_reset(bus_addr_t);
    146        1.1       uch STATIC void smap_desc_init(struct smap_softc *);
    147        1.1       uch 
    148        1.1       uch int
    149        1.1       uch smap_match(struct device *parent, struct cfdata *cf, void *aux)
    150        1.1       uch {
    151        1.1       uch 	struct spd_attach_args *spa = aux;
    152        1.1       uch 
    153        1.1       uch 	if (spa->spa_slot != SPD_NIC)
    154        1.1       uch 		return (0);
    155        1.1       uch 
    156        1.1       uch 	return (1);
    157        1.1       uch }
    158        1.1       uch 
    159        1.1       uch void
    160        1.1       uch smap_attach(struct device *parent, struct device *self, void *aux)
    161        1.1       uch {
    162        1.1       uch 	struct spd_attach_args *spa = aux;
    163        1.1       uch 	struct smap_softc *sc = (void *)self;
    164        1.1       uch 	struct emac3_softc *emac3 = &sc->emac3;
    165        1.1       uch 	struct ifnet *ifp = &sc->ethercom.ec_if;
    166        1.1       uch 	struct mii_data *mii = &emac3->mii;
    167        1.1       uch 	void *txbuf, *rxbuf;
    168        1.1       uch 	u_int16_t r;
    169        1.1       uch 
    170        1.1       uch #ifdef SMAP_DEBUG
    171        1.1       uch 	__sc = sc;
    172        1.1       uch #endif
    173        1.1       uch 
    174        1.1       uch 	printf(": %s\n", spa->spa_product_name);
    175        1.1       uch 
    176        1.1       uch 	/* SPD EEPROM */
    177        1.1       uch 	if (smap_get_eaddr(sc, emac3->eaddr) != 0)
    178        1.1       uch 		return;
    179        1.1       uch 
    180        1.1       uch 	printf("%s: Ethernet address %s\n", DEVNAME,
    181        1.1       uch 	    ether_sprintf(emac3->eaddr));
    182        1.1       uch 
    183        1.1       uch 	/* disable interrupts */
    184        1.1       uch 	r = _reg_read_2(SPD_INTR_ENABLE_REG16);
    185        1.1       uch 	r &= ~(SPD_INTR_RXEND | SPD_INTR_TXEND | SPD_INTR_RXDNV |
    186        1.1       uch 	    SPD_INTR_EMAC3);
    187        1.1       uch 	_reg_write_2(SPD_INTR_ENABLE_REG16, r);
    188        1.1       uch 	emac3_intr_disable();
    189        1.1       uch 
    190        1.1       uch 	/* clear pending interrupts */
    191        1.1       uch 	_reg_write_2(SPD_INTR_CLEAR_REG16, SPD_INTR_RXEND | SPD_INTR_TXEND |
    192        1.1       uch 	    SPD_INTR_RXDNV);
    193        1.1       uch 	emac3_intr_clear();
    194        1.1       uch 
    195        1.1       uch 	/* buffer descriptor mode */
    196        1.1       uch 	_reg_write_1(SMAP_DESC_MODE_REG8, 0);
    197        1.1       uch 
    198        1.1       uch 	if (smap_fifo_init(sc) != 0)
    199        1.1       uch 		return;
    200        1.1       uch 
    201        1.1       uch 	if (emac3_init(&sc->emac3) != 0)
    202        1.1       uch 		return;
    203        1.1       uch 	emac3_intr_disable();
    204        1.1       uch 	emac3_disable();
    205        1.1       uch 
    206        1.1       uch 	smap_desc_init(sc);
    207        1.1       uch 
    208        1.1       uch 	/* allocate temporary buffer */
    209        1.1       uch 	txbuf = malloc(ETHER_MAX_LEN - ETHER_CRC_LEN + SMAP_FIFO_ALIGN + 16,
    210        1.1       uch 	    M_DEVBUF, M_NOWAIT);
    211        1.1       uch 	if (txbuf == NULL) {
    212        1.1       uch 		printf("%s: no memory.\n", DEVNAME);
    213        1.1       uch 		return;
    214        1.1       uch 	}
    215        1.1       uch 
    216        1.1       uch 	rxbuf = malloc(ETHER_MAX_LEN + SMAP_FIFO_ALIGN + 16,
    217        1.1       uch 	    M_DEVBUF, M_NOWAIT);
    218        1.1       uch 	if (rxbuf == NULL) {
    219        1.1       uch 		printf("%s: no memory.\n", DEVNAME);
    220        1.1       uch 		free(txbuf, M_DEVBUF);
    221        1.1       uch 		return;
    222        1.1       uch 	}
    223        1.1       uch 
    224        1.1       uch 	sc->tx_buf = (u_int32_t *)ROUND16((vaddr_t)txbuf);
    225        1.1       uch 	sc->rx_buf = (u_int32_t *)ROUND16((vaddr_t)rxbuf);
    226        1.1       uch 
    227        1.1       uch 	/*
    228        1.1       uch 	 * setup MI layer
    229        1.1       uch 	 */
    230        1.1       uch 	strcpy(ifp->if_xname, DEVNAME);
    231        1.1       uch 	ifp->if_softc	= sc;
    232        1.1       uch 	ifp->if_start	= smap_start;
    233        1.1       uch 	ifp->if_ioctl	= smap_ioctl;
    234        1.1       uch 	ifp->if_init	= smap_init;
    235        1.1       uch 	ifp->if_stop	= smap_stop;
    236        1.1       uch 	ifp->if_watchdog= smap_watchdog;
    237        1.1       uch 	ifp->if_flags	= IFF_BROADCAST | IFF_SIMPLEX | IFF_NOTRAILERS |
    238        1.1       uch 	    IFF_MULTICAST;
    239        1.1       uch 	IFQ_SET_READY(&ifp->if_snd);
    240        1.1       uch 
    241        1.1       uch 	/* ifmedia setup. */
    242        1.1       uch 	mii->mii_ifp		= ifp;
    243        1.1       uch 	mii->mii_readreg	= emac3_phy_readreg;
    244        1.1       uch 	mii->mii_writereg	= emac3_phy_writereg;
    245        1.1       uch 	mii->mii_statchg	= emac3_phy_statchg;
    246       1.11    dyoung 	sc->ethercom.ec_mii = mii;
    247       1.11    dyoung 	ifmedia_init(&mii->mii_media, 0, ether_mediachange, ether_mediastatus);
    248        1.1       uch 	mii_attach(&emac3->dev, mii, 0xffffffff, MII_PHY_ANY,
    249        1.1       uch 	    MII_OFFSET_ANY, 0);
    250        1.1       uch 
    251        1.1       uch 	/* Choose a default media. */
    252        1.1       uch 	if (LIST_FIRST(&mii->mii_phys) == NULL) {
    253        1.1       uch 		ifmedia_add(&mii->mii_media, IFM_ETHER|IFM_NONE, 0, NULL);
    254        1.1       uch 		ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_NONE);
    255        1.1       uch 	} else {
    256        1.1       uch 		ifmedia_set(&mii->mii_media, IFM_ETHER|IFM_AUTO);
    257        1.1       uch 	}
    258        1.1       uch 
    259        1.1       uch 	if_attach(ifp);
    260        1.1       uch 	ether_ifattach(ifp, emac3->eaddr);
    261        1.1       uch 
    262        1.1       uch 	spd_intr_establish(SPD_NIC, smap_intr, sc);
    263        1.1       uch 
    264        1.1       uch #if NRND > 0
    265        1.1       uch 	rnd_attach_source(&sc->rnd_source, DEVNAME,
    266        1.1       uch 	    RND_TYPE_NET, 0);
    267        1.1       uch #endif
    268        1.1       uch }
    269        1.1       uch 
    270        1.1       uch int
    271        1.9  christos smap_ioctl(struct ifnet *ifp, u_long command, void *data)
    272        1.1       uch {
    273        1.1       uch 	struct smap_softc *sc = ifp->if_softc;
    274        1.1       uch 	struct ifreq *ifr = (struct ifreq *) data;
    275        1.1       uch 	int error, s;
    276        1.1       uch 
    277        1.1       uch 	s = splnet();
    278        1.1       uch 
    279       1.11    dyoung 	error = ether_ioctl(ifp, command, data);
    280       1.11    dyoung 
    281       1.11    dyoung 	if (error == ENETRESET) {
    282       1.11    dyoung 		if (ifp->if_flags & IFF_RUNNING)
    283       1.11    dyoung 			emac3_setmulti(&sc->emac3, &sc->ethercom);
    284       1.11    dyoung 		error = 0;
    285        1.1       uch 	}
    286        1.1       uch 
    287        1.1       uch 	splx(s);
    288        1.1       uch 
    289        1.1       uch 	return (error);
    290        1.1       uch }
    291        1.1       uch 
    292        1.1       uch int
    293        1.1       uch smap_intr(void *arg)
    294        1.1       uch {
    295        1.1       uch 	struct smap_softc *sc = arg;
    296        1.1       uch 	struct ifnet *ifp;
    297        1.1       uch 	u_int16_t cause, disable, r;
    298        1.1       uch 
    299        1.1       uch 	cause = _reg_read_2(SPD_INTR_STATUS_REG16) &
    300        1.1       uch 	    _reg_read_2(SPD_INTR_ENABLE_REG16);
    301        1.1       uch 
    302        1.1       uch 	disable = cause & (SPD_INTR_RXDNV | SPD_INTR_TXDNV);
    303        1.1       uch 	if (disable) {
    304        1.1       uch 		r = _reg_read_2(SPD_INTR_ENABLE_REG16);
    305        1.1       uch 		r &= ~disable;
    306        1.1       uch 		_reg_write_2(SPD_INTR_ENABLE_REG16, r);
    307        1.1       uch 
    308        1.1       uch 		printf("%s: invalid descriptor. (%c%c)\n", DEVNAME,
    309        1.1       uch 		    disable & SPD_INTR_RXDNV ? 'R' : '_',
    310        1.1       uch 		    disable & SPD_INTR_TXDNV ? 'T' : '_');
    311        1.1       uch 
    312        1.1       uch 		if (disable & SPD_INTR_RXDNV)
    313        1.1       uch 			smap_rxeof(arg);
    314        1.1       uch 
    315        1.1       uch 		_reg_write_2(SPD_INTR_CLEAR_REG16, disable);
    316        1.1       uch 	}
    317        1.1       uch 
    318        1.1       uch 	if (cause & SPD_INTR_TXEND) {
    319        1.1       uch 		_reg_write_2(SPD_INTR_CLEAR_REG16, SPD_INTR_TXEND);
    320        1.1       uch 		if (_reg_read_1(SMAP_RXFIFO_FRAME_REG8) > 0)
    321        1.1       uch 			cause |= SPD_INTR_RXEND;
    322        1.1       uch 		smap_txeof(arg);
    323        1.1       uch 	}
    324        1.1       uch 
    325        1.1       uch 	if (cause & SPD_INTR_RXEND) {
    326        1.1       uch 		_reg_write_2(SPD_INTR_CLEAR_REG16, SPD_INTR_RXEND);
    327        1.1       uch 		smap_rxeof(arg);
    328        1.1       uch 		if (sc->tx_desc_cnt > 0 &&
    329        1.1       uch 		    sc->tx_desc_cnt > _reg_read_1(SMAP_TXFIFO_FRAME_REG8))
    330        1.1       uch 			smap_txeof(arg);
    331        1.1       uch 	}
    332        1.1       uch 
    333        1.1       uch 	if (cause & SPD_INTR_EMAC3)
    334        1.1       uch 		emac3_intr(arg);
    335        1.1       uch 
    336        1.4       wiz 	/* if transmission is pending, start here */
    337        1.1       uch 	ifp = &sc->ethercom.ec_if;
    338        1.1       uch 	if (IFQ_IS_EMPTY(&ifp->if_snd) == 0)
    339        1.1       uch 		smap_start(ifp);
    340        1.1       uch #if NRND > 0
    341        1.1       uch 	rnd_add_uint32(&sc->rnd_source, cause | sc->tx_fifo_ptr << 16);
    342        1.1       uch #endif
    343        1.1       uch 
    344        1.1       uch 	return (1);
    345        1.1       uch }
    346        1.1       uch 
    347        1.1       uch void
    348        1.1       uch smap_rxeof(void *arg)
    349        1.1       uch {
    350        1.1       uch 	struct smap_softc *sc = arg;
    351        1.1       uch 	struct smap_desc *d;
    352        1.1       uch 	struct ifnet *ifp = &sc->ethercom.ec_if;
    353        1.1       uch 	struct mbuf *m;
    354        1.1       uch 	u_int16_t r16, stat;
    355        1.1       uch 	u_int32_t *p;
    356        1.1       uch 	int i, j, sz, rxsz, cnt;
    357        1.1       uch 
    358        1.1       uch 	FUNC_ENTER();
    359        1.1       uch 
    360        1.1       uch 	i = sc->rx_done_index;
    361        1.1       uch 
    362        1.1       uch 	for (cnt = 0;; cnt++, i = (i + 1) & 0x3f) {
    363        1.1       uch 		m = NULL;
    364        1.1       uch 		d = &sc->rx_desc[i];
    365        1.1       uch 		stat = d->stat;
    366        1.1       uch 
    367        1.1       uch 		if ((stat & SMAP_RXDESC_EMPTY) != 0) {
    368        1.1       uch 			break;
    369        1.1       uch 		} else if (stat & 0x7fff) {
    370        1.1       uch 			ifp->if_ierrors++;
    371        1.1       uch 			goto next_packet;
    372        1.1       uch 		}
    373        1.1       uch 
    374        1.1       uch 		sz = d->sz;
    375        1.1       uch 		rxsz = ROUND4(sz);
    376        1.1       uch 
    377        1.1       uch 		KDASSERT(sz >= ETHER_ADDR_LEN * 2 + ETHER_TYPE_LEN);
    378        1.1       uch 		KDASSERT(sz <= ETHER_MAX_LEN);
    379        1.1       uch 
    380        1.1       uch 		/* load data from FIFO */
    381        1.1       uch 		_reg_write_2(SMAP_RXFIFO_PTR_REG16, d->ptr & 0x3ffc);
    382        1.1       uch 		p = sc->rx_buf;
    383        1.1       uch 		for (j = 0; j < rxsz; j += sizeof(u_int32_t)) {
    384        1.1       uch 			*p++ = _reg_read_4(SMAP_RXFIFO_DATA_REG);
    385        1.1       uch 		}
    386        1.1       uch 
    387        1.1       uch 		/* put to mbuf */
    388        1.1       uch 		MGETHDR(m, M_DONTWAIT, MT_DATA);
    389        1.1       uch 		if (m == NULL) {
    390        1.1       uch 			printf("%s: unable to allocate Rx mbuf\n", DEVNAME);
    391        1.1       uch 			ifp->if_ierrors++;
    392        1.1       uch 			goto next_packet;
    393        1.1       uch 		}
    394        1.1       uch 
    395        1.1       uch 		if (sz > (MHLEN - 2)) {
    396        1.1       uch 			MCLGET(m, M_DONTWAIT);
    397        1.1       uch 			if ((m->m_flags & M_EXT) == 0) {
    398        1.1       uch 				printf("%s: unable to allocate Rx cluster\n",
    399        1.1       uch 				    DEVNAME);
    400        1.1       uch 				m_freem(m);
    401        1.1       uch 				m = NULL;
    402        1.1       uch 				ifp->if_ierrors++;
    403        1.1       uch 				goto next_packet;
    404        1.1       uch 			}
    405        1.1       uch 		}
    406        1.1       uch 
    407        1.1       uch 		m->m_data += 2; /* for alignment */
    408        1.1       uch 		m->m_pkthdr.rcvif = ifp;
    409        1.1       uch 		m->m_pkthdr.len = m->m_len = sz;
    410        1.9  christos 		memcpy(mtod(m, void *), (void *)sc->rx_buf, sz);
    411        1.1       uch 
    412        1.1       uch 	next_packet:
    413        1.1       uch 		ifp->if_ipackets++;
    414        1.1       uch 
    415        1.1       uch 		_reg_write_1(SMAP_RXFIFO_FRAME_DEC_REG8, 1);
    416        1.1       uch 
    417        1.1       uch 		/* free descriptor */
    418        1.1       uch 		d->sz	= 0;
    419        1.1       uch 		d->ptr	= 0;
    420        1.1       uch 		d->stat	= SMAP_RXDESC_EMPTY;
    421        1.1       uch 		_wbflush();
    422        1.1       uch 
    423        1.1       uch 		if (m != NULL) {
    424        1.1       uch #if NBPFILTER > 0
    425        1.1       uch 			if (ifp->if_bpf)
    426        1.1       uch 				bpf_mtap(ifp->if_bpf, m);
    427        1.1       uch #endif
    428        1.1       uch 			(*ifp->if_input)(ifp, m);
    429        1.1       uch 		}
    430        1.1       uch 	}
    431        1.1       uch 	sc->rx_done_index = i;
    432        1.1       uch 
    433        1.1       uch 	r16 = _reg_read_2(SPD_INTR_ENABLE_REG16);
    434        1.1       uch 	if (((r16 & SPD_INTR_RXDNV) == 0) && cnt > 0) {
    435        1.1       uch 		r16  |= SPD_INTR_RXDNV;
    436        1.1       uch 		_reg_write_2(SPD_INTR_ENABLE_REG16, r16);
    437        1.1       uch 	}
    438        1.1       uch 
    439        1.1       uch 	FUNC_EXIT();
    440        1.1       uch }
    441        1.1       uch 
    442        1.1       uch void
    443        1.1       uch smap_txeof(void *arg)
    444        1.1       uch {
    445        1.1       uch 	struct smap_softc *sc = arg;
    446        1.1       uch 	struct ifnet *ifp = &sc->ethercom.ec_if;
    447        1.1       uch 	struct smap_desc *d;
    448        1.1       uch 	int i;
    449        1.1       uch 
    450        1.1       uch 	FUNC_ENTER();
    451        1.1       uch 
    452        1.1       uch 	/* clear the timeout timer. */
    453        1.1       uch 	ifp->if_timer = 0;
    454        1.1       uch 
    455        1.1       uch 	/* garbage collect */
    456        1.1       uch 	for (i = sc->tx_done_index;; i = (i + 1) & 0x3f) {
    457        1.1       uch 		u_int16_t stat;
    458        1.1       uch 
    459        1.1       uch 		d = &sc->tx_desc[i];
    460        1.1       uch 		stat = d->stat;
    461        1.1       uch 		if (stat & SMAP_TXDESC_READY) {
    462        1.1       uch 			/* all descriptor processed. */
    463        1.1       uch 			break;
    464        1.1       uch 		} else if (stat & 0x7fff) {
    465        1.1       uch 			if (stat & (SMAP_TXDESC_ECOLL | SMAP_TXDESC_LCOLL |
    466        1.1       uch 			    SMAP_TXDESC_MCOLL | SMAP_TXDESC_SCOLL))
    467        1.1       uch 				ifp->if_collisions++;
    468        1.1       uch 			else
    469        1.1       uch 				ifp->if_oerrors++;
    470        1.1       uch 		} else {
    471        1.1       uch 			ifp->if_opackets++;
    472        1.1       uch 		}
    473        1.1       uch 
    474        1.1       uch 		if (sc->tx_desc_cnt == 0)
    475        1.1       uch 			break;
    476        1.1       uch 
    477        1.1       uch 		sc->tx_buf_freesize += ROUND4(d->sz);
    478        1.1       uch 		sc->tx_desc_cnt--;
    479        1.1       uch 
    480        1.1       uch 		d->sz = 0;
    481        1.1       uch 		d->ptr = 0;
    482        1.1       uch 		d->stat = 0;
    483        1.1       uch 		_wbflush();
    484        1.1       uch 	}
    485        1.1       uch 	sc->tx_done_index = i;
    486        1.1       uch 
    487        1.1       uch 	/* OK to start transmit */
    488        1.1       uch 	ifp->if_flags &= ~IFF_OACTIVE;
    489        1.1       uch 
    490        1.1       uch 	FUNC_EXIT();
    491        1.1       uch }
    492        1.1       uch 
    493        1.1       uch void
    494        1.1       uch smap_start(struct ifnet *ifp)
    495        1.1       uch {
    496        1.1       uch 	struct smap_softc *sc = ifp->if_softc;
    497        1.1       uch 	struct smap_desc *d;
    498        1.1       uch 	struct mbuf *m0, *m;
    499        1.1       uch 	u_int8_t *p, *q;
    500        1.1       uch 	u_int32_t *r;
    501        1.1       uch 	int i, sz, pktsz;
    502        1.1       uch 	u_int16_t fifop;
    503        1.1       uch 	u_int16_t r16;
    504        1.1       uch 
    505        1.1       uch 	KDASSERT(ifp->if_flags & IFF_RUNNING);
    506        1.1       uch 	FUNC_ENTER();
    507        1.1       uch 
    508        1.1       uch 	while (1) {
    509        1.1       uch 		IFQ_POLL(&ifp->if_snd, m0);
    510        1.1       uch 		if (m0 == NULL)
    511        1.1       uch 			goto end;
    512        1.1       uch 
    513        1.1       uch 		pktsz = m0->m_pkthdr.len;
    514        1.1       uch 		KDASSERT(pktsz <= ETHER_MAX_LEN - ETHER_CRC_LEN);
    515        1.1       uch 		sz = ROUND4(pktsz);
    516        1.1       uch 
    517        1.1       uch 		if (sz > sc->tx_buf_freesize ||
    518        1.1       uch 		    sc->tx_desc_cnt >= SMAP_DESC_MAX ||
    519        1.1       uch 		    emac3_tx_done() != 0) {
    520        1.1       uch 			ifp->if_flags |= IFF_OACTIVE;
    521        1.1       uch 			goto end;
    522        1.1       uch 		}
    523        1.1       uch 
    524        1.1       uch 		IFQ_DEQUEUE(&ifp->if_snd, m0);
    525        1.1       uch 		KDASSERT(m0 != NULL);
    526        1.1       uch #if NBPFILTER > 0
    527        1.1       uch 		if (ifp->if_bpf)
    528        1.1       uch 			bpf_mtap(ifp->if_bpf, m0);
    529        1.1       uch #endif
    530        1.1       uch 
    531        1.1       uch 		p = (u_int8_t *)sc->tx_buf;
    532        1.1       uch 		q = p + sz;
    533        1.1       uch 		/* copy to temporary buffer area */
    534        1.1       uch 		for (m = m0; m != 0; m = m->m_next) {
    535        1.9  christos 			memcpy(p, mtod(m, void *), m->m_len);
    536        1.1       uch 			p += m->m_len;
    537        1.1       uch 		}
    538        1.1       uch 		m_freem(m0);
    539        1.1       uch 
    540        1.1       uch 		/* zero padding area */
    541        1.1       uch 		for (; p < q; p++)
    542        1.1       uch 			*p = 0;
    543        1.1       uch 
    544        1.1       uch 		/* put to FIFO */
    545        1.1       uch 		fifop = sc->tx_fifo_ptr;
    546        1.1       uch 		KDASSERT((fifop & 3) == 0);
    547        1.1       uch 		_reg_write_2(SMAP_TXFIFO_PTR_REG16, fifop);
    548        1.1       uch 		sc->tx_fifo_ptr = (fifop + sz) & 0xfff;
    549        1.1       uch 
    550        1.1       uch 		r = sc->tx_buf;
    551        1.1       uch 		for (i = 0; i < sz; i += sizeof(u_int32_t))
    552        1.8     perry 			*(volatile u_int32_t *)SMAP_TXFIFO_DATA_REG = *r++;
    553        1.1       uch 		_wbflush();
    554        1.1       uch 
    555        1.1       uch 		/* put FIFO to EMAC3 */
    556        1.1       uch 		d = &sc->tx_desc[sc->tx_start_index];
    557        1.1       uch 		KDASSERT((d->stat & SMAP_TXDESC_READY) == 0);
    558        1.1       uch 
    559        1.1       uch 		d->sz = pktsz;
    560        1.1       uch 		d->ptr = fifop + SMAP_TXBUF_BASE;
    561        1.1       uch 		d->stat = SMAP_TXDESC_READY | SMAP_TXDESC_GENFCS |
    562        1.1       uch 		    SMAP_TXDESC_GENPAD;
    563        1.1       uch 		_wbflush();
    564        1.1       uch 
    565        1.1       uch 		sc->tx_buf_freesize -= sz;
    566        1.1       uch 		sc->tx_desc_cnt++;
    567        1.1       uch 		sc->tx_start_index = (sc->tx_start_index + 1) & 0x3f;
    568        1.1       uch 		_reg_write_1(SMAP_TXFIFO_FRAME_INC_REG8, 1);
    569        1.1       uch 
    570        1.1       uch 		emac3_tx_kick();
    571        1.1       uch 		r16 = _reg_read_2(SPD_INTR_ENABLE_REG16);
    572        1.1       uch 		if ((r16 & SPD_INTR_TXDNV) == 0) {
    573        1.1       uch 			r16 |= SPD_INTR_TXDNV;
    574        1.1       uch 			_reg_write_2(SPD_INTR_ENABLE_REG16, r16);
    575        1.1       uch 		}
    576        1.1       uch 	}
    577        1.1       uch  end:
    578        1.1       uch 	/* set watchdog timer */
    579        1.1       uch 	ifp->if_timer = 5;
    580        1.1       uch 
    581        1.1       uch 	FUNC_EXIT();
    582        1.1       uch }
    583        1.1       uch 
    584        1.1       uch void
    585        1.1       uch smap_watchdog(struct ifnet *ifp)
    586        1.1       uch {
    587        1.1       uch 	struct smap_softc *sc = ifp->if_softc;
    588        1.1       uch 
    589        1.1       uch 	printf("%s: watchdog timeout\n",DEVNAME);
    590        1.1       uch 	sc->ethercom.ec_if.if_oerrors++;
    591        1.1       uch 
    592        1.1       uch 	smap_fifo_init(sc);
    593        1.1       uch 	smap_desc_init(sc);
    594        1.1       uch 	emac3_reset(&sc->emac3);
    595        1.1       uch }
    596        1.1       uch 
    597        1.1       uch int
    598        1.1       uch smap_init(struct ifnet *ifp)
    599        1.1       uch {
    600        1.1       uch 	struct smap_softc *sc = ifp->if_softc;
    601        1.1       uch 	u_int16_t r16;
    602       1.11    dyoung 	int rc;
    603        1.1       uch 
    604        1.1       uch 	smap_fifo_init(sc);
    605        1.1       uch 	emac3_reset(&sc->emac3);
    606        1.1       uch 	smap_desc_init(sc);
    607        1.1       uch 
    608        1.1       uch 	_reg_write_2(SPD_INTR_CLEAR_REG16, SPD_INTR_RXEND | SPD_INTR_TXEND |
    609        1.1       uch 	    SPD_INTR_RXDNV);
    610        1.1       uch 	emac3_intr_clear();
    611        1.1       uch 
    612        1.1       uch 	r16 = _reg_read_2(SPD_INTR_ENABLE_REG16);
    613        1.1       uch 	r16 |=  SPD_INTR_EMAC3 | SPD_INTR_RXEND | SPD_INTR_TXEND |
    614        1.1       uch 	    SPD_INTR_RXDNV;
    615        1.1       uch 	_reg_write_2(SPD_INTR_ENABLE_REG16, r16);
    616        1.1       uch 	emac3_intr_enable();
    617        1.1       uch 
    618        1.1       uch 	emac3_enable();
    619        1.1       uch 
    620        1.1       uch 	/* Program the multicast filter, if necessary. */
    621        1.1       uch 	emac3_setmulti(&sc->emac3, &sc->ethercom);
    622        1.1       uch 
    623        1.1       uch 	/* Set current media. */
    624       1.11    dyoung 	if ((rc = mii_mediachg(&sc->emac3.mii)) == ENXIO)
    625       1.11    dyoung 		rc = 0;
    626       1.11    dyoung 	else if (rc != 0)
    627       1.11    dyoung 		return rc;
    628        1.1       uch 
    629        1.1       uch 	ifp->if_flags |= IFF_RUNNING;
    630        1.1       uch 
    631        1.1       uch 	return (0);
    632        1.1       uch }
    633        1.1       uch 
    634        1.1       uch void
    635        1.1       uch smap_stop(struct ifnet *ifp, int disable)
    636        1.1       uch {
    637        1.1       uch 	struct smap_softc *sc = ifp->if_softc;
    638        1.1       uch 
    639        1.1       uch 	mii_down(&sc->emac3.mii);
    640        1.1       uch 
    641       1.12    dyoung 	ifp->if_flags &= ~(IFF_RUNNING | IFF_OACTIVE);
    642       1.12    dyoung 
    643        1.1       uch 	if (disable)
    644        1.1       uch 		emac3_disable();
    645        1.1       uch }
    646        1.1       uch 
    647        1.1       uch /*
    648        1.1       uch  * FIFO
    649        1.1       uch  */
    650        1.1       uch int
    651        1.1       uch smap_fifo_init(struct smap_softc *sc)
    652        1.1       uch {
    653        1.1       uch 
    654        1.1       uch 	if (smap_fifo_reset(SMAP_TXFIFO_CTRL_REG8) != 0)
    655        1.1       uch 		goto error;
    656        1.1       uch 
    657        1.1       uch 	if (smap_fifo_reset(SMAP_RXFIFO_CTRL_REG8) != 0)
    658        1.1       uch 		goto error;
    659        1.1       uch 
    660        1.1       uch 	return (0);
    661        1.1       uch error:
    662        1.1       uch 	printf("%s: FIFO reset not complete.\n", DEVNAME);
    663        1.1       uch 
    664        1.1       uch 	return (1);
    665        1.1       uch }
    666        1.1       uch 
    667        1.1       uch int
    668        1.1       uch smap_fifo_reset(bus_addr_t a)
    669        1.1       uch {
    670        1.1       uch 	int retry = 10000;
    671        1.1       uch 
    672        1.1       uch 	_reg_write_1(a, SMAP_FIFO_RESET);
    673        1.1       uch 
    674        1.1       uch 	while ((_reg_read_1(a) & SMAP_FIFO_RESET) && --retry > 0)
    675        1.1       uch 		;
    676        1.1       uch 
    677        1.1       uch 	return (retry == 0);
    678        1.1       uch }
    679        1.1       uch 
    680        1.1       uch /*
    681        1.1       uch  * Buffer descriptor
    682        1.1       uch  */
    683        1.1       uch void
    684        1.1       uch smap_desc_init(struct smap_softc *sc)
    685        1.1       uch {
    686        1.1       uch 	struct smap_desc *d;
    687        1.1       uch 	int i;
    688        1.1       uch 
    689        1.1       uch 	sc->tx_desc = (void *)SMAP_TXDESC_BASE;
    690        1.1       uch 	sc->rx_desc = (void *)SMAP_RXDESC_BASE;
    691        1.1       uch 
    692        1.1       uch 	sc->tx_buf_freesize = SMAP_TXBUF_SIZE;
    693        1.1       uch 	sc->tx_fifo_ptr = 0;
    694        1.1       uch 	sc->tx_start_index = 0;
    695        1.1       uch 	sc->tx_done_index = 0;
    696        1.1       uch 	sc->rx_done_index = 0;
    697        1.1       uch 
    698        1.1       uch 	/* intialize entry */
    699        1.1       uch 	d = sc->tx_desc;
    700        1.1       uch 	for (i = 0; i < SMAP_DESC_MAX; i++, d++) {
    701        1.1       uch 		d->stat = 0;
    702        1.1       uch 		d->__reserved = 0;
    703        1.1       uch 		d->sz = 0;
    704        1.1       uch 		d->ptr = 0;
    705        1.1       uch 	}
    706        1.1       uch 
    707        1.1       uch 	d = sc->rx_desc;
    708        1.1       uch 	for (i = 0; i < SMAP_DESC_MAX; i++, d++) {
    709        1.1       uch 		d->stat = SMAP_RXDESC_EMPTY;
    710        1.1       uch 		d->__reserved = 0;
    711        1.1       uch 		d->sz = 0;
    712        1.1       uch 		d->ptr = 0;
    713        1.1       uch 	}
    714        1.1       uch 	_wbflush();
    715        1.1       uch }
    716        1.1       uch 
    717        1.1       uch 
    718        1.1       uch /*
    719        1.1       uch  * EEPROM
    720        1.1       uch  */
    721        1.1       uch int
    722        1.1       uch smap_get_eaddr(struct smap_softc *sc, u_int8_t *eaddr)
    723        1.1       uch {
    724        1.1       uch 	u_int16_t checksum, *p = (u_int16_t *)eaddr;
    725        1.1       uch 
    726        1.1       uch 	spd_eeprom_read(0, p, 3);
    727        1.1       uch 	spd_eeprom_read(3, &checksum, 1);
    728        1.1       uch 
    729        1.1       uch 	if (checksum != (u_int16_t)(p[0] + p[1] + p[2])) {
    730        1.1       uch 		printf("%s: Ethernet address checksum error.(%s)\n",
    731        1.1       uch 		    DEVNAME, ether_sprintf(eaddr));
    732        1.1       uch 		return (1);
    733        1.1       uch 	}
    734        1.1       uch 
    735        1.1       uch 	return (0);
    736        1.1       uch }
    737        1.1       uch 
    738        1.1       uch #ifdef SMAP_DEBUG
    739        1.1       uch #include <mips/locore.h>
    740        1.1       uch void
    741        1.1       uch __smap_lock_check(const char *func, int enter)
    742        1.1       uch {
    743        1.1       uch 	static int cnt;
    744        1.1       uch 	static const char *last;
    745        1.1       uch 
    746        1.1       uch 	cnt += enter ? 1 : -1;
    747        1.1       uch 
    748        1.1       uch 	if (cnt < 0 || cnt > 1)
    749        1.1       uch 		panic("%s cnt=%d last=%s", func, cnt, last);
    750        1.1       uch 
    751        1.1       uch 	last = func;
    752        1.1       uch }
    753        1.1       uch 
    754        1.1       uch void
    755        1.1       uch __smap_status(int msg)
    756        1.1       uch {
    757        1.1       uch 	static int cnt;
    758        1.1       uch 	__gsfb_print(1, "%d: tx=%d rx=%d txcnt=%d free=%d cnt=%d\n", msg,
    759        1.1       uch 	    _reg_read_1(SMAP_TXFIFO_FRAME_REG8),
    760        1.1       uch 	    _reg_read_1(SMAP_RXFIFO_FRAME_REG8), __sc->tx_desc_cnt,
    761        1.1       uch 	    __sc->tx_buf_freesize, cnt++);
    762        1.1       uch }
    763        1.1       uch #endif /* SMAP_DEBUG */
    764