Home | History | Annotate | Line # | Download | only in pci
if_rge.c revision 1.19
      1  1.19   thorpej /*	$NetBSD: if_rge.c,v 1.19 2021/05/08 00:27:02 thorpej Exp $	*/
      2  1.17  jakllsch /*	$OpenBSD: if_rge.c,v 1.9 2020/12/12 11:48:53 jan Exp $	*/
      3   1.1     sevan 
      4   1.1     sevan /*
      5  1.17  jakllsch  * Copyright (c) 2019, 2020 Kevin Lo <kevlo (at) openbsd.org>
      6   1.1     sevan  *
      7   1.1     sevan  * Permission to use, copy, modify, and distribute this software for any
      8   1.1     sevan  * purpose with or without fee is hereby granted, provided that the above
      9   1.1     sevan  * copyright notice and this permission notice appear in all copies.
     10   1.1     sevan  *
     11   1.1     sevan  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     12   1.1     sevan  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     13   1.1     sevan  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     14   1.1     sevan  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     15   1.1     sevan  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     16   1.1     sevan  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     17   1.1     sevan  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     18   1.1     sevan  */
     19   1.1     sevan 
     20   1.2     sevan #include <sys/cdefs.h>
     21  1.19   thorpej __KERNEL_RCSID(0, "$NetBSD: if_rge.c,v 1.19 2021/05/08 00:27:02 thorpej Exp $");
     22   1.2     sevan 
     23   1.2     sevan #include <sys/types.h>
     24   1.1     sevan 
     25   1.1     sevan #include <sys/param.h>
     26   1.1     sevan #include <sys/systm.h>
     27   1.1     sevan #include <sys/sockio.h>
     28   1.1     sevan #include <sys/mbuf.h>
     29   1.1     sevan #include <sys/malloc.h>
     30   1.1     sevan #include <sys/kernel.h>
     31   1.1     sevan #include <sys/socket.h>
     32   1.1     sevan #include <sys/device.h>
     33   1.1     sevan #include <sys/endian.h>
     34   1.3     sevan #include <sys/callout.h>
     35   1.3     sevan #include <sys/workqueue.h>
     36   1.1     sevan 
     37   1.1     sevan #include <net/if.h>
     38   1.2     sevan 
     39   1.2     sevan #include <net/if_dl.h>
     40   1.2     sevan #include <net/if_ether.h>
     41   1.2     sevan 
     42   1.1     sevan #include <net/if_media.h>
     43   1.1     sevan 
     44   1.1     sevan #include <netinet/in.h>
     45   1.2     sevan #include <net/if_ether.h>
     46   1.1     sevan 
     47   1.1     sevan #include <net/bpf.h>
     48   1.1     sevan 
     49   1.2     sevan #include <sys/bus.h>
     50   1.1     sevan #include <machine/intr.h>
     51   1.1     sevan 
     52   1.1     sevan #include <dev/mii/mii.h>
     53   1.1     sevan 
     54   1.1     sevan #include <dev/pci/pcivar.h>
     55   1.1     sevan #include <dev/pci/pcireg.h>
     56   1.1     sevan #include <dev/pci/pcidevs.h>
     57   1.1     sevan 
     58   1.1     sevan #include <dev/pci/if_rgereg.h>
     59   1.1     sevan 
     60   1.2     sevan #ifdef __NetBSD__
     61   1.2     sevan #define letoh32 	htole32
     62   1.2     sevan #define nitems(x) 	__arraycount(x)
     63   1.7     sevan 
     64   1.7     sevan static struct mbuf *
     65  1.17  jakllsch MCLGETL(struct rge_softc *sc __unused, int how,
     66  1.17  jakllsch     u_int size)
     67   1.7     sevan {
     68   1.7     sevan 	struct mbuf *m;
     69   1.7     sevan 
     70   1.7     sevan 	MGETHDR(m, how, MT_DATA);
     71   1.7     sevan 	if (m == NULL)
     72   1.7     sevan 		return NULL;
     73   1.7     sevan 
     74   1.7     sevan 	MEXTMALLOC(m, size, how);
     75   1.7     sevan 	if ((m->m_flags & M_EXT) == 0) {
     76   1.7     sevan 		m_freem(m);
     77   1.7     sevan 		return NULL;
     78   1.7     sevan 	}
     79   1.7     sevan 	return m;
     80   1.7     sevan }
     81   1.7     sevan 
     82   1.3     sevan #ifdef NET_MPSAFE
     83   1.3     sevan #define 	RGE_MPSAFE	1
     84   1.3     sevan #define 	CALLOUT_FLAGS	CALLOUT_MPSAFE
     85   1.3     sevan #else
     86   1.3     sevan #define 	CALLOUT_FLAGS	0
     87   1.3     sevan #endif
     88   1.2     sevan #endif
     89   1.2     sevan 
     90  1.17  jakllsch #ifdef RGE_DEBUG
     91  1.17  jakllsch #define DPRINTF(x)	do { if (rge_debug > 0) printf x; } while (0)
     92  1.17  jakllsch int rge_debug = 0;
     93  1.17  jakllsch #else
     94  1.17  jakllsch #define DPRINTF(x)
     95  1.17  jakllsch #endif
     96  1.17  jakllsch 
     97   1.2     sevan static int		rge_match(device_t, cfdata_t, void *);
     98   1.5     skrll static void		rge_attach(device_t, device_t, void *);
     99   1.1     sevan int		rge_intr(void *);
    100   1.1     sevan int		rge_encap(struct rge_softc *, struct mbuf *, int);
    101   1.2     sevan int		rge_ioctl(struct ifnet *, u_long, void *);
    102   1.2     sevan void		rge_start(struct ifnet *);
    103   1.1     sevan void		rge_watchdog(struct ifnet *);
    104   1.1     sevan int		rge_init(struct ifnet *);
    105  1.17  jakllsch void		rge_stop(struct ifnet *, int);
    106   1.1     sevan int		rge_ifmedia_upd(struct ifnet *);
    107   1.1     sevan void		rge_ifmedia_sts(struct ifnet *, struct ifmediareq *);
    108   1.1     sevan int		rge_allocmem(struct rge_softc *);
    109   1.1     sevan int		rge_newbuf(struct rge_softc *, int);
    110   1.1     sevan void		rge_discard_rxbuf(struct rge_softc *, int);
    111   1.1     sevan int		rge_rx_list_init(struct rge_softc *);
    112   1.1     sevan void		rge_tx_list_init(struct rge_softc *);
    113   1.1     sevan int		rge_rxeof(struct rge_softc *);
    114   1.1     sevan int		rge_txeof(struct rge_softc *);
    115   1.1     sevan void		rge_reset(struct rge_softc *);
    116   1.1     sevan void		rge_iff(struct rge_softc *);
    117   1.1     sevan void		rge_set_phy_power(struct rge_softc *, int);
    118   1.1     sevan void		rge_phy_config(struct rge_softc *);
    119  1.17  jakllsch void		rge_phy_config_mac_cfg2(struct rge_softc *);
    120  1.17  jakllsch void		rge_phy_config_mac_cfg3(struct rge_softc *);
    121  1.17  jakllsch void		rge_phy_config_mac_cfg4(struct rge_softc *);
    122  1.17  jakllsch void		rge_phy_config_mac_cfg5(struct rge_softc *);
    123  1.17  jakllsch void		rge_phy_config_mcu(struct rge_softc *, uint16_t);
    124   1.1     sevan void		rge_set_macaddr(struct rge_softc *, const uint8_t *);
    125   1.1     sevan void		rge_get_macaddr(struct rge_softc *, uint8_t *);
    126   1.1     sevan void		rge_hw_init(struct rge_softc *);
    127   1.1     sevan void		rge_disable_phy_ocp_pwrsave(struct rge_softc *);
    128   1.1     sevan void		rge_patch_phy_mcu(struct rge_softc *, int);
    129   1.1     sevan void		rge_add_media_types(struct rge_softc *);
    130   1.1     sevan void		rge_config_imtype(struct rge_softc *, int);
    131  1.17  jakllsch void		rge_disable_hw_im(struct rge_softc *);
    132   1.1     sevan void		rge_disable_sim_im(struct rge_softc *);
    133   1.1     sevan void		rge_setup_sim_im(struct rge_softc *);
    134   1.1     sevan void		rge_setup_intr(struct rge_softc *, int);
    135   1.1     sevan void		rge_exit_oob(struct rge_softc *);
    136   1.1     sevan void		rge_write_csi(struct rge_softc *, uint32_t, uint32_t);
    137   1.1     sevan uint32_t	rge_read_csi(struct rge_softc *, uint32_t);
    138   1.1     sevan void		rge_write_mac_ocp(struct rge_softc *, uint16_t, uint16_t);
    139   1.1     sevan uint16_t	rge_read_mac_ocp(struct rge_softc *, uint16_t);
    140   1.1     sevan void		rge_write_ephy(struct rge_softc *, uint16_t, uint16_t);
    141  1.17  jakllsch uint16_t	rge_read_ephy(struct rge_softc *, uint16_t);
    142   1.1     sevan void		rge_write_phy(struct rge_softc *, uint16_t, uint16_t, uint16_t);
    143  1.17  jakllsch uint16_t	rge_read_phy(struct rge_softc *, uint16_t, uint16_t);
    144   1.1     sevan void		rge_write_phy_ocp(struct rge_softc *, uint16_t, uint16_t);
    145   1.1     sevan uint16_t	rge_read_phy_ocp(struct rge_softc *, uint16_t);
    146   1.1     sevan int		rge_get_link_status(struct rge_softc *);
    147   1.3     sevan void		rge_txstart(struct work *, void *);
    148   1.1     sevan void		rge_tick(void *);
    149   1.1     sevan void		rge_link_state(struct rge_softc *);
    150   1.1     sevan 
    151   1.1     sevan static const struct {
    152   1.1     sevan 	uint16_t reg;
    153   1.1     sevan 	uint16_t val;
    154  1.17  jakllsch }  rtl8125_mac_cfg2_mcu[] = {
    155   1.1     sevan 	RTL8125_MAC_CFG2_MCU
    156   1.1     sevan }, rtl8125_mac_cfg3_mcu[] = {
    157   1.1     sevan 	RTL8125_MAC_CFG3_MCU
    158  1.17  jakllsch }, rtl8125_mac_cfg4_mcu[] = {
    159  1.17  jakllsch 	RTL8125_MAC_CFG4_MCU
    160  1.17  jakllsch }, rtl8125_mac_cfg5_mcu[] = {
    161  1.17  jakllsch 	RTL8125_MAC_CFG5_MCU
    162   1.1     sevan };
    163   1.1     sevan 
    164   1.2     sevan CFATTACH_DECL_NEW(rge, sizeof(struct rge_softc), rge_match, rge_attach,
    165   1.2     sevan 		NULL, NULL); /* Sevan - detach function? */
    166   1.1     sevan 
    167  1.19   thorpej static const struct device_compatible_entry compat_data[] = {
    168  1.19   thorpej 	{ .id = PCI_ID_CODE(PCI_VENDOR_REALTEK, PCI_PRODUCT_REALTEK_E3000) },
    169  1.19   thorpej 	{ .id = PCI_ID_CODE(PCI_VENDOR_REALTEK, PCI_PRODUCT_REALTEK_RT8125) },
    170  1.19   thorpej 
    171  1.19   thorpej 	PCI_COMPAT_EOL
    172   1.1     sevan };
    173   1.1     sevan 
    174   1.2     sevan static int
    175   1.2     sevan rge_match(device_t parent, cfdata_t match, void *aux)
    176   1.1     sevan {
    177   1.2     sevan 	struct pci_attach_args *pa =aux;
    178   1.2     sevan 
    179  1.19   thorpej 	return pci_compatible_match(pa, compat_data);
    180   1.1     sevan }
    181   1.1     sevan 
    182   1.1     sevan void
    183   1.2     sevan rge_attach(device_t parent, device_t self, void *aux)
    184   1.1     sevan {
    185  1.11     sevan 	struct rge_softc *sc = device_private(self);
    186   1.1     sevan 	struct pci_attach_args *pa = aux;
    187   1.1     sevan 	pci_chipset_tag_t pc = pa->pa_pc;
    188  1.17  jakllsch 	pci_intr_handle_t *ihp;
    189   1.2     sevan 	char intrbuf[PCI_INTRSTR_LEN];
    190   1.1     sevan 	const char *intrstr = NULL;
    191   1.1     sevan 	struct ifnet *ifp;
    192   1.1     sevan 	pcireg_t reg;
    193   1.1     sevan 	uint32_t hwrev;
    194   1.1     sevan 	uint8_t eaddr[ETHER_ADDR_LEN];
    195   1.1     sevan 	int offset;
    196  1.17  jakllsch 	pcireg_t command;
    197   1.1     sevan 
    198   1.1     sevan 	pci_set_powerstate(pa->pa_pc, pa->pa_tag, PCI_PMCSR_STATE_D0);
    199   1.1     sevan 
    200  1.12     sevan 	sc->sc_dev = self;
    201  1.12     sevan 
    202  1.17  jakllsch 	pci_aprint_devinfo(pa, "Ethernet controller");
    203  1.17  jakllsch 
    204   1.5     skrll 	/*
    205   1.1     sevan 	 * Map control/status registers.
    206   1.1     sevan 	 */
    207   1.1     sevan 	if (pci_mapreg_map(pa, RGE_PCI_BAR2, PCI_MAPREG_TYPE_MEM |
    208   1.1     sevan 	    PCI_MAPREG_MEM_TYPE_64BIT, 0, &sc->rge_btag, &sc->rge_bhandle,
    209   1.2     sevan 	    NULL, &sc->rge_bsize)) {
    210   1.1     sevan 		if (pci_mapreg_map(pa, RGE_PCI_BAR1, PCI_MAPREG_TYPE_MEM |
    211   1.1     sevan 		    PCI_MAPREG_MEM_TYPE_32BIT, 0, &sc->rge_btag,
    212   1.2     sevan 		    &sc->rge_bhandle, NULL, &sc->rge_bsize)) {
    213   1.1     sevan 			if (pci_mapreg_map(pa, RGE_PCI_BAR0, PCI_MAPREG_TYPE_IO,
    214   1.1     sevan 			    0, &sc->rge_btag, &sc->rge_bhandle, NULL,
    215   1.2     sevan 			    &sc->rge_bsize)) {
    216  1.13     sevan 				aprint_error(": can't map mem or i/o space\n");
    217   1.1     sevan 				return;
    218   1.1     sevan 			}
    219   1.1     sevan 		}
    220   1.1     sevan 	}
    221   1.1     sevan 
    222  1.17  jakllsch 	int counts[PCI_INTR_TYPE_SIZE] = {
    223  1.17  jakllsch  		[PCI_INTR_TYPE_INTX] = 1,
    224  1.17  jakllsch  		[PCI_INTR_TYPE_MSI] = 1,
    225  1.17  jakllsch  		[PCI_INTR_TYPE_MSIX] = 1,
    226  1.17  jakllsch  	};
    227  1.17  jakllsch 	int max_type = PCI_INTR_TYPE_MSIX;
    228   1.5     skrll 	/*
    229   1.1     sevan 	 * Allocate interrupt.
    230   1.1     sevan 	 */
    231  1.17  jakllsch 	if (pci_intr_alloc(pa, &ihp, counts, max_type) != 0) {
    232  1.13     sevan 		aprint_error(": couldn't map interrupt\n");
    233   1.1     sevan 		return;
    234   1.1     sevan 	}
    235  1.17  jakllsch 	switch (pci_intr_type(pc, ihp[0])) {
    236  1.17  jakllsch 	case PCI_INTR_TYPE_MSIX:
    237  1.17  jakllsch 	case PCI_INTR_TYPE_MSI:
    238  1.17  jakllsch 		sc->rge_flags |= RGE_FLAG_MSI;
    239  1.17  jakllsch 		break;
    240  1.17  jakllsch 	default:
    241  1.17  jakllsch 		break;
    242  1.17  jakllsch 	}
    243  1.17  jakllsch 	intrstr = pci_intr_string(pc, ihp[0], intrbuf, sizeof(intrbuf));
    244  1.17  jakllsch 	sc->sc_ih = pci_intr_establish_xname(pc, ihp[0], IPL_NET, rge_intr,
    245  1.14     sevan 	    sc, device_xname(sc->sc_dev));
    246   1.1     sevan 	if (sc->sc_ih == NULL) {
    247  1.13     sevan 		aprint_error_dev(sc->sc_dev, ": couldn't establish interrupt");
    248   1.1     sevan 		if (intrstr != NULL)
    249  1.13     sevan 			aprint_error(" at %s\n", intrstr);
    250  1.13     sevan 		aprint_error("\n");
    251   1.1     sevan 		return;
    252   1.1     sevan 	}
    253  1.13     sevan 	aprint_normal_dev(sc->sc_dev, "interrupting at %s\n", intrstr);
    254   1.1     sevan 
    255   1.9   thorpej 	if (pci_dma64_available(pa))
    256   1.9   thorpej 		sc->sc_dmat = pa->pa_dmat64;
    257   1.9   thorpej 	else
    258   1.9   thorpej 		sc->sc_dmat = pa->pa_dmat;
    259   1.9   thorpej 
    260   1.1     sevan 	sc->sc_pc = pa->pa_pc;
    261   1.1     sevan 	sc->sc_tag = pa->pa_tag;
    262   1.1     sevan 
    263   1.1     sevan 	/* Determine hardware revision */
    264   1.1     sevan 	hwrev = RGE_READ_4(sc, RGE_TXCFG) & RGE_TXCFG_HWREV;
    265   1.1     sevan 	switch (hwrev) {
    266   1.1     sevan 	case 0x60800000:
    267   1.1     sevan 		sc->rge_type = MAC_CFG2;
    268   1.1     sevan 		break;
    269   1.1     sevan 	case 0x60900000:
    270   1.1     sevan 		sc->rge_type = MAC_CFG3;
    271   1.1     sevan 		break;
    272  1.17  jakllsch 	case 0x64000000:
    273  1.17  jakllsch 		sc->rge_type = MAC_CFG4;
    274  1.17  jakllsch 		break;
    275  1.17  jakllsch 	case 0x64100000:
    276  1.17  jakllsch 		sc->rge_type = MAC_CFG5;
    277  1.17  jakllsch 		break;
    278   1.1     sevan 	default:
    279  1.13     sevan 		aprint_error(": unknown version 0x%08x\n", hwrev);
    280   1.1     sevan 		return;
    281   1.1     sevan 	}
    282   1.1     sevan 
    283   1.1     sevan 	rge_config_imtype(sc, RGE_IMTYPE_SIM);
    284   1.1     sevan 
    285   1.5     skrll 	/*
    286   1.1     sevan 	 * PCI Express check.
    287   1.1     sevan 	 */
    288   1.1     sevan 	if (pci_get_capability(pa->pa_pc, pa->pa_tag, PCI_CAP_PCIEXPRESS,
    289   1.1     sevan 	    &offset, NULL)) {
    290  1.17  jakllsch 		/* Disable PCIe ASPM and ECPM. */
    291   1.1     sevan 		reg = pci_conf_read(pa->pa_pc, pa->pa_tag,
    292   1.2     sevan 		    offset + PCIE_LCSR);
    293  1.17  jakllsch 		reg &= ~(PCIE_LCSR_ASPM_L0S | PCIE_LCSR_ASPM_L1 |
    294  1.17  jakllsch 		    PCIE_LCSR_ENCLKPM);
    295   1.2     sevan 		pci_conf_write(pa->pa_pc, pa->pa_tag, offset + PCIE_LCSR,
    296   1.1     sevan 		    reg);
    297   1.1     sevan 	}
    298   1.1     sevan 
    299   1.1     sevan 	rge_exit_oob(sc);
    300   1.1     sevan 	rge_hw_init(sc);
    301   1.1     sevan 
    302   1.1     sevan 	rge_get_macaddr(sc, eaddr);
    303  1.13     sevan 	aprint_normal_dev(sc->sc_dev, "Ethernet address %s\n",
    304  1.13     sevan 	    ether_sprintf(eaddr));
    305   1.1     sevan 
    306   1.2     sevan 	memcpy(sc->sc_enaddr, eaddr, ETHER_ADDR_LEN);
    307   1.1     sevan 
    308   1.1     sevan 	rge_set_phy_power(sc, 1);
    309   1.1     sevan 	rge_phy_config(sc);
    310   1.1     sevan 
    311   1.1     sevan 	if (rge_allocmem(sc))
    312   1.1     sevan 		return;
    313   1.1     sevan 
    314   1.2     sevan 	ifp = &sc->sc_ec.ec_if;
    315   1.1     sevan 	ifp->if_softc = sc;
    316  1.14     sevan 	strlcpy(ifp->if_xname, device_xname(sc->sc_dev), IFNAMSIZ);
    317   1.1     sevan 	ifp->if_flags = IFF_BROADCAST | IFF_SIMPLEX | IFF_MULTICAST;
    318   1.2     sevan #ifdef RGE_MPSAFE
    319  1.18  knakahar 	ifp->if_extflags = IFEF_MPSAFE;
    320   1.2     sevan #endif
    321   1.1     sevan 	ifp->if_ioctl = rge_ioctl;
    322  1.17  jakllsch 	ifp->if_stop = rge_stop;
    323   1.2     sevan 	ifp->if_start = rge_start;
    324  1.17  jakllsch 	ifp->if_init = rge_init;
    325   1.1     sevan 	ifp->if_watchdog = rge_watchdog;
    326  1.17  jakllsch 	IFQ_SET_MAXLEN(&ifp->if_snd, RGE_TX_LIST_CNT - 1);
    327   1.1     sevan 
    328  1.17  jakllsch #if notyet
    329  1.17  jakllsch 	ifp->if_capabilities = IFCAP_CSUM_IPv4_Rx |
    330   1.2     sevan 	    IFCAP_CSUM_IPv4_Tx |IFCAP_CSUM_TCPv4_Rx | IFCAP_CSUM_TCPv4_Tx|
    331   1.2     sevan 	    IFCAP_CSUM_UDPv4_Rx | IFCAP_CSUM_UDPv4_Tx;
    332  1.17  jakllsch #endif
    333   1.1     sevan 
    334  1.17  jakllsch 	sc->sc_ec.ec_capabilities |= ETHERCAP_VLAN_MTU;
    335  1.17  jakllsch 	sc->sc_ec.ec_capabilities |= ETHERCAP_VLAN_HWTAGGING;
    336   1.1     sevan 
    337   1.3     sevan 	callout_init(&sc->sc_timeout, CALLOUT_FLAGS);
    338   1.3     sevan 	callout_setfunc(&sc->sc_timeout, rge_tick, sc);
    339  1.17  jakllsch 
    340  1.17  jakllsch 	command = pci_conf_read(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG);
    341  1.17  jakllsch 	command |= PCI_COMMAND_MASTER_ENABLE;
    342  1.17  jakllsch 	pci_conf_write(pa->pa_pc, pa->pa_tag, PCI_COMMAND_STATUS_REG, command);
    343   1.1     sevan 
    344   1.1     sevan 	/* Initialize ifmedia structures. */
    345  1.17  jakllsch 	sc->sc_ec.ec_ifmedia = &sc->sc_media;
    346   1.1     sevan 	ifmedia_init(&sc->sc_media, IFM_IMASK, rge_ifmedia_upd,
    347   1.1     sevan 	    rge_ifmedia_sts);
    348   1.1     sevan 	rge_add_media_types(sc);
    349   1.1     sevan 	ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_AUTO, 0, NULL);
    350   1.1     sevan 	ifmedia_set(&sc->sc_media, IFM_ETHER | IFM_AUTO);
    351   1.1     sevan 	sc->sc_media.ifm_media = sc->sc_media.ifm_cur->ifm_media;
    352   1.1     sevan 
    353   1.1     sevan 	if_attach(ifp);
    354   1.2     sevan 	ether_ifattach(ifp, eaddr);
    355   1.1     sevan }
    356   1.1     sevan 
    357   1.1     sevan int
    358   1.1     sevan rge_intr(void *arg)
    359   1.1     sevan {
    360   1.1     sevan 	struct rge_softc *sc = arg;
    361   1.2     sevan 	struct ifnet *ifp = &sc->sc_ec.ec_if;
    362   1.1     sevan 	uint32_t status;
    363   1.1     sevan 	int claimed = 0, rx, tx;
    364   1.1     sevan 
    365   1.1     sevan 	if (!(ifp->if_flags & IFF_RUNNING))
    366   1.1     sevan 		return (0);
    367   1.1     sevan 
    368   1.1     sevan 	/* Disable interrupts. */
    369   1.1     sevan 	RGE_WRITE_4(sc, RGE_IMR, 0);
    370   1.1     sevan 
    371   1.1     sevan 	if (!(sc->rge_flags & RGE_FLAG_MSI)) {
    372  1.17  jakllsch 		if ((RGE_READ_4(sc, RGE_ISR) & sc->rge_intrs) == 0)
    373   1.1     sevan 			return (0);
    374   1.1     sevan 	}
    375  1.17  jakllsch 
    376  1.17  jakllsch 	status = RGE_READ_4(sc, RGE_ISR);
    377   1.1     sevan 	if (status)
    378   1.1     sevan 		RGE_WRITE_4(sc, RGE_ISR, status);
    379   1.1     sevan 
    380   1.1     sevan 	if (status & RGE_ISR_PCS_TIMEOUT)
    381   1.1     sevan 		claimed = 1;
    382   1.1     sevan 
    383   1.1     sevan 	rx = tx = 0;
    384  1.17  jakllsch 	if (status & sc->rge_intrs) {
    385   1.1     sevan 		if (status &
    386   1.1     sevan 		    (sc->rge_rx_ack | RGE_ISR_RX_ERR | RGE_ISR_RX_FIFO_OFLOW)) {
    387   1.1     sevan 			rx |= rge_rxeof(sc);
    388   1.1     sevan 			claimed = 1;
    389   1.1     sevan 		}
    390   1.1     sevan 
    391   1.1     sevan 		if (status & (sc->rge_tx_ack | RGE_ISR_TX_ERR)) {
    392   1.1     sevan 			tx |= rge_txeof(sc);
    393   1.1     sevan 			claimed = 1;
    394   1.1     sevan 		}
    395   1.1     sevan 
    396   1.1     sevan 		if (status & RGE_ISR_SYSTEM_ERR) {
    397   1.2     sevan 			KERNEL_LOCK(1, NULL);
    398   1.1     sevan 			rge_init(ifp);
    399   1.2     sevan 			KERNEL_UNLOCK_ONE(NULL);
    400   1.1     sevan 			claimed = 1;
    401   1.1     sevan 		}
    402   1.1     sevan 	}
    403   1.1     sevan 
    404   1.1     sevan 	if (sc->rge_timerintr) {
    405   1.1     sevan 		if ((tx | rx) == 0) {
    406   1.1     sevan 			/*
    407   1.1     sevan 			 * Nothing needs to be processed, fallback
    408   1.1     sevan 			 * to use TX/RX interrupts.
    409   1.1     sevan 			 */
    410   1.1     sevan 			rge_setup_intr(sc, RGE_IMTYPE_NONE);
    411   1.1     sevan 
    412   1.1     sevan 			/*
    413   1.1     sevan 			 * Recollect, mainly to avoid the possible
    414   1.1     sevan 			 * race introduced by changing interrupt
    415   1.1     sevan 			 * masks.
    416   1.1     sevan 			 */
    417   1.1     sevan 			rge_rxeof(sc);
    418   1.1     sevan 			rge_txeof(sc);
    419   1.1     sevan 		} else
    420   1.1     sevan 			RGE_WRITE_4(sc, RGE_TIMERCNT, 1);
    421   1.1     sevan 	} else if (tx | rx) {
    422   1.1     sevan 		/*
    423   1.1     sevan 		 * Assume that using simulated interrupt moderation
    424   1.1     sevan 		 * (hardware timer based) could reduce the interrupt
    425   1.1     sevan 		 * rate.
    426   1.1     sevan 		 */
    427   1.1     sevan 		rge_setup_intr(sc, RGE_IMTYPE_SIM);
    428   1.1     sevan 	}
    429   1.1     sevan 
    430   1.1     sevan 	RGE_WRITE_4(sc, RGE_IMR, sc->rge_intrs);
    431   1.1     sevan 
    432   1.1     sevan 	return (claimed);
    433   1.1     sevan }
    434   1.1     sevan 
    435   1.1     sevan int
    436   1.1     sevan rge_encap(struct rge_softc *sc, struct mbuf *m, int idx)
    437   1.1     sevan {
    438   1.1     sevan 	struct rge_tx_desc *d = NULL;
    439   1.1     sevan 	struct rge_txq *txq;
    440   1.1     sevan 	bus_dmamap_t txmap;
    441   1.1     sevan 	uint32_t cmdsts, cflags = 0;
    442   1.1     sevan 	int cur, error, i, last, nsegs;
    443   1.1     sevan 
    444  1.17  jakllsch #if notyet
    445   1.1     sevan 	/*
    446   1.1     sevan 	 * Set RGE_TDEXTSTS_IPCSUM if any checksum offloading is requested.
    447   1.1     sevan 	 * Otherwise, RGE_TDEXTSTS_TCPCSUM / RGE_TDEXTSTS_UDPCSUM does not
    448   1.1     sevan 	 * take affect.
    449   1.1     sevan 	 */
    450   1.1     sevan 	if ((m->m_pkthdr.csum_flags &
    451   1.2     sevan 	    (M_CSUM_IPv4 | M_CSUM_TCPv4 | M_CSUM_UDPv4)) != 0) {
    452   1.1     sevan 		cflags |= RGE_TDEXTSTS_IPCSUM;
    453   1.1     sevan 		if (m->m_pkthdr.csum_flags & M_TCP_CSUM_OUT)
    454   1.1     sevan 			cflags |= RGE_TDEXTSTS_TCPCSUM;
    455   1.1     sevan 		if (m->m_pkthdr.csum_flags & M_UDP_CSUM_OUT)
    456   1.1     sevan 			cflags |= RGE_TDEXTSTS_UDPCSUM;
    457   1.1     sevan 	}
    458  1.17  jakllsch #endif
    459   1.1     sevan 
    460   1.1     sevan 	txq = &sc->rge_ldata.rge_txq[idx];
    461   1.1     sevan 	txmap = txq->txq_dmamap;
    462   1.1     sevan 
    463   1.1     sevan 	error = bus_dmamap_load_mbuf(sc->sc_dmat, txmap, m, BUS_DMA_NOWAIT);
    464   1.1     sevan 	switch (error) {
    465   1.1     sevan 	case 0:
    466   1.1     sevan 		break;
    467   1.1     sevan 	case EFBIG: /* mbuf chain is too fragmented */
    468   1.1     sevan 		if (m_defrag(m, M_DONTWAIT) == 0 &&
    469   1.1     sevan 		    bus_dmamap_load_mbuf(sc->sc_dmat, txmap, m,
    470   1.1     sevan 		    BUS_DMA_NOWAIT) == 0)
    471   1.1     sevan 			break;
    472   1.1     sevan 
    473   1.1     sevan 		/* FALLTHROUGH */
    474   1.1     sevan 	default:
    475   1.1     sevan 		return (0);
    476   1.1     sevan 	}
    477   1.1     sevan 
    478   1.1     sevan 	bus_dmamap_sync(sc->sc_dmat, txmap, 0, txmap->dm_mapsize,
    479   1.1     sevan 	    BUS_DMASYNC_PREWRITE);
    480   1.1     sevan 
    481   1.1     sevan 	nsegs = txmap->dm_nsegs;
    482   1.1     sevan 
    483   1.1     sevan 	/* Set up hardware VLAN tagging. */
    484  1.17  jakllsch 	if (vlan_has_tag(m))
    485  1.17  jakllsch 		cflags |= bswap16(vlan_get_tag(m)) | RGE_TDEXTSTS_VTAG;
    486   1.1     sevan 
    487  1.17  jakllsch 	last = cur = idx;
    488   1.1     sevan 	cmdsts = RGE_TDCMDSTS_SOF;
    489   1.1     sevan 
    490   1.1     sevan 	for (i = 0; i < txmap->dm_nsegs; i++) {
    491   1.1     sevan 		d = &sc->rge_ldata.rge_tx_list[cur];
    492   1.1     sevan 
    493   1.1     sevan 		d->rge_extsts = htole32(cflags);
    494   1.1     sevan 		d->rge_addrlo = htole32(RGE_ADDR_LO(txmap->dm_segs[i].ds_addr));
    495   1.1     sevan 		d->rge_addrhi = htole32(RGE_ADDR_HI(txmap->dm_segs[i].ds_addr));
    496   1.1     sevan 
    497   1.1     sevan 		cmdsts |= txmap->dm_segs[i].ds_len;
    498   1.1     sevan 
    499   1.1     sevan 		if (cur == RGE_TX_LIST_CNT - 1)
    500   1.1     sevan 			cmdsts |= RGE_TDCMDSTS_EOR;
    501   1.1     sevan 
    502   1.1     sevan 		d->rge_cmdsts = htole32(cmdsts);
    503   1.1     sevan 
    504   1.1     sevan 		last = cur;
    505   1.1     sevan 		cmdsts = RGE_TDCMDSTS_OWN;
    506   1.1     sevan 		cur = RGE_NEXT_TX_DESC(cur);
    507   1.1     sevan 	}
    508   1.1     sevan 
    509   1.1     sevan 	/* Set EOF on the last descriptor. */
    510   1.1     sevan 	d->rge_cmdsts |= htole32(RGE_TDCMDSTS_EOF);
    511   1.1     sevan 
    512   1.1     sevan 	/* Transfer ownership of packet to the chip. */
    513   1.1     sevan 	d = &sc->rge_ldata.rge_tx_list[idx];
    514   1.1     sevan 
    515   1.1     sevan 	d->rge_cmdsts |= htole32(RGE_TDCMDSTS_OWN);
    516   1.1     sevan 
    517   1.1     sevan 	bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map,
    518   1.1     sevan 	    cur * sizeof(struct rge_tx_desc), sizeof(struct rge_tx_desc),
    519   1.1     sevan 	    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
    520   1.1     sevan 
    521   1.1     sevan 	/* Update info of TX queue and descriptors. */
    522   1.1     sevan 	txq->txq_mbuf = m;
    523   1.1     sevan 	txq->txq_descidx = last;
    524   1.1     sevan 
    525   1.1     sevan 	return (nsegs);
    526   1.1     sevan }
    527   1.1     sevan 
    528   1.1     sevan int
    529   1.2     sevan rge_ioctl(struct ifnet *ifp, u_long cmd, void *data)
    530   1.1     sevan {
    531   1.1     sevan 	struct rge_softc *sc = ifp->if_softc;
    532  1.17  jakllsch 	//struct ifreq *ifr = (struct ifreq *)data;
    533   1.1     sevan 	int s, error = 0;
    534   1.1     sevan 
    535   1.1     sevan 	s = splnet();
    536   1.1     sevan 
    537   1.1     sevan 	switch (cmd) {
    538   1.1     sevan 	case SIOCSIFFLAGS:
    539  1.17  jakllsch 		if ((error = ifioctl_common(ifp, cmd, data)) != 0)
    540  1.17  jakllsch 			break;
    541  1.17  jakllsch 		/* XXX set an ifflags callback and let ether_ioctl
    542  1.17  jakllsch 		 * handle all of this.
    543  1.17  jakllsch 		 */
    544   1.1     sevan 		if (ifp->if_flags & IFF_UP) {
    545   1.1     sevan 			if (ifp->if_flags & IFF_RUNNING)
    546   1.1     sevan 				error = ENETRESET;
    547   1.1     sevan 			else
    548   1.1     sevan 				rge_init(ifp);
    549   1.1     sevan 		} else {
    550   1.1     sevan 			if (ifp->if_flags & IFF_RUNNING)
    551  1.17  jakllsch 				rge_stop(ifp, 1);
    552   1.1     sevan 		}
    553   1.1     sevan 		break;
    554   1.1     sevan 	default:
    555   1.2     sevan 		error = ether_ioctl(ifp, cmd, data);
    556   1.1     sevan 	}
    557   1.1     sevan 
    558   1.1     sevan 	if (error == ENETRESET) {
    559   1.1     sevan 		if (ifp->if_flags & IFF_RUNNING)
    560   1.1     sevan 			rge_iff(sc);
    561   1.1     sevan 		error = 0;
    562   1.1     sevan 	}
    563   1.1     sevan 
    564   1.1     sevan 	splx(s);
    565   1.1     sevan 	return (error);
    566   1.1     sevan }
    567   1.1     sevan 
    568   1.1     sevan void
    569   1.3     sevan rge_start(struct ifnet *ifp)
    570   1.1     sevan {
    571   1.1     sevan 	struct rge_softc *sc = ifp->if_softc;
    572   1.1     sevan 	struct mbuf *m;
    573   1.1     sevan 	int free, idx, used;
    574   1.1     sevan 	int queued = 0;
    575   1.1     sevan 
    576   1.2     sevan #define LINK_STATE_IS_UP(_s)    \
    577   1.2     sevan 	((_s) >= LINK_STATE_UP || (_s) == LINK_STATE_UNKNOWN)
    578   1.2     sevan 
    579   1.1     sevan 	if (!LINK_STATE_IS_UP(ifp->if_link_state)) {
    580  1.17  jakllsch 		IFQ_PURGE(&ifp->if_snd);
    581   1.1     sevan 		return;
    582   1.1     sevan 	}
    583   1.1     sevan 
    584   1.1     sevan 	/* Calculate free space. */
    585   1.1     sevan 	idx = sc->rge_ldata.rge_txq_prodidx;
    586   1.1     sevan 	free = sc->rge_ldata.rge_txq_considx;
    587   1.1     sevan 	if (free <= idx)
    588   1.1     sevan 		free += RGE_TX_LIST_CNT;
    589   1.1     sevan 	free -= idx;
    590   1.1     sevan 
    591   1.1     sevan 	for (;;) {
    592   1.1     sevan 		if (RGE_TX_NSEGS >= free + 2) {
    593   1.3     sevan 			SET(ifp->if_flags, IFF_OACTIVE);
    594   1.1     sevan 			break;
    595   1.1     sevan 		}
    596   1.1     sevan 
    597   1.3     sevan 		IFQ_DEQUEUE(&ifp->if_snd, m);
    598   1.1     sevan 		if (m == NULL)
    599   1.1     sevan 			break;
    600   1.1     sevan 
    601   1.1     sevan 		used = rge_encap(sc, m, idx);
    602   1.1     sevan 		if (used == 0) {
    603   1.1     sevan 			m_freem(m);
    604   1.1     sevan 			continue;
    605   1.1     sevan 		}
    606   1.1     sevan 
    607   1.1     sevan 		KASSERT(used <= free);
    608   1.1     sevan 		free -= used;
    609   1.1     sevan 
    610  1.17  jakllsch 		bpf_mtap(ifp, m, BPF_D_OUT);
    611   1.1     sevan 
    612   1.1     sevan 		idx += used;
    613   1.1     sevan 		if (idx >= RGE_TX_LIST_CNT)
    614   1.1     sevan 			idx -= RGE_TX_LIST_CNT;
    615   1.1     sevan 
    616   1.1     sevan 		queued++;
    617   1.1     sevan 	}
    618   1.1     sevan 
    619   1.1     sevan 	if (queued == 0)
    620   1.1     sevan 		return;
    621   1.1     sevan 
    622   1.1     sevan 	/* Set a timeout in case the chip goes out to lunch. */
    623   1.1     sevan 	ifp->if_timer = 5;
    624   1.1     sevan 
    625   1.1     sevan 	sc->rge_ldata.rge_txq_prodidx = idx;
    626  1.17  jakllsch #if 0
    627   1.1     sevan 	ifq_serialize(ifq, &sc->sc_task);
    628  1.17  jakllsch #else
    629  1.17  jakllsch 	rge_txstart(&sc->sc_task, sc);
    630  1.17  jakllsch #endif
    631   1.1     sevan }
    632   1.1     sevan 
    633   1.1     sevan void
    634   1.1     sevan rge_watchdog(struct ifnet *ifp)
    635   1.1     sevan {
    636   1.1     sevan 	struct rge_softc *sc = ifp->if_softc;
    637   1.1     sevan 
    638  1.16  jakllsch 	device_printf(sc->sc_dev, "watchdog timeout\n");
    639   1.4     skrll 	if_statinc(ifp, if_oerrors);
    640   1.1     sevan 
    641   1.1     sevan 	rge_init(ifp);
    642   1.1     sevan }
    643   1.1     sevan 
    644   1.1     sevan int
    645   1.1     sevan rge_init(struct ifnet *ifp)
    646   1.1     sevan {
    647   1.1     sevan 	struct rge_softc *sc = ifp->if_softc;
    648   1.1     sevan 	uint32_t val;
    649   1.1     sevan 	int i;
    650   1.1     sevan 
    651  1.17  jakllsch 	rge_stop(ifp, 0);
    652   1.1     sevan 
    653   1.1     sevan 	/* Set MAC address. */
    654  1.17  jakllsch 	rge_set_macaddr(sc, CLLADDR(ifp->if_sadl));
    655   1.1     sevan 
    656  1.17  jakllsch 	/* Set Maximum frame size. */
    657  1.17  jakllsch 	RGE_WRITE_2(sc, RGE_RXMAXSIZE, RGE_JUMBO_FRAMELEN);
    658   1.1     sevan 
    659   1.1     sevan 	/* Initialize RX descriptors list. */
    660   1.1     sevan 	if (rge_rx_list_init(sc) == ENOBUFS) {
    661  1.16  jakllsch 		device_printf(sc->sc_dev,
    662  1.13     sevan 		    "init failed: no memory for RX buffers\n");
    663  1.17  jakllsch 		rge_stop(ifp, 1);
    664   1.1     sevan 		return (ENOBUFS);
    665   1.1     sevan 	}
    666   1.1     sevan 
    667   1.1     sevan 	/* Initialize TX descriptors. */
    668   1.1     sevan 	rge_tx_list_init(sc);
    669   1.1     sevan 
    670   1.1     sevan 	/* Load the addresses of the RX and TX lists into the chip. */
    671   1.1     sevan 	RGE_WRITE_4(sc, RGE_RXDESC_ADDR_LO,
    672   1.1     sevan 	    RGE_ADDR_LO(sc->rge_ldata.rge_rx_list_map->dm_segs[0].ds_addr));
    673   1.1     sevan 	RGE_WRITE_4(sc, RGE_RXDESC_ADDR_HI,
    674   1.1     sevan 	    RGE_ADDR_HI(sc->rge_ldata.rge_rx_list_map->dm_segs[0].ds_addr));
    675   1.1     sevan 	RGE_WRITE_4(sc, RGE_TXDESC_ADDR_LO,
    676   1.1     sevan 	    RGE_ADDR_LO(sc->rge_ldata.rge_tx_list_map->dm_segs[0].ds_addr));
    677   1.1     sevan 	RGE_WRITE_4(sc, RGE_TXDESC_ADDR_HI,
    678   1.1     sevan 	    RGE_ADDR_HI(sc->rge_ldata.rge_tx_list_map->dm_segs[0].ds_addr));
    679   1.1     sevan 
    680   1.1     sevan 	RGE_SETBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
    681   1.1     sevan 
    682   1.1     sevan 	RGE_CLRBIT_1(sc, 0xf1, 0x80);
    683   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_CFG2, RGE_CFG2_CLKREQ_EN);
    684   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_CFG5, RGE_CFG5_PME_STS);
    685   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_CFG3, RGE_CFG3_RDY_TO_L23);
    686   1.1     sevan 
    687   1.1     sevan 	/* Clear interrupt moderation timer. */
    688   1.1     sevan 	for (i = 0; i < 64; i++)
    689  1.17  jakllsch 		RGE_WRITE_4(sc, RGE_INTMITI(i), 0);
    690   1.1     sevan 
    691   1.1     sevan 	/* Set the initial RX and TX configurations. */
    692   1.1     sevan 	RGE_WRITE_4(sc, RGE_RXCFG, RGE_RXCFG_CONFIG);
    693   1.1     sevan 	RGE_WRITE_4(sc, RGE_TXCFG, RGE_TXCFG_CONFIG);
    694   1.1     sevan 
    695   1.1     sevan 	val = rge_read_csi(sc, 0x70c) & ~0xff000000;
    696   1.1     sevan 	rge_write_csi(sc, 0x70c, val | 0x27000000);
    697   1.1     sevan 
    698   1.1     sevan 	/* Enable hardware optimization function. */
    699   1.1     sevan 	val = pci_conf_read(sc->sc_pc, sc->sc_tag, 0x78) & ~0x00007000;
    700   1.1     sevan 	pci_conf_write(sc->sc_pc, sc->sc_tag, 0x78, val | 0x00005000);
    701   1.1     sevan 
    702   1.1     sevan 	RGE_WRITE_2(sc, 0x0382, 0x221b);
    703   1.1     sevan 	RGE_WRITE_1(sc, 0x4500, 0);
    704   1.1     sevan 	RGE_WRITE_2(sc, 0x4800, 0);
    705   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_CFG1, RGE_CFG1_SPEED_DOWN);
    706   1.1     sevan 
    707   1.1     sevan 	rge_write_mac_ocp(sc, 0xc140, 0xffff);
    708   1.1     sevan 	rge_write_mac_ocp(sc, 0xc142, 0xffff);
    709   1.1     sevan 
    710   1.1     sevan 	val = rge_read_mac_ocp(sc, 0xd3e2) & ~0x0fff;
    711   1.1     sevan 	rge_write_mac_ocp(sc, 0xd3e2, val | 0x03a9);
    712   1.1     sevan 
    713   1.1     sevan 	RGE_MAC_CLRBIT(sc, 0xd3e4, 0x00ff);
    714   1.1     sevan 	RGE_MAC_SETBIT(sc, 0xe860, 0x0080);
    715   1.1     sevan 	RGE_MAC_SETBIT(sc, 0xeb58, 0x0001);
    716   1.1     sevan 
    717   1.1     sevan 	val = rge_read_mac_ocp(sc, 0xe614) & ~0x0700;
    718  1.17  jakllsch 	if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3)
    719  1.17  jakllsch 		rge_write_mac_ocp(sc, 0xe614, val | 0x0400);
    720  1.17  jakllsch 	else
    721  1.17  jakllsch 		rge_write_mac_ocp(sc, 0xe614, val | 0x0200);
    722   1.1     sevan 
    723   1.1     sevan 	RGE_MAC_CLRBIT(sc, 0xe63e, 0x0c00);
    724   1.1     sevan 
    725  1.17  jakllsch 	if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3) {
    726  1.17  jakllsch 		val = rge_read_mac_ocp(sc, 0xe63e) & ~0x0030;
    727  1.17  jakllsch 		rge_write_mac_ocp(sc, 0xe63e, val | 0x0020);
    728  1.17  jakllsch 	} else
    729  1.17  jakllsch 		RGE_MAC_CLRBIT(sc, 0xe63e, 0x0030);
    730   1.1     sevan 
    731   1.1     sevan 	RGE_MAC_SETBIT(sc, 0xc0b4, 0x000c);
    732   1.1     sevan 
    733  1.17  jakllsch 	val = rge_read_mac_ocp(sc, 0xeb6a) & ~0x00ff;
    734   1.1     sevan 	rge_write_mac_ocp(sc, 0xeb6a, val | 0x0033);
    735   1.1     sevan 
    736   1.1     sevan 	val = rge_read_mac_ocp(sc, 0xeb50) & ~0x03e0;
    737   1.1     sevan 	rge_write_mac_ocp(sc, 0xeb50, val | 0x0040);
    738   1.1     sevan 
    739   1.1     sevan 	val = rge_read_mac_ocp(sc, 0xe056) & ~0x00f0;
    740   1.1     sevan 	rge_write_mac_ocp(sc, 0xe056, val | 0x0030);
    741   1.1     sevan 
    742   1.1     sevan 	RGE_WRITE_1(sc, RGE_TDFNR, 0x10);
    743   1.1     sevan 
    744  1.17  jakllsch 	RGE_SETBIT_1(sc, RGE_DLLPR, RGE_DLLPR_TX_10M_PS_EN);
    745  1.17  jakllsch 
    746   1.1     sevan 	RGE_MAC_CLRBIT(sc, 0xe040, 0x1000);
    747   1.1     sevan 
    748  1.17  jakllsch 	val = rge_read_mac_ocp(sc, 0xea1c) & ~0x0003;
    749  1.17  jakllsch 	rge_write_mac_ocp(sc, 0xea1c, val | 0x0001);
    750  1.17  jakllsch 
    751   1.1     sevan 	val = rge_read_mac_ocp(sc, 0xe0c0) & ~0x4f0f;
    752   1.1     sevan 	rge_write_mac_ocp(sc, 0xe0c0, val | 0x4403);
    753   1.1     sevan 
    754   1.1     sevan 	RGE_MAC_SETBIT(sc, 0xe052, 0x0068);
    755   1.1     sevan 	RGE_MAC_CLRBIT(sc, 0xe052, 0x0080);
    756   1.1     sevan 
    757   1.1     sevan 	val = rge_read_mac_ocp(sc, 0xc0ac) & ~0x0080;
    758   1.1     sevan 	rge_write_mac_ocp(sc, 0xc0ac, val | 0x1f00);
    759   1.1     sevan 
    760   1.1     sevan 	val = rge_read_mac_ocp(sc, 0xd430) & ~0x0fff;
    761   1.1     sevan 	rge_write_mac_ocp(sc, 0xd430, val | 0x047f);
    762   1.1     sevan 
    763  1.17  jakllsch 	val = rge_read_mac_ocp(sc, 0xe84c) & ~0x0040;
    764  1.17  jakllsch 	if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3)
    765  1.17  jakllsch 		rge_write_mac_ocp(sc, 0xe84c, 0x00c0);
    766  1.17  jakllsch 	else
    767  1.17  jakllsch 		rge_write_mac_ocp(sc, 0xe84c, 0x0080);
    768  1.17  jakllsch 
    769  1.17  jakllsch 	RGE_SETBIT_1(sc, RGE_DLLPR, RGE_DLLPR_PFM_EN);
    770  1.17  jakllsch 
    771  1.17  jakllsch 	if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3)
    772  1.17  jakllsch 		RGE_SETBIT_1(sc, RGE_MCUCMD, 0x01);
    773   1.1     sevan 
    774   1.1     sevan 	/* Disable EEE plus. */
    775   1.1     sevan 	RGE_MAC_CLRBIT(sc, 0xe080, 0x0002);
    776   1.1     sevan 
    777   1.1     sevan 	RGE_MAC_CLRBIT(sc, 0xea1c, 0x0004);
    778   1.1     sevan 
    779   1.1     sevan 	RGE_MAC_SETBIT(sc, 0xeb54, 0x0001);
    780   1.1     sevan 	DELAY(1);
    781   1.1     sevan 	RGE_MAC_CLRBIT(sc, 0xeb54, 0x0001);
    782   1.1     sevan 
    783   1.1     sevan 	RGE_CLRBIT_4(sc, 0x1880, 0x0030);
    784   1.1     sevan 
    785   1.1     sevan 	rge_write_mac_ocp(sc, 0xe098, 0xc302);
    786   1.1     sevan 
    787  1.17  jakllsch 	if ((sc->sc_ec.ec_capenable & ETHERCAP_VLAN_HWTAGGING) != 0)
    788   1.1     sevan 		RGE_SETBIT_4(sc, RGE_RXCFG, RGE_RXCFG_VLANSTRIP);
    789  1.17  jakllsch 	else
    790  1.17  jakllsch 		RGE_CLRBIT_4(sc, RGE_RXCFG, RGE_RXCFG_VLANSTRIP);
    791   1.1     sevan 
    792   1.1     sevan 	RGE_SETBIT_2(sc, RGE_CPLUSCMD, RGE_CPLUSCMD_RXCSUM);
    793   1.1     sevan 
    794   1.1     sevan 	for (i = 0; i < 10; i++) {
    795   1.1     sevan 		if (!(rge_read_mac_ocp(sc, 0xe00e) & 0x2000))
    796   1.1     sevan 			break;
    797   1.1     sevan 		DELAY(1000);
    798   1.1     sevan 	}
    799   1.1     sevan 
    800   1.1     sevan 	/* Disable RXDV gate. */
    801   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_PPSW, 0x08);
    802   1.1     sevan 	DELAY(2000);
    803   1.1     sevan 
    804   1.1     sevan 	rge_ifmedia_upd(ifp);
    805   1.1     sevan 
    806   1.1     sevan 	/* Enable transmit and receive. */
    807   1.1     sevan 	RGE_WRITE_1(sc, RGE_CMD, RGE_CMD_TXENB | RGE_CMD_RXENB);
    808   1.1     sevan 
    809   1.1     sevan 	/* Program promiscuous mode and multicast filters. */
    810   1.1     sevan 	rge_iff(sc);
    811   1.1     sevan 
    812   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_CFG2, RGE_CFG2_CLKREQ_EN);
    813   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_CFG5, RGE_CFG5_PME_STS);
    814   1.1     sevan 
    815   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
    816   1.1     sevan 
    817   1.1     sevan 	/* Enable interrupts. */
    818   1.1     sevan 	rge_setup_intr(sc, RGE_IMTYPE_SIM);
    819   1.1     sevan 
    820   1.1     sevan 	ifp->if_flags |= IFF_RUNNING;
    821   1.3     sevan 	CLR(ifp->if_flags, IFF_OACTIVE);
    822   1.1     sevan 
    823   1.3     sevan 	callout_schedule(&sc->sc_timeout, 1);
    824   1.1     sevan 
    825   1.1     sevan 	return (0);
    826   1.1     sevan }
    827   1.1     sevan 
    828   1.1     sevan /*
    829   1.1     sevan  * Stop the adapter and free any mbufs allocated to the RX and TX lists.
    830   1.1     sevan  */
    831   1.1     sevan void
    832  1.17  jakllsch rge_stop(struct ifnet *ifp, int disable)
    833   1.1     sevan {
    834   1.1     sevan 	struct rge_softc *sc = ifp->if_softc;
    835   1.1     sevan 	int i;
    836   1.1     sevan 
    837  1.17  jakllsch 	if (disable) {
    838  1.17  jakllsch 		callout_halt(&sc->sc_timeout, NULL);
    839  1.17  jakllsch 	} else
    840  1.17  jakllsch 		callout_stop(&sc->sc_timeout);
    841   1.1     sevan 
    842   1.1     sevan 	ifp->if_timer = 0;
    843   1.1     sevan 	ifp->if_flags &= ~IFF_RUNNING;
    844   1.1     sevan 	sc->rge_timerintr = 0;
    845   1.1     sevan 
    846   1.1     sevan 	RGE_CLRBIT_4(sc, RGE_RXCFG, RGE_RXCFG_ALLPHYS | RGE_RXCFG_INDIV |
    847   1.1     sevan 	    RGE_RXCFG_MULTI | RGE_RXCFG_BROAD | RGE_RXCFG_RUNT |
    848   1.1     sevan 	    RGE_RXCFG_ERRPKT);
    849   1.1     sevan 
    850   1.1     sevan 	RGE_WRITE_4(sc, RGE_IMR, 0);
    851  1.17  jakllsch 
    852  1.17  jakllsch 	/* Clear timer interrupts. */
    853  1.17  jakllsch 	RGE_WRITE_4(sc, RGE_TIMERINT0, 0);
    854  1.17  jakllsch 	RGE_WRITE_4(sc, RGE_TIMERINT1, 0);
    855  1.17  jakllsch 	RGE_WRITE_4(sc, RGE_TIMERINT2, 0);
    856  1.17  jakllsch 	RGE_WRITE_4(sc, RGE_TIMERINT3, 0);
    857   1.1     sevan 
    858   1.1     sevan 	rge_reset(sc);
    859   1.1     sevan 
    860  1.17  jakllsch //	intr_barrier(sc->sc_ih);
    861  1.17  jakllsch //	ifq_barrier(&ifp->if_snd);
    862   1.2     sevan /*	ifq_clr_oactive(&ifp->if_snd); Sevan - OpenBSD queue API */
    863   1.1     sevan 
    864   1.1     sevan 	if (sc->rge_head != NULL) {
    865   1.1     sevan 		m_freem(sc->rge_head);
    866   1.1     sevan 		sc->rge_head = sc->rge_tail = NULL;
    867   1.1     sevan 	}
    868   1.1     sevan 
    869   1.1     sevan 	/* Free the TX list buffers. */
    870   1.1     sevan 	for (i = 0; i < RGE_TX_LIST_CNT; i++) {
    871   1.1     sevan 		if (sc->rge_ldata.rge_txq[i].txq_mbuf != NULL) {
    872   1.1     sevan 			bus_dmamap_unload(sc->sc_dmat,
    873   1.1     sevan 			    sc->rge_ldata.rge_txq[i].txq_dmamap);
    874   1.1     sevan 			m_freem(sc->rge_ldata.rge_txq[i].txq_mbuf);
    875   1.1     sevan 			sc->rge_ldata.rge_txq[i].txq_mbuf = NULL;
    876   1.1     sevan 		}
    877   1.1     sevan 	}
    878   1.1     sevan 
    879   1.1     sevan 	/* Free the RX list buffers. */
    880   1.1     sevan 	for (i = 0; i < RGE_RX_LIST_CNT; i++) {
    881   1.1     sevan 		if (sc->rge_ldata.rge_rxq[i].rxq_mbuf != NULL) {
    882   1.1     sevan 			bus_dmamap_unload(sc->sc_dmat,
    883   1.1     sevan 			    sc->rge_ldata.rge_rxq[i].rxq_dmamap);
    884   1.1     sevan 			m_freem(sc->rge_ldata.rge_rxq[i].rxq_mbuf);
    885   1.1     sevan 			sc->rge_ldata.rge_rxq[i].rxq_mbuf = NULL;
    886   1.1     sevan 		}
    887   1.1     sevan 	}
    888   1.1     sevan }
    889   1.1     sevan 
    890   1.1     sevan /*
    891   1.1     sevan  * Set media options.
    892   1.1     sevan  */
    893   1.1     sevan int
    894   1.1     sevan rge_ifmedia_upd(struct ifnet *ifp)
    895   1.1     sevan {
    896   1.1     sevan 	struct rge_softc *sc = ifp->if_softc;
    897   1.1     sevan 	struct ifmedia *ifm = &sc->sc_media;
    898   1.1     sevan 	int anar, gig, val;
    899   1.1     sevan 
    900   1.1     sevan 	if (IFM_TYPE(ifm->ifm_media) != IFM_ETHER)
    901   1.1     sevan 		return (EINVAL);
    902   1.1     sevan 
    903   1.1     sevan 	/* Disable Gigabit Lite. */
    904   1.1     sevan 	RGE_PHY_CLRBIT(sc, 0xa428, 0x0200);
    905   1.1     sevan 	RGE_PHY_CLRBIT(sc, 0xa5ea, 0x0001);
    906   1.1     sevan 
    907   1.1     sevan 	val = rge_read_phy_ocp(sc, 0xa5d4);
    908   1.1     sevan 	val &= ~RGE_ADV_2500TFDX;
    909   1.1     sevan 
    910   1.1     sevan 	anar = gig = 0;
    911   1.1     sevan 	switch (IFM_SUBTYPE(ifm->ifm_media)) {
    912   1.1     sevan 	case IFM_AUTO:
    913  1.17  jakllsch 		anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10;
    914  1.17  jakllsch 		gig = GTCR_ADV_1000TFDX | GTCR_ADV_1000THDX;
    915   1.1     sevan 		val |= RGE_ADV_2500TFDX;
    916   1.1     sevan 		break;
    917   1.1     sevan 	case IFM_2500_T:
    918  1.17  jakllsch 		anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10;
    919  1.17  jakllsch 		gig = GTCR_ADV_1000TFDX | GTCR_ADV_1000THDX;
    920   1.1     sevan 		val |= RGE_ADV_2500TFDX;
    921   1.1     sevan 		ifp->if_baudrate = IF_Mbps(2500);
    922   1.1     sevan 		break;
    923   1.1     sevan 	case IFM_1000_T:
    924  1.17  jakllsch 		anar = ANAR_TX_FD | ANAR_TX | ANAR_10_FD | ANAR_10;
    925  1.17  jakllsch 		gig = GTCR_ADV_1000TFDX | GTCR_ADV_1000THDX;
    926   1.1     sevan 		ifp->if_baudrate = IF_Gbps(1);
    927   1.1     sevan 		break;
    928   1.1     sevan 	case IFM_100_TX:
    929  1.17  jakllsch 		gig = rge_read_phy(sc, 0, MII_100T2CR) &
    930  1.17  jakllsch 		    ~(GTCR_ADV_1000TFDX | GTCR_ADV_1000THDX);
    931  1.17  jakllsch 		anar = ((ifm->ifm_media & IFM_GMASK) == IFM_FDX) ?
    932  1.17  jakllsch 		    ANAR_TX | ANAR_TX_FD | ANAR_10_FD | ANAR_10 :
    933  1.17  jakllsch 		    ANAR_TX | ANAR_10_FD | ANAR_10;
    934   1.1     sevan 		ifp->if_baudrate = IF_Mbps(100);
    935   1.1     sevan 		break;
    936   1.1     sevan 	case IFM_10_T:
    937  1.17  jakllsch 		gig = rge_read_phy(sc, 0, MII_100T2CR) &
    938  1.17  jakllsch 		    ~(GTCR_ADV_1000TFDX | GTCR_ADV_1000THDX);
    939  1.17  jakllsch 		anar = ((ifm->ifm_media & IFM_GMASK) == IFM_FDX) ?
    940  1.17  jakllsch 		    ANAR_10_FD | ANAR_10 : ANAR_10;
    941   1.1     sevan 		ifp->if_baudrate = IF_Mbps(10);
    942   1.1     sevan 		break;
    943   1.1     sevan 	default:
    944  1.16  jakllsch 		device_printf(sc->sc_dev,
    945  1.13     sevan 		    "unsupported media type\n");
    946   1.1     sevan 		return (EINVAL);
    947   1.1     sevan 	}
    948   1.1     sevan 
    949   1.1     sevan 	rge_write_phy(sc, 0, MII_ANAR, anar | ANAR_PAUSE_ASYM | ANAR_FC);
    950   1.1     sevan 	rge_write_phy(sc, 0, MII_100T2CR, gig);
    951   1.1     sevan 	rge_write_phy_ocp(sc, 0xa5d4, val);
    952  1.17  jakllsch 	rge_write_phy(sc, 0, MII_BMCR, BMCR_RESET | BMCR_AUTOEN |
    953  1.17  jakllsch 	    BMCR_STARTNEG);
    954   1.1     sevan 
    955   1.1     sevan 	return (0);
    956   1.1     sevan }
    957   1.1     sevan 
    958   1.1     sevan /*
    959   1.1     sevan  * Report current media status.
    960   1.1     sevan  */
    961   1.1     sevan void
    962   1.1     sevan rge_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
    963   1.1     sevan {
    964   1.1     sevan 	struct rge_softc *sc = ifp->if_softc;
    965   1.1     sevan 	uint16_t status = 0;
    966   1.1     sevan 
    967   1.1     sevan 	ifmr->ifm_status = IFM_AVALID;
    968   1.1     sevan 	ifmr->ifm_active = IFM_ETHER;
    969   1.1     sevan 
    970   1.1     sevan 	if (rge_get_link_status(sc)) {
    971   1.1     sevan 		ifmr->ifm_status |= IFM_ACTIVE;
    972   1.1     sevan 
    973   1.1     sevan 		status = RGE_READ_2(sc, RGE_PHYSTAT);
    974   1.1     sevan 		if ((status & RGE_PHYSTAT_FDX) ||
    975   1.1     sevan 		    (status & RGE_PHYSTAT_2500MBPS))
    976   1.1     sevan 			ifmr->ifm_active |= IFM_FDX;
    977   1.1     sevan 		else
    978   1.1     sevan 			ifmr->ifm_active |= IFM_HDX;
    979   1.1     sevan 
    980   1.1     sevan 		if (status & RGE_PHYSTAT_10MBPS)
    981   1.1     sevan 			ifmr->ifm_active |= IFM_10_T;
    982   1.1     sevan 		else if (status & RGE_PHYSTAT_100MBPS)
    983   1.1     sevan 			ifmr->ifm_active |= IFM_100_TX;
    984   1.1     sevan 		else if (status & RGE_PHYSTAT_1000MBPS)
    985   1.1     sevan 			ifmr->ifm_active |= IFM_1000_T;
    986   1.1     sevan 		else if (status & RGE_PHYSTAT_2500MBPS)
    987   1.1     sevan 			ifmr->ifm_active |= IFM_2500_T;
    988   1.1     sevan 	}
    989   1.1     sevan }
    990   1.1     sevan 
    991   1.5     skrll /*
    992   1.1     sevan  * Allocate memory for RX/TX rings.
    993   1.1     sevan  */
    994   1.1     sevan int
    995   1.1     sevan rge_allocmem(struct rge_softc *sc)
    996   1.1     sevan {
    997   1.1     sevan 	int error, i;
    998   1.1     sevan 
    999   1.1     sevan 	/* Allocate DMA'able memory for the TX ring. */
   1000   1.1     sevan 	error = bus_dmamap_create(sc->sc_dmat, RGE_TX_LIST_SZ, 1,
   1001   1.1     sevan 	    RGE_TX_LIST_SZ, 0, BUS_DMA_NOWAIT, &sc->rge_ldata.rge_tx_list_map);
   1002   1.1     sevan 	if (error) {
   1003  1.13     sevan 		aprint_error_dev(sc->sc_dev, "can't create TX list map\n");
   1004   1.1     sevan 		return (error);
   1005   1.1     sevan 	}
   1006   1.1     sevan 	error = bus_dmamem_alloc(sc->sc_dmat, RGE_TX_LIST_SZ, RGE_ALIGN, 0,
   1007   1.1     sevan 	    &sc->rge_ldata.rge_tx_listseg, 1, &sc->rge_ldata.rge_tx_listnseg,
   1008  1.17  jakllsch 	    BUS_DMA_NOWAIT);
   1009   1.1     sevan 	if (error) {
   1010  1.13     sevan 		aprint_error_dev(sc->sc_dev, "can't alloc TX list\n");
   1011   1.1     sevan 		return (error);
   1012   1.1     sevan 	}
   1013   1.1     sevan 
   1014   1.1     sevan 	/* Load the map for the TX ring. */
   1015   1.1     sevan 	error = bus_dmamem_map(sc->sc_dmat, &sc->rge_ldata.rge_tx_listseg,
   1016   1.1     sevan 	    sc->rge_ldata.rge_tx_listnseg, RGE_TX_LIST_SZ,
   1017   1.8     sevan 	    (void **) &sc->rge_ldata.rge_tx_list,
   1018  1.17  jakllsch 	    BUS_DMA_NOWAIT | BUS_DMA_COHERENT);
   1019   1.1     sevan 	if (error) {
   1020  1.13     sevan 		aprint_error_dev(sc->sc_dev, "can't map TX dma buffers\n");
   1021   1.1     sevan 		bus_dmamem_free(sc->sc_dmat, &sc->rge_ldata.rge_tx_listseg,
   1022   1.1     sevan 		    sc->rge_ldata.rge_tx_listnseg);
   1023   1.1     sevan 		return (error);
   1024   1.1     sevan 	}
   1025  1.17  jakllsch 	memset(sc->rge_ldata.rge_tx_list, 0, RGE_TX_LIST_SZ);
   1026   1.1     sevan 	error = bus_dmamap_load(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map,
   1027   1.1     sevan 	    sc->rge_ldata.rge_tx_list, RGE_TX_LIST_SZ, NULL, BUS_DMA_NOWAIT);
   1028   1.1     sevan 	if (error) {
   1029  1.13     sevan 		aprint_error_dev(sc->sc_dev, "can't load TX dma map\n");
   1030   1.1     sevan 		bus_dmamap_destroy(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map);
   1031   1.1     sevan 		bus_dmamem_unmap(sc->sc_dmat,
   1032   1.2     sevan 		    sc->rge_ldata.rge_tx_list, RGE_TX_LIST_SZ);
   1033   1.1     sevan 		bus_dmamem_free(sc->sc_dmat, &sc->rge_ldata.rge_tx_listseg,
   1034   1.1     sevan 		    sc->rge_ldata.rge_tx_listnseg);
   1035   1.1     sevan 		return (error);
   1036   1.1     sevan 	}
   1037   1.1     sevan 
   1038   1.1     sevan 	/* Create DMA maps for TX buffers. */
   1039   1.1     sevan 	for (i = 0; i < RGE_TX_LIST_CNT; i++) {
   1040   1.1     sevan 		error = bus_dmamap_create(sc->sc_dmat, RGE_JUMBO_FRAMELEN,
   1041   1.1     sevan 		    RGE_TX_NSEGS, RGE_JUMBO_FRAMELEN, 0, 0,
   1042   1.1     sevan 		    &sc->rge_ldata.rge_txq[i].txq_dmamap);
   1043   1.1     sevan 		if (error) {
   1044  1.13     sevan 			aprint_error_dev(sc->sc_dev, "can't create DMA map for TX\n");
   1045   1.1     sevan 			return (error);
   1046   1.1     sevan 		}
   1047   1.1     sevan 	}
   1048   1.1     sevan 
   1049   1.1     sevan 	/* Allocate DMA'able memory for the RX ring. */
   1050   1.1     sevan 	error = bus_dmamap_create(sc->sc_dmat, RGE_RX_LIST_SZ, 1,
   1051   1.1     sevan 	    RGE_RX_LIST_SZ, 0, 0, &sc->rge_ldata.rge_rx_list_map);
   1052   1.1     sevan 	if (error) {
   1053  1.13     sevan 		aprint_error_dev(sc->sc_dev, "can't create RX list map\n");
   1054   1.1     sevan 		return (error);
   1055   1.1     sevan 	}
   1056   1.1     sevan 	error = bus_dmamem_alloc(sc->sc_dmat, RGE_RX_LIST_SZ, RGE_ALIGN, 0,
   1057   1.1     sevan 	    &sc->rge_ldata.rge_rx_listseg, 1, &sc->rge_ldata.rge_rx_listnseg,
   1058  1.17  jakllsch 	    BUS_DMA_NOWAIT);
   1059   1.1     sevan 	if (error) {
   1060  1.13     sevan 		aprint_error_dev(sc->sc_dev, "can't alloc RX list\n");
   1061   1.1     sevan 		return (error);
   1062   1.1     sevan 	}
   1063   1.1     sevan 
   1064   1.1     sevan 	/* Load the map for the RX ring. */
   1065   1.1     sevan 	error = bus_dmamem_map(sc->sc_dmat, &sc->rge_ldata.rge_rx_listseg,
   1066   1.1     sevan 	    sc->rge_ldata.rge_rx_listnseg, RGE_RX_LIST_SZ,
   1067   1.8     sevan 	    (void **) &sc->rge_ldata.rge_rx_list,
   1068  1.17  jakllsch 	    BUS_DMA_NOWAIT | BUS_DMA_COHERENT);
   1069   1.1     sevan 	if (error) {
   1070  1.13     sevan 		aprint_error_dev(sc->sc_dev, "can't map RX dma buffers\n");
   1071   1.1     sevan 		bus_dmamem_free(sc->sc_dmat, &sc->rge_ldata.rge_rx_listseg,
   1072   1.1     sevan 		    sc->rge_ldata.rge_rx_listnseg);
   1073   1.1     sevan 		return (error);
   1074   1.1     sevan 	}
   1075  1.17  jakllsch 	memset(sc->rge_ldata.rge_rx_list, 0, RGE_RX_LIST_SZ);
   1076   1.1     sevan 	error = bus_dmamap_load(sc->sc_dmat, sc->rge_ldata.rge_rx_list_map,
   1077   1.1     sevan 	    sc->rge_ldata.rge_rx_list, RGE_RX_LIST_SZ, NULL, BUS_DMA_NOWAIT);
   1078   1.1     sevan 	if (error) {
   1079  1.13     sevan 		aprint_error_dev(sc->sc_dev, "can't load RX dma map\n");
   1080   1.1     sevan 		bus_dmamap_destroy(sc->sc_dmat, sc->rge_ldata.rge_rx_list_map);
   1081   1.1     sevan 		bus_dmamem_unmap(sc->sc_dmat,
   1082   1.2     sevan 		    sc->rge_ldata.rge_rx_list, RGE_RX_LIST_SZ);
   1083   1.1     sevan 		bus_dmamem_free(sc->sc_dmat, &sc->rge_ldata.rge_rx_listseg,
   1084   1.1     sevan 		    sc->rge_ldata.rge_rx_listnseg);
   1085   1.1     sevan 		return (error);
   1086   1.1     sevan 	}
   1087   1.1     sevan 
   1088   1.1     sevan 	/* Create DMA maps for RX buffers. */
   1089   1.1     sevan 	for (i = 0; i < RGE_RX_LIST_CNT; i++) {
   1090   1.1     sevan 		error = bus_dmamap_create(sc->sc_dmat, RGE_JUMBO_FRAMELEN, 1,
   1091   1.1     sevan 		    RGE_JUMBO_FRAMELEN, 0, 0,
   1092   1.1     sevan 		    &sc->rge_ldata.rge_rxq[i].rxq_dmamap);
   1093   1.1     sevan 		if (error) {
   1094  1.13     sevan 			aprint_error_dev(sc->sc_dev, "can't create DMA map for RX\n");
   1095   1.1     sevan 			return (error);
   1096   1.1     sevan 		}
   1097   1.1     sevan 	}
   1098   1.1     sevan 
   1099   1.1     sevan 	return (error);
   1100   1.1     sevan }
   1101   1.1     sevan 
   1102   1.1     sevan /*
   1103   1.1     sevan  * Initialize the RX descriptor and attach an mbuf cluster.
   1104   1.1     sevan  */
   1105   1.1     sevan int
   1106   1.1     sevan rge_newbuf(struct rge_softc *sc, int idx)
   1107   1.1     sevan {
   1108   1.1     sevan 	struct mbuf *m;
   1109   1.1     sevan 	struct rge_rx_desc *r;
   1110   1.1     sevan 	struct rge_rxq *rxq;
   1111   1.1     sevan 	bus_dmamap_t rxmap;
   1112   1.1     sevan 
   1113  1.17  jakllsch 	m = MCLGETL(NULL, M_DONTWAIT, RGE_JUMBO_FRAMELEN);
   1114   1.1     sevan 	if (m == NULL)
   1115   1.1     sevan 		return (ENOBUFS);
   1116   1.1     sevan 
   1117   1.1     sevan 	m->m_len = m->m_pkthdr.len = RGE_JUMBO_FRAMELEN;
   1118   1.1     sevan 
   1119   1.1     sevan 	rxq = &sc->rge_ldata.rge_rxq[idx];
   1120   1.1     sevan 	rxmap = rxq->rxq_dmamap;
   1121   1.1     sevan 
   1122   1.1     sevan 	if (bus_dmamap_load_mbuf(sc->sc_dmat, rxmap, m, BUS_DMA_NOWAIT))
   1123   1.1     sevan 		goto out;
   1124   1.1     sevan 
   1125   1.1     sevan 	bus_dmamap_sync(sc->sc_dmat, rxmap, 0, rxmap->dm_mapsize,
   1126   1.1     sevan 	    BUS_DMASYNC_PREREAD);
   1127   1.1     sevan 
   1128   1.1     sevan 	/* Map the segments into RX descriptors. */
   1129   1.1     sevan 	r = &sc->rge_ldata.rge_rx_list[idx];
   1130   1.1     sevan 
   1131   1.1     sevan 	if (RGE_OWN(r)) {
   1132  1.16  jakllsch 		device_printf(sc->sc_dev, "tried to map busy RX descriptor\n");
   1133   1.1     sevan 		goto out;
   1134   1.1     sevan 	}
   1135   1.1     sevan 
   1136   1.1     sevan 	rxq->rxq_mbuf = m;
   1137   1.1     sevan 
   1138   1.1     sevan 	r->rge_extsts = 0;
   1139   1.1     sevan 	r->rge_addrlo = htole32(RGE_ADDR_LO(rxmap->dm_segs[0].ds_addr));
   1140   1.1     sevan 	r->rge_addrhi = htole32(RGE_ADDR_HI(rxmap->dm_segs[0].ds_addr));
   1141   1.1     sevan 
   1142   1.1     sevan 	r->rge_cmdsts = htole32(rxmap->dm_segs[0].ds_len);
   1143   1.1     sevan 	if (idx == RGE_RX_LIST_CNT - 1)
   1144   1.1     sevan 		r->rge_cmdsts |= htole32(RGE_RDCMDSTS_EOR);
   1145   1.1     sevan 
   1146   1.1     sevan 	r->rge_cmdsts |= htole32(RGE_RDCMDSTS_OWN);
   1147   1.1     sevan 
   1148   1.1     sevan 	bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_rx_list_map,
   1149   1.1     sevan 	    idx * sizeof(struct rge_rx_desc), sizeof(struct rge_rx_desc),
   1150   1.1     sevan 	    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
   1151   1.1     sevan 
   1152   1.1     sevan 	return (0);
   1153   1.1     sevan out:
   1154   1.1     sevan 	if (m != NULL)
   1155   1.1     sevan 		m_freem(m);
   1156   1.1     sevan 	return (ENOMEM);
   1157   1.1     sevan }
   1158   1.1     sevan 
   1159   1.1     sevan void
   1160   1.1     sevan rge_discard_rxbuf(struct rge_softc *sc, int idx)
   1161   1.1     sevan {
   1162   1.1     sevan 	struct rge_rx_desc *r;
   1163   1.1     sevan 
   1164   1.1     sevan 	r = &sc->rge_ldata.rge_rx_list[idx];
   1165   1.1     sevan 
   1166   1.1     sevan 	r->rge_cmdsts = htole32(RGE_JUMBO_FRAMELEN);
   1167   1.1     sevan 	r->rge_extsts = 0;
   1168   1.1     sevan 	if (idx == RGE_RX_LIST_CNT - 1)
   1169   1.1     sevan 		r->rge_cmdsts |= htole32(RGE_RDCMDSTS_EOR);
   1170   1.1     sevan 	r->rge_cmdsts |= htole32(RGE_RDCMDSTS_OWN);
   1171   1.1     sevan 
   1172   1.1     sevan 	bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_rx_list_map,
   1173   1.1     sevan 	    idx * sizeof(struct rge_rx_desc), sizeof(struct rge_rx_desc),
   1174   1.1     sevan 	    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
   1175   1.1     sevan }
   1176   1.1     sevan 
   1177   1.1     sevan int
   1178   1.1     sevan rge_rx_list_init(struct rge_softc *sc)
   1179   1.1     sevan {
   1180   1.1     sevan 	int i;
   1181   1.1     sevan 
   1182   1.1     sevan 	memset(sc->rge_ldata.rge_rx_list, 0, RGE_RX_LIST_SZ);
   1183   1.1     sevan 
   1184   1.1     sevan 	for (i = 0; i < RGE_RX_LIST_CNT; i++) {
   1185   1.1     sevan 		sc->rge_ldata.rge_rxq[i].rxq_mbuf = NULL;
   1186   1.1     sevan 		if (rge_newbuf(sc, i) == ENOBUFS)
   1187   1.1     sevan 			return (ENOBUFS);
   1188   1.1     sevan 	}
   1189   1.1     sevan 
   1190  1.17  jakllsch 	sc->rge_ldata.rge_rxq_prodidx = sc->rge_ldata.rge_rxq_considx = 0;
   1191   1.1     sevan 	sc->rge_head = sc->rge_tail = NULL;
   1192   1.1     sevan 
   1193   1.1     sevan 	return (0);
   1194   1.1     sevan }
   1195   1.1     sevan 
   1196   1.1     sevan void
   1197   1.1     sevan rge_tx_list_init(struct rge_softc *sc)
   1198   1.1     sevan {
   1199   1.1     sevan 	int i;
   1200   1.1     sevan 
   1201   1.1     sevan 	memset(sc->rge_ldata.rge_tx_list, 0, RGE_TX_LIST_SZ);
   1202   1.1     sevan 
   1203   1.1     sevan 	for (i = 0; i < RGE_TX_LIST_CNT; i++)
   1204   1.1     sevan 		sc->rge_ldata.rge_txq[i].txq_mbuf = NULL;
   1205   1.1     sevan 
   1206   1.1     sevan 	bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map, 0,
   1207   1.1     sevan 	    sc->rge_ldata.rge_tx_list_map->dm_mapsize,
   1208   1.1     sevan 	    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
   1209   1.1     sevan 
   1210   1.1     sevan 	sc->rge_ldata.rge_txq_prodidx = sc->rge_ldata.rge_txq_considx = 0;
   1211   1.1     sevan }
   1212   1.1     sevan 
   1213   1.1     sevan int
   1214   1.1     sevan rge_rxeof(struct rge_softc *sc)
   1215   1.1     sevan {
   1216   1.1     sevan 	struct mbuf *m;
   1217   1.2     sevan 	struct ifnet *ifp = &sc->sc_ec.ec_if;
   1218   1.1     sevan 	struct rge_rx_desc *cur_rx;
   1219   1.1     sevan 	struct rge_rxq *rxq;
   1220   1.1     sevan 	uint32_t rxstat, extsts;
   1221   1.1     sevan 	int i, total_len, rx = 0;
   1222   1.1     sevan 
   1223  1.17  jakllsch 	for (i = sc->rge_ldata.rge_rxq_considx; ; i = RGE_NEXT_RX_DESC(i)) {
   1224   1.1     sevan 		/* Invalidate the descriptor memory. */
   1225   1.1     sevan 		bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_rx_list_map,
   1226   1.1     sevan 		    i * sizeof(struct rge_rx_desc), sizeof(struct rge_rx_desc),
   1227   1.1     sevan 		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
   1228   1.1     sevan 
   1229   1.1     sevan 		cur_rx = &sc->rge_ldata.rge_rx_list[i];
   1230   1.1     sevan 
   1231   1.1     sevan 		if (RGE_OWN(cur_rx))
   1232   1.1     sevan 			break;
   1233   1.1     sevan 
   1234   1.1     sevan 		rxstat = letoh32(cur_rx->rge_cmdsts);
   1235   1.1     sevan 		extsts = letoh32(cur_rx->rge_extsts);
   1236   1.5     skrll 
   1237   1.1     sevan 		total_len = RGE_RXBYTES(cur_rx);
   1238   1.1     sevan 		rxq = &sc->rge_ldata.rge_rxq[i];
   1239   1.1     sevan 		m = rxq->rxq_mbuf;
   1240  1.17  jakllsch 		rxq->rxq_mbuf = NULL;
   1241   1.1     sevan 		rx = 1;
   1242   1.1     sevan 
   1243   1.1     sevan 		/* Invalidate the RX mbuf and unload its map. */
   1244   1.1     sevan 		bus_dmamap_sync(sc->sc_dmat, rxq->rxq_dmamap, 0,
   1245   1.1     sevan 		    rxq->rxq_dmamap->dm_mapsize, BUS_DMASYNC_POSTREAD);
   1246   1.1     sevan 		bus_dmamap_unload(sc->sc_dmat, rxq->rxq_dmamap);
   1247   1.1     sevan 
   1248   1.1     sevan 		if ((rxstat & (RGE_RDCMDSTS_SOF | RGE_RDCMDSTS_EOF)) !=
   1249   1.1     sevan 		    (RGE_RDCMDSTS_SOF | RGE_RDCMDSTS_EOF)) {
   1250   1.1     sevan 			rge_discard_rxbuf(sc, i);
   1251   1.1     sevan 			continue;
   1252   1.1     sevan 		}
   1253   1.1     sevan 
   1254   1.1     sevan 		if (rxstat & RGE_RDCMDSTS_RXERRSUM) {
   1255   1.4     skrll 			if_statinc(ifp, if_ierrors);
   1256   1.1     sevan 			/*
   1257   1.1     sevan 			 * If this is part of a multi-fragment packet,
   1258   1.1     sevan 			 * discard all the pieces.
   1259   1.1     sevan 			 */
   1260   1.1     sevan 			 if (sc->rge_head != NULL) {
   1261   1.1     sevan 				m_freem(sc->rge_head);
   1262   1.1     sevan 				sc->rge_head = sc->rge_tail = NULL;
   1263   1.1     sevan 			}
   1264   1.1     sevan 			rge_discard_rxbuf(sc, i);
   1265   1.1     sevan 			continue;
   1266   1.1     sevan 		}
   1267   1.1     sevan 
   1268   1.1     sevan 		/*
   1269   1.1     sevan 		 * If allocating a replacement mbuf fails,
   1270   1.1     sevan 		 * reload the current one.
   1271   1.1     sevan 		 */
   1272   1.1     sevan 
   1273   1.1     sevan 		if (rge_newbuf(sc, i) == ENOBUFS) {
   1274   1.1     sevan 			if (sc->rge_head != NULL) {
   1275   1.1     sevan 				m_freem(sc->rge_head);
   1276   1.1     sevan 				sc->rge_head = sc->rge_tail = NULL;
   1277   1.1     sevan 			}
   1278   1.1     sevan 			rge_discard_rxbuf(sc, i);
   1279   1.1     sevan 			continue;
   1280   1.1     sevan 		}
   1281   1.1     sevan 
   1282  1.17  jakllsch 		m_set_rcvif(m, ifp);
   1283   1.1     sevan 		if (sc->rge_head != NULL) {
   1284   1.1     sevan 			m->m_len = total_len;
   1285   1.1     sevan 			/*
   1286   1.1     sevan 			 * Special case: if there's 4 bytes or less
   1287   1.1     sevan 			 * in this buffer, the mbuf can be discarded:
   1288   1.1     sevan 			 * the last 4 bytes is the CRC, which we don't
   1289   1.1     sevan 			 * care about anyway.
   1290   1.1     sevan 			 */
   1291   1.1     sevan 			if (m->m_len <= ETHER_CRC_LEN) {
   1292   1.1     sevan 				sc->rge_tail->m_len -=
   1293   1.1     sevan 				    (ETHER_CRC_LEN - m->m_len);
   1294   1.1     sevan 				m_freem(m);
   1295   1.1     sevan 			} else {
   1296   1.1     sevan 				m->m_len -= ETHER_CRC_LEN;
   1297   1.1     sevan 				m->m_flags &= ~M_PKTHDR;
   1298   1.1     sevan 				sc->rge_tail->m_next = m;
   1299   1.1     sevan 			}
   1300   1.1     sevan 			m = sc->rge_head;
   1301   1.1     sevan 			sc->rge_head = sc->rge_tail = NULL;
   1302   1.1     sevan 			m->m_pkthdr.len = total_len - ETHER_CRC_LEN;
   1303   1.1     sevan 		} else
   1304  1.17  jakllsch 	#if 0
   1305   1.1     sevan 			m->m_pkthdr.len = m->m_len =
   1306   1.1     sevan 			    (total_len - ETHER_CRC_LEN);
   1307  1.17  jakllsch 	#else
   1308  1.17  jakllsch 		{
   1309  1.17  jakllsch 			m->m_pkthdr.len = m->m_len = total_len;
   1310  1.17  jakllsch 			m->m_flags |= M_HASFCS;
   1311  1.17  jakllsch 		}
   1312  1.17  jakllsch 	#endif
   1313   1.1     sevan 
   1314  1.17  jakllsch #if notyet
   1315   1.1     sevan 		/* Check IP header checksum. */
   1316   1.1     sevan 		if (!(rxstat & RGE_RDCMDSTS_IPCSUMERR) &&
   1317   1.1     sevan 		    (extsts & RGE_RDEXTSTS_IPV4))
   1318   1.1     sevan 			m->m_pkthdr.csum_flags |= M_IPV4_CSUM_IN_OK;
   1319   1.1     sevan 
   1320   1.1     sevan 		/* Check TCP/UDP checksum. */
   1321   1.1     sevan 		if ((extsts & (RGE_RDEXTSTS_IPV4 | RGE_RDEXTSTS_IPV6)) &&
   1322   1.1     sevan 		    (((rxstat & RGE_RDCMDSTS_TCPPKT) &&
   1323   1.1     sevan 		    !(rxstat & RGE_RDCMDSTS_TCPCSUMERR)) ||
   1324   1.1     sevan 		    ((rxstat & RGE_RDCMDSTS_UDPPKT) &&
   1325   1.1     sevan 		    !(rxstat & RGE_RDCMDSTS_UDPCSUMERR))))
   1326   1.1     sevan 			m->m_pkthdr.csum_flags |= M_TCP_CSUM_IN_OK |
   1327   1.1     sevan 			    M_UDP_CSUM_IN_OK;
   1328  1.17  jakllsch #endif
   1329   1.1     sevan 
   1330   1.1     sevan 		if (extsts & RGE_RDEXTSTS_VTAG) {
   1331  1.17  jakllsch 			vlan_set_tag(m,
   1332  1.17  jakllsch 			    bswap16(extsts & RGE_RDEXTSTS_VLAN_MASK));
   1333   1.1     sevan 		}
   1334   1.1     sevan 
   1335  1.17  jakllsch 		if_percpuq_enqueue(ifp->if_percpuq, m);
   1336   1.1     sevan 	}
   1337   1.1     sevan 
   1338  1.17  jakllsch 	sc->rge_ldata.rge_rxq_considx = i;
   1339   1.1     sevan 
   1340   1.1     sevan 	return (rx);
   1341   1.1     sevan }
   1342   1.1     sevan 
   1343   1.1     sevan int
   1344   1.1     sevan rge_txeof(struct rge_softc *sc)
   1345   1.1     sevan {
   1346   1.2     sevan 	struct ifnet *ifp = &sc->sc_ec.ec_if;
   1347   1.1     sevan 	struct rge_txq *txq;
   1348   1.1     sevan 	uint32_t txstat;
   1349   1.1     sevan 	int cons, idx, prod;
   1350   1.1     sevan 	int free = 0;
   1351   1.1     sevan 
   1352   1.1     sevan 	prod = sc->rge_ldata.rge_txq_prodidx;
   1353   1.1     sevan 	cons = sc->rge_ldata.rge_txq_considx;
   1354   1.1     sevan 
   1355   1.1     sevan 	while (prod != cons) {
   1356   1.1     sevan 		txq = &sc->rge_ldata.rge_txq[cons];
   1357   1.1     sevan 		idx = txq->txq_descidx;
   1358   1.1     sevan 
   1359   1.1     sevan 		bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map,
   1360   1.1     sevan 		    idx * sizeof(struct rge_tx_desc),
   1361   1.1     sevan 		    sizeof(struct rge_tx_desc),
   1362   1.1     sevan 		    BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
   1363   1.1     sevan 
   1364   1.1     sevan 		txstat = letoh32(sc->rge_ldata.rge_tx_list[idx].rge_cmdsts);
   1365   1.1     sevan 
   1366   1.1     sevan 		if (txstat & RGE_TDCMDSTS_OWN) {
   1367   1.1     sevan 			free = 2;
   1368   1.1     sevan 			break;
   1369   1.1     sevan 		}
   1370   1.1     sevan 
   1371   1.5     skrll 		bus_dmamap_sync(sc->sc_dmat, txq->txq_dmamap, 0,
   1372   1.1     sevan 		    txq->txq_dmamap->dm_mapsize, BUS_DMASYNC_POSTWRITE);
   1373   1.1     sevan 		bus_dmamap_unload(sc->sc_dmat, txq->txq_dmamap);
   1374   1.1     sevan 		m_freem(txq->txq_mbuf);
   1375   1.1     sevan 		txq->txq_mbuf = NULL;
   1376   1.1     sevan 
   1377   1.1     sevan 		if (txstat & (RGE_TDCMDSTS_EXCESSCOLL | RGE_TDCMDSTS_COLL))
   1378   1.4     skrll 			if_statinc(ifp, if_collisions);
   1379   1.1     sevan 		if (txstat & RGE_TDCMDSTS_TXERR)
   1380   1.4     skrll 			if_statinc(ifp, if_oerrors);
   1381   1.1     sevan 
   1382   1.1     sevan 		bus_dmamap_sync(sc->sc_dmat, sc->rge_ldata.rge_tx_list_map,
   1383   1.1     sevan 		    idx * sizeof(struct rge_tx_desc),
   1384   1.1     sevan 		    sizeof(struct rge_tx_desc),
   1385   1.1     sevan 		    BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
   1386   1.1     sevan 
   1387   1.1     sevan 		cons = RGE_NEXT_TX_DESC(idx);
   1388   1.1     sevan 		free = 1;
   1389   1.1     sevan 	}
   1390   1.1     sevan 
   1391   1.1     sevan 	if (free == 0)
   1392   1.1     sevan 		return (0);
   1393   1.1     sevan 
   1394   1.1     sevan 	sc->rge_ldata.rge_txq_considx = cons;
   1395   1.1     sevan 
   1396  1.17  jakllsch #if 0
   1397   1.1     sevan 	if (ifq_is_oactive(&ifp->if_snd))
   1398   1.1     sevan 		ifq_restart(&ifp->if_snd);
   1399   1.1     sevan 	else if (free == 2)
   1400   1.1     sevan 		ifq_serialize(&ifp->if_snd, &sc->sc_task);
   1401   1.1     sevan 	else
   1402   1.1     sevan 		ifp->if_timer = 0;
   1403  1.17  jakllsch #else
   1404  1.17  jakllsch #if 0
   1405  1.17  jakllsch 	if (!IF_IS_EMPTY(&ifp->if_snd))
   1406  1.17  jakllsch 		rge_start(ifp);
   1407  1.17  jakllsch 	else
   1408  1.17  jakllsch 	if (free == 2)
   1409  1.17  jakllsch 		if (0) { rge_txstart(&sc->sc_task, sc); }
   1410  1.17  jakllsch 	else
   1411  1.17  jakllsch #endif
   1412  1.17  jakllsch 		ifp->if_timer = 0;
   1413  1.17  jakllsch #endif
   1414   1.1     sevan 
   1415   1.1     sevan 	return (1);
   1416   1.1     sevan }
   1417   1.1     sevan 
   1418   1.1     sevan void
   1419   1.1     sevan rge_reset(struct rge_softc *sc)
   1420   1.1     sevan {
   1421   1.1     sevan 	int i;
   1422   1.1     sevan 
   1423   1.1     sevan 	/* Enable RXDV gate. */
   1424   1.1     sevan 	RGE_SETBIT_1(sc, RGE_PPSW, 0x08);
   1425   1.1     sevan 	DELAY(2000);
   1426   1.1     sevan 
   1427  1.17  jakllsch 	for (i = 0; i < 3000; i++) {
   1428  1.17  jakllsch 		DELAY(50);
   1429   1.1     sevan 		if ((RGE_READ_1(sc, RGE_MCUCMD) & (RGE_MCUCMD_RXFIFO_EMPTY |
   1430   1.1     sevan 		    RGE_MCUCMD_TXFIFO_EMPTY)) == (RGE_MCUCMD_RXFIFO_EMPTY |
   1431   1.1     sevan 		    RGE_MCUCMD_TXFIFO_EMPTY))
   1432   1.1     sevan 			break;
   1433   1.1     sevan 	}
   1434  1.17  jakllsch 	if (sc->rge_type == MAC_CFG4 || sc->rge_type == MAC_CFG5) {
   1435  1.17  jakllsch 		for (i = 0; i < 3000; i++) {
   1436  1.17  jakllsch 			DELAY(50);
   1437  1.17  jakllsch 			if ((RGE_READ_2(sc, RGE_IM) & 0x0103) == 0x0103)
   1438  1.17  jakllsch 				break;
   1439  1.17  jakllsch 		}
   1440  1.17  jakllsch 	}
   1441  1.17  jakllsch 
   1442  1.17  jakllsch 	DELAY(2000);
   1443   1.1     sevan 
   1444   1.1     sevan 	/* Soft reset. */
   1445   1.1     sevan 	RGE_WRITE_1(sc, RGE_CMD, RGE_CMD_RESET);
   1446   1.1     sevan 
   1447   1.1     sevan 	for (i = 0; i < RGE_TIMEOUT; i++) {
   1448   1.1     sevan 		DELAY(100);
   1449   1.1     sevan 		if (!(RGE_READ_1(sc, RGE_CMD) & RGE_CMD_RESET))
   1450   1.1     sevan 			break;
   1451   1.1     sevan 	}
   1452   1.1     sevan 	if (i == RGE_TIMEOUT)
   1453  1.16  jakllsch 		device_printf(sc->sc_dev, "reset never completed!\n");
   1454   1.1     sevan }
   1455   1.1     sevan 
   1456   1.1     sevan void
   1457   1.1     sevan rge_iff(struct rge_softc *sc)
   1458   1.1     sevan {
   1459   1.2     sevan 	struct ifnet *ifp = &sc->sc_ec.ec_if;
   1460  1.17  jakllsch 	struct ethercom *ec = &sc->sc_ec;
   1461   1.1     sevan 	struct ether_multi *enm;
   1462   1.1     sevan 	struct ether_multistep step;
   1463   1.1     sevan 	uint32_t hashes[2];
   1464   1.1     sevan 	uint32_t rxfilt;
   1465   1.1     sevan 	int h = 0;
   1466   1.1     sevan 
   1467   1.1     sevan 	rxfilt = RGE_READ_4(sc, RGE_RXCFG);
   1468   1.1     sevan 	rxfilt &= ~(RGE_RXCFG_ALLPHYS | RGE_RXCFG_MULTI);
   1469   1.1     sevan 	ifp->if_flags &= ~IFF_ALLMULTI;
   1470   1.1     sevan 
   1471   1.1     sevan 	/*
   1472   1.1     sevan 	 * Always accept frames destined to our station address.
   1473   1.1     sevan 	 * Always accept broadcast frames.
   1474   1.1     sevan 	 */
   1475   1.1     sevan 	rxfilt |= RGE_RXCFG_INDIV | RGE_RXCFG_BROAD;
   1476   1.1     sevan 
   1477  1.17  jakllsch 	if (ifp->if_flags & IFF_PROMISC) {
   1478  1.17  jakllsch  allmulti:
   1479   1.1     sevan 		ifp->if_flags |= IFF_ALLMULTI;
   1480   1.1     sevan 		rxfilt |= RGE_RXCFG_MULTI;
   1481   1.1     sevan 		if (ifp->if_flags & IFF_PROMISC)
   1482   1.1     sevan 			rxfilt |= RGE_RXCFG_ALLPHYS;
   1483   1.1     sevan 		hashes[0] = hashes[1] = 0xffffffff;
   1484   1.1     sevan 	} else {
   1485   1.1     sevan 		rxfilt |= RGE_RXCFG_MULTI;
   1486   1.1     sevan 		/* Program new filter. */
   1487   1.1     sevan 		memset(hashes, 0, sizeof(hashes));
   1488   1.1     sevan 
   1489  1.17  jakllsch 		ETHER_LOCK(ec);
   1490  1.17  jakllsch 		ETHER_FIRST_MULTI(step, ec, enm);
   1491   1.1     sevan 		while (enm != NULL) {
   1492  1.17  jakllsch 			if (memcmp(enm->enm_addrlo, enm->enm_addrhi,
   1493  1.17  jakllsch 			    ETHER_ADDR_LEN) != 0) {
   1494  1.17  jakllsch 			    	ETHER_UNLOCK(ec);
   1495  1.17  jakllsch 				goto allmulti;
   1496  1.17  jakllsch 			}
   1497   1.1     sevan 			h = ether_crc32_be(enm->enm_addrlo,
   1498   1.1     sevan 			    ETHER_ADDR_LEN) >> 26;
   1499   1.1     sevan 
   1500   1.1     sevan 			if (h < 32)
   1501   1.1     sevan 				hashes[0] |= (1 << h);
   1502   1.1     sevan 			else
   1503   1.1     sevan 				hashes[1] |= (1 << (h - 32));
   1504   1.1     sevan 
   1505   1.1     sevan 			ETHER_NEXT_MULTI(step, enm);
   1506   1.1     sevan 		}
   1507  1.17  jakllsch 		ETHER_UNLOCK(ec);
   1508   1.1     sevan 	}
   1509   1.1     sevan 
   1510   1.1     sevan 	RGE_WRITE_4(sc, RGE_RXCFG, rxfilt);
   1511   1.2     sevan 	RGE_WRITE_4(sc, RGE_MAR0, bswap32(hashes[1]));
   1512   1.2     sevan 	RGE_WRITE_4(sc, RGE_MAR4, bswap32(hashes[0]));
   1513   1.1     sevan }
   1514   1.1     sevan 
   1515   1.1     sevan void
   1516   1.1     sevan rge_set_phy_power(struct rge_softc *sc, int on)
   1517   1.1     sevan {
   1518   1.1     sevan 	int i;
   1519   1.1     sevan 
   1520   1.1     sevan 	if (on) {
   1521   1.1     sevan 		RGE_SETBIT_1(sc, RGE_PMCH, 0xc0);
   1522   1.1     sevan 
   1523   1.1     sevan 		rge_write_phy(sc, 0, MII_BMCR, BMCR_AUTOEN);
   1524   1.1     sevan 
   1525   1.1     sevan 		for (i = 0; i < RGE_TIMEOUT; i++) {
   1526  1.10     sevan 			if ((rge_read_phy_ocp(sc, 0xa420) & 0x0007) == 3)
   1527   1.1     sevan 				break;
   1528   1.1     sevan 			DELAY(1000);
   1529   1.1     sevan 		}
   1530  1.17  jakllsch 	} else {
   1531   1.1     sevan 		rge_write_phy(sc, 0, MII_BMCR, BMCR_AUTOEN | BMCR_PDOWN);
   1532  1.17  jakllsch 		RGE_CLRBIT_1(sc, RGE_PMCH, 0x80);
   1533  1.17  jakllsch 		RGE_CLRBIT_1(sc, RGE_PPSW, 0x40);
   1534  1.17  jakllsch 	}
   1535   1.1     sevan }
   1536   1.1     sevan 
   1537   1.1     sevan void
   1538   1.1     sevan rge_phy_config(struct rge_softc *sc)
   1539   1.1     sevan {
   1540  1.17  jakllsch 	/* Read microcode version. */
   1541  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x801e);
   1542  1.17  jakllsch 	sc->rge_mcodever = rge_read_phy_ocp(sc, 0xa438);
   1543  1.17  jakllsch 
   1544  1.17  jakllsch 	switch (sc->rge_type) {
   1545  1.17  jakllsch 	case MAC_CFG2:
   1546  1.17  jakllsch 		rge_phy_config_mac_cfg2(sc);
   1547  1.17  jakllsch 		break;
   1548  1.17  jakllsch 	case MAC_CFG3:
   1549  1.17  jakllsch 		rge_phy_config_mac_cfg3(sc);
   1550  1.17  jakllsch 		break;
   1551  1.17  jakllsch 	case MAC_CFG4:
   1552  1.17  jakllsch 		rge_phy_config_mac_cfg4(sc);
   1553  1.17  jakllsch 		break;
   1554  1.17  jakllsch 	case MAC_CFG5:
   1555  1.17  jakllsch 		rge_phy_config_mac_cfg5(sc);
   1556  1.17  jakllsch 		break;
   1557  1.17  jakllsch 	default:
   1558  1.17  jakllsch 		break;	/* Can't happen. */
   1559  1.17  jakllsch 	}
   1560  1.17  jakllsch 
   1561  1.17  jakllsch 	rge_write_phy(sc, 0x0a5b, 0x12,
   1562  1.17  jakllsch 	    rge_read_phy(sc, 0x0a5b, 0x12) & ~0x8000);
   1563  1.17  jakllsch 
   1564  1.17  jakllsch 	/* Disable EEE. */
   1565  1.17  jakllsch 	RGE_MAC_CLRBIT(sc, 0xe040, 0x0003);
   1566  1.17  jakllsch 	if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3) {
   1567  1.17  jakllsch 		RGE_MAC_CLRBIT(sc, 0xeb62, 0x0006);
   1568  1.17  jakllsch 		RGE_PHY_CLRBIT(sc, 0xa432, 0x0010);
   1569  1.17  jakllsch 	}
   1570  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa5d0, 0x0006);
   1571  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa6d4, 0x0001);
   1572  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa6d8, 0x0010);
   1573  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa428, 0x0080);
   1574  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa4a2, 0x0200);
   1575  1.17  jakllsch 
   1576  1.17  jakllsch 	rge_patch_phy_mcu(sc, 1);
   1577  1.17  jakllsch 	RGE_MAC_CLRBIT(sc, 0xe052, 0x0001);
   1578  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa442, 0x3000);
   1579  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa430, 0x8000);
   1580  1.17  jakllsch 	rge_patch_phy_mcu(sc, 0);
   1581  1.17  jakllsch }
   1582  1.17  jakllsch 
   1583  1.17  jakllsch void
   1584  1.17  jakllsch rge_phy_config_mac_cfg2(struct rge_softc *sc)
   1585  1.17  jakllsch {
   1586  1.17  jakllsch 	uint16_t val;
   1587  1.17  jakllsch 	int i;
   1588  1.17  jakllsch 
   1589  1.17  jakllsch 	for (i = 0; i < nitems(rtl8125_mac_cfg2_ephy); i++)
   1590  1.17  jakllsch 		rge_write_ephy(sc, rtl8125_mac_cfg2_ephy[i].reg,
   1591  1.17  jakllsch 		    rtl8125_mac_cfg2_ephy[i].val);
   1592  1.17  jakllsch 
   1593  1.17  jakllsch 	rge_phy_config_mcu(sc, RGE_MAC_CFG2_MCODE_VER);
   1594  1.17  jakllsch 
   1595  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xad40) & ~0x03ff;
   1596  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xad40, val | 0x0084);
   1597  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xad4e, 0x0010);
   1598  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xad16) & ~0x03ff;
   1599  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xad16, val | 0x0006);
   1600  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xad32) & ~0x03ff;
   1601  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xad32, val | 0x0006);
   1602  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xac08, 0x1100);
   1603  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xac8a) & ~0xf000;
   1604  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xac8a, val | 0x7000);
   1605  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xad18, 0x0400);
   1606  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xad1a, 0x03ff);
   1607  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xad1c, 0x03ff);
   1608  1.17  jakllsch 
   1609  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80ea);
   1610  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1611  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0xc400);
   1612  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80eb);
   1613  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0x0700;
   1614  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x0300);
   1615  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80f8);
   1616  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1617  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x1c00);
   1618  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80f1);
   1619  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1620  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x3000);
   1621  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80fe);
   1622  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1623  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0xa500);
   1624  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8102);
   1625  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1626  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x5000);
   1627  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8105);
   1628  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1629  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x3300);
   1630  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8100);
   1631  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1632  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x7000);
   1633  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8104);
   1634  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1635  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0xf000);
   1636  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8106);
   1637  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1638  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x6500);
   1639  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80dc);
   1640  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1641  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0xed00);
   1642  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80df);
   1643  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa438, 0x0100);
   1644  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80e1);
   1645  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa438, 0x0100);
   1646  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xbf06) & ~0x003f;
   1647  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbf06, val | 0x0038);
   1648  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x819f);
   1649  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0xd0b6);
   1650  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbc34, 0x5555);
   1651  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xbf0a) & ~0x0e00;
   1652  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbf0a, val | 0x0a00);
   1653  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa5c0, 0x0400);
   1654  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa442, 0x0800);
   1655  1.17  jakllsch }
   1656  1.17  jakllsch 
   1657  1.17  jakllsch void
   1658  1.17  jakllsch rge_phy_config_mac_cfg3(struct rge_softc *sc)
   1659  1.17  jakllsch {
   1660  1.17  jakllsch 	struct ifnet *ifp = &sc->sc_ec.ec_if;
   1661  1.17  jakllsch 	uint16_t val;
   1662   1.1     sevan 	int i;
   1663   1.1     sevan 	static const uint16_t mac_cfg3_a438_value[] =
   1664   1.1     sevan 	    { 0x0043, 0x00a7, 0x00d6, 0x00ec, 0x00f6, 0x00fb, 0x00fd, 0x00ff,
   1665   1.1     sevan 	      0x00bb, 0x0058, 0x0029, 0x0013, 0x0009, 0x0004, 0x0002 };
   1666   1.1     sevan 
   1667   1.1     sevan 	static const uint16_t mac_cfg3_b88e_value[] =
   1668   1.5     skrll 	    { 0xc091, 0x6e12, 0xc092, 0x1214, 0xc094, 0x1516, 0xc096, 0x171b,
   1669   1.1     sevan 	      0xc098, 0x1b1c, 0xc09a, 0x1f1f, 0xc09c, 0x2021, 0xc09e, 0x2224,
   1670   1.1     sevan 	      0xc0a0, 0x2424, 0xc0a2, 0x2424, 0xc0a4, 0x2424, 0xc018, 0x0af2,
   1671   1.1     sevan 	      0xc01a, 0x0d4a, 0xc01c, 0x0f26, 0xc01e, 0x118d, 0xc020, 0x14f3,
   1672   1.1     sevan 	      0xc022, 0x175a, 0xc024, 0x19c0, 0xc026, 0x1c26, 0xc089, 0x6050,
   1673   1.1     sevan 	      0xc08a, 0x5f6e, 0xc08c, 0x6e6e, 0xc08e, 0x6e6e, 0xc090, 0x6e12 };
   1674   1.1     sevan 
   1675  1.17  jakllsch 	for (i = 0; i < nitems(rtl8125_mac_cfg3_ephy); i++)
   1676  1.17  jakllsch 		rge_write_ephy(sc, rtl8125_mac_cfg3_ephy[i].reg,
   1677  1.17  jakllsch 		    rtl8125_mac_cfg3_ephy[i].val);
   1678  1.17  jakllsch 
   1679  1.17  jakllsch 	val = rge_read_ephy(sc, 0x002a) & ~0x7000;
   1680  1.17  jakllsch 	rge_write_ephy(sc, 0x002a, val | 0x3000);
   1681  1.17  jakllsch 	RGE_EPHY_CLRBIT(sc, 0x0019, 0x0040);
   1682  1.17  jakllsch 	RGE_EPHY_SETBIT(sc, 0x001b, 0x0e00);
   1683  1.17  jakllsch 	RGE_EPHY_CLRBIT(sc, 0x001b, 0x7000);
   1684  1.17  jakllsch 	rge_write_ephy(sc, 0x0002, 0x6042);
   1685  1.17  jakllsch 	rge_write_ephy(sc, 0x0006, 0x0014);
   1686  1.17  jakllsch 	val = rge_read_ephy(sc, 0x006a) & ~0x7000;
   1687  1.17  jakllsch 	rge_write_ephy(sc, 0x006a, val | 0x3000);
   1688  1.17  jakllsch 	RGE_EPHY_CLRBIT(sc, 0x0059, 0x0040);
   1689  1.17  jakllsch 	RGE_EPHY_SETBIT(sc, 0x005b, 0x0e00);
   1690  1.17  jakllsch 	RGE_EPHY_CLRBIT(sc, 0x005b, 0x7000);
   1691  1.17  jakllsch 	rge_write_ephy(sc, 0x0042, 0x6042);
   1692  1.17  jakllsch 	rge_write_ephy(sc, 0x0046, 0x0014);
   1693  1.17  jakllsch 
   1694  1.17  jakllsch 	rge_phy_config_mcu(sc, RGE_MAC_CFG3_MCODE_VER);
   1695  1.17  jakllsch 
   1696  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xad4e, 0x0010);
   1697  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xad16) & ~0x03ff;
   1698  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xad16, val | 0x03ff);
   1699  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xad32) & ~0x003f;
   1700  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xad32, val | 0x0006);
   1701  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xac08, 0x1000);
   1702  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xac08, 0x0100);
   1703  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xacc0) & ~0x0003;
   1704  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xacc0, val | 0x0002);
   1705  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xad40) & ~0x00e0;
   1706  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xad40, val | 0x0040);
   1707  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xad40) & ~0x0007;
   1708  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xad40, val | 0x0004);
   1709  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xac14, 0x0080);
   1710  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xac80, 0x0300);
   1711  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xac5e) & ~0x0007;
   1712  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xac5e, val | 0x0002);
   1713  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xad4c, 0x00a8);
   1714  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xac5c, 0x01ff);
   1715  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xac8a) & ~0x00f0;
   1716  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xac8a, val | 0x0030);
   1717  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8157);
   1718  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xb87e) & ~0xff00;
   1719  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, val | 0x0500);
   1720  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8159);
   1721  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xb87e) & ~0xff00;
   1722  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, val | 0x0700);
   1723  1.17  jakllsch 	RGE_WRITE_2(sc, RGE_EEE_TXIDLE_TIMER, ifp->if_mtu + ETHER_HDR_LEN +
   1724  1.17  jakllsch 	    32);
   1725  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x80a2);
   1726  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x0153);
   1727  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x809c);
   1728  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x0153);
   1729  1.17  jakllsch 
   1730  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x81b3);
   1731  1.17  jakllsch 	for (i = 0; i < nitems(mac_cfg3_a438_value); i++)
   1732  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xa438, mac_cfg3_a438_value[i]);
   1733  1.17  jakllsch 	for (i = 0; i < 26; i++)
   1734  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xa438, 0);
   1735  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8257);
   1736  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x020f);
   1737  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80ea);
   1738  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x7843);
   1739  1.17  jakllsch 
   1740  1.17  jakllsch 	rge_patch_phy_mcu(sc, 1);
   1741  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xb896, 0x0001);
   1742  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xb892, 0xff00);
   1743  1.17  jakllsch 	for (i = 0; i < nitems(mac_cfg3_b88e_value); i += 2) {
   1744  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xb88e, mac_cfg3_b88e_value[i]);
   1745  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xb890, mac_cfg3_b88e_value[i + 1]);
   1746  1.17  jakllsch 	}
   1747  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xb896, 0x0001);
   1748  1.17  jakllsch 	rge_patch_phy_mcu(sc, 0);
   1749  1.17  jakllsch 
   1750  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xd068, 0x2000);
   1751  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x81a2);
   1752  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa438, 0x0100);
   1753  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xb54c) & ~0xff00;
   1754  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb54c, val | 0xdb00);
   1755  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa454, 0x0001);
   1756  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa5d4, 0x0020);
   1757  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xad4e, 0x0010);
   1758  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa86a, 0x0001);
   1759  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa442, 0x0800);
   1760  1.17  jakllsch }
   1761  1.17  jakllsch 
   1762  1.17  jakllsch void
   1763  1.17  jakllsch rge_phy_config_mac_cfg4(struct rge_softc *sc)
   1764  1.17  jakllsch {
   1765  1.17  jakllsch 	struct ifnet *ifp = &sc->sc_ec.ec_if;
   1766  1.17  jakllsch 	uint16_t val;
   1767  1.17  jakllsch 	int i;
   1768  1.17  jakllsch 	static const uint16_t mac_cfg4_b87c_value[] =
   1769  1.17  jakllsch 	    { 0x8013, 0x0700, 0x8fb9, 0x2801, 0x8fba, 0x0100, 0x8fbc, 0x1900,
   1770  1.17  jakllsch 	      0x8fbe, 0xe100, 0x8fc0, 0x0800, 0x8fc2, 0xe500, 0x8fc4, 0x0f00,
   1771  1.17  jakllsch 	      0x8fc6, 0xf100, 0x8fc8, 0x0400, 0x8fca, 0xf300, 0x8fcc, 0xfd00,
   1772  1.17  jakllsch 	      0x8fce, 0xff00, 0x8fd0, 0xfb00, 0x8fd2, 0x0100, 0x8fd4, 0xf400,
   1773  1.17  jakllsch 	      0x8fd6, 0xff00, 0x8fd8, 0xf600, 0x813d, 0x390e, 0x814f, 0x790e,
   1774  1.17  jakllsch 	      0x80b0, 0x0f31 };
   1775  1.17  jakllsch 
   1776  1.17  jakllsch 	for (i = 0; i < nitems(rtl8125_mac_cfg4_ephy); i++)
   1777  1.17  jakllsch 		rge_write_ephy(sc, rtl8125_mac_cfg4_ephy[i].reg,
   1778  1.17  jakllsch 		    rtl8125_mac_cfg4_ephy[i].val);
   1779  1.17  jakllsch 
   1780  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbf86, 0x9000);
   1781  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xc402, 0x0400);
   1782  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xc402, 0x0400);
   1783  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbd86, 0x1010);
   1784  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbd88, 0x1010);
   1785  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xbd4e) & ~0x0c00;
   1786  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbd4e, val | 0x0800);
   1787  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xbf46) & ~0x0f00;
   1788  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbf46, val | 0x0700);
   1789  1.17  jakllsch 
   1790  1.17  jakllsch 	rge_phy_config_mcu(sc, RGE_MAC_CFG4_MCODE_VER);
   1791  1.17  jakllsch 
   1792  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa442, 0x0800);
   1793  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xbc08, 0x000c);
   1794  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8fff);
   1795  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1796  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x0400);
   1797  1.17  jakllsch 	for (i = 0; i < 6; i++) {
   1798  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xb87c, 0x8560 + i * 2);
   1799  1.17  jakllsch 		if (i < 3)
   1800  1.17  jakllsch 			rge_write_phy_ocp(sc, 0xb87e, 0x19cc);
   1801  1.17  jakllsch 		else
   1802  1.17  jakllsch 			rge_write_phy_ocp(sc, 0xb87e, 0x147d);
   1803  1.17  jakllsch 	}
   1804  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8ffe);
   1805  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x0907);
   1806  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xacda) & ~0xff00;
   1807  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xacda, val | 0xff00);
   1808  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xacde) & ~0xf000;
   1809  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xacde, val | 0xf000);
   1810  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x80d6);
   1811  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x2801);
   1812  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x80F2);
   1813  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x2801);
   1814  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x80f4);
   1815  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x6077);
   1816  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb506, 0x01e7);
   1817  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xac8c, 0x0ffc);
   1818  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xac46, 0xb7b4);
   1819  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xac50, 0x0fbc);
   1820  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xac3c, 0x9240);
   1821  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xac4E, 0x0db4);
   1822  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xacc6, 0x0707);
   1823  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xacc8, 0xa0d3);
   1824  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xad08, 0x0007);
   1825  1.17  jakllsch 	for (i = 0; i < nitems(mac_cfg4_b87c_value); i += 2) {
   1826  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xb87c, mac_cfg4_b87c_value[i]);
   1827  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xb87e, mac_cfg4_b87c_value[i + 1]);
   1828  1.17  jakllsch 	}
   1829  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xbf4c, 0x0002);
   1830  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xbcca, 0x0300);
   1831  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8141);
   1832  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x320e);
   1833  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8153);
   1834  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x720e);
   1835  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xa432, 0x0040);
   1836  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8529);
   1837  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x050e);
   1838  1.17  jakllsch 	RGE_WRITE_2(sc, RGE_EEE_TXIDLE_TIMER, ifp->if_mtu + ETHER_HDR_LEN +
   1839  1.17  jakllsch 	    32);
   1840  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x816c);
   1841  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0xc4a0);
   1842  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8170);
   1843  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0xc4a0);
   1844  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8174);
   1845  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x04a0);
   1846  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8178);
   1847  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x04a0);
   1848  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x817c);
   1849  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x0719);
   1850  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8ff4);
   1851  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x0400);
   1852  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8ff1);
   1853  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x0404);
   1854  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbf4a, 0x001b);
   1855  1.17  jakllsch 	for (i = 0; i < 6; i++) {
   1856  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xb87c, 0x8033 + i * 4);
   1857  1.17  jakllsch 		if (i == 2)
   1858  1.17  jakllsch 			rge_write_phy_ocp(sc, 0xb87e, 0xfc32);
   1859  1.17  jakllsch 		else
   1860  1.17  jakllsch 			rge_write_phy_ocp(sc, 0xb87e, 0x7c13);
   1861  1.17  jakllsch 	}
   1862  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8145);
   1863  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x370e);
   1864  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8157);
   1865  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x770e);
   1866  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8169);
   1867  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x0d0a);
   1868  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x817b);
   1869  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x1d0a);
   1870  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x8217);
   1871  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1872  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x5000);
   1873  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x821a);
   1874  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1875  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x5000);
   1876  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80da);
   1877  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x0403);
   1878  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80dc);
   1879  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1880  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x1000);
   1881  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80b3);
   1882  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x0384);
   1883  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80b7);
   1884  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x2007);
   1885  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80ba);
   1886  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1887  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x6c00);
   1888  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80b5);
   1889  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0xf009);
   1890  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80bd);
   1891  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1892  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x9f00);
   1893  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80c7);
   1894  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0xf083);
   1895  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80dd);
   1896  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x03f0);
   1897  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80df);
   1898  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1899  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x1000);
   1900  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80cb);
   1901  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x2007);
   1902  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80ce);
   1903  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1904  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x6c00);
   1905  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80c9);
   1906  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x8009);
   1907  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80d1);
   1908  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1909  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0x8000);
   1910  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80a3);
   1911  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x200a);
   1912  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80a5);
   1913  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0xf0ad);
   1914  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x809f);
   1915  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x6073);
   1916  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80a1);
   1917  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, 0x000b);
   1918  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x80a9);
   1919  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xa438) & ~0xff00;
   1920  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa438, val | 0xc000);
   1921  1.17  jakllsch 	rge_patch_phy_mcu(sc, 1);
   1922  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xb896, 0x0001);
   1923  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xb892, 0xff00);
   1924  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb88e, 0xc23e);
   1925  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb890, 0x0000);
   1926  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb88e, 0xc240);
   1927  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb890, 0x0103);
   1928  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb88e, 0xc242);
   1929  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb890, 0x0507);
   1930  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb88e, 0xc244);
   1931  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb890, 0x090b);
   1932  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb88e, 0xc246);
   1933  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb890, 0x0c0e);
   1934  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb88e, 0xc248);
   1935  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb890, 0x1012);
   1936  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb88e, 0xc24a);
   1937  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb890, 0x1416);
   1938  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xb896, 0x0001);
   1939  1.17  jakllsch 	rge_patch_phy_mcu(sc, 0);
   1940  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa86a, 0x0001);
   1941  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa6f0, 0x0001);
   1942  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbfa0, 0xd70d);
   1943  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbfa2, 0x4100);
   1944  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbfa4, 0xe868);
   1945  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbfa6, 0xdc59);
   1946  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb54c, 0x3c18);
   1947  1.17  jakllsch 	RGE_PHY_CLRBIT(sc, 0xbfa4, 0x0020);
   1948  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xa436, 0x817d);
   1949  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa438, 0x1000);
   1950  1.17  jakllsch }
   1951  1.17  jakllsch 
   1952  1.17  jakllsch void
   1953  1.17  jakllsch rge_phy_config_mac_cfg5(struct rge_softc *sc)
   1954  1.17  jakllsch {
   1955  1.17  jakllsch 	struct ifnet *ifp = &sc->sc_ec.ec_if;
   1956  1.17  jakllsch 	uint16_t val;
   1957  1.17  jakllsch 	int i;
   1958   1.1     sevan 
   1959  1.17  jakllsch 	for (i = 0; i < nitems(rtl8125_mac_cfg5_ephy); i++)
   1960  1.17  jakllsch 		rge_write_ephy(sc, rtl8125_mac_cfg5_ephy[i].reg,
   1961  1.17  jakllsch 		    rtl8125_mac_cfg5_ephy[i].val);
   1962  1.17  jakllsch 
   1963  1.17  jakllsch 	val = rge_read_ephy(sc, 0x0022) & ~0x0030;
   1964  1.17  jakllsch 	rge_write_ephy(sc, 0x0022, val | 0x0020);
   1965  1.17  jakllsch 	val = rge_read_ephy(sc, 0x0062) & ~0x0030;
   1966  1.17  jakllsch 	rge_write_ephy(sc, 0x0062, val | 0x0020);
   1967  1.17  jakllsch 
   1968  1.17  jakllsch 	rge_phy_config_mcu(sc, RGE_MAC_CFG5_MCODE_VER);
   1969  1.17  jakllsch 
   1970  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa442, 0x0800);
   1971  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xac46) & ~0x00f0;
   1972  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xac46, val | 0x0090);
   1973  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xad30) & ~0x0003;
   1974  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xad30, val | 0x0001);
   1975  1.17  jakllsch 	RGE_WRITE_2(sc, RGE_EEE_TXIDLE_TIMER, ifp->if_mtu + ETHER_HDR_LEN +
   1976  1.17  jakllsch 	    32);
   1977  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x80f5);
   1978  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x760e);
   1979  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8107);
   1980  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, 0x360e);
   1981  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87c, 0x8551);
   1982  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xb87e) & ~0xff00;
   1983  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xb87e, val | 0x0800);
   1984  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xbf00) & ~0xe000;
   1985  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbf00, val | 0xa000);
   1986  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xbf46) & ~0x0f00;
   1987  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbf46, val | 0x0300);
   1988  1.17  jakllsch 	for (i = 0; i < 10; i++) {
   1989  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xa436, 0x8044 + i * 6);
   1990  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xa438, 0x2417);
   1991  1.17  jakllsch 	}
   1992  1.17  jakllsch 	RGE_PHY_SETBIT(sc, 0xa4ca, 0x0040);
   1993  1.17  jakllsch 	val = rge_read_phy_ocp(sc, 0xbf84) & ~0xe000;
   1994  1.17  jakllsch 	rge_write_phy_ocp(sc, 0xbf84, val | 0xa000);
   1995  1.17  jakllsch }
   1996   1.1     sevan 
   1997  1.17  jakllsch void
   1998  1.17  jakllsch rge_phy_config_mcu(struct rge_softc *sc, uint16_t mcode_version)
   1999  1.17  jakllsch {
   2000  1.17  jakllsch 	if (sc->rge_mcodever != mcode_version) {
   2001  1.17  jakllsch 		int i;
   2002   1.1     sevan 
   2003  1.17  jakllsch 		rge_patch_phy_mcu(sc, 1);
   2004   1.1     sevan 
   2005  1.17  jakllsch 		if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3) {
   2006   1.1     sevan 			rge_write_phy_ocp(sc, 0xa436, 0x8024);
   2007  1.17  jakllsch 			if (sc->rge_type == MAC_CFG2)
   2008  1.17  jakllsch 				rge_write_phy_ocp(sc, 0xa438, 0x8600);
   2009  1.17  jakllsch 			else
   2010  1.17  jakllsch 				rge_write_phy_ocp(sc, 0xa438, 0x8601);
   2011   1.1     sevan 			rge_write_phy_ocp(sc, 0xa436, 0xb82e);
   2012   1.1     sevan 			rge_write_phy_ocp(sc, 0xa438, 0x0001);
   2013   1.1     sevan 
   2014   1.1     sevan 			RGE_PHY_SETBIT(sc, 0xb820, 0x0080);
   2015  1.17  jakllsch 		}
   2016  1.17  jakllsch 
   2017  1.17  jakllsch 		if (sc->rge_type == MAC_CFG2) {
   2018   1.1     sevan 			for (i = 0; i < nitems(rtl8125_mac_cfg2_mcu); i++) {
   2019   1.1     sevan 				rge_write_phy_ocp(sc,
   2020   1.1     sevan 				    rtl8125_mac_cfg2_mcu[i].reg,
   2021   1.1     sevan 				    rtl8125_mac_cfg2_mcu[i].val);
   2022   1.1     sevan 			}
   2023  1.17  jakllsch 		} else if (sc->rge_type == MAC_CFG3) {
   2024   1.1     sevan 			for (i = 0; i < nitems(rtl8125_mac_cfg3_mcu); i++) {
   2025   1.1     sevan 				rge_write_phy_ocp(sc,
   2026   1.1     sevan 				    rtl8125_mac_cfg3_mcu[i].reg,
   2027   1.1     sevan 				    rtl8125_mac_cfg3_mcu[i].val);
   2028   1.1     sevan 			}
   2029  1.17  jakllsch 		} else if (sc->rge_type == MAC_CFG4) {
   2030  1.17  jakllsch 			for (i = 0; i < nitems(rtl8125_mac_cfg4_mcu); i++) {
   2031  1.17  jakllsch 				rge_write_phy_ocp(sc,
   2032  1.17  jakllsch 				    rtl8125_mac_cfg4_mcu[i].reg,
   2033  1.17  jakllsch 				    rtl8125_mac_cfg4_mcu[i].val);
   2034  1.17  jakllsch 			}
   2035  1.17  jakllsch 		} else if (sc->rge_type == MAC_CFG5) {
   2036  1.17  jakllsch 			for (i = 0; i < nitems(rtl8125_mac_cfg5_mcu); i++) {
   2037  1.17  jakllsch 				rge_write_phy_ocp(sc,
   2038  1.17  jakllsch 				    rtl8125_mac_cfg5_mcu[i].reg,
   2039  1.17  jakllsch 				    rtl8125_mac_cfg5_mcu[i].val);
   2040  1.17  jakllsch 			}
   2041  1.17  jakllsch 		}
   2042  1.17  jakllsch 
   2043  1.17  jakllsch 		if (sc->rge_type == MAC_CFG2 || sc->rge_type == MAC_CFG3) {
   2044   1.1     sevan 			RGE_PHY_CLRBIT(sc, 0xb820, 0x0080);
   2045   1.1     sevan 
   2046   1.1     sevan 			rge_write_phy_ocp(sc, 0xa436, 0);
   2047   1.1     sevan 			rge_write_phy_ocp(sc, 0xa438, 0);
   2048   1.1     sevan 			RGE_PHY_CLRBIT(sc, 0xb82e, 0x0001);
   2049   1.1     sevan 			rge_write_phy_ocp(sc, 0xa436, 0x8024);
   2050   1.1     sevan 			rge_write_phy_ocp(sc, 0xa438, 0);
   2051  1.17  jakllsch 		}
   2052   1.1     sevan 
   2053   1.1     sevan 		rge_patch_phy_mcu(sc, 0);
   2054   1.1     sevan 
   2055  1.17  jakllsch 		/* Write microcode version. */
   2056  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xa436, 0x801e);
   2057  1.17  jakllsch 		rge_write_phy_ocp(sc, 0xa438, mcode_version);
   2058   1.1     sevan 	}
   2059   1.1     sevan }
   2060   1.1     sevan 
   2061   1.1     sevan void
   2062   1.1     sevan rge_set_macaddr(struct rge_softc *sc, const uint8_t *addr)
   2063   1.1     sevan {
   2064   1.1     sevan 	RGE_SETBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
   2065   1.1     sevan 	RGE_WRITE_4(sc, RGE_MAC0,
   2066   1.1     sevan 	    addr[3] << 24 | addr[2] << 16 | addr[1] << 8 | addr[0]);
   2067   1.1     sevan 	RGE_WRITE_4(sc, RGE_MAC4,
   2068   1.1     sevan 	    addr[5] <<  8 | addr[4]);
   2069   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
   2070   1.1     sevan }
   2071   1.1     sevan 
   2072   1.1     sevan void
   2073   1.1     sevan rge_get_macaddr(struct rge_softc *sc, uint8_t *addr)
   2074   1.1     sevan {
   2075   1.1     sevan 	*(uint32_t *)&addr[0] = RGE_READ_4(sc, RGE_ADDR0);
   2076   1.1     sevan 	*(uint16_t *)&addr[4] = RGE_READ_2(sc, RGE_ADDR1);
   2077   1.1     sevan }
   2078   1.1     sevan 
   2079   1.1     sevan void
   2080   1.1     sevan rge_hw_init(struct rge_softc *sc)
   2081   1.1     sevan {
   2082   1.1     sevan 	int i;
   2083   1.1     sevan 
   2084   1.1     sevan 	RGE_SETBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
   2085   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_CFG5, RGE_CFG5_PME_STS);
   2086   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_CFG2, RGE_CFG2_CLKREQ_EN);
   2087   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_EECMD, RGE_EECMD_WRITECFG);
   2088   1.1     sevan 	RGE_CLRBIT_1(sc, 0xf1, 0x80);
   2089   1.1     sevan 
   2090   1.1     sevan 	/* Disable UPS. */
   2091   1.1     sevan 	RGE_MAC_CLRBIT(sc, 0xd40a, 0x0010);
   2092   1.1     sevan 
   2093   1.1     sevan 	/* Configure MAC MCU. */
   2094   1.1     sevan 	rge_write_mac_ocp(sc, 0xfc38, 0);
   2095   1.1     sevan 
   2096   1.1     sevan 	for (i = 0xfc28; i < 0xfc38; i += 2)
   2097   1.1     sevan 		rge_write_mac_ocp(sc, i, 0);
   2098   1.1     sevan 
   2099   1.1     sevan 	DELAY(3000);
   2100   1.1     sevan 	rge_write_mac_ocp(sc, 0xfc26, 0);
   2101   1.1     sevan 
   2102   1.1     sevan 	if (sc->rge_type == MAC_CFG3) {
   2103  1.17  jakllsch 		for (i = 0; i < nitems(rtl8125_mac_bps); i++) {
   2104  1.17  jakllsch 			rge_write_mac_ocp(sc, rtl8125_mac_bps[i].reg,
   2105  1.17  jakllsch 			    rtl8125_mac_bps[i].val);
   2106  1.17  jakllsch 		}
   2107  1.17  jakllsch 	} else if (sc->rge_type == MAC_CFG5) {
   2108  1.17  jakllsch 		for (i = 0; i < nitems(rtl8125b_mac_bps); i++) {
   2109  1.17  jakllsch 			rge_write_mac_ocp(sc, rtl8125b_mac_bps[i].reg,
   2110  1.17  jakllsch 			    rtl8125b_mac_bps[i].val);
   2111  1.17  jakllsch 		}
   2112   1.1     sevan 	}
   2113   1.1     sevan 
   2114   1.1     sevan 	/* Disable PHY power saving. */
   2115   1.1     sevan 	rge_disable_phy_ocp_pwrsave(sc);
   2116   1.1     sevan 
   2117   1.1     sevan 	/* Set PCIe uncorrectable error status. */
   2118   1.1     sevan 	rge_write_csi(sc, 0x108,
   2119   1.1     sevan 	    rge_read_csi(sc, 0x108) | 0x00100000);
   2120   1.1     sevan }
   2121   1.1     sevan 
   2122   1.1     sevan void
   2123   1.1     sevan rge_disable_phy_ocp_pwrsave(struct rge_softc *sc)
   2124   1.1     sevan {
   2125   1.1     sevan 	if (rge_read_phy_ocp(sc, 0xc416) != 0x0500) {
   2126   1.1     sevan 		rge_patch_phy_mcu(sc, 1);
   2127   1.1     sevan 		rge_write_phy_ocp(sc, 0xc416, 0);
   2128   1.1     sevan 		rge_write_phy_ocp(sc, 0xc416, 0x0500);
   2129   1.1     sevan 		rge_patch_phy_mcu(sc, 0);
   2130   1.1     sevan 	}
   2131   1.1     sevan }
   2132   1.1     sevan 
   2133   1.1     sevan void
   2134   1.1     sevan rge_patch_phy_mcu(struct rge_softc *sc, int set)
   2135   1.1     sevan {
   2136   1.1     sevan 	int i;
   2137   1.1     sevan 
   2138   1.1     sevan 	if (set)
   2139   1.1     sevan 		RGE_PHY_SETBIT(sc, 0xb820, 0x0010);
   2140   1.1     sevan 	else
   2141   1.1     sevan 		RGE_PHY_CLRBIT(sc, 0xb820, 0x0010);
   2142   1.1     sevan 
   2143   1.1     sevan 	for (i = 0; i < 1000; i++) {
   2144  1.17  jakllsch 		if ((rge_read_phy_ocp(sc, 0xb800) & 0x0040) == 0x0040)
   2145  1.17  jakllsch 			break;
   2146   1.1     sevan 		DELAY(100);
   2147   1.1     sevan 	}
   2148  1.17  jakllsch 	if (i == 1000) {
   2149  1.17  jakllsch 		DPRINTF(("timeout waiting to patch phy mcu\n"));
   2150  1.17  jakllsch 		return;
   2151  1.17  jakllsch 	}
   2152   1.1     sevan }
   2153   1.1     sevan 
   2154   1.1     sevan void
   2155   1.1     sevan rge_add_media_types(struct rge_softc *sc)
   2156   1.1     sevan {
   2157   1.1     sevan 	ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_10_T, 0, NULL);
   2158   1.1     sevan 	ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_10_T | IFM_FDX, 0, NULL);
   2159   1.1     sevan 	ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_100_TX, 0, NULL);
   2160   1.1     sevan 	ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_100_TX | IFM_FDX, 0, NULL);
   2161   1.1     sevan 	ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_1000_T, 0, NULL);
   2162   1.1     sevan 	ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_1000_T | IFM_FDX, 0, NULL);
   2163   1.1     sevan 	ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_2500_T, 0, NULL);
   2164   1.1     sevan 	ifmedia_add(&sc->sc_media, IFM_ETHER | IFM_2500_T | IFM_FDX, 0, NULL);
   2165   1.1     sevan }
   2166   1.1     sevan 
   2167   1.1     sevan void
   2168   1.1     sevan rge_config_imtype(struct rge_softc *sc, int imtype)
   2169   1.1     sevan {
   2170   1.1     sevan 	switch (imtype) {
   2171   1.1     sevan 	case RGE_IMTYPE_NONE:
   2172   1.1     sevan 		sc->rge_intrs = RGE_INTRS;
   2173   1.1     sevan 		sc->rge_rx_ack = RGE_ISR_RX_OK | RGE_ISR_RX_DESC_UNAVAIL |
   2174   1.1     sevan 		    RGE_ISR_RX_FIFO_OFLOW;
   2175   1.1     sevan 		sc->rge_tx_ack = RGE_ISR_TX_OK;
   2176   1.1     sevan 		break;
   2177   1.1     sevan 	case RGE_IMTYPE_SIM:
   2178   1.1     sevan 		sc->rge_intrs = RGE_INTRS_TIMER;
   2179   1.1     sevan 		sc->rge_rx_ack = RGE_ISR_PCS_TIMEOUT;
   2180   1.1     sevan 		sc->rge_tx_ack = RGE_ISR_PCS_TIMEOUT;
   2181   1.1     sevan 		break;
   2182   1.1     sevan 	default:
   2183  1.14     sevan 		panic("%s: unknown imtype %d", device_xname(sc->sc_dev), imtype);
   2184   1.1     sevan 	}
   2185   1.1     sevan }
   2186   1.1     sevan 
   2187   1.1     sevan void
   2188  1.17  jakllsch rge_disable_hw_im(struct rge_softc *sc)
   2189  1.17  jakllsch {
   2190  1.17  jakllsch 	RGE_WRITE_2(sc, RGE_IM, 0);
   2191  1.17  jakllsch }
   2192  1.17  jakllsch 
   2193  1.17  jakllsch void
   2194   1.1     sevan rge_disable_sim_im(struct rge_softc *sc)
   2195   1.1     sevan {
   2196  1.17  jakllsch 	RGE_WRITE_4(sc, RGE_TIMERINT0, 0);
   2197   1.1     sevan 	sc->rge_timerintr = 0;
   2198   1.1     sevan }
   2199   1.1     sevan 
   2200   1.1     sevan void
   2201   1.1     sevan rge_setup_sim_im(struct rge_softc *sc)
   2202   1.1     sevan {
   2203  1.17  jakllsch 	RGE_WRITE_4(sc, RGE_TIMERINT0, 0x2600);
   2204   1.1     sevan 	RGE_WRITE_4(sc, RGE_TIMERCNT, 1);
   2205   1.1     sevan 	sc->rge_timerintr = 1;
   2206   1.1     sevan }
   2207   1.1     sevan 
   2208   1.1     sevan void
   2209   1.1     sevan rge_setup_intr(struct rge_softc *sc, int imtype)
   2210   1.1     sevan {
   2211   1.1     sevan 	rge_config_imtype(sc, imtype);
   2212   1.1     sevan 
   2213   1.1     sevan 	/* Enable interrupts. */
   2214   1.1     sevan 	RGE_WRITE_4(sc, RGE_IMR, sc->rge_intrs);
   2215   1.1     sevan 
   2216   1.1     sevan 	switch (imtype) {
   2217   1.1     sevan 	case RGE_IMTYPE_NONE:
   2218   1.1     sevan 		rge_disable_sim_im(sc);
   2219  1.17  jakllsch 		rge_disable_hw_im(sc);
   2220   1.1     sevan 		break;
   2221   1.1     sevan 	case RGE_IMTYPE_SIM:
   2222  1.17  jakllsch 		rge_disable_hw_im(sc);
   2223   1.1     sevan 		rge_setup_sim_im(sc);
   2224   1.1     sevan 		break;
   2225   1.1     sevan 	default:
   2226  1.14     sevan 		panic("%s: unknown imtype %d", device_xname(sc->sc_dev), imtype);
   2227   1.1     sevan 	}
   2228   1.1     sevan }
   2229   1.1     sevan 
   2230   1.1     sevan void
   2231   1.1     sevan rge_exit_oob(struct rge_softc *sc)
   2232   1.1     sevan {
   2233   1.1     sevan 	int i;
   2234   1.1     sevan 
   2235   1.1     sevan 	RGE_CLRBIT_4(sc, RGE_RXCFG, RGE_RXCFG_ALLPHYS | RGE_RXCFG_INDIV |
   2236   1.1     sevan 	    RGE_RXCFG_MULTI | RGE_RXCFG_BROAD | RGE_RXCFG_RUNT |
   2237   1.1     sevan 	    RGE_RXCFG_ERRPKT);
   2238   1.1     sevan 
   2239   1.1     sevan 	/* Disable RealWoW. */
   2240   1.1     sevan 	rge_write_mac_ocp(sc, 0xc0bc, 0x00ff);
   2241   1.1     sevan 
   2242   1.1     sevan 	rge_reset(sc);
   2243   1.1     sevan 
   2244   1.1     sevan 	/* Disable OOB. */
   2245   1.1     sevan 	RGE_CLRBIT_1(sc, RGE_MCUCMD, RGE_MCUCMD_IS_OOB);
   2246   1.1     sevan 
   2247   1.1     sevan 	RGE_MAC_CLRBIT(sc, 0xe8de, 0x4000);
   2248   1.1     sevan 
   2249   1.1     sevan 	for (i = 0; i < 10; i++) {
   2250   1.1     sevan 		DELAY(100);
   2251   1.1     sevan 		if (RGE_READ_2(sc, RGE_TWICMD) & 0x0200)
   2252   1.1     sevan 			break;
   2253   1.1     sevan 	}
   2254   1.1     sevan 
   2255   1.1     sevan 	rge_write_mac_ocp(sc, 0xc0aa, 0x07d0);
   2256  1.17  jakllsch 	rge_write_mac_ocp(sc, 0xc0a6, 0x01b5);
   2257   1.1     sevan 	rge_write_mac_ocp(sc, 0xc01e, 0x5555);
   2258   1.1     sevan 
   2259   1.1     sevan 	for (i = 0; i < 10; i++) {
   2260   1.1     sevan 		DELAY(100);
   2261   1.1     sevan 		if (RGE_READ_2(sc, RGE_TWICMD) & 0x0200)
   2262   1.1     sevan 			break;
   2263   1.1     sevan 	}
   2264   1.1     sevan 
   2265   1.1     sevan 	if (rge_read_mac_ocp(sc, 0xd42c) & 0x0100) {
   2266  1.17  jakllsch 		printf("%s: rge_exit_oob(): rtl8125_is_ups_resume!!\n",
   2267  1.17  jakllsch 		    device_xname(sc->sc_dev));
   2268   1.1     sevan 		for (i = 0; i < RGE_TIMEOUT; i++) {
   2269  1.10     sevan 			if ((rge_read_phy_ocp(sc, 0xa420) & 0x0007) == 2)
   2270   1.1     sevan 				break;
   2271   1.1     sevan 			DELAY(1000);
   2272   1.1     sevan 		}
   2273   1.1     sevan 		RGE_MAC_CLRBIT(sc, 0xd408, 0x0100);
   2274  1.17  jakllsch 		if (sc->rge_type == MAC_CFG4 || sc->rge_type == MAC_CFG5)
   2275  1.17  jakllsch 			RGE_PHY_CLRBIT(sc, 0xa466, 0x0001);
   2276   1.1     sevan 		RGE_PHY_CLRBIT(sc, 0xa468, 0x000a);
   2277   1.1     sevan 	}
   2278   1.1     sevan }
   2279   1.1     sevan 
   2280   1.1     sevan void
   2281   1.1     sevan rge_write_csi(struct rge_softc *sc, uint32_t reg, uint32_t val)
   2282   1.1     sevan {
   2283   1.1     sevan 	int i;
   2284   1.1     sevan 
   2285   1.1     sevan 	RGE_WRITE_4(sc, RGE_CSIDR, val);
   2286  1.17  jakllsch 	RGE_WRITE_4(sc, RGE_CSIAR, (reg & RGE_CSIAR_ADDR_MASK) |
   2287   1.1     sevan 	    (RGE_CSIAR_BYTE_EN << RGE_CSIAR_BYTE_EN_SHIFT) | RGE_CSIAR_BUSY);
   2288   1.1     sevan 
   2289   1.1     sevan 	for (i = 0; i < 10; i++) {
   2290   1.1     sevan 		 DELAY(100);
   2291   1.1     sevan 		 if (!(RGE_READ_4(sc, RGE_CSIAR) & RGE_CSIAR_BUSY))
   2292   1.1     sevan 			break;
   2293   1.1     sevan 	}
   2294   1.1     sevan 
   2295   1.1     sevan 	DELAY(20);
   2296   1.1     sevan }
   2297   1.1     sevan 
   2298   1.1     sevan uint32_t
   2299   1.1     sevan rge_read_csi(struct rge_softc *sc, uint32_t reg)
   2300   1.1     sevan {
   2301   1.1     sevan 	int i;
   2302   1.1     sevan 
   2303  1.17  jakllsch 	RGE_WRITE_4(sc, RGE_CSIAR, (reg & RGE_CSIAR_ADDR_MASK) |
   2304   1.1     sevan 	    (RGE_CSIAR_BYTE_EN << RGE_CSIAR_BYTE_EN_SHIFT));
   2305   1.1     sevan 
   2306   1.1     sevan 	for (i = 0; i < 10; i++) {
   2307   1.1     sevan 		 DELAY(100);
   2308   1.1     sevan 		 if (RGE_READ_4(sc, RGE_CSIAR) & RGE_CSIAR_BUSY)
   2309   1.1     sevan 			break;
   2310   1.1     sevan 	}
   2311   1.1     sevan 
   2312   1.1     sevan 	DELAY(20);
   2313   1.1     sevan 
   2314   1.1     sevan 	return (RGE_READ_4(sc, RGE_CSIDR));
   2315   1.1     sevan }
   2316   1.1     sevan 
   2317   1.1     sevan void
   2318   1.1     sevan rge_write_mac_ocp(struct rge_softc *sc, uint16_t reg, uint16_t val)
   2319   1.1     sevan {
   2320   1.1     sevan 	uint32_t tmp;
   2321   1.1     sevan 
   2322   1.1     sevan 	tmp = (reg >> 1) << RGE_MACOCP_ADDR_SHIFT;
   2323   1.1     sevan 	tmp += val;
   2324   1.1     sevan 	tmp |= RGE_MACOCP_BUSY;
   2325   1.1     sevan 	RGE_WRITE_4(sc, RGE_MACOCP, tmp);
   2326   1.1     sevan }
   2327   1.1     sevan 
   2328   1.1     sevan uint16_t
   2329   1.1     sevan rge_read_mac_ocp(struct rge_softc *sc, uint16_t reg)
   2330   1.1     sevan {
   2331   1.1     sevan 	uint32_t val;
   2332   1.1     sevan 
   2333   1.1     sevan 	val = (reg >> 1) << RGE_MACOCP_ADDR_SHIFT;
   2334   1.1     sevan 	RGE_WRITE_4(sc, RGE_MACOCP, val);
   2335   1.1     sevan 
   2336   1.1     sevan 	return (RGE_READ_4(sc, RGE_MACOCP) & RGE_MACOCP_DATA_MASK);
   2337   1.1     sevan }
   2338   1.1     sevan 
   2339   1.1     sevan void
   2340   1.1     sevan rge_write_ephy(struct rge_softc *sc, uint16_t reg, uint16_t val)
   2341   1.1     sevan {
   2342   1.1     sevan 	uint32_t tmp;
   2343   1.1     sevan 	int i;
   2344   1.1     sevan 
   2345   1.1     sevan 	tmp = (reg & RGE_EPHYAR_ADDR_MASK) << RGE_EPHYAR_ADDR_SHIFT;
   2346   1.1     sevan 	tmp |= RGE_EPHYAR_BUSY | (val & RGE_EPHYAR_DATA_MASK);
   2347   1.1     sevan 	RGE_WRITE_4(sc, RGE_EPHYAR, tmp);
   2348   1.1     sevan 
   2349   1.1     sevan 	for (i = 0; i < 10; i++) {
   2350   1.1     sevan 		DELAY(100);
   2351   1.1     sevan 		if (!(RGE_READ_4(sc, RGE_EPHYAR) & RGE_EPHYAR_BUSY))
   2352   1.1     sevan 			break;
   2353   1.1     sevan 	}
   2354   1.1     sevan 
   2355   1.1     sevan 	DELAY(20);
   2356   1.1     sevan }
   2357   1.1     sevan 
   2358  1.17  jakllsch uint16_t
   2359  1.17  jakllsch rge_read_ephy(struct rge_softc *sc, uint16_t reg)
   2360  1.17  jakllsch {
   2361  1.17  jakllsch 	uint32_t val;
   2362  1.17  jakllsch 	int i;
   2363  1.17  jakllsch 
   2364  1.17  jakllsch 	val = (reg & RGE_EPHYAR_ADDR_MASK) << RGE_EPHYAR_ADDR_SHIFT;
   2365  1.17  jakllsch 	RGE_WRITE_4(sc, RGE_EPHYAR, val);
   2366  1.17  jakllsch 
   2367  1.17  jakllsch 	for (i = 0; i < 10; i++) {
   2368  1.17  jakllsch 		DELAY(100);
   2369  1.17  jakllsch 		val = RGE_READ_4(sc, RGE_EPHYAR);
   2370  1.17  jakllsch 		if (val & RGE_EPHYAR_BUSY)
   2371  1.17  jakllsch 			break;
   2372  1.17  jakllsch 	}
   2373  1.17  jakllsch 
   2374  1.17  jakllsch 	DELAY(20);
   2375  1.17  jakllsch 
   2376  1.17  jakllsch 	return (val & RGE_EPHYAR_DATA_MASK);
   2377  1.17  jakllsch }
   2378  1.17  jakllsch 
   2379   1.1     sevan void
   2380   1.1     sevan rge_write_phy(struct rge_softc *sc, uint16_t addr, uint16_t reg, uint16_t val)
   2381   1.1     sevan {
   2382   1.1     sevan 	uint16_t off, phyaddr;
   2383   1.1     sevan 
   2384   1.1     sevan 	phyaddr = addr ? addr : RGE_PHYBASE + (reg / 8);
   2385   1.1     sevan 	phyaddr <<= 4;
   2386   1.1     sevan 
   2387   1.1     sevan 	off = addr ? reg : 0x10 + (reg % 8);
   2388   1.1     sevan 
   2389   1.1     sevan 	phyaddr += (off - 16) << 1;
   2390   1.1     sevan 
   2391   1.1     sevan 	rge_write_phy_ocp(sc, phyaddr, val);
   2392   1.1     sevan }
   2393   1.1     sevan 
   2394  1.17  jakllsch uint16_t
   2395  1.17  jakllsch rge_read_phy(struct rge_softc *sc, uint16_t addr, uint16_t reg)
   2396  1.17  jakllsch {
   2397  1.17  jakllsch 	uint16_t off, phyaddr;
   2398  1.17  jakllsch 
   2399  1.17  jakllsch 	phyaddr = addr ? addr : RGE_PHYBASE + (reg / 8);
   2400  1.17  jakllsch 	phyaddr <<= 4;
   2401  1.17  jakllsch 
   2402  1.17  jakllsch 	off = addr ? reg : 0x10 + (reg % 8);
   2403  1.17  jakllsch 
   2404  1.17  jakllsch 	phyaddr += (off - 16) << 1;
   2405  1.17  jakllsch 
   2406  1.17  jakllsch 	return (rge_read_phy_ocp(sc, phyaddr));
   2407  1.17  jakllsch }
   2408  1.17  jakllsch 
   2409   1.1     sevan void
   2410   1.1     sevan rge_write_phy_ocp(struct rge_softc *sc, uint16_t reg, uint16_t val)
   2411   1.1     sevan {
   2412   1.1     sevan 	uint32_t tmp;
   2413   1.1     sevan 	int i;
   2414   1.1     sevan 
   2415   1.1     sevan 	tmp = (reg >> 1) << RGE_PHYOCP_ADDR_SHIFT;
   2416   1.1     sevan 	tmp |= RGE_PHYOCP_BUSY | val;
   2417   1.1     sevan 	RGE_WRITE_4(sc, RGE_PHYOCP, tmp);
   2418   1.1     sevan 
   2419   1.1     sevan 	for (i = 0; i < RGE_TIMEOUT; i++) {
   2420   1.1     sevan 		DELAY(1);
   2421   1.1     sevan 		if (!(RGE_READ_4(sc, RGE_PHYOCP) & RGE_PHYOCP_BUSY))
   2422   1.1     sevan 			break;
   2423   1.1     sevan 	}
   2424   1.1     sevan }
   2425   1.1     sevan 
   2426   1.1     sevan uint16_t
   2427   1.1     sevan rge_read_phy_ocp(struct rge_softc *sc, uint16_t reg)
   2428   1.1     sevan {
   2429   1.1     sevan 	uint32_t val;
   2430   1.1     sevan 	int i;
   2431   1.1     sevan 
   2432   1.1     sevan 	val = (reg >> 1) << RGE_PHYOCP_ADDR_SHIFT;
   2433   1.1     sevan 	RGE_WRITE_4(sc, RGE_PHYOCP, val);
   2434   1.1     sevan 
   2435   1.1     sevan 	for (i = 0; i < RGE_TIMEOUT; i++) {
   2436   1.1     sevan 		DELAY(1);
   2437   1.1     sevan 		val = RGE_READ_4(sc, RGE_PHYOCP);
   2438   1.1     sevan 		if (val & RGE_PHYOCP_BUSY)
   2439   1.1     sevan 			break;
   2440   1.1     sevan 	}
   2441   1.1     sevan 
   2442   1.1     sevan 	return (val & RGE_PHYOCP_DATA_MASK);
   2443   1.1     sevan }
   2444   1.1     sevan 
   2445   1.1     sevan int
   2446   1.1     sevan rge_get_link_status(struct rge_softc *sc)
   2447   1.1     sevan {
   2448   1.1     sevan 	return ((RGE_READ_2(sc, RGE_PHYSTAT) & RGE_PHYSTAT_LINK) ? 1 : 0);
   2449   1.1     sevan }
   2450   1.1     sevan 
   2451   1.1     sevan void
   2452   1.3     sevan rge_txstart(struct work *wk, void *arg)
   2453   1.1     sevan {
   2454   1.1     sevan 	struct rge_softc *sc = arg;
   2455   1.1     sevan 
   2456   1.1     sevan 	RGE_WRITE_2(sc, RGE_TXSTART, RGE_TXSTART_START);
   2457   1.1     sevan }
   2458   1.1     sevan 
   2459   1.1     sevan void
   2460   1.1     sevan rge_tick(void *arg)
   2461   1.1     sevan {
   2462   1.1     sevan 	struct rge_softc *sc = arg;
   2463   1.1     sevan 	int s;
   2464   1.1     sevan 
   2465   1.1     sevan 	s = splnet();
   2466   1.1     sevan 	rge_link_state(sc);
   2467   1.1     sevan 	splx(s);
   2468   1.1     sevan 
   2469  1.17  jakllsch 	callout_schedule(&sc->sc_timeout, hz);
   2470   1.1     sevan }
   2471   1.1     sevan 
   2472   1.1     sevan void
   2473   1.1     sevan rge_link_state(struct rge_softc *sc)
   2474   1.1     sevan {
   2475   1.2     sevan 	struct ifnet *ifp = &sc->sc_ec.ec_if;
   2476   1.1     sevan 	int link = LINK_STATE_DOWN;
   2477   1.1     sevan 
   2478   1.1     sevan 	if (rge_get_link_status(sc))
   2479   1.1     sevan 		link = LINK_STATE_UP;
   2480   1.1     sevan 
   2481  1.17  jakllsch 	if (ifp->if_link_state != link) { /* XXX not safe to access */
   2482  1.17  jakllsch 		if_link_state_change(ifp, link);
   2483   1.1     sevan 	}
   2484   1.1     sevan }
   2485