1537078d8f
Mainly focus on files that use BSD 2-Clause license, however the tool I was using misidentified many licenses so this was mostly a manual - error prone - task. The Software Package Data Exchange (SPDX) group provides a specification to make it easier for automated tools to detect and summarize well known opensource licenses. We are gradually adopting the specification, noting that the tags are considered only advisory and do not, in any way, superceed or replace the license texts.
4595 lines
137 KiB
C
4595 lines
137 KiB
C
/*-
|
|
* SPDX-License-Identifier: BSD-2-Clause-FreeBSD
|
|
*
|
|
* $FreeBSD$
|
|
*
|
|
* Copyright (c) 2002-2004 David Boggs. <boggs@boggs.palo-alto.ca.us>
|
|
* All rights reserved.
|
|
*
|
|
* BSD License:
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
|
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
|
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
|
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
|
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
|
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
|
* SUCH DAMAGE.
|
|
*
|
|
* GNU General Public License:
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License as published by the Free
|
|
* Software Foundation; either version 2 of the License, or (at your option)
|
|
* any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along with
|
|
* this program; if not, write to the Free Software Foundation, Inc., 59
|
|
* Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
*
|
|
* Description:
|
|
*
|
|
* This is an open-source Unix device driver for PCI-bus WAN interface cards.
|
|
* It sends and receives packets in HDLC frames over synchronous links.
|
|
* A generic PC plus Unix plus some SBE/LMC cards makes an OPEN router.
|
|
* This driver works with FreeBSD, NetBSD, OpenBSD, BSD/OS and Linux.
|
|
* It has been tested on i386 (32-bit little-end), Sparc (64-bit big-end),
|
|
* and Alpha (64-bit little-end) architectures.
|
|
*
|
|
* History and Authors:
|
|
*
|
|
* Ron Crane had the neat idea to use a Fast Ethernet chip as a PCI
|
|
* interface and add an Ethernet-to-HDLC gate array to make a WAN card.
|
|
* David Boggs designed the Ethernet-to-HDLC gate arrays and PC cards.
|
|
* We did this at our company, LAN Media Corporation (LMC).
|
|
* SBE Corp acquired LMC and continues to make the cards.
|
|
*
|
|
* Since the cards use Tulip Ethernet chips, we started with Matt Thomas'
|
|
* ubiquitous "de" driver. Michael Graff stripped out the Ethernet stuff
|
|
* and added HSSI stuff. Basil Gunn ported it to Solaris (lost) and
|
|
* Rob Braun ported it to Linux. Andrew Stanley-Jones added support
|
|
* for three more cards and wrote the first version of lmcconfig.
|
|
* During 2002-5 David Boggs rewrote it and now feels responsible for it.
|
|
*
|
|
* Responsible Individual:
|
|
*
|
|
* Send bug reports and improvements to <boggs@boggs.palo-alto.ca.us>.
|
|
*/
|
|
# include <sys/param.h> /* OS version */
|
|
# define IFNET 1
|
|
# include "opt_inet.h" /* INET */
|
|
# include "opt_inet6.h" /* INET6 */
|
|
# include "opt_netgraph.h" /* NETGRAPH */
|
|
# ifdef HAVE_KERNEL_OPTION_HEADERS
|
|
# include "opt_device_polling.h" /* DEVICE_POLLING */
|
|
# endif
|
|
# ifndef INET
|
|
# define INET 0
|
|
# endif
|
|
# ifndef INET6
|
|
# define INET6 0
|
|
# endif
|
|
# ifndef NETGRAPH
|
|
# define NETGRAPH 0
|
|
# endif
|
|
# define P2P 0 /* not in FreeBSD */
|
|
# define NSPPP 1 /* No count devices in FreeBSD 5 */
|
|
# include "opt_bpf.h" /* DEV_BPF */
|
|
# ifdef DEV_BPF
|
|
# define NBPFILTER 1
|
|
# else
|
|
# define NBPFILTER 0
|
|
# endif
|
|
# define GEN_HDLC 0 /* not in FreeBSD */
|
|
#
|
|
# include <sys/systm.h>
|
|
# include <sys/kernel.h>
|
|
# include <sys/malloc.h>
|
|
# include <sys/mbuf.h>
|
|
# include <sys/socket.h>
|
|
# include <sys/sockio.h>
|
|
# include <sys/module.h>
|
|
# include <sys/bus.h>
|
|
# include <sys/lock.h>
|
|
# include <net/if.h>
|
|
# include <net/if_var.h>
|
|
# include <net/if_types.h>
|
|
# include <net/if_media.h>
|
|
# include <net/netisr.h>
|
|
# include <net/route.h>
|
|
# include <machine/bus.h>
|
|
# include <machine/resource.h>
|
|
# include <sys/rman.h>
|
|
# include <vm/vm.h>
|
|
# include <vm/pmap.h>
|
|
# include <sys/priv.h>
|
|
# include <sys/mutex.h>
|
|
# include <dev/pci/pcivar.h>
|
|
# if NETGRAPH
|
|
# include <netgraph/ng_message.h>
|
|
# include <netgraph/netgraph.h>
|
|
# endif
|
|
# if (INET || INET6)
|
|
# include <netinet/in.h>
|
|
# include <netinet/in_var.h>
|
|
# endif
|
|
# if NSPPP
|
|
# include <net/if_sppp.h>
|
|
# endif
|
|
# if NBPFILTER
|
|
# include <net/bpf.h>
|
|
# endif
|
|
/* and finally... */
|
|
# include <dev/lmc/if_lmc.h>
|
|
|
|
|
|
|
|
|
|
|
|
/* The SROM is a generic 93C46 serial EEPROM (64 words by 16 bits). */
|
|
/* Data is set up before the RISING edge of CLK; CLK is parked low. */
|
|
static void
|
|
shift_srom_bits(softc_t *sc, u_int32_t data, u_int32_t len)
|
|
{
|
|
u_int32_t csr = READ_CSR(TLP_SROM_MII);
|
|
for (; len>0; len--)
|
|
{ /* MSB first */
|
|
if (data & (1<<(len-1)))
|
|
csr |= TLP_SROM_DIN; /* DIN setup */
|
|
else
|
|
csr &= ~TLP_SROM_DIN; /* DIN setup */
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
csr |= TLP_SROM_CLK; /* CLK rising edge */
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
csr &= ~TLP_SROM_CLK; /* CLK falling edge */
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
}
|
|
}
|
|
|
|
/* Data is sampled on the RISING edge of CLK; CLK is parked low. */
|
|
static u_int16_t
|
|
read_srom(softc_t *sc, u_int8_t addr)
|
|
{
|
|
int i;
|
|
u_int32_t csr;
|
|
u_int16_t data;
|
|
|
|
/* Enable SROM access. */
|
|
csr = (TLP_SROM_SEL | TLP_SROM_RD | TLP_MII_MDOE);
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
/* CS rising edge prepares SROM for a new cycle. */
|
|
csr |= TLP_SROM_CS;
|
|
WRITE_CSR(TLP_SROM_MII, csr); /* assert CS */
|
|
shift_srom_bits(sc, 6, 4); /* issue read cmd */
|
|
shift_srom_bits(sc, addr, 6); /* issue address */
|
|
for (data=0, i=16; i>=0; i--) /* read ->17<- bits of data */
|
|
{ /* MSB first */
|
|
csr = READ_CSR(TLP_SROM_MII); /* DOUT sampled */
|
|
data = (data<<1) | ((csr & TLP_SROM_DOUT) ? 1:0);
|
|
csr |= TLP_SROM_CLK; /* CLK rising edge */
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
csr &= ~TLP_SROM_CLK; /* CLK falling edge */
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
}
|
|
/* Disable SROM access. */
|
|
WRITE_CSR(TLP_SROM_MII, TLP_MII_MDOE);
|
|
|
|
return data;
|
|
}
|
|
|
|
/* The SROM is formatted by the mfgr and should NOT be written! */
|
|
/* But lmcconfig can rewrite it in case it gets overwritten somehow. */
|
|
/* IOCTL SYSCALL: can sleep. */
|
|
static void
|
|
write_srom(softc_t *sc, u_int8_t addr, u_int16_t data)
|
|
{
|
|
u_int32_t csr;
|
|
int i;
|
|
|
|
/* Enable SROM access. */
|
|
csr = (TLP_SROM_SEL | TLP_SROM_RD | TLP_MII_MDOE);
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
|
|
/* Issue write-enable command. */
|
|
csr |= TLP_SROM_CS;
|
|
WRITE_CSR(TLP_SROM_MII, csr); /* assert CS */
|
|
shift_srom_bits(sc, 4, 4); /* issue write enable cmd */
|
|
shift_srom_bits(sc, 63, 6); /* issue address */
|
|
csr &= ~TLP_SROM_CS;
|
|
WRITE_CSR(TLP_SROM_MII, csr); /* deassert CS */
|
|
|
|
/* Issue erase command. */
|
|
csr |= TLP_SROM_CS;
|
|
WRITE_CSR(TLP_SROM_MII, csr); /* assert CS */
|
|
shift_srom_bits(sc, 7, 4); /* issue erase cmd */
|
|
shift_srom_bits(sc, addr, 6); /* issue address */
|
|
csr &= ~TLP_SROM_CS;
|
|
WRITE_CSR(TLP_SROM_MII, csr); /* deassert CS */
|
|
|
|
/* Issue write command. */
|
|
csr |= TLP_SROM_CS;
|
|
WRITE_CSR(TLP_SROM_MII, csr); /* assert CS */
|
|
for (i=0; i<10; i++) /* 100 ms max wait */
|
|
if ((READ_CSR(TLP_SROM_MII) & TLP_SROM_DOUT)==0) SLEEP(10000);
|
|
shift_srom_bits(sc, 5, 4); /* issue write cmd */
|
|
shift_srom_bits(sc, addr, 6); /* issue address */
|
|
shift_srom_bits(sc, data, 16); /* issue data */
|
|
csr &= ~TLP_SROM_CS;
|
|
WRITE_CSR(TLP_SROM_MII, csr); /* deassert CS */
|
|
|
|
/* Issue write-disable command. */
|
|
csr |= TLP_SROM_CS;
|
|
WRITE_CSR(TLP_SROM_MII, csr); /* assert CS */
|
|
for (i=0; i<10; i++) /* 100 ms max wait */
|
|
if ((READ_CSR(TLP_SROM_MII) & TLP_SROM_DOUT)==0) SLEEP(10000);
|
|
shift_srom_bits(sc, 4, 4); /* issue write disable cmd */
|
|
shift_srom_bits(sc, 0, 6); /* issue address */
|
|
csr &= ~TLP_SROM_CS;
|
|
WRITE_CSR(TLP_SROM_MII, csr); /* deassert CS */
|
|
|
|
/* Disable SROM access. */
|
|
WRITE_CSR(TLP_SROM_MII, TLP_MII_MDOE);
|
|
}
|
|
|
|
/* Not all boards have BIOS roms. */
|
|
/* The BIOS ROM is an AMD 29F010 1Mbit (128K by 8) EEPROM. */
|
|
static u_int8_t
|
|
read_bios(softc_t *sc, u_int32_t addr)
|
|
{
|
|
u_int32_t srom_mii;
|
|
|
|
/* Load the BIOS rom address register. */
|
|
WRITE_CSR(TLP_BIOS_ROM, addr);
|
|
|
|
/* Enable the BIOS rom. */
|
|
srom_mii = TLP_BIOS_SEL | TLP_BIOS_RD | TLP_MII_MDOE;
|
|
WRITE_CSR(TLP_SROM_MII, srom_mii);
|
|
|
|
/* Wait at least 20 PCI cycles. */
|
|
DELAY(20);
|
|
|
|
/* Read the BIOS rom data. */
|
|
srom_mii = READ_CSR(TLP_SROM_MII);
|
|
|
|
/* Disable the BIOS rom. */
|
|
WRITE_CSR(TLP_SROM_MII, TLP_MII_MDOE);
|
|
|
|
return (u_int8_t)srom_mii & 0xFF;
|
|
}
|
|
|
|
static void
|
|
write_bios_phys(softc_t *sc, u_int32_t addr, u_int8_t data)
|
|
{
|
|
u_int32_t srom_mii;
|
|
|
|
/* Load the BIOS rom address register. */
|
|
WRITE_CSR(TLP_BIOS_ROM, addr);
|
|
|
|
/* Enable the BIOS rom. */
|
|
srom_mii = TLP_BIOS_SEL | TLP_BIOS_WR | TLP_MII_MDOE;
|
|
|
|
/* Load the data into the data register. */
|
|
srom_mii = (srom_mii & 0xFFFFFF00) | (data & 0xFF);
|
|
WRITE_CSR(TLP_SROM_MII, srom_mii);
|
|
|
|
/* Wait at least 20 PCI cycles. */
|
|
DELAY(20);
|
|
|
|
/* Disable the BIOS rom. */
|
|
WRITE_CSR(TLP_SROM_MII, TLP_MII_MDOE);
|
|
}
|
|
|
|
/* IOCTL SYSCALL: can sleep. */
|
|
static void
|
|
write_bios(softc_t *sc, u_int32_t addr, u_int8_t data)
|
|
{
|
|
u_int8_t read_data;
|
|
|
|
/* this sequence enables writing */
|
|
write_bios_phys(sc, 0x5555, 0xAA);
|
|
write_bios_phys(sc, 0x2AAA, 0x55);
|
|
write_bios_phys(sc, 0x5555, 0xA0);
|
|
write_bios_phys(sc, addr, data);
|
|
|
|
/* Wait for the write operation to complete. */
|
|
for (;;) /* interruptable syscall */
|
|
{
|
|
for (;;)
|
|
{
|
|
read_data = read_bios(sc, addr);
|
|
if ((read_data & 0x80) == (data & 0x80)) break;
|
|
if (read_data & 0x20)
|
|
{ /* Data sheet says read it again. */
|
|
read_data = read_bios(sc, addr);
|
|
if ((read_data & 0x80) == (data & 0x80)) break;
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: write_bios() failed; rom addr=0x%x\n",
|
|
NAME_UNIT, addr);
|
|
return;
|
|
}
|
|
}
|
|
read_data = read_bios(sc, addr);
|
|
if (read_data == data) break;
|
|
}
|
|
}
|
|
|
|
/* IOCTL SYSCALL: can sleep. */
|
|
static void
|
|
erase_bios(softc_t *sc)
|
|
{
|
|
unsigned char read_data;
|
|
|
|
/* This sequence enables erasing: */
|
|
write_bios_phys(sc, 0x5555, 0xAA);
|
|
write_bios_phys(sc, 0x2AAA, 0x55);
|
|
write_bios_phys(sc, 0x5555, 0x80);
|
|
write_bios_phys(sc, 0x5555, 0xAA);
|
|
write_bios_phys(sc, 0x2AAA, 0x55);
|
|
write_bios_phys(sc, 0x5555, 0x10);
|
|
|
|
/* Wait for the erase operation to complete. */
|
|
for (;;) /* interruptable syscall */
|
|
{
|
|
for (;;)
|
|
{
|
|
read_data = read_bios(sc, 0);
|
|
if (read_data & 0x80) break;
|
|
if (read_data & 0x20)
|
|
{ /* Data sheet says read it again. */
|
|
read_data = read_bios(sc, 0);
|
|
if (read_data & 0x80) break;
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: erase_bios() failed\n", NAME_UNIT);
|
|
return;
|
|
}
|
|
}
|
|
read_data = read_bios(sc, 0);
|
|
if (read_data == 0xFF) break;
|
|
}
|
|
}
|
|
|
|
/* MDIO is 3-stated between tranactions. */
|
|
/* MDIO is set up before the RISING edge of MDC; MDC is parked low. */
|
|
static void
|
|
shift_mii_bits(softc_t *sc, u_int32_t data, u_int32_t len)
|
|
{
|
|
u_int32_t csr = READ_CSR(TLP_SROM_MII);
|
|
for (; len>0; len--)
|
|
{ /* MSB first */
|
|
if (data & (1<<(len-1)))
|
|
csr |= TLP_MII_MDOUT; /* MDOUT setup */
|
|
else
|
|
csr &= ~TLP_MII_MDOUT; /* MDOUT setup */
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
csr |= TLP_MII_MDC; /* MDC rising edge */
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
csr &= ~TLP_MII_MDC; /* MDC falling edge */
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
}
|
|
}
|
|
|
|
/* The specification for the MII is IEEE Std 802.3 clause 22. */
|
|
/* MDIO is sampled on the RISING edge of MDC; MDC is parked low. */
|
|
static u_int16_t
|
|
read_mii(softc_t *sc, u_int8_t regad)
|
|
{
|
|
int i;
|
|
u_int32_t csr;
|
|
u_int16_t data = 0;
|
|
|
|
WRITE_CSR(TLP_SROM_MII, TLP_MII_MDOUT);
|
|
|
|
shift_mii_bits(sc, 0xFFFFF, 20); /* preamble */
|
|
shift_mii_bits(sc, 0xFFFFF, 20); /* preamble */
|
|
shift_mii_bits(sc, 1, 2); /* start symbol */
|
|
shift_mii_bits(sc, 2, 2); /* read op */
|
|
shift_mii_bits(sc, 0, 5); /* phyad=0 */
|
|
shift_mii_bits(sc, regad, 5); /* regad */
|
|
csr = READ_CSR(TLP_SROM_MII);
|
|
csr |= TLP_MII_MDOE;
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
shift_mii_bits(sc, 0, 2); /* turn-around */
|
|
for (i=15; i>=0; i--) /* data */
|
|
{ /* MSB first */
|
|
csr = READ_CSR(TLP_SROM_MII); /* MDIN sampled */
|
|
data = (data<<1) | ((csr & TLP_MII_MDIN) ? 1:0);
|
|
csr |= TLP_MII_MDC; /* MDC rising edge */
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
csr &= ~TLP_MII_MDC; /* MDC falling edge */
|
|
WRITE_CSR(TLP_SROM_MII, csr);
|
|
}
|
|
return data;
|
|
}
|
|
|
|
static void
|
|
write_mii(softc_t *sc, u_int8_t regad, u_int16_t data)
|
|
{
|
|
WRITE_CSR(TLP_SROM_MII, TLP_MII_MDOUT);
|
|
shift_mii_bits(sc, 0xFFFFF, 20); /* preamble */
|
|
shift_mii_bits(sc, 0xFFFFF, 20); /* preamble */
|
|
shift_mii_bits(sc, 1, 2); /* start symbol */
|
|
shift_mii_bits(sc, 1, 2); /* write op */
|
|
shift_mii_bits(sc, 0, 5); /* phyad=0 */
|
|
shift_mii_bits(sc, regad, 5); /* regad */
|
|
shift_mii_bits(sc, 2, 2); /* turn-around */
|
|
shift_mii_bits(sc, data, 16); /* data */
|
|
WRITE_CSR(TLP_SROM_MII, TLP_MII_MDOE);
|
|
if (regad == 16) sc->led_state = data; /* a small optimization */
|
|
}
|
|
|
|
static void
|
|
set_mii16_bits(softc_t *sc, u_int16_t bits)
|
|
{
|
|
u_int16_t mii16 = read_mii(sc, 16);
|
|
mii16 |= bits;
|
|
write_mii(sc, 16, mii16);
|
|
}
|
|
|
|
static void
|
|
clr_mii16_bits(softc_t *sc, u_int16_t bits)
|
|
{
|
|
u_int16_t mii16 = read_mii(sc, 16);
|
|
mii16 &= ~bits;
|
|
write_mii(sc, 16, mii16);
|
|
}
|
|
|
|
static void
|
|
set_mii17_bits(softc_t *sc, u_int16_t bits)
|
|
{
|
|
u_int16_t mii17 = read_mii(sc, 17);
|
|
mii17 |= bits;
|
|
write_mii(sc, 17, mii17);
|
|
}
|
|
|
|
static void
|
|
clr_mii17_bits(softc_t *sc, u_int16_t bits)
|
|
{
|
|
u_int16_t mii17 = read_mii(sc, 17);
|
|
mii17 &= ~bits;
|
|
write_mii(sc, 17, mii17);
|
|
}
|
|
|
|
/*
|
|
* Watchdog code is more readable if it refreshes LEDs
|
|
* once a second whether they need it or not.
|
|
* But MII refs take 150 uSecs each, so remember the last value
|
|
* written to MII16 and avoid LED writes that do nothing.
|
|
*/
|
|
|
|
static void
|
|
led_off(softc_t *sc, u_int16_t led)
|
|
{
|
|
if ((led & sc->led_state) == led) return;
|
|
set_mii16_bits(sc, led);
|
|
}
|
|
|
|
static void
|
|
led_on(softc_t *sc, u_int16_t led)
|
|
{
|
|
if ((led & sc->led_state) == 0) return;
|
|
clr_mii16_bits(sc, led);
|
|
}
|
|
|
|
static void
|
|
led_inv(softc_t *sc, u_int16_t led)
|
|
{
|
|
u_int16_t mii16 = read_mii(sc, 16);
|
|
mii16 ^= led;
|
|
write_mii(sc, 16, mii16);
|
|
}
|
|
|
|
/*
|
|
* T1 & T3 framer registers are accessed through MII regs 17 & 18.
|
|
* Write the address to MII reg 17 then R/W data through MII reg 18.
|
|
* The hardware interface is an Intel-style 8-bit muxed A/D bus.
|
|
*/
|
|
static void
|
|
write_framer(softc_t *sc, u_int16_t addr, u_int8_t data)
|
|
{
|
|
write_mii(sc, 17, addr);
|
|
write_mii(sc, 18, data);
|
|
}
|
|
|
|
static u_int8_t
|
|
read_framer(softc_t *sc, u_int16_t addr)
|
|
{
|
|
write_mii(sc, 17, addr);
|
|
return (u_int8_t)read_mii(sc, 18);
|
|
}
|
|
|
|
/* Tulip's hardware implementation of General Purpose IO
|
|
* (GPIO) pins makes life difficult for software.
|
|
* Bits 7-0 in the Tulip GPIO CSR are used for two purposes
|
|
* depending on the state of bit 8.
|
|
* If bit 8 is 0 then bits 7-0 are "data" bits.
|
|
* If bit 8 is 1 then bits 7-0 are "direction" bits.
|
|
* If a direction bit is one, the data bit is an output.
|
|
* The problem is that the direction bits are WRITE-ONLY.
|
|
* Software must remember the direction bits in a shadow copy.
|
|
* (sc->gpio_dir) in order to change some but not all of the bits.
|
|
* All accesses to the Tulip GPIO register use these five procedures.
|
|
*/
|
|
|
|
static void
|
|
make_gpio_input(softc_t *sc, u_int32_t bits)
|
|
{
|
|
sc->gpio_dir &= ~bits;
|
|
WRITE_CSR(TLP_GPIO, TLP_GPIO_DIR | (sc->gpio_dir));
|
|
}
|
|
|
|
static void
|
|
make_gpio_output(softc_t *sc, u_int32_t bits)
|
|
{
|
|
sc->gpio_dir |= bits;
|
|
WRITE_CSR(TLP_GPIO, TLP_GPIO_DIR | (sc->gpio_dir));
|
|
}
|
|
|
|
static u_int32_t
|
|
read_gpio(softc_t *sc)
|
|
{
|
|
return READ_CSR(TLP_GPIO);
|
|
}
|
|
|
|
static void
|
|
set_gpio_bits(softc_t *sc, u_int32_t bits)
|
|
{
|
|
WRITE_CSR(TLP_GPIO, (read_gpio(sc) | bits) & 0xFF);
|
|
}
|
|
|
|
static void
|
|
clr_gpio_bits(softc_t *sc, u_int32_t bits)
|
|
{
|
|
WRITE_CSR(TLP_GPIO, (read_gpio(sc) & ~bits) & 0xFF);
|
|
}
|
|
|
|
/* Reset ALL of the flip-flops in the gate array to zero. */
|
|
/* This does NOT change the gate array programming. */
|
|
/* Called during initialization so it must not sleep. */
|
|
static void
|
|
reset_xilinx(softc_t *sc)
|
|
{
|
|
/* Drive RESET low to force initialization. */
|
|
clr_gpio_bits(sc, GPIO_RESET);
|
|
make_gpio_output(sc, GPIO_RESET);
|
|
|
|
/* Hold RESET low for more than 10 uSec. */
|
|
DELAY(50);
|
|
|
|
/* Done with RESET; make it an input. */
|
|
make_gpio_input(sc, GPIO_RESET);
|
|
}
|
|
|
|
/* Load Xilinx gate array program from on-board rom. */
|
|
/* This changes the gate array programming. */
|
|
/* IOCTL SYSCALL: can sleep. */
|
|
static void
|
|
load_xilinx_from_rom(softc_t *sc)
|
|
{
|
|
int i;
|
|
|
|
/* Drive MODE low to load from ROM rather than GPIO. */
|
|
clr_gpio_bits(sc, GPIO_MODE);
|
|
make_gpio_output(sc, GPIO_MODE);
|
|
|
|
/* Drive DP & RESET low to force configuration. */
|
|
clr_gpio_bits(sc, GPIO_RESET | GPIO_DP);
|
|
make_gpio_output(sc, GPIO_RESET | GPIO_DP);
|
|
|
|
/* Hold RESET & DP low for more than 10 uSec. */
|
|
DELAY(50);
|
|
|
|
/* Done with RESET & DP; make them inputs. */
|
|
make_gpio_input(sc, GPIO_DP | GPIO_RESET);
|
|
|
|
/* BUSY-WAIT for Xilinx chip to configure itself from ROM bits. */
|
|
for (i=0; i<100; i++) /* 1 sec max delay */
|
|
if ((read_gpio(sc) & GPIO_DP) == 0) SLEEP(10000);
|
|
|
|
/* Done with MODE; make it an input. */
|
|
make_gpio_input(sc, GPIO_MODE);
|
|
}
|
|
|
|
/* Load the Xilinx gate array program from userland bits. */
|
|
/* This changes the gate array programming. */
|
|
/* IOCTL SYSCALL: can sleep. */
|
|
static int
|
|
load_xilinx_from_file(softc_t *sc, char *addr, u_int32_t len)
|
|
{
|
|
char *data;
|
|
int i, j, error;
|
|
|
|
/* Get some pages to hold the Xilinx bits; biggest file is < 6 KB. */
|
|
if (len > 8192) return EFBIG; /* too big */
|
|
data = malloc(len, M_DEVBUF, M_WAITOK);
|
|
if (data == NULL) return ENOMEM;
|
|
|
|
/* Copy the Xilinx bits from userland. */
|
|
if ((error = copyin(addr, data, len)))
|
|
{
|
|
free(data, M_DEVBUF);
|
|
return error;
|
|
}
|
|
|
|
/* Drive MODE high to load from GPIO rather than ROM. */
|
|
set_gpio_bits(sc, GPIO_MODE);
|
|
make_gpio_output(sc, GPIO_MODE);
|
|
|
|
/* Drive DP & RESET low to force configuration. */
|
|
clr_gpio_bits(sc, GPIO_RESET | GPIO_DP);
|
|
make_gpio_output(sc, GPIO_RESET | GPIO_DP);
|
|
|
|
/* Hold RESET & DP low for more than 10 uSec. */
|
|
DELAY(50);
|
|
|
|
/* Done with RESET & DP; make them inputs. */
|
|
make_gpio_input(sc, GPIO_RESET | GPIO_DP);
|
|
|
|
/* BUSY-WAIT for Xilinx chip to clear its config memory. */
|
|
make_gpio_input(sc, GPIO_INIT);
|
|
for (i=0; i<10000; i++) /* 1 sec max delay */
|
|
if ((read_gpio(sc) & GPIO_INIT)==0) SLEEP(10000);
|
|
|
|
/* Configure CLK and DATA as outputs. */
|
|
set_gpio_bits(sc, GPIO_CLK); /* park CLK high */
|
|
make_gpio_output(sc, GPIO_CLK | GPIO_DATA);
|
|
|
|
/* Write bits to Xilinx; CLK is parked HIGH. */
|
|
/* DATA is set up before the RISING edge of CLK. */
|
|
for (i=0; i<len; i++)
|
|
for (j=0; j<8; j++)
|
|
{ /* LSB first */
|
|
if ((data[i] & (1<<j)) != 0)
|
|
set_gpio_bits(sc, GPIO_DATA); /* DATA setup */
|
|
else
|
|
clr_gpio_bits(sc, GPIO_DATA); /* DATA setup */
|
|
clr_gpio_bits(sc, GPIO_CLK); /* CLK falling edge */
|
|
set_gpio_bits(sc, GPIO_CLK); /* CLK rising edge */
|
|
}
|
|
|
|
/* Stop driving all Xilinx-related signals. */
|
|
/* Pullup and pulldown resistors take over. */
|
|
make_gpio_input(sc, GPIO_CLK | GPIO_DATA | GPIO_MODE);
|
|
|
|
free(data, M_DEVBUF);
|
|
return 0;
|
|
}
|
|
|
|
/* Write fragments of a command into the synthesized oscillator. */
|
|
/* DATA is set up before the RISING edge of CLK. CLK is parked low. */
|
|
static void
|
|
shift_synth_bits(softc_t *sc, u_int32_t data, u_int32_t len)
|
|
{
|
|
int i;
|
|
|
|
for (i=0; i<len; i++)
|
|
{ /* LSB first */
|
|
if ((data & (1<<i)) != 0)
|
|
set_gpio_bits(sc, GPIO_DATA); /* DATA setup */
|
|
else
|
|
clr_gpio_bits(sc, GPIO_DATA); /* DATA setup */
|
|
set_gpio_bits(sc, GPIO_CLK); /* CLK rising edge */
|
|
clr_gpio_bits(sc, GPIO_CLK); /* CLK falling edge */
|
|
}
|
|
}
|
|
|
|
/* Write a command to the synthesized oscillator on SSI and HSSIc. */
|
|
static void
|
|
write_synth(softc_t *sc, struct synth *synth)
|
|
{
|
|
/* SSI cards have a programmable prescaler */
|
|
if (sc->status.card_type == TLP_CSID_SSI)
|
|
{
|
|
if (synth->prescale == 9) /* divide by 512 */
|
|
set_mii17_bits(sc, MII17_SSI_PRESCALE);
|
|
else /* divide by 32 */
|
|
clr_mii17_bits(sc, MII17_SSI_PRESCALE);
|
|
}
|
|
|
|
clr_gpio_bits(sc, GPIO_DATA | GPIO_CLK);
|
|
make_gpio_output(sc, GPIO_DATA | GPIO_CLK);
|
|
|
|
/* SYNTH is a low-true chip enable for the AV9110 chip. */
|
|
set_gpio_bits(sc, GPIO_SSI_SYNTH);
|
|
make_gpio_output(sc, GPIO_SSI_SYNTH);
|
|
clr_gpio_bits(sc, GPIO_SSI_SYNTH);
|
|
|
|
/* Serially shift the command into the AV9110 chip. */
|
|
shift_synth_bits(sc, synth->n, 7);
|
|
shift_synth_bits(sc, synth->m, 7);
|
|
shift_synth_bits(sc, synth->v, 1);
|
|
shift_synth_bits(sc, synth->x, 2);
|
|
shift_synth_bits(sc, synth->r, 2);
|
|
shift_synth_bits(sc, 0x16, 5); /* enable clk/x output */
|
|
|
|
/* SYNTH (chip enable) going high ends the command. */
|
|
set_gpio_bits(sc, GPIO_SSI_SYNTH);
|
|
make_gpio_input(sc, GPIO_SSI_SYNTH);
|
|
|
|
/* Stop driving serial-related signals; pullups/pulldowns take over. */
|
|
make_gpio_input(sc, GPIO_DATA | GPIO_CLK);
|
|
|
|
/* remember the new synthesizer parameters */
|
|
if (&sc->config.synth != synth) sc->config.synth = *synth;
|
|
}
|
|
|
|
/* Write a command to the DAC controlling the VCXO on some T3 adapters. */
|
|
/* The DAC is a TI-TLV5636: 12-bit resolution and a serial interface. */
|
|
/* DATA is set up before the FALLING edge of CLK. CLK is parked HIGH. */
|
|
static void
|
|
write_dac(softc_t *sc, u_int16_t data)
|
|
{
|
|
int i;
|
|
|
|
/* Prepare to use DATA and CLK. */
|
|
set_gpio_bits(sc, GPIO_DATA | GPIO_CLK);
|
|
make_gpio_output(sc, GPIO_DATA | GPIO_CLK);
|
|
|
|
/* High-to-low transition prepares DAC for new value. */
|
|
set_gpio_bits(sc, GPIO_T3_DAC);
|
|
make_gpio_output(sc, GPIO_T3_DAC);
|
|
clr_gpio_bits(sc, GPIO_T3_DAC);
|
|
|
|
/* Serially shift command bits into DAC. */
|
|
for (i=0; i<16; i++)
|
|
{ /* MSB first */
|
|
if ((data & (1<<(15-i))) != 0)
|
|
set_gpio_bits(sc, GPIO_DATA); /* DATA setup */
|
|
else
|
|
clr_gpio_bits(sc, GPIO_DATA); /* DATA setup */
|
|
clr_gpio_bits(sc, GPIO_CLK); /* CLK falling edge */
|
|
set_gpio_bits(sc, GPIO_CLK); /* CLK rising edge */
|
|
}
|
|
|
|
/* Done with DAC; make it an input; loads new value into DAC. */
|
|
set_gpio_bits(sc, GPIO_T3_DAC);
|
|
make_gpio_input(sc, GPIO_T3_DAC);
|
|
|
|
/* Stop driving serial-related signals; pullups/pulldowns take over. */
|
|
make_gpio_input(sc, GPIO_DATA | GPIO_CLK);
|
|
}
|
|
|
|
/* begin HSSI card code */
|
|
|
|
/* Must not sleep. */
|
|
static void
|
|
hssi_config(softc_t *sc)
|
|
{
|
|
if (sc->status.card_type == 0)
|
|
{ /* defaults */
|
|
sc->status.card_type = READ_PCI_CFG(sc, TLP_CSID);
|
|
sc->config.crc_len = CFG_CRC_16;
|
|
sc->config.loop_back = CFG_LOOP_NONE;
|
|
sc->config.tx_clk_src = CFG_CLKMUX_ST;
|
|
sc->config.dte_dce = CFG_DTE;
|
|
sc->config.synth.n = 52; /* 52.000 Mbs */
|
|
sc->config.synth.m = 5;
|
|
sc->config.synth.v = 0;
|
|
sc->config.synth.x = 0;
|
|
sc->config.synth.r = 0;
|
|
sc->config.synth.prescale = 2;
|
|
}
|
|
|
|
/* set CRC length */
|
|
if (sc->config.crc_len == CFG_CRC_32)
|
|
set_mii16_bits(sc, MII16_HSSI_CRC32);
|
|
else
|
|
clr_mii16_bits(sc, MII16_HSSI_CRC32);
|
|
|
|
/* Assert pin LA in HSSI conn: ask modem for local loop. */
|
|
if (sc->config.loop_back == CFG_LOOP_LL)
|
|
set_mii16_bits(sc, MII16_HSSI_LA);
|
|
else
|
|
clr_mii16_bits(sc, MII16_HSSI_LA);
|
|
|
|
/* Assert pin LB in HSSI conn: ask modem for remote loop. */
|
|
if (sc->config.loop_back == CFG_LOOP_RL)
|
|
set_mii16_bits(sc, MII16_HSSI_LB);
|
|
else
|
|
clr_mii16_bits(sc, MII16_HSSI_LB);
|
|
|
|
if (sc->status.card_type == TLP_CSID_HSSI)
|
|
{
|
|
/* set TXCLK src */
|
|
if (sc->config.tx_clk_src == CFG_CLKMUX_ST)
|
|
set_gpio_bits(sc, GPIO_HSSI_TXCLK);
|
|
else
|
|
clr_gpio_bits(sc, GPIO_HSSI_TXCLK);
|
|
make_gpio_output(sc, GPIO_HSSI_TXCLK);
|
|
}
|
|
else if (sc->status.card_type == TLP_CSID_HSSIc)
|
|
{ /* cPCI HSSI rev C has extra features */
|
|
/* Set TXCLK source. */
|
|
u_int16_t mii16 = read_mii(sc, 16);
|
|
mii16 &= ~MII16_HSSI_CLKMUX;
|
|
mii16 |= (sc->config.tx_clk_src&3)<<13;
|
|
write_mii(sc, 16, mii16);
|
|
|
|
/* cPCI HSSI implements loopback towards the net. */
|
|
if (sc->config.loop_back == CFG_LOOP_LINE)
|
|
set_mii16_bits(sc, MII16_HSSI_LOOP);
|
|
else
|
|
clr_mii16_bits(sc, MII16_HSSI_LOOP);
|
|
|
|
/* Set DTE/DCE mode. */
|
|
if (sc->config.dte_dce == CFG_DCE)
|
|
set_gpio_bits(sc, GPIO_HSSI_DCE);
|
|
else
|
|
clr_gpio_bits(sc, GPIO_HSSI_DCE);
|
|
make_gpio_output(sc, GPIO_HSSI_DCE);
|
|
|
|
/* Program the synthesized oscillator. */
|
|
write_synth(sc, &sc->config.synth);
|
|
}
|
|
}
|
|
|
|
static void
|
|
hssi_ident(softc_t *sc)
|
|
{
|
|
}
|
|
|
|
/* Called once a second; must not sleep. */
|
|
static int
|
|
hssi_watchdog(softc_t *sc)
|
|
{
|
|
u_int16_t mii16 = read_mii(sc, 16) & MII16_HSSI_MODEM;
|
|
int link_status = STATUS_UP;
|
|
|
|
led_inv(sc, MII16_HSSI_LED_UL); /* Software is alive. */
|
|
led_on(sc, MII16_HSSI_LED_LL); /* always on (SSI cable) */
|
|
|
|
/* Check the transmit clock. */
|
|
if (sc->status.tx_speed == 0)
|
|
{
|
|
led_on(sc, MII16_HSSI_LED_UR);
|
|
link_status = STATUS_DOWN;
|
|
}
|
|
else
|
|
led_off(sc, MII16_HSSI_LED_UR);
|
|
|
|
/* Is the modem ready? */
|
|
if ((mii16 & MII16_HSSI_CA) == 0)
|
|
{
|
|
led_off(sc, MII16_HSSI_LED_LR);
|
|
link_status = STATUS_DOWN;
|
|
}
|
|
else
|
|
led_on(sc, MII16_HSSI_LED_LR);
|
|
|
|
/* Print the modem control signals if they changed. */
|
|
if ((DRIVER_DEBUG) && (mii16 != sc->last_mii16))
|
|
{
|
|
char *on = "ON ", *off = "OFF";
|
|
printf("%s: TA=%s CA=%s LA=%s LB=%s LC=%s TM=%s\n", NAME_UNIT,
|
|
(mii16 & MII16_HSSI_TA) ? on : off,
|
|
(mii16 & MII16_HSSI_CA) ? on : off,
|
|
(mii16 & MII16_HSSI_LA) ? on : off,
|
|
(mii16 & MII16_HSSI_LB) ? on : off,
|
|
(mii16 & MII16_HSSI_LC) ? on : off,
|
|
(mii16 & MII16_HSSI_TM) ? on : off);
|
|
}
|
|
|
|
/* SNMP one-second-report */
|
|
sc->status.snmp.hssi.sigs = mii16 & MII16_HSSI_MODEM;
|
|
|
|
/* Remember this state until next time. */
|
|
sc->last_mii16 = mii16;
|
|
|
|
/* If a loop back is in effect, link status is UP */
|
|
if (sc->config.loop_back != CFG_LOOP_NONE)
|
|
link_status = STATUS_UP;
|
|
|
|
return link_status;
|
|
}
|
|
|
|
/* IOCTL SYSCALL: can sleep (but doesn't). */
|
|
static int
|
|
hssi_ioctl(softc_t *sc, struct ioctl *ioctl)
|
|
{
|
|
int error = 0;
|
|
|
|
if (ioctl->cmd == IOCTL_SNMP_SIGS)
|
|
{
|
|
u_int16_t mii16 = read_mii(sc, 16);
|
|
mii16 &= ~MII16_HSSI_MODEM;
|
|
mii16 |= (MII16_HSSI_MODEM & ioctl->data);
|
|
write_mii(sc, 16, mii16);
|
|
}
|
|
else if (ioctl->cmd == IOCTL_SET_STATUS)
|
|
{
|
|
if (ioctl->data != 0)
|
|
set_mii16_bits(sc, MII16_HSSI_TA);
|
|
else
|
|
clr_mii16_bits(sc, MII16_HSSI_TA);
|
|
}
|
|
else
|
|
error = EINVAL;
|
|
|
|
return error;
|
|
}
|
|
|
|
/* begin DS3 card code */
|
|
|
|
/* Must not sleep. */
|
|
static void
|
|
t3_config(softc_t *sc)
|
|
{
|
|
int i;
|
|
u_int8_t ctl1;
|
|
|
|
if (sc->status.card_type == 0)
|
|
{ /* defaults */
|
|
sc->status.card_type = TLP_CSID_T3;
|
|
sc->config.crc_len = CFG_CRC_16;
|
|
sc->config.loop_back = CFG_LOOP_NONE;
|
|
sc->config.format = CFG_FORMAT_T3CPAR;
|
|
sc->config.cable_len = 10; /* meters */
|
|
sc->config.scrambler = CFG_SCRAM_DL_KEN;
|
|
sc->config.tx_clk_src = CFG_CLKMUX_INT;
|
|
|
|
/* Center the VCXO -- get within 20 PPM of 44736000. */
|
|
write_dac(sc, 0x9002); /* set Vref = 2.048 volts */
|
|
write_dac(sc, 2048); /* range is 0..4095 */
|
|
}
|
|
|
|
/* Set cable length. */
|
|
if (sc->config.cable_len > 30)
|
|
clr_mii16_bits(sc, MII16_DS3_ZERO);
|
|
else
|
|
set_mii16_bits(sc, MII16_DS3_ZERO);
|
|
|
|
/* Set payload scrambler polynomial. */
|
|
if (sc->config.scrambler == CFG_SCRAM_LARS)
|
|
set_mii16_bits(sc, MII16_DS3_POLY);
|
|
else
|
|
clr_mii16_bits(sc, MII16_DS3_POLY);
|
|
|
|
/* Set payload scrambler on/off. */
|
|
if (sc->config.scrambler == CFG_SCRAM_OFF)
|
|
clr_mii16_bits(sc, MII16_DS3_SCRAM);
|
|
else
|
|
set_mii16_bits(sc, MII16_DS3_SCRAM);
|
|
|
|
/* Set CRC length. */
|
|
if (sc->config.crc_len == CFG_CRC_32)
|
|
set_mii16_bits(sc, MII16_DS3_CRC32);
|
|
else
|
|
clr_mii16_bits(sc, MII16_DS3_CRC32);
|
|
|
|
/* Loopback towards host thru the line interface. */
|
|
if (sc->config.loop_back == CFG_LOOP_OTHER)
|
|
set_mii16_bits(sc, MII16_DS3_TRLBK);
|
|
else
|
|
clr_mii16_bits(sc, MII16_DS3_TRLBK);
|
|
|
|
/* Loopback towards network thru the line interface. */
|
|
if (sc->config.loop_back == CFG_LOOP_LINE)
|
|
set_mii16_bits(sc, MII16_DS3_LNLBK);
|
|
else if (sc->config.loop_back == CFG_LOOP_DUAL)
|
|
set_mii16_bits(sc, MII16_DS3_LNLBK);
|
|
else
|
|
clr_mii16_bits(sc, MII16_DS3_LNLBK);
|
|
|
|
/* Configure T3 framer chip; write EVERY writeable register. */
|
|
ctl1 = CTL1_SER | CTL1_XTX;
|
|
if (sc->config.loop_back == CFG_LOOP_INWARD) ctl1 |= CTL1_3LOOP;
|
|
if (sc->config.loop_back == CFG_LOOP_DUAL) ctl1 |= CTL1_3LOOP;
|
|
if (sc->config.format == CFG_FORMAT_T3M13) ctl1 |= CTL1_M13MODE;
|
|
write_framer(sc, T3CSR_CTL1, ctl1);
|
|
write_framer(sc, T3CSR_TX_FEAC, CTL5_EMODE);
|
|
write_framer(sc, T3CSR_CTL8, CTL8_FBEC);
|
|
write_framer(sc, T3CSR_CTL12, CTL12_DLCB1 | CTL12_C21 | CTL12_MCB1);
|
|
write_framer(sc, T3CSR_DBL_FEAC, 0);
|
|
write_framer(sc, T3CSR_CTL14, CTL14_RGCEN | CTL14_TGCEN);
|
|
write_framer(sc, T3CSR_INTEN, 0);
|
|
write_framer(sc, T3CSR_CTL20, CTL20_CVEN);
|
|
|
|
/* Clear error counters and latched error bits */
|
|
/* that may have happened while initializing. */
|
|
for (i=0; i<21; i++) read_framer(sc, i);
|
|
}
|
|
|
|
static void
|
|
t3_ident(softc_t *sc)
|
|
{
|
|
printf(", TXC03401 rev B");
|
|
}
|
|
|
|
/* Called once a second; must not sleep. */
|
|
static int
|
|
t3_watchdog(softc_t *sc)
|
|
{
|
|
u_int16_t CV;
|
|
u_int8_t CERR, PERR, MERR, FERR, FEBE;
|
|
u_int8_t ctl1, stat16, feac;
|
|
int link_status = STATUS_UP;
|
|
u_int16_t mii16;
|
|
|
|
/* Read the alarm registers. */
|
|
ctl1 = read_framer(sc, T3CSR_CTL1);
|
|
stat16 = read_framer(sc, T3CSR_STAT16);
|
|
mii16 = read_mii(sc, 16);
|
|
|
|
/* Always ignore the RTLOC alarm bit. */
|
|
stat16 &= ~STAT16_RTLOC;
|
|
|
|
/* Software is alive. */
|
|
led_inv(sc, MII16_DS3_LED_GRN);
|
|
|
|
/* Receiving Alarm Indication Signal (AIS). */
|
|
if ((stat16 & STAT16_RAIS) != 0) /* receiving ais */
|
|
led_on(sc, MII16_DS3_LED_BLU);
|
|
else if (ctl1 & CTL1_TXAIS) /* sending ais */
|
|
led_inv(sc, MII16_DS3_LED_BLU);
|
|
else
|
|
led_off(sc, MII16_DS3_LED_BLU);
|
|
|
|
/* Receiving Remote Alarm Indication (RAI). */
|
|
if ((stat16 & STAT16_XERR) != 0) /* receiving rai */
|
|
led_on(sc, MII16_DS3_LED_YEL);
|
|
else if ((ctl1 & CTL1_XTX) == 0) /* sending rai */
|
|
led_inv(sc, MII16_DS3_LED_YEL);
|
|
else
|
|
led_off(sc, MII16_DS3_LED_YEL);
|
|
|
|
/* If certain status bits are set then the link is 'down'. */
|
|
/* The bad bits are: rxlos rxoof rxais rxidl xerr. */
|
|
if ((stat16 & ~(STAT16_FEAC | STAT16_SEF)) != 0)
|
|
link_status = STATUS_DOWN;
|
|
|
|
/* Declare local Red Alarm if the link is down. */
|
|
if (link_status == STATUS_DOWN)
|
|
led_on(sc, MII16_DS3_LED_RED);
|
|
else if (sc->loop_timer != 0) /* loopback is active */
|
|
led_inv(sc, MII16_DS3_LED_RED);
|
|
else
|
|
led_off(sc, MII16_DS3_LED_RED);
|
|
|
|
/* Print latched error bits if they changed. */
|
|
if ((DRIVER_DEBUG) && ((stat16 & ~STAT16_FEAC) != sc->last_stat16))
|
|
{
|
|
char *on = "ON ", *off = "OFF";
|
|
printf("%s: RLOS=%s ROOF=%s RAIS=%s RIDL=%s SEF=%s XERR=%s\n",
|
|
NAME_UNIT,
|
|
(stat16 & STAT16_RLOS) ? on : off,
|
|
(stat16 & STAT16_ROOF) ? on : off,
|
|
(stat16 & STAT16_RAIS) ? on : off,
|
|
(stat16 & STAT16_RIDL) ? on : off,
|
|
(stat16 & STAT16_SEF) ? on : off,
|
|
(stat16 & STAT16_XERR) ? on : off);
|
|
}
|
|
|
|
/* Check and print error counters if non-zero. */
|
|
CV = read_framer(sc, T3CSR_CVHI)<<8;
|
|
CV += read_framer(sc, T3CSR_CVLO);
|
|
PERR = read_framer(sc, T3CSR_PERR);
|
|
CERR = read_framer(sc, T3CSR_CERR);
|
|
FERR = read_framer(sc, T3CSR_FERR);
|
|
MERR = read_framer(sc, T3CSR_MERR);
|
|
FEBE = read_framer(sc, T3CSR_FEBE);
|
|
|
|
/* CV is invalid during LOS. */
|
|
if ((stat16 & STAT16_RLOS)!=0) CV = 0;
|
|
/* CERR & FEBE are invalid in M13 mode */
|
|
if (sc->config.format == CFG_FORMAT_T3M13) CERR = FEBE = 0;
|
|
/* FEBE is invalid during AIS. */
|
|
if ((stat16 & STAT16_RAIS)!=0) FEBE = 0;
|
|
if (DRIVER_DEBUG && (CV || PERR || CERR || FERR || MERR || FEBE))
|
|
printf("%s: CV=%u PERR=%u CERR=%u FERR=%u MERR=%u FEBE=%u\n",
|
|
NAME_UNIT, CV, PERR, CERR, FERR, MERR, FEBE);
|
|
|
|
/* Driver keeps crude link-level error counters (SNMP is better). */
|
|
sc->status.cntrs.lcv_errs += CV;
|
|
sc->status.cntrs.par_errs += PERR;
|
|
sc->status.cntrs.cpar_errs += CERR;
|
|
sc->status.cntrs.frm_errs += FERR;
|
|
sc->status.cntrs.mfrm_errs += MERR;
|
|
sc->status.cntrs.febe_errs += FEBE;
|
|
|
|
/* Check for FEAC messages (FEAC not defined in M13 mode). */
|
|
if (FORMAT_T3CPAR && (stat16 & STAT16_FEAC)) do
|
|
{
|
|
feac = read_framer(sc, T3CSR_FEAC_STK);
|
|
if ((feac & FEAC_STK_VALID)==0) break;
|
|
/* Ignore RxFEACs while a far end loopback has been requested. */
|
|
if ((sc->status.snmp.t3.line & TLOOP_FAR_LINE)!=0) continue;
|
|
switch (feac & FEAC_STK_FEAC)
|
|
{
|
|
case T3BOP_LINE_UP: break;
|
|
case T3BOP_LINE_DOWN: break;
|
|
case T3BOP_LOOP_DS3:
|
|
{
|
|
if (sc->last_FEAC == T3BOP_LINE_DOWN)
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'line loopback deactivate' FEAC msg\n", NAME_UNIT);
|
|
clr_mii16_bits(sc, MII16_DS3_LNLBK);
|
|
sc->loop_timer = 0;
|
|
}
|
|
if (sc->last_FEAC == T3BOP_LINE_UP)
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'line loopback activate' FEAC msg\n", NAME_UNIT);
|
|
set_mii16_bits(sc, MII16_DS3_LNLBK);
|
|
sc->loop_timer = 300;
|
|
}
|
|
break;
|
|
}
|
|
case T3BOP_OOF:
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'far end LOF' FEAC msg\n", NAME_UNIT);
|
|
break;
|
|
}
|
|
case T3BOP_IDLE:
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'far end IDL' FEAC msg\n", NAME_UNIT);
|
|
break;
|
|
}
|
|
case T3BOP_AIS:
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'far end AIS' FEAC msg\n", NAME_UNIT);
|
|
break;
|
|
}
|
|
case T3BOP_LOS:
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'far end LOS' FEAC msg\n", NAME_UNIT);
|
|
break;
|
|
}
|
|
default:
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'type 0x%02X' FEAC msg\n", NAME_UNIT, feac & FEAC_STK_FEAC);
|
|
break;
|
|
}
|
|
}
|
|
sc->last_FEAC = feac & FEAC_STK_FEAC;
|
|
} while ((feac & FEAC_STK_MORE) != 0);
|
|
stat16 &= ~STAT16_FEAC;
|
|
|
|
/* Send Service-Affecting priority FEAC messages */
|
|
if (((sc->last_stat16 ^ stat16) & 0xF0) && (FORMAT_T3CPAR))
|
|
{
|
|
/* Transmit continuous FEACs */
|
|
write_framer(sc, T3CSR_CTL14,
|
|
read_framer(sc, T3CSR_CTL14) & ~CTL14_FEAC10);
|
|
if ((stat16 & STAT16_RLOS)!=0)
|
|
write_framer(sc, T3CSR_TX_FEAC, 0xC0 + T3BOP_LOS);
|
|
else if ((stat16 & STAT16_ROOF)!=0)
|
|
write_framer(sc, T3CSR_TX_FEAC, 0xC0 + T3BOP_OOF);
|
|
else if ((stat16 & STAT16_RAIS)!=0)
|
|
write_framer(sc, T3CSR_TX_FEAC, 0xC0 + T3BOP_AIS);
|
|
else if ((stat16 & STAT16_RIDL)!=0)
|
|
write_framer(sc, T3CSR_TX_FEAC, 0xC0 + T3BOP_IDLE);
|
|
else
|
|
write_framer(sc, T3CSR_TX_FEAC, CTL5_EMODE);
|
|
}
|
|
|
|
/* Start sending RAI, Remote Alarm Indication. */
|
|
if (((stat16 & STAT16_ROOF)!=0) && ((stat16 & STAT16_RLOS)==0) &&
|
|
((sc->last_stat16 & STAT16_ROOF)==0))
|
|
write_framer(sc, T3CSR_CTL1, ctl1 &= ~CTL1_XTX);
|
|
/* Stop sending RAI, Remote Alarm Indication. */
|
|
else if (((stat16 & STAT16_ROOF)==0) && ((sc->last_stat16 & STAT16_ROOF)!=0))
|
|
write_framer(sc, T3CSR_CTL1, ctl1 |= CTL1_XTX);
|
|
|
|
/* Start sending AIS, Alarm Indication Signal */
|
|
if (((stat16 & STAT16_RLOS)!=0) && ((sc->last_stat16 & STAT16_RLOS)==0))
|
|
{
|
|
set_mii16_bits(sc, MII16_DS3_FRAME);
|
|
write_framer(sc, T3CSR_CTL1, ctl1 | CTL1_TXAIS);
|
|
}
|
|
/* Stop sending AIS, Alarm Indication Signal */
|
|
else if (((stat16 & STAT16_RLOS)==0) && ((sc->last_stat16 & STAT16_RLOS)!=0))
|
|
{
|
|
clr_mii16_bits(sc, MII16_DS3_FRAME);
|
|
write_framer(sc, T3CSR_CTL1, ctl1 & ~CTL1_TXAIS);
|
|
}
|
|
|
|
/* Time out loopback requests. */
|
|
if (sc->loop_timer != 0)
|
|
if (--sc->loop_timer == 0)
|
|
if ((mii16 & MII16_DS3_LNLBK)!=0)
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Timeout: Loop Down after 300 seconds\n", NAME_UNIT);
|
|
clr_mii16_bits(sc, MII16_DS3_LNLBK); /* line loopback off */
|
|
}
|
|
|
|
/* SNMP error counters */
|
|
sc->status.snmp.t3.lcv = CV;
|
|
sc->status.snmp.t3.pcv = PERR;
|
|
sc->status.snmp.t3.ccv = CERR;
|
|
sc->status.snmp.t3.febe = FEBE;
|
|
|
|
/* SNMP Line Status */
|
|
sc->status.snmp.t3.line = 0;
|
|
if ((ctl1 & CTL1_XTX)==0) sc->status.snmp.t3.line |= TLINE_TX_RAI;
|
|
if (stat16 & STAT16_XERR) sc->status.snmp.t3.line |= TLINE_RX_RAI;
|
|
if (ctl1 & CTL1_TXAIS) sc->status.snmp.t3.line |= TLINE_TX_AIS;
|
|
if (stat16 & STAT16_RAIS) sc->status.snmp.t3.line |= TLINE_RX_AIS;
|
|
if (stat16 & STAT16_ROOF) sc->status.snmp.t3.line |= TLINE_LOF;
|
|
if (stat16 & STAT16_RLOS) sc->status.snmp.t3.line |= TLINE_LOS;
|
|
if (stat16 & STAT16_SEF) sc->status.snmp.t3.line |= T3LINE_SEF;
|
|
|
|
/* SNMP Loopback Status */
|
|
sc->status.snmp.t3.loop &= ~TLOOP_FAR_LINE;
|
|
if (sc->config.loop_back == CFG_LOOP_TULIP)
|
|
sc->status.snmp.t3.loop |= TLOOP_NEAR_OTHER;
|
|
if (ctl1 & CTL1_3LOOP) sc->status.snmp.t3.loop |= TLOOP_NEAR_INWARD;
|
|
if (mii16 & MII16_DS3_TRLBK) sc->status.snmp.t3.loop |= TLOOP_NEAR_OTHER;
|
|
if (mii16 & MII16_DS3_LNLBK) sc->status.snmp.t3.loop |= TLOOP_NEAR_LINE;
|
|
/*if (ctl12 & CTL12_RTPLOOP) sc->status.snmp.t3.loop |= TLOOP_NEAR_PAYLOAD; */
|
|
|
|
/* Remember this state until next time. */
|
|
sc->last_stat16 = stat16;
|
|
|
|
/* If an INWARD loopback is in effect, link status is UP */
|
|
if (sc->config.loop_back != CFG_LOOP_NONE) /* XXX INWARD ONLY */
|
|
link_status = STATUS_UP;
|
|
|
|
return link_status;
|
|
}
|
|
|
|
/* IOCTL SYSCALL: can sleep. */
|
|
static void
|
|
t3_send_dbl_feac(softc_t *sc, int feac1, int feac2)
|
|
{
|
|
u_int8_t tx_feac;
|
|
int i;
|
|
|
|
/* The FEAC transmitter could be sending a continuous */
|
|
/* FEAC msg when told to send a double FEAC message. */
|
|
/* So save the current state of the FEAC transmitter. */
|
|
tx_feac = read_framer(sc, T3CSR_TX_FEAC);
|
|
/* Load second FEAC code and stop FEAC transmitter. */
|
|
write_framer(sc, T3CSR_TX_FEAC, CTL5_EMODE + feac2);
|
|
/* FEAC transmitter sends 10 more FEACs and then stops. */
|
|
SLEEP(20000); /* sending one FEAC takes 1700 uSecs */
|
|
/* Load first FEAC code and start FEAC transmitter. */
|
|
write_framer(sc, T3CSR_DBL_FEAC, CTL13_DFEXEC + feac1);
|
|
/* Wait for double FEAC sequence to complete -- about 70 ms. */
|
|
for (i=0; i<10; i++) /* max delay 100 ms */
|
|
if (read_framer(sc, T3CSR_DBL_FEAC) & CTL13_DFEXEC) SLEEP(10000);
|
|
/* Flush received FEACS; don't respond to our own loop cmd! */
|
|
while (read_framer(sc, T3CSR_FEAC_STK) & FEAC_STK_VALID) DELAY(1); /* XXX HANG */
|
|
/* Restore previous state of the FEAC transmitter. */
|
|
/* If it was sending a continuous FEAC, it will resume. */
|
|
write_framer(sc, T3CSR_TX_FEAC, tx_feac);
|
|
}
|
|
|
|
/* IOCTL SYSCALL: can sleep. */
|
|
static int
|
|
t3_ioctl(softc_t *sc, struct ioctl *ioctl)
|
|
{
|
|
int error = 0;
|
|
|
|
switch (ioctl->cmd)
|
|
{
|
|
case IOCTL_SNMP_SEND: /* set opstatus? */
|
|
{
|
|
if (sc->config.format != CFG_FORMAT_T3CPAR)
|
|
error = EINVAL;
|
|
else if (ioctl->data == TSEND_LINE)
|
|
{
|
|
sc->status.snmp.t3.loop |= TLOOP_FAR_LINE;
|
|
t3_send_dbl_feac(sc, T3BOP_LINE_UP, T3BOP_LOOP_DS3);
|
|
}
|
|
else if (ioctl->data == TSEND_RESET)
|
|
{
|
|
t3_send_dbl_feac(sc, T3BOP_LINE_DOWN, T3BOP_LOOP_DS3);
|
|
sc->status.snmp.t3.loop &= ~TLOOP_FAR_LINE;
|
|
}
|
|
else
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
case IOCTL_SNMP_LOOP: /* set opstatus = test? */
|
|
{
|
|
if (ioctl->data == CFG_LOOP_NONE)
|
|
{
|
|
clr_mii16_bits(sc, MII16_DS3_FRAME);
|
|
clr_mii16_bits(sc, MII16_DS3_TRLBK);
|
|
clr_mii16_bits(sc, MII16_DS3_LNLBK);
|
|
write_framer(sc, T3CSR_CTL1,
|
|
read_framer(sc, T3CSR_CTL1) & ~CTL1_3LOOP);
|
|
write_framer(sc, T3CSR_CTL12,
|
|
read_framer(sc, T3CSR_CTL12) & ~(CTL12_RTPLOOP | CTL12_RTPLLEN));
|
|
}
|
|
else if (ioctl->data == CFG_LOOP_LINE)
|
|
set_mii16_bits(sc, MII16_DS3_LNLBK);
|
|
else if (ioctl->data == CFG_LOOP_OTHER)
|
|
set_mii16_bits(sc, MII16_DS3_TRLBK);
|
|
else if (ioctl->data == CFG_LOOP_INWARD)
|
|
write_framer(sc, T3CSR_CTL1,
|
|
read_framer(sc, T3CSR_CTL1) | CTL1_3LOOP);
|
|
else if (ioctl->data == CFG_LOOP_DUAL)
|
|
{
|
|
set_mii16_bits(sc, MII16_DS3_LNLBK);
|
|
write_framer(sc, T3CSR_CTL1,
|
|
read_framer(sc, T3CSR_CTL1) | CTL1_3LOOP);
|
|
}
|
|
else if (ioctl->data == CFG_LOOP_PAYLOAD)
|
|
{
|
|
set_mii16_bits(sc, MII16_DS3_FRAME);
|
|
write_framer(sc, T3CSR_CTL12,
|
|
read_framer(sc, T3CSR_CTL12) | CTL12_RTPLOOP);
|
|
write_framer(sc, T3CSR_CTL12,
|
|
read_framer(sc, T3CSR_CTL12) | CTL12_RTPLLEN);
|
|
DELAY(25); /* at least two frames (22 uS) */
|
|
write_framer(sc, T3CSR_CTL12,
|
|
read_framer(sc, T3CSR_CTL12) & ~CTL12_RTPLLEN);
|
|
}
|
|
else
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
|
|
return error;
|
|
}
|
|
|
|
/* begin SSI card code */
|
|
|
|
/* Must not sleep. */
|
|
static void
|
|
ssi_config(softc_t *sc)
|
|
{
|
|
if (sc->status.card_type == 0)
|
|
{ /* defaults */
|
|
sc->status.card_type = TLP_CSID_SSI;
|
|
sc->config.crc_len = CFG_CRC_16;
|
|
sc->config.loop_back = CFG_LOOP_NONE;
|
|
sc->config.tx_clk_src = CFG_CLKMUX_ST;
|
|
sc->config.dte_dce = CFG_DTE;
|
|
sc->config.synth.n = 51; /* 1.536 MHz */
|
|
sc->config.synth.m = 83;
|
|
sc->config.synth.v = 1;
|
|
sc->config.synth.x = 1;
|
|
sc->config.synth.r = 1;
|
|
sc->config.synth.prescale = 4;
|
|
}
|
|
|
|
/* Disable the TX clock driver while programming the oscillator. */
|
|
clr_gpio_bits(sc, GPIO_SSI_DCE);
|
|
make_gpio_output(sc, GPIO_SSI_DCE);
|
|
|
|
/* Program the synthesized oscillator. */
|
|
write_synth(sc, &sc->config.synth);
|
|
|
|
/* Set DTE/DCE mode. */
|
|
/* If DTE mode then DCD & TXC are received. */
|
|
/* If DCE mode then DCD & TXC are driven. */
|
|
/* Boards with MII rev=4.0 don't drive DCD. */
|
|
if (sc->config.dte_dce == CFG_DCE)
|
|
set_gpio_bits(sc, GPIO_SSI_DCE);
|
|
else
|
|
clr_gpio_bits(sc, GPIO_SSI_DCE);
|
|
make_gpio_output(sc, GPIO_SSI_DCE);
|
|
|
|
/* Set CRC length. */
|
|
if (sc->config.crc_len == CFG_CRC_32)
|
|
set_mii16_bits(sc, MII16_SSI_CRC32);
|
|
else
|
|
clr_mii16_bits(sc, MII16_SSI_CRC32);
|
|
|
|
/* Loop towards host thru cable drivers and receivers. */
|
|
/* Asserts DCD at the far end of a null modem cable. */
|
|
if (sc->config.loop_back == CFG_LOOP_PINS)
|
|
set_mii16_bits(sc, MII16_SSI_LOOP);
|
|
else
|
|
clr_mii16_bits(sc, MII16_SSI_LOOP);
|
|
|
|
/* Assert pin LL in modem conn: ask modem for local loop. */
|
|
/* Asserts TM at the far end of a null modem cable. */
|
|
if (sc->config.loop_back == CFG_LOOP_LL)
|
|
set_mii16_bits(sc, MII16_SSI_LL);
|
|
else
|
|
clr_mii16_bits(sc, MII16_SSI_LL);
|
|
|
|
/* Assert pin RL in modem conn: ask modem for remote loop. */
|
|
if (sc->config.loop_back == CFG_LOOP_RL)
|
|
set_mii16_bits(sc, MII16_SSI_RL);
|
|
else
|
|
clr_mii16_bits(sc, MII16_SSI_RL);
|
|
}
|
|
|
|
static void
|
|
ssi_ident(softc_t *sc)
|
|
{
|
|
printf(", LTC1343/44");
|
|
}
|
|
|
|
/* Called once a second; must not sleep. */
|
|
static int
|
|
ssi_watchdog(softc_t *sc)
|
|
{
|
|
u_int16_t cable;
|
|
u_int16_t mii16 = read_mii(sc, 16) & MII16_SSI_MODEM;
|
|
int link_status = STATUS_UP;
|
|
|
|
/* Software is alive. */
|
|
led_inv(sc, MII16_SSI_LED_UL);
|
|
|
|
/* Check the transmit clock. */
|
|
if (sc->status.tx_speed == 0)
|
|
{
|
|
led_on(sc, MII16_SSI_LED_UR);
|
|
link_status = STATUS_DOWN;
|
|
}
|
|
else
|
|
led_off(sc, MII16_SSI_LED_UR);
|
|
|
|
/* Check the external cable. */
|
|
cable = read_mii(sc, 17);
|
|
cable = cable & MII17_SSI_CABLE_MASK;
|
|
cable = cable >> MII17_SSI_CABLE_SHIFT;
|
|
if (cable == 7)
|
|
{
|
|
led_off(sc, MII16_SSI_LED_LL); /* no cable */
|
|
link_status = STATUS_DOWN;
|
|
}
|
|
else
|
|
led_on(sc, MII16_SSI_LED_LL);
|
|
|
|
/* The unit at the other end of the cable is ready if: */
|
|
/* DTE mode and DCD pin is asserted */
|
|
/* DCE mode and DSR pin is asserted */
|
|
if (((sc->config.dte_dce == CFG_DTE) && ((mii16 & MII16_SSI_DCD)==0)) ||
|
|
((sc->config.dte_dce == CFG_DCE) && ((mii16 & MII16_SSI_DSR)==0)))
|
|
{
|
|
led_off(sc, MII16_SSI_LED_LR);
|
|
link_status = STATUS_DOWN;
|
|
}
|
|
else
|
|
led_on(sc, MII16_SSI_LED_LR);
|
|
|
|
if (DRIVER_DEBUG && (cable != sc->status.cable_type))
|
|
printf("%s: SSI cable type changed to '%s'\n",
|
|
NAME_UNIT, ssi_cables[cable]);
|
|
sc->status.cable_type = cable;
|
|
|
|
/* Print the modem control signals if they changed. */
|
|
if ((DRIVER_DEBUG) && (mii16 != sc->last_mii16))
|
|
{
|
|
char *on = "ON ", *off = "OFF";
|
|
printf("%s: DTR=%s DSR=%s RTS=%s CTS=%s DCD=%s RI=%s LL=%s RL=%s TM=%s\n",
|
|
NAME_UNIT,
|
|
(mii16 & MII16_SSI_DTR) ? on : off,
|
|
(mii16 & MII16_SSI_DSR) ? on : off,
|
|
(mii16 & MII16_SSI_RTS) ? on : off,
|
|
(mii16 & MII16_SSI_CTS) ? on : off,
|
|
(mii16 & MII16_SSI_DCD) ? on : off,
|
|
(mii16 & MII16_SSI_RI) ? on : off,
|
|
(mii16 & MII16_SSI_LL) ? on : off,
|
|
(mii16 & MII16_SSI_RL) ? on : off,
|
|
(mii16 & MII16_SSI_TM) ? on : off);
|
|
}
|
|
|
|
/* SNMP one-second report */
|
|
sc->status.snmp.ssi.sigs = mii16 & MII16_SSI_MODEM;
|
|
|
|
/* Remember this state until next time. */
|
|
sc->last_mii16 = mii16;
|
|
|
|
/* If a loop back is in effect, link status is UP */
|
|
if (sc->config.loop_back != CFG_LOOP_NONE)
|
|
link_status = STATUS_UP;
|
|
|
|
return link_status;
|
|
}
|
|
|
|
/* IOCTL SYSCALL: can sleep (but doesn't). */
|
|
static int
|
|
ssi_ioctl(softc_t *sc, struct ioctl *ioctl)
|
|
{
|
|
int error = 0;
|
|
|
|
if (ioctl->cmd == IOCTL_SNMP_SIGS)
|
|
{
|
|
u_int16_t mii16 = read_mii(sc, 16);
|
|
mii16 &= ~MII16_SSI_MODEM;
|
|
mii16 |= (MII16_SSI_MODEM & ioctl->data);
|
|
write_mii(sc, 16, mii16);
|
|
}
|
|
else if (ioctl->cmd == IOCTL_SET_STATUS)
|
|
{
|
|
if (ioctl->data != 0)
|
|
set_mii16_bits(sc, (MII16_SSI_DTR | MII16_SSI_RTS | MII16_SSI_DCD));
|
|
else
|
|
clr_mii16_bits(sc, (MII16_SSI_DTR | MII16_SSI_RTS | MII16_SSI_DCD));
|
|
}
|
|
else
|
|
error = EINVAL;
|
|
|
|
return error;
|
|
}
|
|
|
|
/* begin T1E1 card code */
|
|
|
|
/* Must not sleep. */
|
|
static void
|
|
t1_config(softc_t *sc)
|
|
{
|
|
int i;
|
|
u_int8_t pulse, lbo, gain;
|
|
|
|
if (sc->status.card_type == 0)
|
|
{ /* defaults */
|
|
sc->status.card_type = TLP_CSID_T1E1;
|
|
sc->config.crc_len = CFG_CRC_16;
|
|
sc->config.loop_back = CFG_LOOP_NONE;
|
|
sc->config.tx_clk_src = CFG_CLKMUX_INT;
|
|
sc->config.format = CFG_FORMAT_T1ESF;
|
|
sc->config.cable_len = 10;
|
|
sc->config.time_slots = 0x01FFFFFE;
|
|
sc->config.tx_pulse = CFG_PULSE_AUTO;
|
|
sc->config.rx_gain = CFG_GAIN_AUTO;
|
|
sc->config.tx_lbo = CFG_LBO_AUTO;
|
|
|
|
/* Bt8370 occasionally powers up in a loopback mode. */
|
|
/* Data sheet says zero LOOP reg and do a s/w reset. */
|
|
write_framer(sc, Bt8370_LOOP, 0x00); /* no loopback */
|
|
write_framer(sc, Bt8370_CR0, 0x80); /* s/w reset */
|
|
for (i=0; i<10; i++) /* max delay 10 ms */
|
|
if (read_framer(sc, Bt8370_CR0) & 0x80) DELAY(1000);
|
|
}
|
|
|
|
/* Set CRC length. */
|
|
if (sc->config.crc_len == CFG_CRC_32)
|
|
set_mii16_bits(sc, MII16_T1_CRC32);
|
|
else
|
|
clr_mii16_bits(sc, MII16_T1_CRC32);
|
|
|
|
/* Invert HDLC payload data in SF/AMI mode. */
|
|
/* HDLC stuff bits satisfy T1 pulse density. */
|
|
if (FORMAT_T1SF)
|
|
set_mii16_bits(sc, MII16_T1_INVERT);
|
|
else
|
|
clr_mii16_bits(sc, MII16_T1_INVERT);
|
|
|
|
/* Set the transmitter output impedance. */
|
|
if (FORMAT_E1ANY) set_mii16_bits(sc, MII16_T1_Z);
|
|
|
|
/* 001:CR0 -- Control Register 0 - T1/E1 and frame format */
|
|
write_framer(sc, Bt8370_CR0, sc->config.format);
|
|
|
|
/* 002:JAT_CR -- Jitter Attenuator Control Register */
|
|
if (sc->config.tx_clk_src == CFG_CLKMUX_RT) /* loop timing */
|
|
write_framer(sc, Bt8370_JAT_CR, 0xA3); /* JAT in RX path */
|
|
else
|
|
{ /* 64-bit elastic store; free-running JCLK and CLADO */
|
|
write_framer(sc, Bt8370_JAT_CR, 0x4B); /* assert jcenter */
|
|
write_framer(sc, Bt8370_JAT_CR, 0x43); /* release jcenter */
|
|
}
|
|
|
|
/* 00C-013:IERn -- Interrupt Enable Registers */
|
|
for (i=Bt8370_IER7; i<=Bt8370_IER0; i++)
|
|
write_framer(sc, i, 0); /* no interrupts; polled */
|
|
|
|
/* 014:LOOP -- loopbacks */
|
|
if (sc->config.loop_back == CFG_LOOP_PAYLOAD)
|
|
write_framer(sc, Bt8370_LOOP, LOOP_PAYLOAD);
|
|
else if (sc->config.loop_back == CFG_LOOP_LINE)
|
|
write_framer(sc, Bt8370_LOOP, LOOP_LINE);
|
|
else if (sc->config.loop_back == CFG_LOOP_OTHER)
|
|
write_framer(sc, Bt8370_LOOP, LOOP_ANALOG);
|
|
else if (sc->config.loop_back == CFG_LOOP_INWARD)
|
|
write_framer(sc, Bt8370_LOOP, LOOP_FRAMER);
|
|
else if (sc->config.loop_back == CFG_LOOP_DUAL)
|
|
write_framer(sc, Bt8370_LOOP, LOOP_DUAL);
|
|
else
|
|
write_framer(sc, Bt8370_LOOP, 0x00); /* no loopback */
|
|
|
|
/* 015:DL3_TS -- Data Link 3 */
|
|
write_framer(sc, Bt8370_DL3_TS, 0x00); /* disabled */
|
|
|
|
/* 018:PIO -- Programmable I/O */
|
|
write_framer(sc, Bt8370_PIO, 0xFF); /* all pins are outputs */
|
|
|
|
/* 019:POE -- Programmable Output Enable */
|
|
write_framer(sc, Bt8370_POE, 0x00); /* all outputs are enabled */
|
|
|
|
/* 01A;CMUX -- Clock Input Mux */
|
|
if (sc->config.tx_clk_src == CFG_CLKMUX_EXT)
|
|
write_framer(sc, Bt8370_CMUX, 0x0C); /* external timing */
|
|
else
|
|
write_framer(sc, Bt8370_CMUX, 0x0F); /* internal timing */
|
|
|
|
/* 020:LIU_CR -- Line Interface Unit Config Register */
|
|
write_framer(sc, Bt8370_LIU_CR, 0xC1); /* reset LIU, squelch */
|
|
|
|
/* 022:RLIU_CR -- RX Line Interface Unit Config Reg */
|
|
/* Errata sheet says don't use freeze-short, but we do anyway! */
|
|
write_framer(sc, Bt8370_RLIU_CR, 0xB1); /* AGC=2048, Long Eye */
|
|
|
|
/* Select Rx sensitivity based on cable length. */
|
|
if ((gain = sc->config.rx_gain) == CFG_GAIN_AUTO)
|
|
{
|
|
if (sc->config.cable_len > 2000)
|
|
gain = CFG_GAIN_EXTEND;
|
|
else if (sc->config.cable_len > 1000)
|
|
gain = CFG_GAIN_LONG;
|
|
else if (sc->config.cable_len > 100)
|
|
gain = CFG_GAIN_MEDIUM;
|
|
else
|
|
gain = CFG_GAIN_SHORT;
|
|
}
|
|
|
|
/* 024:VGA_MAX -- Variable Gain Amplifier Max gain */
|
|
write_framer(sc, Bt8370_VGA_MAX, gain);
|
|
|
|
/* 028:PRE_EQ -- Pre Equalizer */
|
|
if (gain == CFG_GAIN_EXTEND)
|
|
write_framer(sc, Bt8370_PRE_EQ, 0xE6); /* ON; thresh 6 */
|
|
else
|
|
write_framer(sc, Bt8370_PRE_EQ, 0xA6); /* OFF; thresh 6 */
|
|
|
|
/* 038-03C:GAINn -- RX Equalizer gain thresholds */
|
|
write_framer(sc, Bt8370_GAIN0, 0x24);
|
|
write_framer(sc, Bt8370_GAIN1, 0x28);
|
|
write_framer(sc, Bt8370_GAIN2, 0x2C);
|
|
write_framer(sc, Bt8370_GAIN3, 0x30);
|
|
write_framer(sc, Bt8370_GAIN4, 0x34);
|
|
|
|
/* 040:RCR0 -- Receiver Control Register 0 */
|
|
if (FORMAT_T1ESF)
|
|
write_framer(sc, Bt8370_RCR0, 0x05); /* B8ZS, 2/5 FErrs */
|
|
else if (FORMAT_T1SF)
|
|
write_framer(sc, Bt8370_RCR0, 0x84); /* AMI, 2/5 FErrs */
|
|
else if (FORMAT_E1NONE)
|
|
write_framer(sc, Bt8370_RCR0, 0x41); /* HDB3, rabort */
|
|
else if (FORMAT_E1CRC)
|
|
write_framer(sc, Bt8370_RCR0, 0x09); /* HDB3, 3 FErrs or 915 CErrs */
|
|
else /* E1 no CRC */
|
|
write_framer(sc, Bt8370_RCR0, 0x19); /* HDB3, 3 FErrs */
|
|
|
|
/* 041:RPATT -- Receive Test Pattern configuration */
|
|
write_framer(sc, Bt8370_RPATT, 0x3E); /* looking for framed QRSS */
|
|
|
|
/* 042:RLB -- Receive Loop Back code detector config */
|
|
write_framer(sc, Bt8370_RLB, 0x09); /* 6 bits down; 5 bits up */
|
|
|
|
/* 043:LBA -- Loop Back Activate code */
|
|
write_framer(sc, Bt8370_LBA, 0x08); /* 10000 10000 10000 ... */
|
|
|
|
/* 044:LBD -- Loop Back Deactivate code */
|
|
write_framer(sc, Bt8370_LBD, 0x24); /* 100100 100100 100100 ... */
|
|
|
|
/* 045:RALM -- Receive Alarm signal configuration */
|
|
write_framer(sc, Bt8370_RALM, 0x0C); /* yel_intg rlof_intg */
|
|
|
|
/* 046:LATCH -- Alarm/Error/Counter Latch register */
|
|
write_framer(sc, Bt8370_LATCH, 0x1F); /* stop_cnt latch_{cnt,err,alm} */
|
|
|
|
/* Select Pulse Shape based on cable length (T1 only). */
|
|
if ((pulse = sc->config.tx_pulse) == CFG_PULSE_AUTO)
|
|
{
|
|
if (FORMAT_T1ANY)
|
|
{
|
|
if (sc->config.cable_len > 200)
|
|
pulse = CFG_PULSE_T1CSU;
|
|
else if (sc->config.cable_len > 160)
|
|
pulse = CFG_PULSE_T1DSX4;
|
|
else if (sc->config.cable_len > 120)
|
|
pulse = CFG_PULSE_T1DSX3;
|
|
else if (sc->config.cable_len > 80)
|
|
pulse = CFG_PULSE_T1DSX2;
|
|
else if (sc->config.cable_len > 40)
|
|
pulse = CFG_PULSE_T1DSX1;
|
|
else
|
|
pulse = CFG_PULSE_T1DSX0;
|
|
}
|
|
else
|
|
pulse = CFG_PULSE_E1TWIST;
|
|
}
|
|
|
|
/* Select Line Build Out based on cable length (T1CSU only). */
|
|
if ((lbo = sc->config.tx_lbo) == CFG_LBO_AUTO)
|
|
{
|
|
if (pulse == CFG_PULSE_T1CSU)
|
|
{
|
|
if (sc->config.cable_len > 1500)
|
|
lbo = CFG_LBO_0DB;
|
|
else if (sc->config.cable_len > 1000)
|
|
lbo = CFG_LBO_7DB;
|
|
else if (sc->config.cable_len > 500)
|
|
lbo = CFG_LBO_15DB;
|
|
else
|
|
lbo = CFG_LBO_22DB;
|
|
}
|
|
else
|
|
lbo = 0;
|
|
}
|
|
|
|
/* 068:TLIU_CR -- Transmit LIU Control Register */
|
|
write_framer(sc, Bt8370_TLIU_CR, (0x40 | (lbo & 0x30) | (pulse & 0x0E)));
|
|
|
|
/* 070:TCR0 -- Transmit Framer Configuration */
|
|
write_framer(sc, Bt8370_TCR0, sc->config.format>>1);
|
|
|
|
/* 071:TCR1 -- Transmitter Configuration */
|
|
if (FORMAT_T1SF)
|
|
write_framer(sc, Bt8370_TCR1, 0x43); /* tabort, AMI PDV enforced */
|
|
else
|
|
write_framer(sc, Bt8370_TCR1, 0x41); /* tabort, B8ZS or HDB3 */
|
|
|
|
/* 072:TFRM -- Transmit Frame format MYEL YEL MF FE CRC FBIT */
|
|
if (sc->config.format == CFG_FORMAT_T1ESF)
|
|
write_framer(sc, Bt8370_TFRM, 0x0B); /* - YEL MF - CRC FBIT */
|
|
else if (sc->config.format == CFG_FORMAT_T1SF)
|
|
write_framer(sc, Bt8370_TFRM, 0x19); /* - YEL MF - - FBIT */
|
|
else if (sc->config.format == CFG_FORMAT_E1FAS)
|
|
write_framer(sc, Bt8370_TFRM, 0x11); /* - YEL - - - FBIT */
|
|
else if (sc->config.format == CFG_FORMAT_E1FASCRC)
|
|
write_framer(sc, Bt8370_TFRM, 0x1F); /* - YEL MF FE CRC FBIT */
|
|
else if (sc->config.format == CFG_FORMAT_E1FASCAS)
|
|
write_framer(sc, Bt8370_TFRM, 0x31); /* MYEL YEL - - - FBIT */
|
|
else if (sc->config.format == CFG_FORMAT_E1FASCRCCAS)
|
|
write_framer(sc, Bt8370_TFRM, 0x3F); /* MYEL YEL MF FE CRC FBIT */
|
|
else if (sc->config.format == CFG_FORMAT_E1NONE)
|
|
write_framer(sc, Bt8370_TFRM, 0x00); /* NO FRAMING BITS AT ALL! */
|
|
|
|
/* 073:TERROR -- Transmit Error Insert */
|
|
write_framer(sc, Bt8370_TERROR, 0x00); /* no errors, please! */
|
|
|
|
/* 074:TMAN -- Transmit Manual Sa-byte/FEBE configuration */
|
|
write_framer(sc, Bt8370_TMAN, 0x00); /* none */
|
|
|
|
/* 075:TALM -- Transmit Alarm Signal Configuration */
|
|
if (FORMAT_E1ANY)
|
|
write_framer(sc, Bt8370_TALM, 0x38); /* auto_myel auto_yel auto_ais */
|
|
else if (FORMAT_T1ANY)
|
|
write_framer(sc, Bt8370_TALM, 0x18); /* auto_yel auto_ais */
|
|
|
|
/* 076:TPATT -- Transmit Test Pattern Configuration */
|
|
write_framer(sc, Bt8370_TPATT, 0x00); /* disabled */
|
|
|
|
/* 077:TLB -- Transmit Inband Loopback Code Configuration */
|
|
write_framer(sc, Bt8370_TLB, 0x00); /* disabled */
|
|
|
|
/* 090:CLAD_CR -- Clack Rate Adapter Configuration */
|
|
if (FORMAT_T1ANY)
|
|
write_framer(sc, Bt8370_CLAD_CR, 0x06); /* loop filter gain 1/2^6 */
|
|
else
|
|
write_framer(sc, Bt8370_CLAD_CR, 0x08); /* loop filter gain 1/2^8 */
|
|
|
|
/* 091:CSEL -- CLAD frequency Select */
|
|
if (FORMAT_T1ANY)
|
|
write_framer(sc, Bt8370_CSEL, 0x55); /* 1544 kHz */
|
|
else
|
|
write_framer(sc, Bt8370_CSEL, 0x11); /* 2048 kHz */
|
|
|
|
/* 092:CPHASE -- CLAD Phase detector */
|
|
if (FORMAT_T1ANY)
|
|
write_framer(sc, Bt8370_CPHASE, 0x22); /* phase compare @ 386 kHz */
|
|
else
|
|
write_framer(sc, Bt8370_CPHASE, 0x00); /* phase compare @ 2048 kHz */
|
|
|
|
if (FORMAT_T1ESF) /* BOP & PRM are enabled in T1ESF mode only. */
|
|
{
|
|
/* 0A0:BOP -- Bit Oriented Protocol messages */
|
|
write_framer(sc, Bt8370_BOP, RBOP_25 | TBOP_OFF);
|
|
/* 0A4:DL1_TS -- Data Link 1 Time Slot Enable */
|
|
write_framer(sc, Bt8370_DL1_TS, 0x40); /* FDL bits in odd frames */
|
|
/* 0A6:DL1_CTL -- Data Link 1 Control */
|
|
write_framer(sc, Bt8370_DL1_CTL, 0x03); /* FCS mode, TX on, RX on */
|
|
/* 0A7:RDL1_FFC -- Rx Data Link 1 Fifo Fill Control */
|
|
write_framer(sc, Bt8370_RDL1_FFC, 0x30); /* assert "near full" at 48 */
|
|
/* 0AA:PRM -- Performance Report Messages */
|
|
write_framer(sc, Bt8370_PRM, 0x80);
|
|
}
|
|
|
|
/* 0D0:SBI_CR -- System Bus Interface Configuration Register */
|
|
if (FORMAT_T1ANY)
|
|
write_framer(sc, Bt8370_SBI_CR, 0x47); /* 1.544 with 24 TS +Fbits */
|
|
else
|
|
write_framer(sc, Bt8370_SBI_CR, 0x46); /* 2.048 with 32 TS */
|
|
|
|
/* 0D1:RSB_CR -- Receive System Bus Configuration Register */
|
|
/* Change RINDO & RFSYNC on falling edge of RSBCLKI. */
|
|
write_framer(sc, Bt8370_RSB_CR, 0x70);
|
|
|
|
/* 0D2,0D3:RSYNC_{TS,BIT} -- Receive frame Sync offset */
|
|
write_framer(sc, Bt8370_RSYNC_BIT, 0x00);
|
|
write_framer(sc, Bt8370_RSYNC_TS, 0x00);
|
|
|
|
/* 0D4:TSB_CR -- Transmit System Bus Configuration Register */
|
|
/* Change TINDO & TFSYNC on falling edge of TSBCLKI. */
|
|
write_framer(sc, Bt8370_TSB_CR, 0x30);
|
|
|
|
/* 0D5,0D6:TSYNC_{TS,BIT} -- Transmit frame Sync offset */
|
|
write_framer(sc, Bt8370_TSYNC_BIT, 0x00);
|
|
write_framer(sc, Bt8370_TSYNC_TS, 0x00);
|
|
|
|
/* 0D7:RSIG_CR -- Receive SIGnalling Configuratin Register */
|
|
write_framer(sc, Bt8370_RSIG_CR, 0x00);
|
|
|
|
/* Assign and configure 64Kb TIME SLOTS. */
|
|
/* TS24..TS1 must be assigned for T1, TS31..TS0 for E1. */
|
|
/* Timeslots with no user data have RINDO and TINDO off. */
|
|
for (i=0; i<32; i++)
|
|
{
|
|
/* 0E0-0FF:SBCn -- System Bus Per-Channel Control */
|
|
if (FORMAT_T1ANY && (i==0 || i>24))
|
|
write_framer(sc, Bt8370_SBCn +i, 0x00); /* not assigned in T1 mode */
|
|
else if (FORMAT_E1ANY && (i==0) && !FORMAT_E1NONE)
|
|
write_framer(sc, Bt8370_SBCn +i, 0x01); /* assigned, TS0 o/h bits */
|
|
else if (FORMAT_E1CAS && (i==16) && !FORMAT_E1NONE)
|
|
write_framer(sc, Bt8370_SBCn +i, 0x01); /* assigned, TS16 o/h bits */
|
|
else if ((sc->config.time_slots & (1<<i)) != 0)
|
|
write_framer(sc, Bt8370_SBCn +i, 0x0D); /* assigned, RINDO, TINDO */
|
|
else
|
|
write_framer(sc, Bt8370_SBCn +i, 0x01); /* assigned, idle */
|
|
|
|
/* 100-11F:TPCn -- Transmit Per-Channel Control */
|
|
if (FORMAT_E1CAS && (i==0))
|
|
write_framer(sc, Bt8370_TPCn +i, 0x30); /* tidle, sig=0000 (MAS) */
|
|
else if (FORMAT_E1CAS && (i==16))
|
|
write_framer(sc, Bt8370_TPCn +i, 0x3B); /* tidle, sig=1011 (XYXX) */
|
|
else if ((sc->config.time_slots & (1<<i)) == 0)
|
|
write_framer(sc, Bt8370_TPCn +i, 0x20); /* tidle: use TSLIP_LOn */
|
|
else
|
|
write_framer(sc, Bt8370_TPCn +i, 0x00); /* nothing special */
|
|
|
|
/* 140-15F:TSLIP_LOn -- Transmit PCM Slip Buffer */
|
|
write_framer(sc, Bt8370_TSLIP_LOn +i, 0x7F); /* idle chan data */
|
|
/* 180-19F:RPCn -- Receive Per-Channel Control */
|
|
write_framer(sc, Bt8370_RPCn +i, 0x00); /* nothing special */
|
|
}
|
|
|
|
/* Enable transmitter output drivers. */
|
|
set_mii16_bits(sc, MII16_T1_XOE);
|
|
}
|
|
|
|
static void
|
|
t1_ident(softc_t *sc)
|
|
{
|
|
printf(", Bt837%x rev %x",
|
|
read_framer(sc, Bt8370_DID)>>4,
|
|
read_framer(sc, Bt8370_DID)&0x0F);
|
|
}
|
|
|
|
/* Called once a second; must not sleep. */
|
|
static int
|
|
t1_watchdog(softc_t *sc)
|
|
{
|
|
u_int16_t LCV = 0, FERR = 0, CRC = 0, FEBE = 0;
|
|
u_int8_t alm1, alm3, loop, isr0;
|
|
int link_status = STATUS_UP;
|
|
int i;
|
|
|
|
/* Read the alarm registers */
|
|
alm1 = read_framer(sc, Bt8370_ALM1);
|
|
alm3 = read_framer(sc, Bt8370_ALM3);
|
|
loop = read_framer(sc, Bt8370_LOOP);
|
|
isr0 = read_framer(sc, Bt8370_ISR0);
|
|
|
|
/* Always ignore the SIGFRZ alarm bit, */
|
|
alm1 &= ~ALM1_SIGFRZ;
|
|
if (FORMAT_T1ANY) /* ignore RYEL in T1 modes */
|
|
alm1 &= ~ALM1_RYEL;
|
|
else if (FORMAT_E1NONE) /* ignore all alarms except LOS */
|
|
alm1 &= ALM1_RLOS;
|
|
|
|
/* Software is alive. */
|
|
led_inv(sc, MII16_T1_LED_GRN);
|
|
|
|
/* Receiving Alarm Indication Signal (AIS). */
|
|
if ((alm1 & ALM1_RAIS)!=0) /* receiving ais */
|
|
led_on(sc, MII16_T1_LED_BLU);
|
|
else if ((alm1 & ALM1_RLOS)!=0) /* sending ais */
|
|
led_inv(sc, MII16_T1_LED_BLU);
|
|
else
|
|
led_off(sc, MII16_T1_LED_BLU);
|
|
|
|
/* Receiving Remote Alarm Indication (RAI). */
|
|
if ((alm1 & (ALM1_RMYEL | ALM1_RYEL))!=0) /* receiving rai */
|
|
led_on(sc, MII16_T1_LED_YEL);
|
|
else if ((alm1 & ALM1_RLOF)!=0) /* sending rai */
|
|
led_inv(sc, MII16_T1_LED_YEL);
|
|
else
|
|
led_off(sc, MII16_T1_LED_YEL);
|
|
|
|
/* If any alarm bits are set then the link is 'down'. */
|
|
/* The bad bits are: rmyel ryel rais ralos rlos rlof. */
|
|
/* Some alarm bits have been masked by this point. */
|
|
if (alm1 != 0) link_status = STATUS_DOWN;
|
|
|
|
/* Declare local Red Alarm if the link is down. */
|
|
if (link_status == STATUS_DOWN)
|
|
led_on(sc, MII16_T1_LED_RED);
|
|
else if (sc->loop_timer != 0) /* loopback is active */
|
|
led_inv(sc, MII16_T1_LED_RED);
|
|
else
|
|
led_off(sc, MII16_T1_LED_RED);
|
|
|
|
/* Print latched error bits if they changed. */
|
|
if ((DRIVER_DEBUG) && (alm1 != sc->last_alm1))
|
|
{
|
|
char *on = "ON ", *off = "OFF";
|
|
printf("%s: RLOF=%s RLOS=%s RALOS=%s RAIS=%s RYEL=%s RMYEL=%s\n",
|
|
NAME_UNIT,
|
|
(alm1 & ALM1_RLOF) ? on : off,
|
|
(alm1 & ALM1_RLOS) ? on : off,
|
|
(alm1 & ALM1_RALOS) ? on : off,
|
|
(alm1 & ALM1_RAIS) ? on : off,
|
|
(alm1 & ALM1_RYEL) ? on : off,
|
|
(alm1 & ALM1_RMYEL) ? on : off);
|
|
}
|
|
|
|
/* Check and print error counters if non-zero. */
|
|
LCV = read_framer(sc, Bt8370_LCV_LO) +
|
|
(read_framer(sc, Bt8370_LCV_HI)<<8);
|
|
if (!FORMAT_E1NONE)
|
|
FERR = read_framer(sc, Bt8370_FERR_LO) +
|
|
(read_framer(sc, Bt8370_FERR_HI)<<8);
|
|
if (FORMAT_E1CRC || FORMAT_T1ESF)
|
|
CRC = read_framer(sc, Bt8370_CRC_LO) +
|
|
(read_framer(sc, Bt8370_CRC_HI)<<8);
|
|
if (FORMAT_E1CRC)
|
|
FEBE = read_framer(sc, Bt8370_FEBE_LO) +
|
|
(read_framer(sc, Bt8370_FEBE_HI)<<8);
|
|
/* Only LCV is valid if Out-Of-Frame */
|
|
if (FORMAT_E1NONE) FERR = CRC = FEBE = 0;
|
|
if ((DRIVER_DEBUG) && (LCV || FERR || CRC || FEBE))
|
|
printf("%s: LCV=%u FERR=%u CRC=%u FEBE=%u\n",
|
|
NAME_UNIT, LCV, FERR, CRC, FEBE);
|
|
|
|
/* Driver keeps crude link-level error counters (SNMP is better). */
|
|
sc->status.cntrs.lcv_errs += LCV;
|
|
sc->status.cntrs.frm_errs += FERR;
|
|
sc->status.cntrs.crc_errs += CRC;
|
|
sc->status.cntrs.febe_errs += FEBE;
|
|
|
|
/* Check for BOP messages in the ESF Facility Data Link. */
|
|
if ((FORMAT_T1ESF) && (read_framer(sc, Bt8370_ISR1) & 0x80))
|
|
{
|
|
u_int8_t bop_code = read_framer(sc, Bt8370_RBOP) & 0x3F;
|
|
|
|
switch (bop_code)
|
|
{
|
|
case T1BOP_OOF:
|
|
{
|
|
if ((DRIVER_DEBUG) && ((sc->last_alm1 & ALM1_RMYEL)==0))
|
|
printf("%s: Receiving a 'yellow alarm' BOP msg\n", NAME_UNIT);
|
|
break;
|
|
}
|
|
case T1BOP_LINE_UP:
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'line loopback activate' BOP msg\n", NAME_UNIT);
|
|
write_framer(sc, Bt8370_LOOP, LOOP_LINE);
|
|
sc->loop_timer = 305;
|
|
break;
|
|
}
|
|
case T1BOP_LINE_DOWN:
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'line loopback deactivate' BOP msg\n", NAME_UNIT);
|
|
write_framer(sc, Bt8370_LOOP,
|
|
read_framer(sc, Bt8370_LOOP) & ~LOOP_LINE);
|
|
sc->loop_timer = 0;
|
|
break;
|
|
}
|
|
case T1BOP_PAY_UP:
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'payload loopback activate' BOP msg\n", NAME_UNIT);
|
|
write_framer(sc, Bt8370_LOOP, LOOP_PAYLOAD);
|
|
sc->loop_timer = 305;
|
|
break;
|
|
}
|
|
case T1BOP_PAY_DOWN:
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'payload loopback deactivate' BOP msg\n", NAME_UNIT);
|
|
write_framer(sc, Bt8370_LOOP,
|
|
read_framer(sc, Bt8370_LOOP) & ~LOOP_PAYLOAD);
|
|
sc->loop_timer = 0;
|
|
break;
|
|
}
|
|
default:
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a type 0x%02X BOP msg\n", NAME_UNIT, bop_code);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Check for HDLC pkts in the ESF Facility Data Link. */
|
|
if ((FORMAT_T1ESF) && (read_framer(sc, Bt8370_ISR2) & 0x70))
|
|
{
|
|
/* while (not fifo-empty && not start-of-msg) flush fifo */
|
|
while ((read_framer(sc, Bt8370_RDL1_STAT) & 0x0C) == 0)
|
|
read_framer(sc, Bt8370_RDL1);
|
|
/* If (not fifo-empty), then begin processing fifo contents. */
|
|
if ((read_framer(sc, Bt8370_RDL1_STAT) & 0x0C) == 0x08)
|
|
{
|
|
u_int8_t msg[64];
|
|
u_int8_t stat = read_framer(sc, Bt8370_RDL1);
|
|
sc->status.cntrs.fdl_pkts++;
|
|
for (i=0; i<(stat & 0x3F); i++)
|
|
msg[i] = read_framer(sc, Bt8370_RDL1);
|
|
/* Is this FDL message a T1.403 performance report? */
|
|
if (((stat & 0x3F)==11) &&
|
|
((msg[0]==0x38) || (msg[0]==0x3A)) &&
|
|
(msg[1]==1) && (msg[2]==3))
|
|
/* Copy 4 PRs from FDL pkt to SNMP struct. */
|
|
memcpy(sc->status.snmp.t1.prm, msg+3, 8);
|
|
}
|
|
}
|
|
|
|
/* Check for inband loop up/down commands. */
|
|
if (FORMAT_T1ANY)
|
|
{
|
|
u_int8_t isr6 = read_framer(sc, Bt8370_ISR6);
|
|
u_int8_t alarm2 = read_framer(sc, Bt8370_ALM2);
|
|
u_int8_t tlb = read_framer(sc, Bt8370_TLB);
|
|
|
|
/* Inband Code == Loop Up && On Transition && Inband Tx Inactive */
|
|
if ((isr6 & 0x40) && (alarm2 & 0x40) && ((tlb & 1)==0))
|
|
{ /* CSU loop up is 10000 10000 ... */
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'CSU Loop Up' inband msg\n", NAME_UNIT);
|
|
write_framer(sc, Bt8370_LOOP, LOOP_LINE); /* Loop up */
|
|
sc->loop_timer = 305;
|
|
}
|
|
/* Inband Code == Loop Down && On Transition && Inband Tx Inactive */
|
|
if ((isr6 & 0x80) && (alarm2 & 0x80) && ((tlb & 1)==0))
|
|
{ /* CSU loop down is 100 100 100 ... */
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Received a 'CSU Loop Down' inband msg\n", NAME_UNIT);
|
|
write_framer(sc, Bt8370_LOOP,
|
|
read_framer(sc, Bt8370_LOOP) & ~LOOP_LINE); /* loop down */
|
|
sc->loop_timer = 0;
|
|
}
|
|
}
|
|
|
|
/* Manually send Yellow Alarm BOP msgs. */
|
|
if (FORMAT_T1ESF)
|
|
{
|
|
u_int8_t isr7 = read_framer(sc, Bt8370_ISR7);
|
|
|
|
if ((isr7 & 0x02) && (alm1 & 0x02)) /* RLOF on-transition */
|
|
{ /* Start sending continuous Yellow Alarm BOP messages. */
|
|
write_framer(sc, Bt8370_BOP, RBOP_25 | TBOP_CONT);
|
|
write_framer(sc, Bt8370_TBOP, 0x00); /* send BOP; order matters */
|
|
}
|
|
else if ((isr7 & 0x02) && ((alm1 & 0x02)==0)) /* RLOF off-transition */
|
|
{ /* Stop sending continuous Yellow Alarm BOP messages. */
|
|
write_framer(sc, Bt8370_BOP, RBOP_25 | TBOP_OFF);
|
|
}
|
|
}
|
|
|
|
/* Time out loopback requests. */
|
|
if (sc->loop_timer != 0)
|
|
if (--sc->loop_timer == 0)
|
|
if (loop != 0)
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: Timeout: Loop Down after 300 seconds\n", NAME_UNIT);
|
|
write_framer(sc, Bt8370_LOOP, loop & ~(LOOP_PAYLOAD | LOOP_LINE));
|
|
}
|
|
|
|
/* RX Test Pattern status */
|
|
if ((DRIVER_DEBUG) && (isr0 & 0x10))
|
|
printf("%s: RX Test Pattern Sync\n", NAME_UNIT);
|
|
|
|
/* SNMP Error Counters */
|
|
sc->status.snmp.t1.lcv = LCV;
|
|
sc->status.snmp.t1.fe = FERR;
|
|
sc->status.snmp.t1.crc = CRC;
|
|
sc->status.snmp.t1.febe = FEBE;
|
|
|
|
/* SNMP Line Status */
|
|
sc->status.snmp.t1.line = 0;
|
|
if (alm1 & ALM1_RMYEL) sc->status.snmp.t1.line |= TLINE_RX_RAI;
|
|
if (alm1 & ALM1_RYEL) sc->status.snmp.t1.line |= TLINE_RX_RAI;
|
|
if (alm1 & ALM1_RLOF) sc->status.snmp.t1.line |= TLINE_TX_RAI;
|
|
if (alm1 & ALM1_RAIS) sc->status.snmp.t1.line |= TLINE_RX_AIS;
|
|
if (alm1 & ALM1_RLOS) sc->status.snmp.t1.line |= TLINE_TX_AIS;
|
|
if (alm1 & ALM1_RLOF) sc->status.snmp.t1.line |= TLINE_LOF;
|
|
if (alm1 & ALM1_RLOS) sc->status.snmp.t1.line |= TLINE_LOS;
|
|
if (alm3 & ALM3_RMAIS) sc->status.snmp.t1.line |= T1LINE_RX_TS16_AIS;
|
|
if (alm3 & ALM3_SRED) sc->status.snmp.t1.line |= T1LINE_TX_TS16_LOMF;
|
|
if (alm3 & ALM3_SEF) sc->status.snmp.t1.line |= T1LINE_SEF;
|
|
if (isr0 & 0x10) sc->status.snmp.t1.line |= T1LINE_RX_TEST;
|
|
if ((alm1 & ALM1_RMYEL) && (FORMAT_E1CAS))
|
|
sc->status.snmp.t1.line |= T1LINE_RX_TS16_LOMF;
|
|
|
|
/* SNMP Loopback Status */
|
|
sc->status.snmp.t1.loop &= ~(TLOOP_FAR_LINE | TLOOP_FAR_PAYLOAD);
|
|
if (sc->config.loop_back == CFG_LOOP_TULIP)
|
|
sc->status.snmp.t1.loop |= TLOOP_NEAR_OTHER;
|
|
if (loop & LOOP_PAYLOAD) sc->status.snmp.t1.loop |= TLOOP_NEAR_PAYLOAD;
|
|
if (loop & LOOP_LINE) sc->status.snmp.t1.loop |= TLOOP_NEAR_LINE;
|
|
if (loop & LOOP_ANALOG) sc->status.snmp.t1.loop |= TLOOP_NEAR_OTHER;
|
|
if (loop & LOOP_FRAMER) sc->status.snmp.t1.loop |= TLOOP_NEAR_INWARD;
|
|
|
|
/* Remember this state until next time. */
|
|
sc->last_alm1 = alm1;
|
|
|
|
/* If an INWARD loopback is in effect, link status is UP */
|
|
if (sc->config.loop_back != CFG_LOOP_NONE) /* XXX INWARD ONLY */
|
|
link_status = STATUS_UP;
|
|
|
|
return link_status;
|
|
}
|
|
|
|
/* IOCTL SYSCALL: can sleep. */
|
|
static void
|
|
t1_send_bop(softc_t *sc, int bop_code)
|
|
{
|
|
u_int8_t bop;
|
|
int i;
|
|
|
|
/* The BOP transmitter could be sending a continuous */
|
|
/* BOP msg when told to send this BOP_25 message. */
|
|
/* So save and restore the state of the BOP machine. */
|
|
bop = read_framer(sc, Bt8370_BOP);
|
|
write_framer(sc, Bt8370_BOP, RBOP_OFF | TBOP_OFF);
|
|
for (i=0; i<40; i++) /* max delay 400 ms. */
|
|
if (read_framer(sc, Bt8370_BOP_STAT) & 0x80) SLEEP(10000);
|
|
/* send 25 repetitions of bop_code */
|
|
write_framer(sc, Bt8370_BOP, RBOP_OFF | TBOP_25);
|
|
write_framer(sc, Bt8370_TBOP, bop_code); /* order matters */
|
|
/* wait for tx to stop */
|
|
for (i=0; i<40; i++) /* max delay 400 ms. */
|
|
if (read_framer(sc, Bt8370_BOP_STAT) & 0x80) SLEEP(10000);
|
|
/* Restore previous state of the BOP machine. */
|
|
write_framer(sc, Bt8370_BOP, bop);
|
|
}
|
|
|
|
/* IOCTL SYSCALL: can sleep. */
|
|
static int
|
|
t1_ioctl(softc_t *sc, struct ioctl *ioctl)
|
|
{
|
|
int error = 0;
|
|
|
|
switch (ioctl->cmd)
|
|
{
|
|
case IOCTL_SNMP_SEND: /* set opstatus? */
|
|
{
|
|
switch (ioctl->data)
|
|
{
|
|
case TSEND_NORMAL:
|
|
{
|
|
write_framer(sc, Bt8370_TPATT, 0x00); /* tx pattern generator off */
|
|
write_framer(sc, Bt8370_RPATT, 0x00); /* rx pattern detector off */
|
|
write_framer(sc, Bt8370_TLB, 0x00); /* tx inband generator off */
|
|
break;
|
|
}
|
|
case TSEND_LINE:
|
|
{
|
|
if (FORMAT_T1ESF)
|
|
t1_send_bop(sc, T1BOP_LINE_UP);
|
|
else if (FORMAT_T1SF)
|
|
{
|
|
write_framer(sc, Bt8370_LBP, 0x08); /* 10000 10000 ... */
|
|
write_framer(sc, Bt8370_TLB, 0x05); /* 5 bits, framed, start */
|
|
}
|
|
sc->status.snmp.t1.loop |= TLOOP_FAR_LINE;
|
|
break;
|
|
}
|
|
case TSEND_PAYLOAD:
|
|
{
|
|
t1_send_bop(sc, T1BOP_PAY_UP);
|
|
sc->status.snmp.t1.loop |= TLOOP_FAR_PAYLOAD;
|
|
break;
|
|
}
|
|
case TSEND_RESET:
|
|
{
|
|
if (sc->status.snmp.t1.loop == TLOOP_FAR_LINE)
|
|
{
|
|
if (FORMAT_T1ESF)
|
|
t1_send_bop(sc, T1BOP_LINE_DOWN);
|
|
else if (FORMAT_T1SF)
|
|
{
|
|
write_framer(sc, Bt8370_LBP, 0x24); /* 100100 100100 ... */
|
|
write_framer(sc, Bt8370_TLB, 0x09); /* 6 bits, framed, start */
|
|
}
|
|
sc->status.snmp.t1.loop &= ~TLOOP_FAR_LINE;
|
|
}
|
|
if (sc->status.snmp.t1.loop == TLOOP_FAR_PAYLOAD)
|
|
{
|
|
t1_send_bop(sc, T1BOP_PAY_DOWN);
|
|
sc->status.snmp.t1.loop &= ~TLOOP_FAR_PAYLOAD;
|
|
}
|
|
break;
|
|
}
|
|
case TSEND_QRS:
|
|
{
|
|
write_framer(sc, Bt8370_TPATT, 0x1E); /* framed QRSS */
|
|
break;
|
|
}
|
|
default:
|
|
{
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
}
|
|
break;
|
|
}
|
|
case IOCTL_SNMP_LOOP: /* set opstatus = test? */
|
|
{
|
|
u_int8_t new_loop = 0;
|
|
|
|
if (ioctl->data == CFG_LOOP_NONE)
|
|
new_loop = 0;
|
|
else if (ioctl->data == CFG_LOOP_PAYLOAD)
|
|
new_loop = LOOP_PAYLOAD;
|
|
else if (ioctl->data == CFG_LOOP_LINE)
|
|
new_loop = LOOP_LINE;
|
|
else if (ioctl->data == CFG_LOOP_OTHER)
|
|
new_loop = LOOP_ANALOG;
|
|
else if (ioctl->data == CFG_LOOP_INWARD)
|
|
new_loop = LOOP_FRAMER;
|
|
else if (ioctl->data == CFG_LOOP_DUAL)
|
|
new_loop = LOOP_DUAL;
|
|
else
|
|
error = EINVAL;
|
|
if (error == 0)
|
|
{
|
|
write_framer(sc, Bt8370_LOOP, new_loop);
|
|
sc->config.loop_back = ioctl->data;
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
|
|
return error;
|
|
}
|
|
|
|
static
|
|
struct card hssi_card =
|
|
{
|
|
.config = hssi_config,
|
|
.ident = hssi_ident,
|
|
.watchdog = hssi_watchdog,
|
|
.ioctl = hssi_ioctl,
|
|
};
|
|
|
|
static
|
|
struct card t3_card =
|
|
{
|
|
.config = t3_config,
|
|
.ident = t3_ident,
|
|
.watchdog = t3_watchdog,
|
|
.ioctl = t3_ioctl,
|
|
};
|
|
|
|
static
|
|
struct card ssi_card =
|
|
{
|
|
.config = ssi_config,
|
|
.ident = ssi_ident,
|
|
.watchdog = ssi_watchdog,
|
|
.ioctl = ssi_ioctl,
|
|
};
|
|
|
|
static
|
|
struct card t1_card =
|
|
{
|
|
.config = t1_config,
|
|
.ident = t1_ident,
|
|
.watchdog = t1_watchdog,
|
|
.ioctl = t1_ioctl,
|
|
};
|
|
|
|
/* RAWIP is raw IP packets (v4 or v6) in HDLC frames with NO HEADERS. */
|
|
/* No HDLC Address/Control fields! No line control protocol at all! */
|
|
|
|
/* rxintr_cleanup calls this to give a newly arrived pkt to higher levels. */
|
|
static void
|
|
lmc_raw_input(struct ifnet *ifp, struct mbuf *mbuf)
|
|
{
|
|
softc_t *sc = IFP2SC(ifp);
|
|
|
|
M_SETFIB(mbuf, ifp->if_fib);
|
|
# if INET
|
|
if (mbuf->m_data[0]>>4 == 4)
|
|
netisr_dispatch(NETISR_IP, mbuf);
|
|
else
|
|
# endif
|
|
# if INET6
|
|
if (mbuf->m_data[0]>>4 == 6)
|
|
netisr_dispatch(NETISR_IPV6, mbuf);
|
|
else
|
|
# endif
|
|
{
|
|
m_freem(mbuf);
|
|
sc->status.cntrs.idiscards++;
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: lmc_raw_input: rx pkt discarded: not IPv4 or IPv6\n",
|
|
NAME_UNIT);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* We are "standing on the head of a pin" in these routines.
|
|
* Tulip CSRs can be accessed, but nothing else is interrupt-safe!
|
|
* Do NOT access: MII, GPIO, SROM, BIOSROM, XILINX, SYNTH, or DAC.
|
|
*/
|
|
|
|
|
|
/* Singly-linked tail-queues hold mbufs with active DMA.
|
|
* For RX, single mbuf clusters; for TX, mbuf chains are queued.
|
|
* NB: mbufs are linked through their m_nextpkt field.
|
|
* Callers must hold sc->bottom_lock; not otherwise locked.
|
|
*/
|
|
|
|
/* Put an mbuf (chain) on the tail of the descriptor ring queue. */
|
|
static void /* BSD version */
|
|
mbuf_enqueue(struct desc_ring *ring, struct mbuf *m)
|
|
{
|
|
m->m_nextpkt = NULL;
|
|
if (ring->tail == NULL)
|
|
ring->head = m;
|
|
else
|
|
ring->tail->m_nextpkt = m;
|
|
ring->tail = m;
|
|
}
|
|
|
|
/* Get an mbuf (chain) from the head of the descriptor ring queue. */
|
|
static struct mbuf* /* BSD version */
|
|
mbuf_dequeue(struct desc_ring *ring)
|
|
{
|
|
struct mbuf *m = ring->head;
|
|
if (m != NULL)
|
|
if ((ring->head = m->m_nextpkt) == NULL)
|
|
ring->tail = NULL;
|
|
return m;
|
|
}
|
|
|
|
static void /* *** FreeBSD ONLY *** Callout from bus_dmamap_load() */
|
|
fbsd_dmamap_load(void *arg, bus_dma_segment_t *segs, int nsegs, int error)
|
|
{
|
|
struct desc_ring *ring = arg;
|
|
ring->nsegs = error ? 0 : nsegs;
|
|
ring->segs[0] = segs[0];
|
|
ring->segs[1] = segs[1];
|
|
}
|
|
|
|
/* Initialize a DMA descriptor ring. */
|
|
static int /* BSD version */
|
|
create_ring(softc_t *sc, struct desc_ring *ring, int num_descs)
|
|
{
|
|
struct dma_desc *descs;
|
|
int size_descs = sizeof(struct dma_desc)*num_descs;
|
|
int i, error = 0;
|
|
|
|
/* The DMA descriptor array must not cross a page boundary. */
|
|
if (size_descs > PAGE_SIZE)
|
|
{
|
|
printf("%s: DMA descriptor array > PAGE_SIZE (%d)\n", NAME_UNIT,
|
|
(u_int)PAGE_SIZE);
|
|
return EINVAL;
|
|
}
|
|
|
|
|
|
/* Create a DMA tag for descriptors and buffers. */
|
|
if ((error = bus_dma_tag_create(bus_get_dma_tag(sc->dev),
|
|
4, 0, BUS_SPACE_MAXADDR_32BIT,
|
|
BUS_SPACE_MAXADDR, NULL, NULL, PAGE_SIZE, 2, PAGE_SIZE, BUS_DMA_ALLOCNOW,
|
|
NULL, NULL,
|
|
&ring->tag)))
|
|
{
|
|
printf("%s: bus_dma_tag_create() failed: error %d\n", NAME_UNIT, error);
|
|
return error;
|
|
}
|
|
|
|
/* Allocate wired physical memory for DMA descriptor array */
|
|
/* and map physical address to kernel virtual address. */
|
|
if ((error = bus_dmamem_alloc(ring->tag, (void**)&ring->first,
|
|
BUS_DMA_NOWAIT | BUS_DMA_COHERENT | BUS_DMA_ZERO, &ring->map)))
|
|
{
|
|
printf("%s: bus_dmamem_alloc() failed; error %d\n", NAME_UNIT, error);
|
|
return error;
|
|
}
|
|
descs = ring->first;
|
|
|
|
/* Map kernel virtual address to PCI address for DMA descriptor array. */
|
|
if ((error = bus_dmamap_load(ring->tag, ring->map, descs, size_descs,
|
|
fbsd_dmamap_load, ring, 0)))
|
|
{
|
|
printf("%s: bus_dmamap_load() failed; error %d\n", NAME_UNIT, error);
|
|
return error;
|
|
}
|
|
ring->dma_addr = ring->segs[0].ds_addr;
|
|
|
|
/* Allocate dmamaps for each DMA descriptor. */
|
|
for (i=0; i<num_descs; i++)
|
|
if ((error = bus_dmamap_create(ring->tag, 0, &descs[i].map)))
|
|
{
|
|
printf("%s: bus_dmamap_create() failed; error %d\n", NAME_UNIT, error);
|
|
return error;
|
|
}
|
|
|
|
|
|
ring->read = descs;
|
|
ring->write = descs;
|
|
ring->first = descs;
|
|
ring->last = descs + num_descs -1;
|
|
ring->last->control = TLP_DCTL_END_RING;
|
|
ring->num_descs = num_descs;
|
|
ring->size_descs = size_descs;
|
|
ring->head = NULL;
|
|
ring->tail = NULL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Destroy a DMA descriptor ring */
|
|
static void /* BSD version */
|
|
destroy_ring(softc_t *sc, struct desc_ring *ring)
|
|
{
|
|
struct dma_desc *desc;
|
|
struct mbuf *m;
|
|
|
|
/* Free queued mbufs. */
|
|
while ((m = mbuf_dequeue(ring)) != NULL)
|
|
m_freem(m);
|
|
|
|
/* TX may have one pkt that is not on any queue. */
|
|
if (sc->tx_mbuf != NULL)
|
|
{
|
|
m_freem(sc->tx_mbuf);
|
|
sc->tx_mbuf = NULL;
|
|
}
|
|
|
|
/* Unmap active DMA descriptors. */
|
|
while (ring->read != ring->write)
|
|
{
|
|
bus_dmamap_unload(ring->tag, ring->read->map);
|
|
if (ring->read++ == ring->last) ring->read = ring->first;
|
|
}
|
|
|
|
|
|
/* Free the dmamaps of all DMA descriptors. */
|
|
for (desc=ring->first; desc!=ring->last+1; desc++)
|
|
if (desc->map != NULL)
|
|
bus_dmamap_destroy(ring->tag, desc->map);
|
|
|
|
/* Unmap PCI address for DMA descriptor array. */
|
|
if (ring->dma_addr != 0)
|
|
bus_dmamap_unload(ring->tag, ring->map);
|
|
/* Free kernel memory for DMA descriptor array. */
|
|
if (ring->first != NULL)
|
|
bus_dmamem_free(ring->tag, ring->first, ring->map);
|
|
/* Free the DMA tag created for this ring. */
|
|
if (ring->tag != NULL)
|
|
bus_dma_tag_destroy(ring->tag);
|
|
|
|
}
|
|
|
|
/* Clean up after a packet has been received. */
|
|
static int /* BSD version */
|
|
rxintr_cleanup(softc_t *sc)
|
|
{
|
|
struct desc_ring *ring = &sc->rxring;
|
|
struct dma_desc *first_desc, *last_desc;
|
|
struct mbuf *first_mbuf=NULL, *last_mbuf=NULL;
|
|
struct mbuf *new_mbuf;
|
|
int pkt_len, desc_len;
|
|
|
|
#if defined(DEVICE_POLLING)
|
|
/* Input packet flow control (livelock prevention): */
|
|
/* Give pkts to higher levels only if quota is > 0. */
|
|
if (sc->quota <= 0) return 0;
|
|
#endif
|
|
|
|
/* This looks complicated, but remember: typically packets up */
|
|
/* to 2048 bytes long fit in one mbuf and use one descriptor. */
|
|
|
|
first_desc = last_desc = ring->read;
|
|
|
|
/* ASSERTION: If there is a descriptor in the ring and the hardware has */
|
|
/* finished with it, then that descriptor will have RX_FIRST_DESC set. */
|
|
if ((ring->read != ring->write) && /* descriptor ring not empty */
|
|
((ring->read->status & TLP_DSTS_OWNER) == 0) && /* hardware done */
|
|
((ring->read->status & TLP_DSTS_RX_FIRST_DESC) == 0)) /* should be set */
|
|
panic("%s: rxintr_cleanup: rx-first-descriptor not set.\n", NAME_UNIT);
|
|
|
|
/* First decide if a complete packet has arrived. */
|
|
/* Run down DMA descriptors looking for one marked "last". */
|
|
/* Bail out if an active descriptor is encountered. */
|
|
/* Accumulate most significant bits of packet length. */
|
|
pkt_len = 0;
|
|
for (;;)
|
|
{
|
|
if (last_desc == ring->write) return 0; /* no more descs */
|
|
if (last_desc->status & TLP_DSTS_OWNER) return 0; /* still active */
|
|
if (last_desc->status & TLP_DSTS_RX_LAST_DESC) break; /* end of packet */
|
|
pkt_len += last_desc->length1 + last_desc->length2; /* entire desc filled */
|
|
if (last_desc++->control & TLP_DCTL_END_RING) last_desc = ring->first; /* ring wrap */
|
|
}
|
|
|
|
/* A complete packet has arrived; how long is it? */
|
|
/* H/w ref man shows RX pkt length as a 14-bit field. */
|
|
/* An experiment found that only the 12 LSBs work. */
|
|
if (((last_desc->status>>16)&0xFFF) == 0) pkt_len += 4096; /* carry-bit */
|
|
pkt_len = (pkt_len & 0xF000) + ((last_desc->status>>16) & 0x0FFF);
|
|
/* Subtract the CRC length unless doing so would underflow. */
|
|
if (pkt_len >= sc->config.crc_len) pkt_len -= sc->config.crc_len;
|
|
|
|
/* Run down DMA descriptors again doing the following:
|
|
* 1) put pkt info in pkthdr of first mbuf,
|
|
* 2) link mbufs,
|
|
* 3) set mbuf lengths.
|
|
*/
|
|
first_desc = ring->read;
|
|
do
|
|
{
|
|
/* Read a DMA descriptor from the ring. */
|
|
last_desc = ring->read;
|
|
/* Advance the ring read pointer. */
|
|
if (ring->read++ == ring->last) ring->read = ring->first;
|
|
|
|
/* Dequeue the corresponding cluster mbuf. */
|
|
new_mbuf = mbuf_dequeue(ring);
|
|
if (new_mbuf == NULL)
|
|
panic("%s: rxintr_cleanup: expected an mbuf\n", NAME_UNIT);
|
|
|
|
desc_len = last_desc->length1 + last_desc->length2;
|
|
/* If bouncing, copy bounce buf to mbuf. */
|
|
DMA_SYNC(last_desc->map, desc_len, BUS_DMASYNC_POSTREAD);
|
|
/* Unmap kernel virtual address to PCI address. */
|
|
bus_dmamap_unload(ring->tag, last_desc->map);
|
|
|
|
/* 1) Put pkt info in pkthdr of first mbuf. */
|
|
if (last_desc == first_desc)
|
|
{
|
|
first_mbuf = new_mbuf;
|
|
first_mbuf->m_pkthdr.len = pkt_len; /* total pkt length */
|
|
first_mbuf->m_pkthdr.rcvif = sc->ifp; /* how it got here */
|
|
}
|
|
else /* 2) link mbufs. */
|
|
{
|
|
last_mbuf->m_next = new_mbuf;
|
|
/* M_PKTHDR should be set in the first mbuf only. */
|
|
new_mbuf->m_flags &= ~M_PKTHDR;
|
|
}
|
|
last_mbuf = new_mbuf;
|
|
|
|
/* 3) Set mbuf lengths. */
|
|
new_mbuf->m_len = (pkt_len >= desc_len) ? desc_len : pkt_len;
|
|
pkt_len -= new_mbuf->m_len;
|
|
} while ((last_desc->status & TLP_DSTS_RX_LAST_DESC) == 0);
|
|
|
|
/* Decide whether to accept or to discard this packet. */
|
|
/* RxHDLC sets MIIERR for bad CRC, abort and partial byte at pkt end. */
|
|
if (((last_desc->status & TLP_DSTS_RX_BAD) == 0) &&
|
|
(sc->status.oper_status == STATUS_UP) &&
|
|
(first_mbuf->m_pkthdr.len > 0))
|
|
{
|
|
/* Optimization: copy a small pkt into a small mbuf. */
|
|
if (first_mbuf->m_pkthdr.len <= COPY_BREAK)
|
|
{
|
|
MGETHDR(new_mbuf, M_NOWAIT, MT_DATA);
|
|
if (new_mbuf != NULL)
|
|
{
|
|
new_mbuf->m_pkthdr.rcvif = first_mbuf->m_pkthdr.rcvif;
|
|
new_mbuf->m_pkthdr.len = first_mbuf->m_pkthdr.len;
|
|
new_mbuf->m_len = first_mbuf->m_len;
|
|
memcpy(new_mbuf->m_data, first_mbuf->m_data,
|
|
first_mbuf->m_pkthdr.len);
|
|
m_freem(first_mbuf);
|
|
first_mbuf = new_mbuf;
|
|
}
|
|
}
|
|
/* Include CRC and one flag byte in input byte count. */
|
|
sc->status.cntrs.ibytes += first_mbuf->m_pkthdr.len + sc->config.crc_len +1;
|
|
sc->status.cntrs.ipackets++;
|
|
if_inc_counter(sc->ifp, IFCOUNTER_IPACKETS, 1);
|
|
LMC_BPF_MTAP(first_mbuf);
|
|
#if defined(DEVICE_POLLING)
|
|
sc->quota--;
|
|
#endif
|
|
|
|
/* Give this good packet to the network stacks. */
|
|
#if NETGRAPH
|
|
if (sc->ng_hook != NULL) /* is hook connected? */
|
|
{
|
|
int error; /* ignore error */
|
|
NG_SEND_DATA_ONLY(error, sc->ng_hook, first_mbuf);
|
|
return 1; /* did something */
|
|
}
|
|
#endif /* NETGRAPH */
|
|
if (sc->config.line_pkg == PKG_RAWIP)
|
|
lmc_raw_input(sc->ifp, first_mbuf);
|
|
else
|
|
{
|
|
#if NSPPP
|
|
sppp_input(sc->ifp, first_mbuf);
|
|
#elif P2P
|
|
new_mbuf = first_mbuf;
|
|
while (new_mbuf != NULL)
|
|
{
|
|
sc->p2p->p2p_hdrinput(sc->p2p, new_mbuf->m_data, new_mbuf->m_len);
|
|
new_mbuf = new_mbuf->m_next;
|
|
}
|
|
sc->p2p->p2p_input(sc->p2p, NULL);
|
|
m_freem(first_mbuf);
|
|
#else
|
|
m_freem(first_mbuf);
|
|
sc->status.cntrs.idiscards++;
|
|
#endif
|
|
}
|
|
}
|
|
else if (sc->status.oper_status != STATUS_UP)
|
|
{
|
|
/* If the link is down, this packet is probably noise. */
|
|
m_freem(first_mbuf);
|
|
sc->status.cntrs.idiscards++;
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: rxintr_cleanup: rx pkt discarded: link down\n", NAME_UNIT);
|
|
}
|
|
else /* Log and discard this bad packet. */
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: RX bad pkt; len=%d %s%s%s%s\n",
|
|
NAME_UNIT, first_mbuf->m_pkthdr.len,
|
|
(last_desc->status & TLP_DSTS_RX_MII_ERR) ? " miierr" : "",
|
|
(last_desc->status & TLP_DSTS_RX_DRIBBLE) ? " dribble" : "",
|
|
(last_desc->status & TLP_DSTS_RX_DESC_ERR) ? " descerr" : "",
|
|
(last_desc->status & TLP_DSTS_RX_OVERRUN) ? " overrun" : "");
|
|
if (last_desc->status & TLP_DSTS_RX_OVERRUN)
|
|
sc->status.cntrs.fifo_over++;
|
|
else
|
|
sc->status.cntrs.ierrors++;
|
|
m_freem(first_mbuf);
|
|
}
|
|
|
|
return 1; /* did something */
|
|
}
|
|
|
|
/* Setup (prepare) to receive a packet. */
|
|
/* Try to keep the RX descriptor ring full of empty buffers. */
|
|
static int /* BSD version */
|
|
rxintr_setup(softc_t *sc)
|
|
{
|
|
struct desc_ring *ring = &sc->rxring;
|
|
struct dma_desc *desc;
|
|
struct mbuf *m;
|
|
int desc_len;
|
|
int error;
|
|
|
|
/* Ring is full if (wrap(write+1)==read) */
|
|
if (((ring->write == ring->last) ? ring->first : ring->write+1) == ring->read)
|
|
return 0; /* ring is full; nothing to do */
|
|
|
|
/* Allocate a small mbuf and attach an mbuf cluster. */
|
|
MGETHDR(m, M_NOWAIT, MT_DATA);
|
|
if (m == NULL)
|
|
{
|
|
sc->status.cntrs.rxdma++;
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: rxintr_setup: MGETHDR() failed\n", NAME_UNIT);
|
|
return 0;
|
|
}
|
|
if (!(MCLGET(m, M_NOWAIT)))
|
|
{
|
|
m_freem(m);
|
|
sc->status.cntrs.rxdma++;
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: rxintr_setup: MCLGET() failed\n", NAME_UNIT);
|
|
return 0;
|
|
}
|
|
|
|
/* Queue the mbuf for later processing by rxintr_cleanup. */
|
|
mbuf_enqueue(ring, m);
|
|
|
|
/* Write a DMA descriptor into the ring. */
|
|
/* Hardware won't see it until the OWNER bit is set. */
|
|
desc = ring->write;
|
|
/* Advance the ring write pointer. */
|
|
if (ring->write++ == ring->last) ring->write = ring->first;
|
|
|
|
desc_len = (MCLBYTES < MAX_DESC_LEN) ? MCLBYTES : MAX_DESC_LEN;
|
|
/* Map kernel virtual address to PCI address. */
|
|
if ((error = DMA_LOAD(desc->map, m->m_data, desc_len)))
|
|
printf("%s: bus_dmamap_load(rx) failed; error %d\n", NAME_UNIT, error);
|
|
/* Invalidate the cache for this mbuf. */
|
|
DMA_SYNC(desc->map, desc_len, BUS_DMASYNC_PREREAD);
|
|
|
|
/* Set up the DMA descriptor. */
|
|
desc->address1 = ring->segs[0].ds_addr;
|
|
desc->length1 = desc_len>>1;
|
|
desc->address2 = desc->address1 + desc->length1;
|
|
desc->length2 = desc_len>>1;
|
|
|
|
/* Before setting the OWNER bit, flush the cache (memory barrier). */
|
|
DMA_SYNC(ring->map, ring->size_descs, BUS_DMASYNC_PREWRITE);
|
|
|
|
/* Commit the DMA descriptor to the hardware. */
|
|
desc->status = TLP_DSTS_OWNER;
|
|
|
|
/* Notify the receiver that there is another buffer available. */
|
|
WRITE_CSR(TLP_RX_POLL, 1);
|
|
|
|
return 1; /* did something */
|
|
}
|
|
|
|
/* Clean up after a packet has been transmitted. */
|
|
/* Free the mbuf chain and update the DMA descriptor ring. */
|
|
static int /* BSD version */
|
|
txintr_cleanup(softc_t *sc)
|
|
{
|
|
struct desc_ring *ring = &sc->txring;
|
|
struct dma_desc *desc;
|
|
|
|
while ((ring->read != ring->write) && /* while ring is not empty */
|
|
((ring->read->status & TLP_DSTS_OWNER) == 0))
|
|
{
|
|
/* Read a DMA descriptor from the ring. */
|
|
desc = ring->read;
|
|
/* Advance the ring read pointer. */
|
|
if (ring->read++ == ring->last) ring->read = ring->first;
|
|
|
|
/* This is a no-op on most architectures. */
|
|
DMA_SYNC(desc->map, desc->length1 + desc->length2, BUS_DMASYNC_POSTWRITE);
|
|
/* Unmap kernel virtual address to PCI address. */
|
|
bus_dmamap_unload(ring->tag, desc->map);
|
|
|
|
/* If this descriptor is the last segment of a packet, */
|
|
/* then dequeue and free the corresponding mbuf chain. */
|
|
if ((desc->control & TLP_DCTL_TX_LAST_SEG) != 0)
|
|
{
|
|
struct mbuf *m;
|
|
if ((m = mbuf_dequeue(ring)) == NULL)
|
|
panic("%s: txintr_cleanup: expected an mbuf\n", NAME_UNIT);
|
|
|
|
/* Include CRC and one flag byte in output byte count. */
|
|
sc->status.cntrs.obytes += m->m_pkthdr.len + sc->config.crc_len +1;
|
|
sc->status.cntrs.opackets++;
|
|
if_inc_counter(sc->ifp, IFCOUNTER_OPACKETS, 1);
|
|
LMC_BPF_MTAP(m);
|
|
/* The only bad TX status is fifo underrun. */
|
|
if ((desc->status & TLP_DSTS_TX_UNDERRUN) != 0)
|
|
sc->status.cntrs.fifo_under++;
|
|
|
|
m_freem(m);
|
|
return 1; /* did something */
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Build DMA descriptors for a transmit packet mbuf chain. */
|
|
static int /* 0=success; 1=error */ /* BSD version */
|
|
txintr_setup_mbuf(softc_t *sc, struct mbuf *m)
|
|
{
|
|
struct desc_ring *ring = &sc->txring;
|
|
struct dma_desc *desc;
|
|
unsigned int desc_len;
|
|
|
|
/* build DMA descriptors for a chain of mbufs. */
|
|
while (m != NULL)
|
|
{
|
|
char *data = m->m_data;
|
|
int length = m->m_len; /* zero length mbufs happen! */
|
|
|
|
/* Build DMA descriptors for one mbuf. */
|
|
while (length > 0)
|
|
{
|
|
int error;
|
|
|
|
/* Ring is full if (wrap(write+1)==read) */
|
|
if (((ring->temp==ring->last) ? ring->first : ring->temp+1) == ring->read)
|
|
{ /* Not enough DMA descriptors; try later. */
|
|
for (; ring->temp!=ring->write;
|
|
ring->temp = (ring->temp==ring->first)? ring->last : ring->temp-1)
|
|
bus_dmamap_unload(ring->tag, ring->temp->map);
|
|
sc->status.cntrs.txdma++;
|
|
return 1;
|
|
}
|
|
|
|
/* Provisionally, write a descriptor into the ring. */
|
|
/* But don't change the REAL ring write pointer. */
|
|
/* Hardware won't see it until the OWNER bit is set. */
|
|
desc = ring->temp;
|
|
/* Advance the temporary ring write pointer. */
|
|
if (ring->temp++ == ring->last) ring->temp = ring->first;
|
|
|
|
/* Clear all control bits except the END_RING bit. */
|
|
desc->control &= TLP_DCTL_END_RING;
|
|
/* Don't pad short packets up to 64 bytes. */
|
|
desc->control |= TLP_DCTL_TX_NO_PAD;
|
|
/* Use Tulip's CRC-32 generator, if appropriate. */
|
|
if (sc->config.crc_len != CFG_CRC_32)
|
|
desc->control |= TLP_DCTL_TX_NO_CRC;
|
|
/* Set the OWNER bit, except in the first descriptor. */
|
|
if (desc != ring->write)
|
|
desc->status = TLP_DSTS_OWNER;
|
|
|
|
desc_len = (length > MAX_CHUNK_LEN) ? MAX_CHUNK_LEN : length;
|
|
/* Map kernel virtual address to PCI address. */
|
|
if ((error = DMA_LOAD(desc->map, data, desc_len)))
|
|
printf("%s: bus_dmamap_load(tx) failed; error %d\n", NAME_UNIT, error);
|
|
/* Flush the cache and if bouncing, copy mbuf to bounce buf. */
|
|
DMA_SYNC(desc->map, desc_len, BUS_DMASYNC_PREWRITE);
|
|
|
|
/* Prevent wild fetches if mapping fails (nsegs==0). */
|
|
desc->length1 = desc->length2 = 0;
|
|
desc->address1 = desc->address2 = 0;
|
|
{
|
|
bus_dma_segment_t *segs = ring->segs;
|
|
int nsegs = ring->nsegs;
|
|
if (nsegs >= 1)
|
|
{
|
|
desc->address1 = segs[0].ds_addr;
|
|
desc->length1 = segs[0].ds_len;
|
|
}
|
|
if (nsegs == 2)
|
|
{
|
|
desc->address2 = segs[1].ds_addr;
|
|
desc->length2 = segs[1].ds_len;
|
|
}
|
|
}
|
|
|
|
data += desc_len;
|
|
length -= desc_len;
|
|
} /* while (length > 0) */
|
|
|
|
m = m->m_next;
|
|
} /* while (m != NULL) */
|
|
|
|
return 0; /* success */
|
|
}
|
|
|
|
/* Setup (prepare) to transmit a packet. */
|
|
/* Select a packet, build DMA descriptors and give packet to hardware. */
|
|
/* If DMA descriptors run out, abandon the attempt and return 0. */
|
|
static int /* BSD version */
|
|
txintr_setup(softc_t *sc)
|
|
{
|
|
struct desc_ring *ring = &sc->txring;
|
|
struct dma_desc *first_desc, *last_desc;
|
|
|
|
/* Protect against half-up links: Don't transmit */
|
|
/* if the receiver can't hear the far end. */
|
|
if (sc->status.oper_status != STATUS_UP) return 0;
|
|
|
|
/* Pick a packet to transmit. */
|
|
#if NETGRAPH
|
|
if ((sc->ng_hook != NULL) && (sc->tx_mbuf == NULL))
|
|
{
|
|
if (!IFQ_IS_EMPTY(&sc->ng_fastq))
|
|
IFQ_DEQUEUE(&sc->ng_fastq, sc->tx_mbuf);
|
|
else
|
|
IFQ_DEQUEUE(&sc->ng_sndq, sc->tx_mbuf);
|
|
}
|
|
else
|
|
#endif
|
|
if (sc->tx_mbuf == NULL)
|
|
{
|
|
if (sc->config.line_pkg == PKG_RAWIP)
|
|
IFQ_DEQUEUE(&sc->ifp->if_snd, sc->tx_mbuf);
|
|
else
|
|
{
|
|
#if NSPPP
|
|
sc->tx_mbuf = sppp_dequeue(sc->ifp);
|
|
#elif P2P
|
|
if (!IFQ_IS_EMPTY(&sc->p2p->p2p_isnd))
|
|
IFQ_DEQUEUE(&sc->p2p->p2p_isnd, sc->tx_mbuf);
|
|
else
|
|
IFQ_DEQUEUE(&sc->ifp->if_snd, sc->tx_mbuf);
|
|
#endif
|
|
}
|
|
}
|
|
if (sc->tx_mbuf == NULL) return 0; /* no pkt to transmit */
|
|
|
|
/* Build DMA descriptors for an outgoing mbuf chain. */
|
|
ring->temp = ring->write; /* temporary ring write pointer */
|
|
if (txintr_setup_mbuf(sc, sc->tx_mbuf) != 0) return 0;
|
|
|
|
/* Enqueue the mbuf; txintr_cleanup will free it. */
|
|
mbuf_enqueue(ring, sc->tx_mbuf);
|
|
|
|
/* The transmitter has room for another packet. */
|
|
sc->tx_mbuf = NULL;
|
|
|
|
/* Set first & last segment bits. */
|
|
/* last_desc is the desc BEFORE the one pointed to by ring->temp. */
|
|
first_desc = ring->write;
|
|
first_desc->control |= TLP_DCTL_TX_FIRST_SEG;
|
|
last_desc = (ring->temp==ring->first)? ring->last : ring->temp-1;
|
|
last_desc->control |= TLP_DCTL_TX_LAST_SEG;
|
|
/* Interrupt at end-of-transmission? Why bother the poor computer! */
|
|
/* last_desc->control |= TLP_DCTL_TX_INTERRUPT; */
|
|
|
|
/* Make sure the OWNER bit is not set in the next descriptor. */
|
|
/* The OWNER bit may have been set if a previous call aborted. */
|
|
ring->temp->status = 0;
|
|
|
|
/* Commit the DMA descriptors to the software. */
|
|
ring->write = ring->temp;
|
|
|
|
/* Before setting the OWNER bit, flush the cache (memory barrier). */
|
|
DMA_SYNC(ring->map, ring->size_descs, BUS_DMASYNC_PREWRITE);
|
|
|
|
/* Commit the DMA descriptors to the hardware. */
|
|
first_desc->status = TLP_DSTS_OWNER;
|
|
|
|
/* Notify the transmitter that there is another packet to send. */
|
|
WRITE_CSR(TLP_TX_POLL, 1);
|
|
|
|
return 1; /* did something */
|
|
}
|
|
|
|
|
|
|
|
static void
|
|
check_intr_status(softc_t *sc)
|
|
{
|
|
u_int32_t status, cfcs, op_mode;
|
|
u_int32_t missed, overruns;
|
|
|
|
/* Check for four unusual events:
|
|
* 1) fatal PCI bus errors - some are recoverable
|
|
* 2) transmitter FIFO underruns - increase fifo threshold
|
|
* 3) receiver FIFO overruns - clear potential hangup
|
|
* 4) no receive descs or bufs - count missed packets
|
|
*/
|
|
|
|
/* 1) A fatal bus error causes a Tulip to stop initiating bus cycles. */
|
|
/* Module unload/load or boot are the only fixes for Parity Errors. */
|
|
/* Master and Target Aborts can be cleared and life may continue. */
|
|
status = READ_CSR(TLP_STATUS);
|
|
if ((status & TLP_STAT_FATAL_ERROR) != 0)
|
|
{
|
|
u_int32_t fatal = (status & TLP_STAT_FATAL_BITS)>>TLP_STAT_FATAL_SHIFT;
|
|
printf("%s: FATAL PCI BUS ERROR: %s%s%s%s\n", NAME_UNIT,
|
|
(fatal == 0) ? "PARITY ERROR" : "",
|
|
(fatal == 1) ? "MASTER ABORT" : "",
|
|
(fatal == 2) ? "TARGET ABORT" : "",
|
|
(fatal >= 3) ? "RESERVED (?)" : "");
|
|
cfcs = READ_PCI_CFG(sc, TLP_CFCS); /* try to clear it */
|
|
cfcs &= ~(TLP_CFCS_MSTR_ABORT | TLP_CFCS_TARG_ABORT);
|
|
WRITE_PCI_CFG(sc, TLP_CFCS, cfcs);
|
|
}
|
|
|
|
/* 2) If the transmitter fifo underruns, increase the transmit fifo */
|
|
/* threshold: the number of bytes required to be in the fifo */
|
|
/* before starting the transmitter (cost: increased tx delay). */
|
|
/* The TX_FSM must be stopped to change this parameter. */
|
|
if ((status & TLP_STAT_TX_UNDERRUN) != 0)
|
|
{
|
|
op_mode = READ_CSR(TLP_OP_MODE);
|
|
/* enable store-and-forward mode if tx_threshold tops out? */
|
|
if ((op_mode & TLP_OP_TX_THRESH) < TLP_OP_TX_THRESH)
|
|
{
|
|
op_mode += 0x4000; /* increment TX_THRESH field; can't overflow */
|
|
WRITE_CSR(TLP_OP_MODE, op_mode & ~TLP_OP_TX_RUN);
|
|
/* Wait for the TX FSM to stop; it might be processing a pkt. */
|
|
while (READ_CSR(TLP_STATUS) & TLP_STAT_TX_FSM); /* XXX HANG */
|
|
WRITE_CSR(TLP_OP_MODE, op_mode); /* restart tx */
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: tx underrun; tx fifo threshold now %d bytes\n",
|
|
NAME_UNIT, 128<<((op_mode>>TLP_OP_TR_SHIFT)&3));
|
|
}
|
|
}
|
|
|
|
/* 3) Errata memo from Digital Equipment Corp warns that 21140A */
|
|
/* receivers through rev 2.2 can hang if the fifo overruns. */
|
|
/* Recommended fix: stop and start the RX FSM after an overrun. */
|
|
missed = READ_CSR(TLP_MISSED);
|
|
if ((overruns = ((missed & TLP_MISS_OVERRUN)>>TLP_OVERRUN_SHIFT)) != 0)
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: rx overrun cntr=%d\n", NAME_UNIT, overruns);
|
|
sc->status.cntrs.overruns += overruns;
|
|
if ((READ_PCI_CFG(sc, TLP_CFRV) & 0xFF) <= 0x22)
|
|
{
|
|
op_mode = READ_CSR(TLP_OP_MODE);
|
|
WRITE_CSR(TLP_OP_MODE, op_mode & ~TLP_OP_RX_RUN);
|
|
/* Wait for the RX FSM to stop; it might be processing a pkt. */
|
|
while (READ_CSR(TLP_STATUS) & TLP_STAT_RX_FSM); /* XXX HANG */
|
|
WRITE_CSR(TLP_OP_MODE, op_mode); /* restart rx */
|
|
}
|
|
}
|
|
|
|
/* 4) When the receiver is enabled and a packet arrives, but no DMA */
|
|
/* descriptor is available, the packet is counted as 'missed'. */
|
|
/* The receiver should never miss packets; warn if it happens. */
|
|
if ((missed = (missed & TLP_MISS_MISSED)) != 0)
|
|
{
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: rx missed %d pkts\n", NAME_UNIT, missed);
|
|
sc->status.cntrs.missed += missed;
|
|
}
|
|
}
|
|
|
|
static void /* This is where the work gets done. */
|
|
core_interrupt(void *arg, int check_status)
|
|
{
|
|
softc_t *sc = arg;
|
|
int activity;
|
|
|
|
/* If any CPU is inside this critical section, then */
|
|
/* other CPUs should go away without doing anything. */
|
|
if (BOTTOM_TRYLOCK == 0)
|
|
{
|
|
sc->status.cntrs.lck_intr++;
|
|
return;
|
|
}
|
|
|
|
/* Clear pending card interrupts. */
|
|
WRITE_CSR(TLP_STATUS, READ_CSR(TLP_STATUS));
|
|
|
|
/* In Linux, pci_alloc_consistent() means DMA descriptors */
|
|
/* don't need explicit syncing. */
|
|
{
|
|
struct desc_ring *ring = &sc->txring;
|
|
DMA_SYNC(sc->txring.map, sc->txring.size_descs,
|
|
BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
|
|
ring = &sc->rxring;
|
|
DMA_SYNC(sc->rxring.map, sc->rxring.size_descs,
|
|
BUS_DMASYNC_POSTREAD | BUS_DMASYNC_POSTWRITE);
|
|
}
|
|
|
|
do /* This is the main loop for interrupt processing. */
|
|
{
|
|
activity = txintr_cleanup(sc);
|
|
activity += txintr_setup(sc);
|
|
activity += rxintr_cleanup(sc);
|
|
activity += rxintr_setup(sc);
|
|
} while (activity);
|
|
|
|
{
|
|
struct desc_ring *ring = &sc->txring;
|
|
DMA_SYNC(sc->txring.map, sc->txring.size_descs,
|
|
BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
|
|
ring = &sc->rxring;
|
|
DMA_SYNC(sc->rxring.map, sc->rxring.size_descs,
|
|
BUS_DMASYNC_PREREAD | BUS_DMASYNC_PREWRITE);
|
|
}
|
|
|
|
/* As the interrupt is dismissed, check for four unusual events. */
|
|
if (check_status) check_intr_status(sc);
|
|
|
|
BOTTOM_UNLOCK;
|
|
}
|
|
|
|
/* user_interrupt() may be called from a syscall or a softirq */
|
|
static void
|
|
user_interrupt(softc_t *sc, int check_status)
|
|
{
|
|
DISABLE_INTR; /* noop on FreeBSD-5 and Linux */
|
|
core_interrupt(sc, check_status);
|
|
ENABLE_INTR; /* noop on FreeBSD-5 and Linux */
|
|
}
|
|
|
|
|
|
# if defined(DEVICE_POLLING)
|
|
|
|
/* Service the card from the kernel idle loop without interrupts. */
|
|
static int
|
|
fbsd_poll(struct ifnet *ifp, enum poll_cmd cmd, int count)
|
|
{
|
|
softc_t *sc = IFP2SC(ifp);
|
|
|
|
|
|
sc->quota = count;
|
|
core_interrupt(sc, (cmd==POLL_AND_CHECK_STATUS));
|
|
return 0;
|
|
}
|
|
|
|
# endif /* DEVICE_POLLING */
|
|
|
|
/* BSD kernels call this procedure when an interrupt happens. */
|
|
static intr_return_t
|
|
bsd_interrupt(void *arg)
|
|
{
|
|
softc_t *sc = arg;
|
|
|
|
/* Cut losses early if this is not our interrupt. */
|
|
if ((READ_CSR(TLP_STATUS) & TLP_INT_TXRX) == 0)
|
|
return IRQ_NONE;
|
|
|
|
# if defined(DEVICE_POLLING)
|
|
if (sc->ifp->if_capenable & IFCAP_POLLING)
|
|
return IRQ_NONE;
|
|
|
|
if ((sc->ifp->if_capabilities & IFCAP_POLLING) &&
|
|
(ether_poll_register(fbsd_poll, sc->ifp)))
|
|
{
|
|
WRITE_CSR(TLP_INT_ENBL, TLP_INT_DISABLE);
|
|
return IRQ_NONE;
|
|
}
|
|
else
|
|
sc->quota = sc->rxring.num_descs; /* input flow control */
|
|
# endif /* DEVICE_POLLING */
|
|
|
|
/* Disable card interrupts. */
|
|
WRITE_CSR(TLP_INT_ENBL, TLP_INT_DISABLE);
|
|
|
|
core_interrupt(sc, 0);
|
|
|
|
/* Enable card interrupts. */
|
|
WRITE_CSR(TLP_INT_ENBL, TLP_INT_TXRX);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
|
|
/* Administrative status of the driver (UP or DOWN) has changed. */
|
|
/* A card-specific action may be required: T1 and T3 cards: no-op. */
|
|
/* HSSI and SSI cards change the state of modem ready signals. */
|
|
static void
|
|
set_status(softc_t *sc, int status)
|
|
{
|
|
struct ioctl ioctl;
|
|
|
|
ioctl.cmd = IOCTL_SET_STATUS;
|
|
ioctl.data = status;
|
|
|
|
sc->card->ioctl(sc, &ioctl);
|
|
}
|
|
|
|
#if P2P
|
|
|
|
/* Callout from P2P: */
|
|
/* Get the state of DCD (Data Carrier Detect). */
|
|
static int
|
|
p2p_getmdm(struct p2pcom *p2p, caddr_t result)
|
|
{
|
|
softc_t *sc = IFP2SC(&p2p->p2p_if);
|
|
|
|
/* Non-zero isn't good enough; TIOCM_CAR is 0x40. */
|
|
*(int *)result = (sc->status.oper_status==STATUS_UP) ? TIOCM_CAR : 0;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Callout from P2P: */
|
|
/* Set the state of DTR (Data Terminal Ready). */
|
|
static int
|
|
p2p_mdmctl(struct p2pcom *p2p, int flag)
|
|
{
|
|
softc_t *sc = IFP2SC(&p2p->p2p_if);
|
|
|
|
set_status(sc, flag);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#endif /* P2P */
|
|
|
|
#if NSPPP
|
|
|
|
# ifndef PP_FR
|
|
# define PP_FR 0
|
|
# endif
|
|
|
|
/* Callout from SPPP: */
|
|
static void
|
|
sppp_tls(struct sppp *sppp)
|
|
{
|
|
if (!(sppp->pp_mode & IFF_LINK2) &&
|
|
!(sppp->pp_flags & PP_FR))
|
|
sppp->pp_up(sppp);
|
|
}
|
|
|
|
/* Callout from SPPP: */
|
|
static void
|
|
sppp_tlf(struct sppp *sppp)
|
|
{
|
|
if (!(sppp->pp_mode & IFF_LINK2) &&
|
|
!(sppp->pp_flags & PP_FR))
|
|
sppp->pp_down(sppp);
|
|
}
|
|
|
|
#endif /* NSPPP */
|
|
|
|
/* Configure line protocol stuff.
|
|
* Called by attach_card() during module init.
|
|
* Called by core_ioctl() when lmcconfig writes sc->config.
|
|
* Called by detach_card() during module shutdown.
|
|
*/
|
|
static void
|
|
config_proto(softc_t *sc, struct config *config)
|
|
{
|
|
/* Use line protocol stack instead of RAWIP mode. */
|
|
if ((sc->config.line_pkg == PKG_RAWIP) &&
|
|
(config->line_pkg != PKG_RAWIP))
|
|
{
|
|
#if NSPPP
|
|
LMC_BPF_DETACH;
|
|
sppp_attach(sc->ifp);
|
|
LMC_BPF_ATTACH(DLT_PPP, 4);
|
|
sc->sppp->pp_tls = sppp_tls;
|
|
sc->sppp->pp_tlf = sppp_tlf;
|
|
/* Force reconfiguration of SPPP params. */
|
|
sc->config.line_prot = 0;
|
|
sc->config.keep_alive = config->keep_alive ? 0:1;
|
|
#elif P2P
|
|
int error = 0;
|
|
sc->p2p->p2p_proto = 0; /* force p2p_attach */
|
|
if ((error = p2p_attach(sc->p2p))) /* calls bpfattach() */
|
|
{
|
|
printf("%s: p2p_attach() failed; error %d\n", NAME_UNIT, error);
|
|
config->line_pkg = PKG_RAWIP; /* still in RAWIP mode */
|
|
}
|
|
else
|
|
{
|
|
sc->p2p->p2p_mdmctl = p2p_mdmctl; /* set DTR */
|
|
sc->p2p->p2p_getmdm = p2p_getmdm; /* get DCD */
|
|
}
|
|
#elif GEN_HDLC
|
|
int error = 0;
|
|
sc->net_dev->mtu = HDLC_MAX_MTU;
|
|
if ((error = hdlc_open(sc->net_dev)))
|
|
{
|
|
printf("%s: hdlc_open() failed; error %d\n", NAME_UNIT, error);
|
|
printf("%s: Try 'sethdlc %s ppp'\n", NAME_UNIT, NAME_UNIT);
|
|
config->line_pkg = PKG_RAWIP; /* still in RAWIP mode */
|
|
}
|
|
#else /* no line protocol stack was configured */
|
|
config->line_pkg = PKG_RAWIP; /* still in RAWIP mode */
|
|
#endif
|
|
}
|
|
|
|
/* Bypass line protocol stack and return to RAWIP mode. */
|
|
if ((sc->config.line_pkg != PKG_RAWIP) &&
|
|
(config->line_pkg == PKG_RAWIP))
|
|
{
|
|
#if NSPPP
|
|
LMC_BPF_DETACH;
|
|
sppp_flush(sc->ifp);
|
|
sppp_detach(sc->ifp);
|
|
setup_ifnet(sc->ifp);
|
|
LMC_BPF_ATTACH(DLT_RAW, 0);
|
|
#elif P2P
|
|
int error = 0;
|
|
if_qflush(&sc->p2p->p2p_isnd);
|
|
if ((error = p2p_detach(sc->p2p)))
|
|
{
|
|
printf("%s: p2p_detach() failed; error %d\n", NAME_UNIT, error);
|
|
printf("%s: Try 'ifconfig %s down -remove'\n", NAME_UNIT, NAME_UNIT);
|
|
config->line_pkg = PKG_P2P; /* not in RAWIP mode; still attached to P2P */
|
|
}
|
|
else
|
|
{
|
|
setup_ifnet(sc->ifp);
|
|
LMC_BPF_ATTACH(DLT_RAW, 0);
|
|
}
|
|
#elif GEN_HDLC
|
|
hdlc_proto_detach(sc->hdlc_dev);
|
|
hdlc_close(sc->net_dev);
|
|
setup_netdev(sc->net_dev);
|
|
#endif
|
|
}
|
|
|
|
#if NSPPP
|
|
|
|
if (config->line_pkg != PKG_RAWIP)
|
|
{
|
|
/* Check for change to PPP protocol. */
|
|
if ((sc->config.line_prot != PROT_PPP) &&
|
|
(config->line_prot == PROT_PPP))
|
|
{
|
|
LMC_BPF_DETACH;
|
|
sc->ifp->if_flags &= ~IFF_LINK2;
|
|
sc->sppp->pp_flags &= ~PP_FR;
|
|
LMC_BPF_ATTACH(DLT_PPP, 4);
|
|
sppp_ioctl(sc->ifp, SIOCSIFFLAGS, NULL);
|
|
}
|
|
|
|
# ifndef DLT_C_HDLC
|
|
# define DLT_C_HDLC DLT_PPP
|
|
# endif
|
|
|
|
/* Check for change to C_HDLC protocol. */
|
|
if ((sc->config.line_prot != PROT_C_HDLC) &&
|
|
(config->line_prot == PROT_C_HDLC))
|
|
{
|
|
LMC_BPF_DETACH;
|
|
sc->ifp->if_flags |= IFF_LINK2;
|
|
sc->sppp->pp_flags &= ~PP_FR;
|
|
LMC_BPF_ATTACH(DLT_C_HDLC, 4);
|
|
sppp_ioctl(sc->ifp, SIOCSIFFLAGS, NULL);
|
|
}
|
|
|
|
/* Check for change to Frame Relay protocol. */
|
|
if ((sc->config.line_prot != PROT_FRM_RLY) &&
|
|
(config->line_prot == PROT_FRM_RLY))
|
|
{
|
|
LMC_BPF_DETACH;
|
|
sc->ifp->if_flags &= ~IFF_LINK2;
|
|
sc->sppp->pp_flags |= PP_FR;
|
|
LMC_BPF_ATTACH(DLT_FRELAY, 4);
|
|
sppp_ioctl(sc->ifp, SIOCSIFFLAGS, NULL);
|
|
}
|
|
|
|
/* Check for disabling keep-alives. */
|
|
if ((sc->config.keep_alive != 0) &&
|
|
(config->keep_alive == 0))
|
|
sc->sppp->pp_flags &= ~PP_KEEPALIVE;
|
|
|
|
/* Check for enabling keep-alives. */
|
|
if ((sc->config.keep_alive == 0) &&
|
|
(config->keep_alive != 0))
|
|
sc->sppp->pp_flags |= PP_KEEPALIVE;
|
|
}
|
|
|
|
#endif /* NSPPP */
|
|
|
|
/* Loop back through the TULIP Ethernet chip; (no CRC). */
|
|
/* Data sheet says stop DMA before changing OPMODE register. */
|
|
/* But that's not as simple as it sounds; works anyway. */
|
|
/* Check for enabling loopback thru Tulip chip. */
|
|
if ((sc->config.loop_back != CFG_LOOP_TULIP) &&
|
|
(config->loop_back == CFG_LOOP_TULIP))
|
|
{
|
|
u_int32_t op_mode = READ_CSR(TLP_OP_MODE);
|
|
op_mode |= TLP_OP_INT_LOOP;
|
|
WRITE_CSR(TLP_OP_MODE, op_mode);
|
|
config->crc_len = CFG_CRC_0;
|
|
}
|
|
|
|
/* Check for disabling loopback thru Tulip chip. */
|
|
if ((sc->config.loop_back == CFG_LOOP_TULIP) &&
|
|
(config->loop_back != CFG_LOOP_TULIP))
|
|
{
|
|
u_int32_t op_mode = READ_CSR(TLP_OP_MODE);
|
|
op_mode &= ~TLP_OP_LOOP_MODE;
|
|
WRITE_CSR(TLP_OP_MODE, op_mode);
|
|
config->crc_len = CFG_CRC_16;
|
|
}
|
|
}
|
|
|
|
/* This is the core ioctl procedure. */
|
|
/* It handles IOCTLs from lmcconfig(8). */
|
|
/* It must not run when card watchdogs run. */
|
|
/* Called from a syscall (user context; no spinlocks). */
|
|
/* This procedure can SLEEP. */
|
|
static int
|
|
core_ioctl(softc_t *sc, u_long cmd, caddr_t data)
|
|
{
|
|
struct iohdr *iohdr = (struct iohdr *) data;
|
|
struct ioctl *ioctl = (struct ioctl *) data;
|
|
struct status *status = (struct status *) data;
|
|
struct config *config = (struct config *) data;
|
|
int error = 0;
|
|
|
|
/* All structs start with a string and a cookie. */
|
|
if (((struct iohdr *)data)->cookie != NGM_LMC_COOKIE)
|
|
return EINVAL;
|
|
|
|
while (TOP_TRYLOCK == 0)
|
|
{
|
|
sc->status.cntrs.lck_ioctl++;
|
|
SLEEP(10000); /* yield? */
|
|
}
|
|
switch (cmd)
|
|
{
|
|
case LMCIOCGSTAT:
|
|
{
|
|
*status = sc->status;
|
|
iohdr->cookie = NGM_LMC_COOKIE;
|
|
break;
|
|
}
|
|
case LMCIOCGCFG:
|
|
{
|
|
*config = sc->config;
|
|
iohdr->cookie = NGM_LMC_COOKIE;
|
|
break;
|
|
}
|
|
case LMCIOCSCFG:
|
|
{
|
|
if ((error = CHECK_CAP)) break;
|
|
config_proto(sc, config);
|
|
sc->config = *config;
|
|
sc->card->config(sc);
|
|
break;
|
|
}
|
|
case LMCIOCREAD:
|
|
{
|
|
if (ioctl->cmd == IOCTL_RW_PCI)
|
|
{
|
|
if (ioctl->address > 252) { error = EFAULT; break; }
|
|
ioctl->data = READ_PCI_CFG(sc, ioctl->address);
|
|
}
|
|
else if (ioctl->cmd == IOCTL_RW_CSR)
|
|
{
|
|
if (ioctl->address > 15) { error = EFAULT; break; }
|
|
ioctl->data = READ_CSR(ioctl->address*TLP_CSR_STRIDE);
|
|
}
|
|
else if (ioctl->cmd == IOCTL_RW_SROM)
|
|
{
|
|
if (ioctl->address > 63) { error = EFAULT; break; }
|
|
ioctl->data = read_srom(sc, ioctl->address);
|
|
}
|
|
else if (ioctl->cmd == IOCTL_RW_BIOS)
|
|
ioctl->data = read_bios(sc, ioctl->address);
|
|
else if (ioctl->cmd == IOCTL_RW_MII)
|
|
ioctl->data = read_mii(sc, ioctl->address);
|
|
else if (ioctl->cmd == IOCTL_RW_FRAME)
|
|
ioctl->data = read_framer(sc, ioctl->address);
|
|
else
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
case LMCIOCWRITE:
|
|
{
|
|
if ((error = CHECK_CAP)) break;
|
|
if (ioctl->cmd == IOCTL_RW_PCI)
|
|
{
|
|
if (ioctl->address > 252) { error = EFAULT; break; }
|
|
WRITE_PCI_CFG(sc, ioctl->address, ioctl->data);
|
|
}
|
|
else if (ioctl->cmd == IOCTL_RW_CSR)
|
|
{
|
|
if (ioctl->address > 15) { error = EFAULT; break; }
|
|
WRITE_CSR(ioctl->address*TLP_CSR_STRIDE, ioctl->data);
|
|
}
|
|
else if (ioctl->cmd == IOCTL_RW_SROM)
|
|
{
|
|
if (ioctl->address > 63) { error = EFAULT; break; }
|
|
write_srom(sc, ioctl->address, ioctl->data); /* can sleep */
|
|
}
|
|
else if (ioctl->cmd == IOCTL_RW_BIOS)
|
|
{
|
|
if (ioctl->address == 0) erase_bios(sc);
|
|
write_bios(sc, ioctl->address, ioctl->data); /* can sleep */
|
|
}
|
|
else if (ioctl->cmd == IOCTL_RW_MII)
|
|
write_mii(sc, ioctl->address, ioctl->data);
|
|
else if (ioctl->cmd == IOCTL_RW_FRAME)
|
|
write_framer(sc, ioctl->address, ioctl->data);
|
|
else if (ioctl->cmd == IOCTL_WO_SYNTH)
|
|
write_synth(sc, (struct synth *)&ioctl->data);
|
|
else if (ioctl->cmd == IOCTL_WO_DAC)
|
|
{
|
|
write_dac(sc, 0x9002); /* set Vref = 2.048 volts */
|
|
write_dac(sc, ioctl->data & 0xFFF);
|
|
}
|
|
else
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
case LMCIOCTL:
|
|
{
|
|
if ((error = CHECK_CAP)) break;
|
|
if (ioctl->cmd == IOCTL_XILINX_RESET)
|
|
{
|
|
reset_xilinx(sc);
|
|
sc->card->config(sc);
|
|
}
|
|
else if (ioctl->cmd == IOCTL_XILINX_ROM)
|
|
{
|
|
load_xilinx_from_rom(sc); /* can sleep */
|
|
sc->card->config(sc);
|
|
}
|
|
else if (ioctl->cmd == IOCTL_XILINX_FILE)
|
|
{
|
|
/* load_xilinx_from_file() can sleep. */
|
|
error = load_xilinx_from_file(sc, ioctl->ucode, ioctl->data);
|
|
if (error != 0) load_xilinx_from_rom(sc); /* try the rom */
|
|
sc->card->config(sc);
|
|
set_status(sc, (error==0)); /* XXX */
|
|
}
|
|
else if (ioctl->cmd == IOCTL_RESET_CNTRS)
|
|
{
|
|
memset(&sc->status.cntrs, 0, sizeof(struct event_cntrs));
|
|
microtime(&sc->status.cntrs.reset_time);
|
|
}
|
|
else
|
|
error = sc->card->ioctl(sc, ioctl); /* can sleep */
|
|
break;
|
|
}
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
TOP_UNLOCK;
|
|
|
|
return error;
|
|
}
|
|
|
|
/* This is the core watchdog procedure. */
|
|
/* It calculates link speed, and calls the card-specific watchdog code. */
|
|
/* Calls interrupt() in case one got lost; also kick-starts the device. */
|
|
/* ioctl syscalls and card watchdog routines must be interlocked. */
|
|
/* This procedure must not sleep. */
|
|
static void
|
|
core_watchdog(softc_t *sc)
|
|
{
|
|
/* Read and restart the Tulip timer. */
|
|
u_int32_t tx_speed = READ_CSR(TLP_TIMER);
|
|
WRITE_CSR(TLP_TIMER, 0xFFFF);
|
|
|
|
/* Measure MII clock using a timer in the Tulip chip.
|
|
* This timer counts transmitter bits divided by 4096.
|
|
* Since this is called once a second the math is easy.
|
|
* This is only correct when the link is NOT sending pkts.
|
|
* On a fully-loaded link, answer will be HALF actual rate.
|
|
* Clock rate during pkt is HALF clk rate between pkts.
|
|
* Measuring clock rate really measures link utilization!
|
|
*/
|
|
sc->status.tx_speed = (0xFFFF - (tx_speed & 0xFFFF)) << 12;
|
|
|
|
/* The first status reset time is when the calendar clock is set. */
|
|
if (sc->status.cntrs.reset_time.tv_sec < 1000)
|
|
microtime(&sc->status.cntrs.reset_time);
|
|
|
|
/* Update hardware (operational) status. */
|
|
/* Call the card-specific watchdog routines. */
|
|
if (TOP_TRYLOCK != 0)
|
|
{
|
|
sc->status.oper_status = sc->card->watchdog(sc);
|
|
|
|
/* Increment a counter which tells user-land */
|
|
/* observers that SNMP state has been updated. */
|
|
sc->status.ticks++;
|
|
|
|
TOP_UNLOCK;
|
|
}
|
|
else
|
|
sc->status.cntrs.lck_watch++;
|
|
|
|
/* In case an interrupt gets lost... */
|
|
user_interrupt(sc, 1);
|
|
}
|
|
|
|
|
|
/* Called from a syscall (user context; no spinlocks). */
|
|
static int
|
|
lmc_raw_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
|
|
{
|
|
struct ifreq *ifr = (struct ifreq *) data;
|
|
int error = 0;
|
|
|
|
switch (cmd)
|
|
{
|
|
case SIOCAIFADDR:
|
|
case SIOCSIFFLAGS:
|
|
case SIOCSIFADDR:
|
|
ifp->if_flags |= IFF_UP; /* a Unix tradition */
|
|
break;
|
|
case SIOCSIFMTU:
|
|
ifp->if_mtu = ifr->ifr_mtu;
|
|
break;
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
return error;
|
|
}
|
|
|
|
/* Called from a syscall (user context; no spinlocks). */
|
|
static int
|
|
lmc_ifnet_ioctl(struct ifnet *ifp, u_long cmd, caddr_t data)
|
|
{
|
|
softc_t *sc = IFP2SC(ifp);
|
|
int error = 0;
|
|
|
|
switch (cmd)
|
|
{
|
|
/* Catch the IOCTLs used by lmcconfig. */
|
|
case LMCIOCGSTAT:
|
|
case LMCIOCGCFG:
|
|
case LMCIOCSCFG:
|
|
case LMCIOCREAD:
|
|
case LMCIOCWRITE:
|
|
case LMCIOCTL:
|
|
error = core_ioctl(sc, cmd, data);
|
|
break;
|
|
/* Pass the rest to the line protocol. */
|
|
default:
|
|
if (sc->config.line_pkg == PKG_RAWIP)
|
|
error = lmc_raw_ioctl(ifp, cmd, data);
|
|
else
|
|
# if NSPPP
|
|
error = sppp_ioctl(ifp, cmd, data);
|
|
# elif P2P
|
|
error = p2p_ioctl(ifp, cmd, data);
|
|
# else
|
|
error = EINVAL;
|
|
# endif
|
|
break;
|
|
}
|
|
|
|
if (DRIVER_DEBUG && (error!=0))
|
|
printf("%s: lmc_ifnet_ioctl; cmd=0x%08lx error=%d\n",
|
|
NAME_UNIT, cmd, error);
|
|
|
|
return error;
|
|
}
|
|
|
|
/* Called from a syscall (user context; no spinlocks). */
|
|
static void
|
|
lmc_ifnet_start(struct ifnet *ifp)
|
|
{
|
|
softc_t *sc = IFP2SC(ifp);
|
|
|
|
/* Start the transmitter; incoming pkts are NOT processed. */
|
|
user_interrupt(sc, 0);
|
|
}
|
|
|
|
/* sppp and p2p replace this with their own proc. */
|
|
/* RAWIP mode is the only time this is used. */
|
|
/* Called from a syscall (user context; no spinlocks). */
|
|
static int
|
|
lmc_raw_output(struct ifnet *ifp, struct mbuf *m,
|
|
const struct sockaddr *dst, struct route *ro)
|
|
{
|
|
softc_t *sc = IFP2SC(ifp);
|
|
int error = 0;
|
|
|
|
/* Fail if the link is down. */
|
|
if (sc->status.oper_status != STATUS_UP)
|
|
{
|
|
m_freem(m);
|
|
sc->status.cntrs.odiscards++;
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: lmc_raw_output: tx pkt discarded: link down\n", NAME_UNIT);
|
|
return ENETDOWN;
|
|
}
|
|
|
|
# if NETGRAPH
|
|
/* Netgraph has priority over the ifnet kernel interface. */
|
|
if (sc->ng_hook != NULL)
|
|
{
|
|
m_freem(m);
|
|
sc->status.cntrs.odiscards++;
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: lmc_raw_output: tx pkt discarded: netgraph active\n",
|
|
NAME_UNIT);
|
|
return EBUSY;
|
|
}
|
|
# endif
|
|
|
|
/* lmc_raw_output() ENQUEUEs in a syscall or softirq. */
|
|
/* txintr_setup() DEQUEUEs in a hard interrupt. */
|
|
/* Some BSD QUEUE routines are not interrupt-safe. */
|
|
{
|
|
DISABLE_INTR;
|
|
IFQ_ENQUEUE(&ifp->if_snd, m, error);
|
|
ENABLE_INTR;
|
|
}
|
|
|
|
if (error==0)
|
|
user_interrupt(sc, 0); /* start the transmitter */
|
|
else
|
|
{
|
|
m_freem(m);
|
|
sc->status.cntrs.odiscards++;
|
|
if_inc_counter(ifp, IFCOUNTER_OQDROPS, 1);
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: lmc_raw_output: IFQ_ENQUEUE() failed; error %d\n",
|
|
NAME_UNIT, error);
|
|
}
|
|
|
|
return error;
|
|
}
|
|
|
|
/* Called from a softirq once a second. */
|
|
static void
|
|
lmc_watchdog(void *arg)
|
|
{
|
|
struct ifnet *ifp = arg;
|
|
softc_t *sc = IFP2SC(ifp);
|
|
u_int8_t old_oper_status = sc->status.oper_status;
|
|
|
|
core_watchdog(sc); /* updates oper_status */
|
|
|
|
#if NETGRAPH
|
|
if (sc->ng_hook != NULL)
|
|
{
|
|
sc->status.line_pkg = PKG_NG;
|
|
sc->status.line_prot = 0;
|
|
}
|
|
else
|
|
#endif
|
|
if (sc->config.line_pkg == PKG_RAWIP)
|
|
{
|
|
sc->status.line_pkg = PKG_RAWIP;
|
|
sc->status.line_prot = PROT_IP_HDLC;
|
|
}
|
|
else
|
|
{
|
|
# if P2P
|
|
/* Notice change in link status. */
|
|
if ((old_oper_status != sc->status.oper_status) && (sc->p2p->p2p_modem))
|
|
(*sc->p2p->p2p_modem)(sc->p2p, sc->status.oper_status==STATUS_UP);
|
|
|
|
/* Notice change in line protocol. */
|
|
sc->status.line_pkg = PKG_P2P;
|
|
switch (sc->ifp->if_type)
|
|
{
|
|
case IFT_PPP:
|
|
sc->status.line_prot = PROT_PPP;
|
|
break;
|
|
case IFT_PTPSERIAL:
|
|
sc->status.line_prot = PROT_C_HDLC;
|
|
break;
|
|
case IFT_FRELAY:
|
|
sc->status.line_prot = PROT_FRM_RLY;
|
|
break;
|
|
default:
|
|
sc->status.line_prot = 0;
|
|
break;
|
|
}
|
|
|
|
# elif NSPPP
|
|
/* Notice change in link status. */
|
|
if ((old_oper_status != STATUS_UP) &&
|
|
(sc->status.oper_status == STATUS_UP)) /* link came up */
|
|
sppp_tls(sc->sppp);
|
|
if ((old_oper_status == STATUS_UP) &&
|
|
(sc->status.oper_status != STATUS_UP)) /* link went down */
|
|
sppp_tlf(sc->sppp);
|
|
|
|
/* Notice change in line protocol. */
|
|
sc->status.line_pkg = PKG_SPPP;
|
|
if (sc->sppp->pp_flags & PP_FR)
|
|
sc->status.line_prot = PROT_FRM_RLY;
|
|
else if (sc->ifp->if_flags & IFF_LINK2)
|
|
sc->status.line_prot = PROT_C_HDLC;
|
|
else
|
|
sc->status.line_prot = PROT_PPP;
|
|
|
|
# else
|
|
/* Suppress compiler warning. */
|
|
if (old_oper_status == STATUS_UP);
|
|
# endif
|
|
}
|
|
|
|
ifp->if_baudrate = sc->status.tx_speed;
|
|
if (sc->status.oper_status == STATUS_UP)
|
|
ifp->if_link_state = LINK_STATE_UP;
|
|
else
|
|
ifp->if_link_state = LINK_STATE_DOWN;
|
|
|
|
/* Call this procedure again after one second. */
|
|
callout_reset(&sc->callout, hz, lmc_watchdog, ifp);
|
|
}
|
|
|
|
static uint64_t
|
|
lmc_get_counter(struct ifnet *ifp, ift_counter cnt)
|
|
{
|
|
softc_t *sc;
|
|
struct event_cntrs *cntrs;
|
|
|
|
sc = if_getsoftc(ifp);
|
|
cntrs = &sc->status.cntrs;
|
|
|
|
switch (cnt) {
|
|
case IFCOUNTER_IPACKETS:
|
|
return (cntrs->ipackets);
|
|
case IFCOUNTER_OPACKETS:
|
|
return (cntrs->opackets);
|
|
case IFCOUNTER_IBYTES:
|
|
return (cntrs->ibytes);
|
|
case IFCOUNTER_OBYTES:
|
|
return (cntrs->obytes);
|
|
case IFCOUNTER_IERRORS:
|
|
return (cntrs->ierrors);
|
|
case IFCOUNTER_OERRORS:
|
|
return (cntrs->oerrors);
|
|
case IFCOUNTER_IQDROPS:
|
|
return (cntrs->idiscards);
|
|
default:
|
|
return (if_get_counter_default(ifp, cnt));
|
|
}
|
|
}
|
|
|
|
static void
|
|
setup_ifnet(struct ifnet *ifp)
|
|
{
|
|
softc_t *sc = ifp->if_softc;
|
|
|
|
/* Initialize the generic network interface. */
|
|
ifp->if_flags = IFF_POINTOPOINT;
|
|
ifp->if_flags |= IFF_RUNNING;
|
|
ifp->if_ioctl = lmc_ifnet_ioctl;
|
|
ifp->if_start = lmc_ifnet_start; /* sppp changes this */
|
|
ifp->if_output = lmc_raw_output; /* sppp & p2p change this */
|
|
ifp->if_input = lmc_raw_input;
|
|
ifp->if_get_counter = lmc_get_counter;
|
|
ifp->if_mtu = MAX_DESC_LEN; /* sppp & p2p change this */
|
|
ifp->if_type = IFT_PTPSERIAL; /* p2p changes this */
|
|
|
|
# if defined(DEVICE_POLLING)
|
|
ifp->if_capabilities |= IFCAP_POLLING;
|
|
ifp->if_capenable |= IFCAP_POLLING_NOCOUNT;
|
|
# endif
|
|
|
|
if_initname(ifp, device_get_name(sc->dev), device_get_unit(sc->dev));
|
|
}
|
|
|
|
static int
|
|
lmc_ifnet_attach(softc_t *sc)
|
|
{
|
|
sc->ifp = if_alloc(NSPPP ? IFT_PPP : IFT_OTHER);
|
|
if (sc->ifp == NULL) return ENOMEM;
|
|
# if NSPPP
|
|
sc->sppp = sc->ifp->if_l2com;
|
|
# elif P2P
|
|
sc->ifp = &sc->p2pcom.p2p_if;
|
|
sc->p2p = &sc->p2pcom;
|
|
# endif
|
|
|
|
/* Initialize the network interface struct. */
|
|
sc->ifp->if_softc = sc;
|
|
setup_ifnet(sc->ifp);
|
|
|
|
/* ALTQ output queue initialization. */
|
|
IFQ_SET_MAXLEN(&sc->ifp->if_snd, SNDQ_MAXLEN);
|
|
IFQ_SET_READY(&sc->ifp->if_snd);
|
|
|
|
/* Attach to the ifnet kernel interface. */
|
|
if_attach(sc->ifp);
|
|
|
|
/* Attach Berkeley Packet Filter. */
|
|
LMC_BPF_ATTACH(DLT_RAW, 0);
|
|
|
|
callout_reset(&sc->callout, hz, lmc_watchdog, sc);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
lmc_ifnet_detach(softc_t *sc)
|
|
{
|
|
|
|
# if defined(DEVICE_POLLING)
|
|
if (sc->ifp->if_capenable & IFCAP_POLLING)
|
|
ether_poll_deregister(sc->ifp);
|
|
# endif
|
|
|
|
/* Detach Berkeley Packet Filter. */
|
|
LMC_BPF_DETACH;
|
|
|
|
/* Detach from the ifnet kernel interface. */
|
|
if_detach(sc->ifp);
|
|
|
|
if_free(sc->ifp);
|
|
}
|
|
|
|
|
|
#if NETGRAPH
|
|
|
|
/* These next two macros should be added to netgraph */
|
|
# define NG_TYPE_REF(type) atomic_add_int(&(type)->refs, 1)
|
|
# define NG_TYPE_UNREF(type) \
|
|
do { \
|
|
if ((type)->refs == 1) \
|
|
ng_rmtype(type); \
|
|
else \
|
|
atomic_subtract_int(&(type)->refs, 1); \
|
|
} while (0)
|
|
|
|
/* It is an error to construct new copies of this Netgraph node. */
|
|
/* All instances are constructed by ng_attach and are persistent. */
|
|
static int ng_constructor(node_p node) { return EINVAL; }
|
|
|
|
/* Incoming Netgraph control message. */
|
|
static int
|
|
ng_rcvmsg(node_p node, item_p item, hook_p lasthook)
|
|
{
|
|
struct ng_mesg *msg;
|
|
struct ng_mesg *resp = NULL;
|
|
softc_t *sc = NG_NODE_PRIVATE(node);
|
|
int error = 0;
|
|
|
|
NGI_GET_MSG(item, msg);
|
|
if (msg->header.typecookie == NGM_LMC_COOKIE)
|
|
{
|
|
switch (msg->header.cmd)
|
|
{
|
|
case LMCIOCGSTAT:
|
|
case LMCIOCGCFG:
|
|
case LMCIOCSCFG:
|
|
case LMCIOCREAD:
|
|
case LMCIOCWRITE:
|
|
case LMCIOCTL:
|
|
{
|
|
/* Call the core ioctl procedure. */
|
|
error = core_ioctl(sc, msg->header.cmd, msg->data);
|
|
if ((msg->header.cmd & IOC_OUT) != 0)
|
|
{ /* synchronous response */
|
|
NG_MKRESPONSE(resp, msg, sizeof(struct ng_mesg) +
|
|
IOCPARM_LEN(msg->header.cmd), M_NOWAIT);
|
|
if (resp == NULL)
|
|
error = ENOMEM;
|
|
else
|
|
memcpy(resp->data, msg->data, IOCPARM_LEN(msg->header.cmd));
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
}
|
|
else if ((msg->header.typecookie == NGM_GENERIC_COOKIE) &&
|
|
(msg->header.cmd == NGM_TEXT_STATUS))
|
|
{ /* synchronous response */
|
|
NG_MKRESPONSE(resp, msg, sizeof(struct ng_mesg) +
|
|
NG_TEXTRESPONSE, M_NOWAIT);
|
|
if (resp == NULL)
|
|
error = ENOMEM;
|
|
else
|
|
{
|
|
char *s = resp->data;
|
|
sprintf(s, "Card type = <%s>\n"
|
|
"This driver considers the link to be %s.\n"
|
|
"Use lmcconfig to configure this interface.\n",
|
|
sc->dev_desc, (sc->status.oper_status==STATUS_UP) ? "UP" : "DOWN");
|
|
resp->header.arglen = strlen(s) +1;
|
|
}
|
|
}
|
|
else
|
|
/* Netgraph should be able to read and write these
|
|
* parameters with text-format control messages:
|
|
* SSI HSSI T1E1 T3
|
|
* crc crc crc crc
|
|
* loop loop loop loop
|
|
* clksrc clksrc
|
|
* dte dte format format
|
|
* synth synth cablen cablen
|
|
* cable timeslot scram
|
|
* gain
|
|
* pulse
|
|
* lbo
|
|
* Someday I'll implement this...
|
|
*/
|
|
error = EINVAL;
|
|
|
|
/* Handle synchronous response. */
|
|
NG_RESPOND_MSG(error, node, item, resp);
|
|
NG_FREE_MSG(msg);
|
|
|
|
return error;
|
|
}
|
|
|
|
/* This is a persistent netgraph node. */
|
|
static int
|
|
ng_shutdown(node_p node)
|
|
{
|
|
/* unless told to really die, bounce back to life */
|
|
if ((node->nd_flags & NG_REALLY_DIE)==0)
|
|
node->nd_flags &= ~NG_INVALID; /* bounce back to life */
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* ng_disconnect is the opposite of this procedure. */
|
|
static int
|
|
ng_newhook(node_p node, hook_p hook, const char *name)
|
|
{
|
|
softc_t *sc = NG_NODE_PRIVATE(node);
|
|
|
|
/* Hook name must be 'rawdata'. */
|
|
if (strncmp(name, "rawdata", 7) != 0) return EINVAL;
|
|
|
|
/* Is our hook connected? */
|
|
if (sc->ng_hook != NULL) return EBUSY;
|
|
|
|
/* Accept the hook. */
|
|
sc->ng_hook = hook;
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Both ends have accepted their hooks and the links have been made. */
|
|
/* This is the last chance to reject the connection request. */
|
|
static int
|
|
ng_connect(hook_p hook)
|
|
{
|
|
/* Probably not at splnet, force outward queueing. (huh?) */
|
|
NG_HOOK_FORCE_QUEUE(NG_HOOK_PEER(hook));
|
|
return 0; /* always accept */
|
|
}
|
|
|
|
/* Receive data in mbufs from another Netgraph node. */
|
|
/* Transmit an mbuf-chain on the communication link. */
|
|
/* This procedure is very similar to lmc_raw_output(). */
|
|
/* Called from a syscall (user context; no spinlocks). */
|
|
static int
|
|
ng_rcvdata(hook_p hook, item_p item)
|
|
{
|
|
softc_t *sc = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
|
|
int error = 0;
|
|
struct mbuf *m;
|
|
meta_p meta = NULL;
|
|
|
|
NGI_GET_M(item, m);
|
|
NGI_GET_META(item, meta);
|
|
NG_FREE_ITEM(item);
|
|
|
|
/* This macro must not store into meta! */
|
|
NG_FREE_META(meta);
|
|
|
|
/* Fail if the link is down. */
|
|
if (sc->status.oper_status != STATUS_UP)
|
|
{
|
|
m_freem(m);
|
|
sc->status.cntrs.odiscards++;
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: ng_rcvdata: tx pkt discarded: link down\n", NAME_UNIT);
|
|
return ENETDOWN;
|
|
}
|
|
|
|
/* ng_rcvdata() ENQUEUEs in a syscall or softirq. */
|
|
/* txintr_setup() DEQUEUEs in a hard interrupt. */
|
|
/* Some BSD QUEUE routines are not interrupt-safe. */
|
|
{
|
|
DISABLE_INTR;
|
|
if (meta==NULL)
|
|
IFQ_ENQUEUE(&sc->ng_sndq, m, error);
|
|
else
|
|
IFQ_ENQUEUE(&sc->ng_fastq, m, error);
|
|
ENABLE_INTR;
|
|
}
|
|
|
|
if (error==0)
|
|
user_interrupt(sc, 0); /* start the transmitter */
|
|
else
|
|
{
|
|
m_freem(m);
|
|
sc->status.cntrs.odiscards++;
|
|
if (DRIVER_DEBUG)
|
|
printf("%s: ng_rcvdata: IFQ_ENQUEUE() failed; error %d\n",
|
|
NAME_UNIT, error);
|
|
}
|
|
|
|
return error;
|
|
}
|
|
|
|
/* ng_newhook is the opposite of this procedure, not */
|
|
/* ng_connect, as you might expect from the names. */
|
|
static int
|
|
ng_disconnect(hook_p hook)
|
|
{
|
|
softc_t *sc = NG_NODE_PRIVATE(NG_HOOK_NODE(hook));
|
|
|
|
/* Disconnect the hook. */
|
|
sc->ng_hook = NULL;
|
|
|
|
return 0;
|
|
}
|
|
|
|
static
|
|
struct ng_type ng_type =
|
|
{
|
|
.version = NG_ABI_VERSION,
|
|
.name = NG_LMC_NODE_TYPE,
|
|
.mod_event = NULL,
|
|
.constructor = ng_constructor,
|
|
.rcvmsg = ng_rcvmsg,
|
|
.close = NULL,
|
|
.shutdown = ng_shutdown,
|
|
.newhook = ng_newhook,
|
|
.findhook = NULL,
|
|
.connect = ng_connect,
|
|
.rcvdata = ng_rcvdata,
|
|
.disconnect = ng_disconnect,
|
|
};
|
|
|
|
|
|
/* Attach to the Netgraph kernel interface (/sys/netgraph).
|
|
* It is called once for each physical card during device attach.
|
|
* This is effectively ng_constructor.
|
|
*/
|
|
static int
|
|
ng_attach(softc_t *sc)
|
|
{
|
|
int error;
|
|
|
|
/* If this node type is not known to Netgraph then register it. */
|
|
if (ng_type.refs == 0) /* or: if (ng_findtype(&ng_type) == NULL) */
|
|
{
|
|
if ((error = ng_newtype(&ng_type)))
|
|
{
|
|
printf("%s: ng_newtype() failed; error %d\n", NAME_UNIT, error);
|
|
return error;
|
|
}
|
|
}
|
|
else
|
|
NG_TYPE_REF(&ng_type);
|
|
|
|
/* Call the superclass node constructor. */
|
|
if ((error = ng_make_node_common(&ng_type, &sc->ng_node)))
|
|
{
|
|
NG_TYPE_UNREF(&ng_type);
|
|
printf("%s: ng_make_node_common() failed; error %d\n", NAME_UNIT, error);
|
|
return error;
|
|
}
|
|
|
|
/* Associate a name with this netgraph node. */
|
|
if ((error = ng_name_node(sc->ng_node, NAME_UNIT)))
|
|
{
|
|
NG_NODE_UNREF(sc->ng_node);
|
|
NG_TYPE_UNREF(&ng_type);
|
|
printf("%s: ng_name_node() failed; error %d\n", NAME_UNIT, error);
|
|
return error;
|
|
}
|
|
|
|
/* Initialize the send queue mutexes. */
|
|
mtx_init(&sc->ng_sndq.ifq_mtx, NAME_UNIT, "sndq", MTX_DEF);
|
|
mtx_init(&sc->ng_fastq.ifq_mtx, NAME_UNIT, "fastq", MTX_DEF);
|
|
|
|
/* Put a backpointer to the softc in the netgraph node. */
|
|
NG_NODE_SET_PRIVATE(sc->ng_node, sc);
|
|
|
|
/* ALTQ output queue initialization. */
|
|
IFQ_SET_MAXLEN(&sc->ng_fastq, SNDQ_MAXLEN);
|
|
IFQ_SET_READY(&sc->ng_fastq);
|
|
IFQ_SET_MAXLEN(&sc->ng_sndq, SNDQ_MAXLEN);
|
|
IFQ_SET_READY(&sc->ng_sndq);
|
|
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void
|
|
ng_detach(softc_t *sc)
|
|
{
|
|
callout_drain(&sc->callout);
|
|
mtx_destroy(&sc->ng_sndq.ifq_mtx);
|
|
mtx_destroy(&sc->ng_fastq.ifq_mtx);
|
|
ng_rmnode_self(sc->ng_node); /* free hook */
|
|
NG_NODE_UNREF(sc->ng_node); /* free node */
|
|
NG_TYPE_UNREF(&ng_type);
|
|
}
|
|
|
|
#endif /* NETGRAPH */
|
|
|
|
/* The next few procedures initialize the card. */
|
|
|
|
/* Returns 0 on success; error code on failure. */
|
|
static int
|
|
startup_card(softc_t *sc)
|
|
{
|
|
int num_rx_descs, error = 0;
|
|
u_int32_t tlp_bus_pbl, tlp_bus_cal, tlp_op_tr;
|
|
u_int32_t tlp_cfdd, tlp_cfcs;
|
|
u_int32_t tlp_cflt, tlp_csid, tlp_cfit;
|
|
|
|
/* Make sure the COMMAND bits are reasonable. */
|
|
tlp_cfcs = READ_PCI_CFG(sc, TLP_CFCS);
|
|
tlp_cfcs &= ~TLP_CFCS_MWI_ENABLE;
|
|
tlp_cfcs |= TLP_CFCS_BUS_MASTER;
|
|
tlp_cfcs |= TLP_CFCS_MEM_ENABLE;
|
|
tlp_cfcs |= TLP_CFCS_IO_ENABLE;
|
|
tlp_cfcs |= TLP_CFCS_PAR_ERROR;
|
|
tlp_cfcs |= TLP_CFCS_SYS_ERROR;
|
|
WRITE_PCI_CFG(sc, TLP_CFCS, tlp_cfcs);
|
|
|
|
/* Set the LATENCY TIMER to the recommended value, */
|
|
/* and make sure the CACHE LINE SIZE is reasonable. */
|
|
tlp_cfit = READ_PCI_CFG(sc, TLP_CFIT);
|
|
tlp_cflt = READ_PCI_CFG(sc, TLP_CFLT);
|
|
tlp_cflt &= ~TLP_CFLT_LATENCY;
|
|
tlp_cflt |= (tlp_cfit & TLP_CFIT_MAX_LAT)>>16;
|
|
/* "prgmbl burst length" and "cache alignment" used below. */
|
|
switch(tlp_cflt & TLP_CFLT_CACHE)
|
|
{
|
|
case 8: /* 8 bytes per cache line */
|
|
{ tlp_bus_pbl = 32; tlp_bus_cal = 1; break; }
|
|
case 16:
|
|
{ tlp_bus_pbl = 32; tlp_bus_cal = 2; break; }
|
|
case 32:
|
|
{ tlp_bus_pbl = 32; tlp_bus_cal = 3; break; }
|
|
default:
|
|
{
|
|
tlp_bus_pbl = 32; tlp_bus_cal = 1;
|
|
tlp_cflt &= ~TLP_CFLT_CACHE;
|
|
tlp_cflt |= 8;
|
|
break;
|
|
}
|
|
}
|
|
WRITE_PCI_CFG(sc, TLP_CFLT, tlp_cflt);
|
|
|
|
/* Make sure SNOOZE and SLEEP modes are disabled. */
|
|
tlp_cfdd = READ_PCI_CFG(sc, TLP_CFDD);
|
|
tlp_cfdd &= ~TLP_CFDD_SLEEP;
|
|
tlp_cfdd &= ~TLP_CFDD_SNOOZE;
|
|
WRITE_PCI_CFG(sc, TLP_CFDD, tlp_cfdd);
|
|
DELAY(11*1000); /* Tulip wakes up in 10 ms max */
|
|
|
|
/* Software Reset the Tulip chip; stops DMA and Interrupts. */
|
|
/* This does not change the PCI config regs just set above. */
|
|
WRITE_CSR(TLP_BUS_MODE, TLP_BUS_RESET); /* self-clearing */
|
|
DELAY(5); /* Tulip is dead for 50 PCI cycles after reset. */
|
|
|
|
/* Reset the Xilinx Field Programmable Gate Array. */
|
|
reset_xilinx(sc); /* side effect: turns on all four LEDs */
|
|
|
|
/* Configure card-specific stuff (framers, line interfaces, etc.). */
|
|
sc->card->config(sc);
|
|
|
|
/* Initializing cards can glitch clocks and upset fifos. */
|
|
/* Reset the FIFOs between the Tulip and Xilinx chips. */
|
|
set_mii16_bits(sc, MII16_FIFO);
|
|
clr_mii16_bits(sc, MII16_FIFO);
|
|
|
|
/* Initialize the PCI busmode register. */
|
|
/* The PCI bus cycle type "Memory Write and Invalidate" does NOT */
|
|
/* work cleanly in any version of the 21140A, so don't enable it! */
|
|
WRITE_CSR(TLP_BUS_MODE,
|
|
(tlp_bus_cal ? TLP_BUS_READ_LINE : 0) |
|
|
(tlp_bus_cal ? TLP_BUS_READ_MULT : 0) |
|
|
(tlp_bus_pbl<<TLP_BUS_PBL_SHIFT) |
|
|
(tlp_bus_cal<<TLP_BUS_CAL_SHIFT) |
|
|
((BYTE_ORDER == BIG_ENDIAN) ? TLP_BUS_DESC_BIGEND : 0) |
|
|
((BYTE_ORDER == BIG_ENDIAN) ? TLP_BUS_DATA_BIGEND : 0) |
|
|
TLP_BUS_DSL_VAL |
|
|
TLP_BUS_ARB);
|
|
|
|
/* Pick number of RX descriptors and TX fifo threshold. */
|
|
/* tx_threshold in bytes: 0=128, 1=256, 2=512, 3=1024 */
|
|
tlp_csid = READ_PCI_CFG(sc, TLP_CSID);
|
|
switch(tlp_csid)
|
|
{
|
|
case TLP_CSID_HSSI: /* 52 Mb/s */
|
|
case TLP_CSID_HSSIc: /* 52 Mb/s */
|
|
case TLP_CSID_T3: /* 45 Mb/s */
|
|
{ num_rx_descs = 48; tlp_op_tr = 2; break; }
|
|
case TLP_CSID_SSI: /* 10 Mb/s */
|
|
{ num_rx_descs = 32; tlp_op_tr = 1; break; }
|
|
case TLP_CSID_T1E1: /* 2 Mb/s */
|
|
{ num_rx_descs = 16; tlp_op_tr = 0; break; }
|
|
default:
|
|
{ num_rx_descs = 16; tlp_op_tr = 0; break; }
|
|
}
|
|
|
|
/* Create DMA descriptors and initialize list head registers. */
|
|
if ((error = create_ring(sc, &sc->txring, NUM_TX_DESCS))) return error;
|
|
WRITE_CSR(TLP_TX_LIST, sc->txring.dma_addr);
|
|
if ((error = create_ring(sc, &sc->rxring, num_rx_descs))) return error;
|
|
WRITE_CSR(TLP_RX_LIST, sc->rxring.dma_addr);
|
|
|
|
/* Initialize the operating mode register. */
|
|
WRITE_CSR(TLP_OP_MODE, TLP_OP_INIT | (tlp_op_tr<<TLP_OP_TR_SHIFT));
|
|
|
|
/* Read the missed frame register (result ignored) to zero it. */
|
|
error = READ_CSR( TLP_MISSED); /* error is used as a bit-dump */
|
|
|
|
/* Disable rx watchdog and tx jabber features. */
|
|
WRITE_CSR(TLP_WDOG, TLP_WDOG_INIT);
|
|
|
|
/* Enable card interrupts. */
|
|
WRITE_CSR(TLP_INT_ENBL, TLP_INT_TXRX);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Stop DMA and Interrupts; free descriptors and buffers. */
|
|
static void
|
|
shutdown_card(void *arg)
|
|
{
|
|
softc_t *sc = arg;
|
|
|
|
/* Leave the LEDs in the state they were in after power-on. */
|
|
led_on(sc, MII16_LED_ALL);
|
|
|
|
/* Software reset the Tulip chip; stops DMA and Interrupts */
|
|
WRITE_CSR(TLP_BUS_MODE, TLP_BUS_RESET); /* self-clearing */
|
|
DELAY(5); /* Tulip is dead for 50 PCI cycles after reset. */
|
|
|
|
/* Disconnect from the PCI bus except for config cycles. */
|
|
/* Hmmm; Linux syslogs a warning that IO and MEM are disabled. */
|
|
WRITE_PCI_CFG(sc, TLP_CFCS, TLP_CFCS_MEM_ENABLE | TLP_CFCS_IO_ENABLE);
|
|
|
|
/* Free the DMA descriptor rings. */
|
|
destroy_ring(sc, &sc->txring);
|
|
destroy_ring(sc, &sc->rxring);
|
|
}
|
|
|
|
/* Start the card and attach a kernel interface and line protocol. */
|
|
static int
|
|
attach_card(softc_t *sc, const char *intrstr)
|
|
{
|
|
struct config config;
|
|
u_int32_t tlp_cfrv;
|
|
u_int16_t mii3;
|
|
u_int8_t *ieee;
|
|
int i, error = 0;
|
|
|
|
/* Start the card. */
|
|
if ((error = startup_card(sc))) return error;
|
|
|
|
callout_init(&sc->callout, 0);
|
|
|
|
/* Attach a kernel interface. */
|
|
#if NETGRAPH
|
|
if ((error = ng_attach(sc))) return error;
|
|
sc->flags |= FLAG_NETGRAPH;
|
|
#endif
|
|
if ((error = lmc_ifnet_attach(sc))) return error;
|
|
sc->flags |= FLAG_IFNET;
|
|
|
|
/* Attach a line protocol stack. */
|
|
sc->config.line_pkg = PKG_RAWIP;
|
|
config = sc->config; /* get current config */
|
|
config.line_pkg = 0; /* select external stack */
|
|
config.line_prot = PROT_C_HDLC;
|
|
config.keep_alive = 1;
|
|
config_proto(sc, &config); /* reconfigure */
|
|
sc->config = config; /* save new configuration */
|
|
|
|
/* Print interesting hardware-related things. */
|
|
mii3 = read_mii(sc, 3);
|
|
tlp_cfrv = READ_PCI_CFG(sc, TLP_CFRV);
|
|
printf("%s: PCI rev %d.%d, MII rev %d.%d", NAME_UNIT,
|
|
(tlp_cfrv>>4) & 0xF, tlp_cfrv & 0xF, (mii3>>4) & 0xF, mii3 & 0xF);
|
|
ieee = (u_int8_t *)sc->status.ieee;
|
|
for (i=0; i<3; i++) sc->status.ieee[i] = read_srom(sc, 10+i);
|
|
printf(", IEEE addr %02x:%02x:%02x:%02x:%02x:%02x",
|
|
ieee[0], ieee[1], ieee[2], ieee[3], ieee[4], ieee[5]);
|
|
sc->card->ident(sc);
|
|
printf(" %s\n", intrstr);
|
|
|
|
/* Print interesting software-related things. */
|
|
printf("%s: Driver rev %d.%d.%d", NAME_UNIT,
|
|
DRIVER_MAJOR_VERSION, DRIVER_MINOR_VERSION, DRIVER_SUB_VERSION);
|
|
printf(", Options %s%s%s%s%s%s%s%s%s\n",
|
|
NETGRAPH ? "NETGRAPH " : "", GEN_HDLC ? "GEN_HDLC " : "",
|
|
NSPPP ? "SPPP " : "", P2P ? "P2P " : "",
|
|
ALTQ_PRESENT ? "ALTQ " : "", NBPFILTER ? "BPF " : "",
|
|
DEV_POLL ? "POLL " : "", IOREF_CSR ? "IO_CSR " : "MEM_CSR ",
|
|
(BYTE_ORDER == BIG_ENDIAN) ? "BIG_END " : "LITTLE_END ");
|
|
|
|
/* Make the local hardware ready. */
|
|
set_status(sc, 1);
|
|
|
|
return 0;
|
|
}
|
|
|
|
/* Detach from the kernel in all ways. */
|
|
static void
|
|
detach_card(softc_t *sc)
|
|
{
|
|
struct config config;
|
|
|
|
/* Make the local hardware NOT ready. */
|
|
set_status(sc, 0);
|
|
|
|
/* Detach external line protocol stack. */
|
|
if (sc->config.line_pkg != PKG_RAWIP)
|
|
{
|
|
config = sc->config;
|
|
config.line_pkg = PKG_RAWIP;
|
|
config_proto(sc, &config);
|
|
sc->config = config;
|
|
}
|
|
|
|
/* Detach kernel interfaces. */
|
|
#if NETGRAPH
|
|
if (sc->flags & FLAG_NETGRAPH)
|
|
{
|
|
IFQ_PURGE(&sc->ng_fastq);
|
|
IFQ_PURGE(&sc->ng_sndq);
|
|
ng_detach(sc);
|
|
sc->flags &= ~FLAG_NETGRAPH;
|
|
}
|
|
#endif
|
|
if (sc->flags & FLAG_IFNET)
|
|
{
|
|
IFQ_PURGE(&sc->ifp->if_snd);
|
|
lmc_ifnet_detach(sc);
|
|
sc->flags &= ~FLAG_IFNET;
|
|
}
|
|
|
|
/* Reset the Tulip chip; stops DMA and Interrupts. */
|
|
shutdown_card(sc);
|
|
}
|
|
|
|
/* This is the I/O configuration interface for FreeBSD */
|
|
|
|
|
|
static int
|
|
fbsd_probe(device_t dev)
|
|
{
|
|
u_int32_t cfid = pci_read_config(dev, TLP_CFID, 4);
|
|
u_int32_t csid = pci_read_config(dev, TLP_CSID, 4);
|
|
|
|
/* Looking for a DEC 21140A chip on any Lan Media Corp card. */
|
|
if (cfid != TLP_CFID_TULIP) return ENXIO;
|
|
switch (csid)
|
|
{
|
|
case TLP_CSID_HSSI:
|
|
case TLP_CSID_HSSIc:
|
|
device_set_desc(dev, HSSI_DESC);
|
|
break;
|
|
case TLP_CSID_T3:
|
|
device_set_desc(dev, T3_DESC);
|
|
break;
|
|
case TLP_CSID_SSI:
|
|
device_set_desc(dev, SSI_DESC);
|
|
break;
|
|
case TLP_CSID_T1E1:
|
|
device_set_desc(dev, T1E1_DESC);
|
|
break;
|
|
default:
|
|
return ENXIO;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
fbsd_detach(device_t dev)
|
|
{
|
|
softc_t *sc = device_get_softc(dev);
|
|
|
|
/* Stop the card and detach from the kernel. */
|
|
detach_card(sc);
|
|
|
|
/* Release resources. */
|
|
if (sc->irq_cookie != NULL)
|
|
{
|
|
bus_teardown_intr(dev, sc->irq_res, sc->irq_cookie);
|
|
sc->irq_cookie = NULL;
|
|
}
|
|
if (sc->irq_res != NULL)
|
|
{
|
|
bus_release_resource(dev, SYS_RES_IRQ, sc->irq_res_id, sc->irq_res);
|
|
sc->irq_res = NULL;
|
|
}
|
|
if (sc->csr_res != NULL)
|
|
{
|
|
bus_release_resource(dev, sc->csr_res_type, sc->csr_res_id, sc->csr_res);
|
|
sc->csr_res = NULL;
|
|
}
|
|
|
|
mtx_destroy(&sc->top_mtx);
|
|
mtx_destroy(&sc->bottom_mtx);
|
|
return 0; /* no error */
|
|
}
|
|
|
|
static int
|
|
fbsd_shutdown(device_t dev)
|
|
{
|
|
shutdown_card(device_get_softc(dev));
|
|
return 0;
|
|
}
|
|
|
|
static int
|
|
fbsd_attach(device_t dev)
|
|
{
|
|
softc_t *sc = device_get_softc(dev);
|
|
int error;
|
|
|
|
/* READ/WRITE_PCI_CFG need this. */
|
|
sc->dev = dev;
|
|
|
|
/* What kind of card are we driving? */
|
|
switch (READ_PCI_CFG(sc, TLP_CSID))
|
|
{
|
|
case TLP_CSID_HSSI:
|
|
case TLP_CSID_HSSIc:
|
|
sc->card = &hssi_card;
|
|
break;
|
|
case TLP_CSID_T3:
|
|
sc->card = &t3_card;
|
|
break;
|
|
case TLP_CSID_SSI:
|
|
sc->card = &ssi_card;
|
|
break;
|
|
case TLP_CSID_T1E1:
|
|
sc->card = &t1_card;
|
|
break;
|
|
default:
|
|
return ENXIO;
|
|
}
|
|
sc->dev_desc = device_get_desc(dev);
|
|
|
|
/* Allocate PCI memory or IO resources to access the Tulip chip CSRs. */
|
|
# if IOREF_CSR
|
|
sc->csr_res_id = TLP_CBIO;
|
|
sc->csr_res_type = SYS_RES_IOPORT;
|
|
# else
|
|
sc->csr_res_id = TLP_CBMA;
|
|
sc->csr_res_type = SYS_RES_MEMORY;
|
|
# endif
|
|
sc->csr_res = bus_alloc_resource_any(dev, sc->csr_res_type, &sc->csr_res_id,
|
|
RF_ACTIVE);
|
|
if (sc->csr_res == NULL)
|
|
{
|
|
printf("%s: bus_alloc_resource(csr) failed.\n", NAME_UNIT);
|
|
return ENXIO;
|
|
}
|
|
sc->csr_tag = rman_get_bustag(sc->csr_res);
|
|
sc->csr_handle = rman_get_bushandle(sc->csr_res);
|
|
|
|
/* Allocate PCI interrupt resources for the card. */
|
|
sc->irq_res_id = 0;
|
|
sc->irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irq_res_id,
|
|
RF_ACTIVE | RF_SHAREABLE);
|
|
if (sc->irq_res == NULL)
|
|
{
|
|
printf("%s: bus_alloc_resource(irq) failed.\n", NAME_UNIT);
|
|
fbsd_detach(dev);
|
|
return ENXIO;
|
|
}
|
|
if ((error = bus_setup_intr(dev, sc->irq_res, INTR_TYPE_NET | INTR_MPSAFE,
|
|
NULL, bsd_interrupt, sc, &sc->irq_cookie)))
|
|
{
|
|
printf("%s: bus_setup_intr() failed; error %d\n", NAME_UNIT, error);
|
|
fbsd_detach(dev);
|
|
return error;
|
|
}
|
|
|
|
/* Initialize the top-half and bottom-half locks. */
|
|
mtx_init(&sc->top_mtx, NAME_UNIT, "top half lock", MTX_DEF);
|
|
mtx_init(&sc->bottom_mtx, NAME_UNIT, "bottom half lock", MTX_DEF);
|
|
|
|
/* Start the card and attach a kernel interface and line protocol. */
|
|
if ((error = attach_card(sc, ""))) detach_card(sc);
|
|
return error;
|
|
}
|
|
|
|
static device_method_t methods[] =
|
|
{
|
|
DEVMETHOD(device_probe, fbsd_probe),
|
|
DEVMETHOD(device_attach, fbsd_attach),
|
|
DEVMETHOD(device_detach, fbsd_detach),
|
|
DEVMETHOD(device_shutdown, fbsd_shutdown),
|
|
/* This driver does not suspend and resume. */
|
|
{ 0, 0 }
|
|
};
|
|
|
|
static driver_t driver =
|
|
{
|
|
.name = DEVICE_NAME,
|
|
.methods = methods,
|
|
.size = sizeof(softc_t),
|
|
};
|
|
|
|
static devclass_t devclass;
|
|
|
|
DRIVER_MODULE(lmc, pci, driver, devclass, 0, 0);
|
|
MODULE_VERSION(lmc, 2);
|
|
MODULE_DEPEND(lmc, pci, 1, 1, 1);
|
|
# if NETGRAPH
|
|
MODULE_DEPEND(lmc, netgraph, NG_ABI_VERSION, NG_ABI_VERSION, NG_ABI_VERSION);
|
|
# endif
|
|
# if NSPPP
|
|
MODULE_DEPEND(lmc, sppp, 1, 1, 1);
|
|
# endif
|
|
|
|
|
|
/* This is the I/O configuration interface for NetBSD. */
|
|
|
|
|
|
/* This is the I/O configuration interface for OpenBSD. */
|
|
|
|
|
|
/* This is the I/O configuration interface for BSD/OS. */
|
|
|
|
|