1095 lines
28 KiB
C
1095 lines
28 KiB
C
/*
|
|
* Copyright (c) 1998, Larry Lile
|
|
* All rights reserved.
|
|
*
|
|
* For latest sources and information on this driver, please
|
|
* go to http://anarchy.stdio.com.
|
|
*
|
|
* Questions, comments or suggestions should be directed to
|
|
* Larry Lile <lile@stdio.com>.
|
|
*
|
|
* 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 unmodified, 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.
|
|
*
|
|
* $FreeBSD$
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/sockio.h>
|
|
#include <sys/malloc.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/module.h>
|
|
#include <sys/socket.h>
|
|
|
|
#include <net/if.h>
|
|
#include <net/if_dl.h>
|
|
#include <net/iso88025.h>
|
|
#include <net/if_media.h>
|
|
#include <net/if_types.h>
|
|
#include <net/bpf.h>
|
|
|
|
#ifndef BPF_MTAP
|
|
#define BPF_MTAP(_ifp, _m) do { \
|
|
if ((_ifp)->if_bpf) \
|
|
bpf_mtap((_ifp), (_m)); \
|
|
} while (0)
|
|
#endif
|
|
|
|
#include <vm/vm.h> /* for vtophys */
|
|
#include <vm/pmap.h> /* for vtophys */
|
|
|
|
#include <machine/bus.h>
|
|
#include <machine/resource.h>
|
|
|
|
#include <sys/bus.h>
|
|
#include <sys/rman.h>
|
|
|
|
#include "contrib/dev/oltr/trlld.h"
|
|
#include "contrib/dev/oltr/if_oltrvar.h"
|
|
|
|
/*
|
|
* Glue function prototypes for PMW kit IO
|
|
*/
|
|
|
|
#ifndef TRlldInlineIO
|
|
static void DriverOutByte __P((unsigned short, unsigned char));
|
|
static void DriverOutWord __P((unsigned short, unsigned short));
|
|
static void DriverOutDword __P((unsigned short, unsigned long));
|
|
static void DriverRepOutByte __P((unsigned short, unsigned char *, int));
|
|
static void DriverRepOutWord __P((unsigned short, unsigned short *, int));
|
|
static void DriverRepOutDword __P((unsigned short, unsigned long *, int));
|
|
static unsigned char DriverInByte __P((unsigned short));
|
|
static unsigned short DriverInWord __P((unsigned short));
|
|
static unsigned long DriverInDword __P((unsigned short));
|
|
static void DriverRepInByte __P((unsigned short, unsigned char *, int));
|
|
static void DriverRepInWord __P((unsigned short, unsigned short *, int));
|
|
static void DriverRepInDword __P((unsigned short, unsigned long *, int));
|
|
#endif /*TRlldInlineIO*/
|
|
static void DriverSuspend __P((unsigned short));
|
|
static void DriverStatus __P((void *, TRlldStatus_t *));
|
|
static void DriverCloseCompleted __P((void *));
|
|
static void DriverStatistics __P((void *, TRlldStatistics_t *));
|
|
static void DriverTransmitFrameCompleted __P((void *, void *, int));
|
|
static void DriverReceiveFrameCompleted __P((void *, int, int, void *, int));
|
|
|
|
TRlldDriver_t LldDriver = {
|
|
TRLLD_VERSION,
|
|
#ifndef TRlldInlineIO
|
|
DriverOutByte,
|
|
DriverOutWord,
|
|
DriverOutDword,
|
|
DriverRepOutByte,
|
|
DriverRepOutWord,
|
|
DriverRepOutDword,
|
|
DriverInByte,
|
|
DriverInWord,
|
|
DriverInDword,
|
|
DriverRepInByte,
|
|
DriverRepInWord,
|
|
DriverRepInDword,
|
|
#endif /*TRlldInlineIO*/
|
|
DriverSuspend,
|
|
DriverStatus,
|
|
DriverCloseCompleted,
|
|
DriverStatistics,
|
|
DriverTransmitFrameCompleted,
|
|
DriverReceiveFrameCompleted,
|
|
};
|
|
|
|
|
|
static void oltr_start __P((struct ifnet *));
|
|
static void oltr_close __P((struct oltr_softc *));
|
|
static void oltr_init __P((void *));
|
|
static int oltr_ioctl __P((struct ifnet *, u_long, caddr_t));
|
|
static void oltr_intr __P((void *));
|
|
static int oltr_ifmedia_upd __P((struct ifnet *));
|
|
static void oltr_ifmedia_sts __P((struct ifnet *, struct ifmediareq *));
|
|
|
|
|
|
|
|
int
|
|
oltr_attach(device_t dev)
|
|
{
|
|
|
|
struct oltr_softc *sc = device_get_softc(dev);
|
|
struct ifnet *ifp;
|
|
int rc = 0;
|
|
int media = IFM_TOKEN|IFM_TOK_UTP16;
|
|
|
|
ifp = sc->ifp = if_alloc(IFT_ISO88025);
|
|
if (ifp == NULL) {
|
|
device_printf(dev, "couldn't if_alloc()");
|
|
return (-1);
|
|
}
|
|
|
|
/*
|
|
* Allocate interrupt and DMA channel
|
|
*/
|
|
|
|
sc->irq_rid = 0;
|
|
sc->irq_res = bus_alloc_resource_any(dev, SYS_RES_IRQ, &sc->irq_rid,
|
|
(sc->config.mode & TRLLD_MODE_SHARE_INTERRUPT) ?
|
|
RF_ACTIVE | RF_SHAREABLE : RF_ACTIVE);
|
|
if (sc->irq_res == NULL) {
|
|
device_printf(dev, "couldn't map interrupt\n");
|
|
if_free(ifp);
|
|
return (-1);
|
|
}
|
|
if (bus_setup_intr(dev, sc->irq_res, INTR_TYPE_NET, oltr_intr,
|
|
sc, &sc-> oltr_intrhand)) {
|
|
device_printf(dev, "couldn't setup interrupt\n");
|
|
bus_release_resource(dev, SYS_RES_IRQ, 0, sc->irq_res);
|
|
if_free(ifp);
|
|
return (-1);
|
|
}
|
|
|
|
/*
|
|
* Do the ifnet initialization
|
|
*/
|
|
ifp->if_softc = sc;
|
|
if_initname(ifp, device_get_name(dev), device_get_unit(dev));
|
|
ifp->if_init = oltr_init;
|
|
ifp->if_start = oltr_start;
|
|
ifp->if_ioctl = oltr_ioctl;
|
|
ifp->if_flags = IFF_BROADCAST | IFF_NEEDSGIANT;
|
|
ifp->if_snd.ifq_maxlen = IFQ_MAXLEN;
|
|
|
|
/*
|
|
* Do ifmedia setup.
|
|
*/
|
|
ifmedia_init(&sc->ifmedia, 0, oltr_ifmedia_upd, oltr_ifmedia_sts);
|
|
rc = TRlldSetSpeed(sc->TRlldAdapter, TRLLD_SPEED_16MBPS);
|
|
switch(sc->config.type) {
|
|
case TRLLD_ADAPTER_PCI7: /* OC-3540 */
|
|
ifmedia_add(&sc->ifmedia, IFM_TOKEN|IFM_TOK_UTP100, 0, NULL);
|
|
/* FALL THROUGH */
|
|
case TRLLD_ADAPTER_PCI4: /* OC-3139 */
|
|
case TRLLD_ADAPTER_PCI5: /* OC-3140 */
|
|
case TRLLD_ADAPTER_PCI6: /* OC-3141 */
|
|
ifmedia_add(&sc->ifmedia, IFM_TOKEN|IFM_AUTO, 0, NULL);
|
|
media = IFM_TOKEN|IFM_AUTO;
|
|
rc = TRlldSetSpeed(sc->TRlldAdapter, 0);
|
|
/* FALL THROUGH */
|
|
default:
|
|
ifmedia_add(&sc->ifmedia, IFM_TOKEN|IFM_TOK_UTP4, 0, NULL);
|
|
ifmedia_add(&sc->ifmedia, IFM_TOKEN|IFM_TOK_UTP16, 0, NULL);
|
|
break;
|
|
}
|
|
sc->ifmedia.ifm_media = media;
|
|
ifmedia_set(&sc->ifmedia, media);
|
|
|
|
/*
|
|
* Attach the interface
|
|
*/
|
|
|
|
iso88025_ifattach(ifp, sc->config.macaddress, ISO88025_BPF_SUPPORTED);
|
|
|
|
return(0);
|
|
}
|
|
|
|
|
|
static void
|
|
oltr_intr(void *xsc)
|
|
{
|
|
struct oltr_softc *sc = (struct oltr_softc *)xsc;
|
|
|
|
if (DEBUG_MASK & DEBUG_INT)
|
|
printf("I");
|
|
|
|
TRlldInterruptService(sc->TRlldAdapter);
|
|
|
|
return;
|
|
}
|
|
|
|
static void
|
|
oltr_start(struct ifnet *ifp)
|
|
{
|
|
struct oltr_softc *sc = ifp->if_softc;
|
|
struct mbuf *m0, *m;
|
|
int copy_len, buffer, frame, fragment, rc, s;
|
|
|
|
/*
|
|
* Check to see if output is already active
|
|
*/
|
|
if (ifp->if_drv_flags & IFF_DRV_OACTIVE)
|
|
return;
|
|
|
|
outloop:
|
|
|
|
/*
|
|
* Make sure we have buffers to transmit with
|
|
*/
|
|
if (sc->tx_avail <= 0) {
|
|
printf("oltr%d: tx queue full\n", sc->unit);
|
|
ifp->if_drv_flags |= IFF_DRV_OACTIVE;
|
|
return;
|
|
}
|
|
|
|
if (sc->restart == NULL) {
|
|
IF_DEQUEUE(&ifp->if_snd, m);
|
|
if (m == NULL)
|
|
return;
|
|
} else {
|
|
m = sc->restart;
|
|
sc->restart = NULL;
|
|
}
|
|
|
|
m0 = m;
|
|
frame = RING_BUFFER(sc->tx_frame);
|
|
buffer = RING_BUFFER(sc->tx_head);
|
|
fragment = 0;
|
|
copy_len = 0;
|
|
sc->frame_ring[frame].FragmentCount = 0;
|
|
|
|
while (copy_len < m0->m_pkthdr.len) {
|
|
sc->frame_ring[frame].FragmentCount++;
|
|
if (sc->frame_ring[frame].FragmentCount > sc->tx_avail)
|
|
goto nobuffers;
|
|
sc->frame_ring[frame].TransmitFragment[fragment].VirtualAddress = sc->tx_ring[buffer].data;
|
|
sc->frame_ring[frame].TransmitFragment[fragment].PhysicalAddress = sc->tx_ring[buffer].address;
|
|
sc->frame_ring[frame].TransmitFragment[fragment].count = MIN(m0->m_pkthdr.len - copy_len, TX_BUFFER_LEN);
|
|
m_copydata(m0, copy_len, MIN(m0->m_pkthdr.len - copy_len, TX_BUFFER_LEN), sc->tx_ring[buffer].data);
|
|
copy_len += MIN(m0->m_pkthdr.len - copy_len, TX_BUFFER_LEN);
|
|
fragment++;
|
|
buffer = RING_BUFFER((buffer + 1));
|
|
}
|
|
|
|
s = splimp();
|
|
rc = TRlldTransmitFrame(sc->TRlldAdapter, &sc->frame_ring[frame], (void *)&sc->frame_ring[frame]);
|
|
(void)splx(s);
|
|
|
|
if (rc != TRLLD_TRANSMIT_OK) {
|
|
printf("oltr%d: TRlldTransmitFrame returned %d\n", sc->unit, rc);
|
|
ifp->if_oerrors++;
|
|
goto bad;
|
|
}
|
|
|
|
sc->tx_avail -= sc->frame_ring[frame].FragmentCount;
|
|
sc->tx_head = RING_BUFFER((sc->tx_head + sc->frame_ring[frame].FragmentCount));
|
|
sc->tx_frame++;
|
|
|
|
BPF_MTAP(ifp, m0);
|
|
/*ifp->if_opackets++;*/
|
|
|
|
bad:
|
|
m_freem(m0);
|
|
|
|
goto outloop;
|
|
|
|
nobuffers:
|
|
|
|
printf("oltr%d: queue full\n", sc->unit);
|
|
ifp->if_drv_flags |= IFF_DRV_OACTIVE;
|
|
ifp->if_oerrors++;
|
|
/*m_freem(m0);*/
|
|
sc->restart = m0;
|
|
|
|
return;
|
|
}
|
|
|
|
static void
|
|
oltr_close(struct oltr_softc *sc)
|
|
{
|
|
/*printf("oltr%d: oltr_close\n", sc->unit);*/
|
|
|
|
oltr_stop(sc);
|
|
|
|
tsleep(sc, PWAIT, "oltrclose", 30*hz);
|
|
}
|
|
|
|
void
|
|
oltr_stop(struct oltr_softc *sc)
|
|
{
|
|
struct ifnet *ifp = sc->ifp;
|
|
|
|
/*printf("oltr%d: oltr_stop\n", sc->unit);*/
|
|
|
|
ifp->if_flags &= ~IFF_UP;
|
|
ifp->if_drv_flags &= ~(IFF_DRV_RUNNING | IFF_DRV_OACTIVE);
|
|
TRlldClose(sc->TRlldAdapter, 0);
|
|
sc->state = OL_CLOSING;
|
|
}
|
|
|
|
static void
|
|
oltr_init(void * xsc)
|
|
{
|
|
struct oltr_softc *sc = (struct oltr_softc *)xsc;
|
|
struct ifnet *ifp = sc->ifp;
|
|
struct ifmedia *ifm = &sc->ifmedia;
|
|
int poll = 0, i, rc = 0, s;
|
|
int work_size;
|
|
|
|
/*
|
|
* Check adapter state, don't allow multiple inits
|
|
*/
|
|
if (sc->state > OL_CLOSED) {
|
|
printf("oltr%d: adapter not ready\n", sc->unit);
|
|
return;
|
|
}
|
|
|
|
s = splimp();
|
|
|
|
/*
|
|
* Initialize Adapter
|
|
*/
|
|
if ((rc = TRlldAdapterInit(&LldDriver, sc->TRlldAdapter, sc->TRlldAdapter_phys,
|
|
(void *)sc, &sc->config)) != TRLLD_INIT_OK) {
|
|
switch(rc) {
|
|
case TRLLD_INIT_NOT_FOUND:
|
|
printf("oltr%d: adapter not found\n", sc->unit);
|
|
break;
|
|
case TRLLD_INIT_UNSUPPORTED:
|
|
printf("oltr%d: adapter not supported by low level driver\n", sc->unit);
|
|
break;
|
|
case TRLLD_INIT_PHYS16:
|
|
printf("oltr%d: adapter memory block above 16M cannot DMA\n", sc->unit);
|
|
break;
|
|
case TRLLD_INIT_VERSION:
|
|
printf("oltr%d: low level driver version mismatch\n", sc->unit);
|
|
break;
|
|
default:
|
|
printf("oltr%d: unknown init error %d\n", sc->unit, rc);
|
|
break;
|
|
}
|
|
goto init_failed;
|
|
}
|
|
sc->state = OL_INIT;
|
|
|
|
switch(sc->config.type) {
|
|
case TRLLD_ADAPTER_PCI4: /* OC-3139 */
|
|
work_size = 32 * 1024;
|
|
break;
|
|
case TRLLD_ADAPTER_PCI7: /* OC-3540 */
|
|
work_size = 256;
|
|
break;
|
|
default:
|
|
work_size = 0;
|
|
}
|
|
|
|
if (work_size) {
|
|
if ((sc->work_memory = malloc(work_size, M_DEVBUF, M_NOWAIT)) == NULL) {
|
|
printf("oltr%d: failed to allocate work memory (%d octets).\n", sc->unit, work_size);
|
|
} else {
|
|
TRlldAddMemory(sc->TRlldAdapter, sc->work_memory,
|
|
vtophys(sc->work_memory), work_size);
|
|
}
|
|
}
|
|
|
|
switch(IFM_SUBTYPE(ifm->ifm_media)) {
|
|
case IFM_AUTO:
|
|
rc = TRlldSetSpeed(sc->TRlldAdapter, 0); /* TRLLD_SPEED_AUTO */
|
|
break;
|
|
case IFM_TOK_UTP4:
|
|
rc = TRlldSetSpeed(sc->TRlldAdapter, TRLLD_SPEED_4MBPS);
|
|
break;
|
|
case IFM_TOK_UTP16:
|
|
rc = TRlldSetSpeed(sc->TRlldAdapter, TRLLD_SPEED_16MBPS);
|
|
break;
|
|
case IFM_TOK_UTP100:
|
|
rc = TRlldSetSpeed(sc->TRlldAdapter, TRLLD_SPEED_100MBPS);
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* Download adapter micro-code
|
|
*/
|
|
if (bootverbose)
|
|
printf("oltr%d: Downloading adapter microcode: ", sc->unit);
|
|
|
|
switch(sc->config.mactype) {
|
|
case TRLLD_MAC_TMS:
|
|
rc = TRlldDownload(sc->TRlldAdapter, TRlldMacCode);
|
|
if (bootverbose)
|
|
printf("TMS-380");
|
|
break;
|
|
case TRLLD_MAC_HAWKEYE:
|
|
rc = TRlldDownload(sc->TRlldAdapter, TRlldHawkeyeMac);
|
|
if (bootverbose)
|
|
printf("Hawkeye");
|
|
break;
|
|
case TRLLD_MAC_BULLSEYE:
|
|
rc = TRlldDownload(sc->TRlldAdapter, TRlldBullseyeMac);
|
|
if (bootverbose)
|
|
printf("Bullseye");
|
|
break;
|
|
default:
|
|
if (bootverbose)
|
|
printf("unknown - failed!\n");
|
|
goto init_failed;
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* Check download status
|
|
*/
|
|
switch(rc) {
|
|
case TRLLD_DOWNLOAD_OK:
|
|
if (bootverbose)
|
|
printf(" - ok\n");
|
|
break;
|
|
case TRLLD_DOWNLOAD_ERROR:
|
|
if (bootverbose)
|
|
printf(" - failed\n");
|
|
else
|
|
printf("oltr%d: adapter microcode download failed\n", sc->unit);
|
|
goto init_failed;
|
|
break;
|
|
case TRLLD_STATE:
|
|
if (bootverbose)
|
|
printf(" - not ready\n");
|
|
goto init_failed;
|
|
break;
|
|
}
|
|
|
|
/*
|
|
* Wait for self-test to complete
|
|
*/
|
|
i = 0;
|
|
while ((poll++ < SELF_TEST_POLLS) && (sc->state < OL_READY)) {
|
|
if (DEBUG_MASK & DEBUG_INIT)
|
|
printf("p");
|
|
DELAY(TRlldPoll(sc->TRlldAdapter) * 1000);
|
|
if (TRlldInterruptService(sc->TRlldAdapter) != 0)
|
|
if (DEBUG_MASK & DEBUG_INIT) printf("i");
|
|
}
|
|
|
|
if (sc->state != OL_CLOSED) {
|
|
printf("oltr%d: self-test failed\n", sc->unit);
|
|
goto init_failed;
|
|
}
|
|
|
|
/*
|
|
* Set up adapter poll
|
|
*/
|
|
callout_handle_init(&sc->oltr_poll_ch);
|
|
sc->oltr_poll_ch = timeout(oltr_poll, (void *)sc, 1);
|
|
|
|
sc->state = OL_OPENING;
|
|
|
|
/*
|
|
* Open the adapter
|
|
*/
|
|
rc = TRlldOpen(sc->TRlldAdapter, IF_LLADDR(sc->ifp), sc->GroupAddress,
|
|
sc->FunctionalAddress, 1552, sc->AdapterMode);
|
|
switch(rc) {
|
|
case TRLLD_OPEN_OK:
|
|
break;
|
|
case TRLLD_OPEN_STATE:
|
|
printf("oltr%d: adapter not ready for open\n", sc->unit);
|
|
(void)splx(s);
|
|
return;
|
|
case TRLLD_OPEN_ADDRESS_ERROR:
|
|
printf("oltr%d: illegal MAC address\n", sc->unit);
|
|
(void)splx(s);
|
|
return;
|
|
case TRLLD_OPEN_MODE_ERROR:
|
|
printf("oltr%d: illegal open mode\n", sc->unit);
|
|
(void)splx(s);
|
|
return;
|
|
default:
|
|
printf("oltr%d: unknown open error (%d)\n", sc->unit, rc);
|
|
(void)splx(s);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Set promiscious mode for now...
|
|
*/
|
|
TRlldSetPromiscuousMode(sc->TRlldAdapter, TRLLD_PROM_LLC);
|
|
ifp->if_flags |= IFF_PROMISC;
|
|
|
|
/*
|
|
* Block on the ring insert and set a timeout
|
|
*/
|
|
tsleep(sc, PWAIT, "oltropen", 30*hz);
|
|
|
|
/*
|
|
* Set up receive buffer ring
|
|
*/
|
|
for (i = 0; i < RING_BUFFER_LEN; i++) {
|
|
rc = TRlldReceiveFragment(sc->TRlldAdapter, (void *)sc->rx_ring[i].data,
|
|
sc->rx_ring[i].address, RX_BUFFER_LEN, (void *)sc->rx_ring[i].index);
|
|
if (rc != TRLLD_RECEIVE_OK) {
|
|
printf("oltr%d: adapter refused receive fragment %d (rc = %d)\n", sc->unit, i, rc);
|
|
break;
|
|
}
|
|
}
|
|
|
|
sc->tx_avail = RING_BUFFER_LEN;
|
|
sc->tx_head = 0;
|
|
sc->tx_frame = 0;
|
|
|
|
sc->restart = NULL;
|
|
|
|
ifp->if_drv_flags |= IFF_DRV_RUNNING;
|
|
ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
|
|
|
|
/*
|
|
* Set up adapter statistics poll
|
|
*/
|
|
/*callout_handle_init(&sc->oltr_stat_ch);*/
|
|
/*sc->oltr_stat_ch = timeout(oltr_stat, (void *)sc, 1*hz);*/
|
|
|
|
(void)splx(s);
|
|
return;
|
|
|
|
init_failed:
|
|
sc->state = OL_DEAD;
|
|
(void)splx(s);
|
|
return;
|
|
}
|
|
|
|
static int
|
|
oltr_ioctl(struct ifnet *ifp, u_long command, caddr_t data)
|
|
{
|
|
struct oltr_softc *sc = ifp->if_softc;
|
|
struct ifreq *ifr = (struct ifreq *)data;
|
|
int error = 0, s;
|
|
|
|
s = splimp();
|
|
|
|
switch(command) {
|
|
case SIOCSIFADDR:
|
|
case SIOCGIFADDR:
|
|
case SIOCSIFMTU:
|
|
error = iso88025_ioctl(ifp, command, data);
|
|
break;
|
|
|
|
case SIOCSIFFLAGS:
|
|
if (ifp->if_flags & IFF_UP) {
|
|
oltr_init(sc);
|
|
} else {
|
|
if (ifp->if_drv_flags & IFF_DRV_RUNNING) {
|
|
oltr_close(sc);
|
|
}
|
|
}
|
|
break;
|
|
case SIOCGIFMEDIA:
|
|
case SIOCSIFMEDIA:
|
|
error = ifmedia_ioctl(ifp, ifr, &sc->ifmedia, command);
|
|
break;
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
|
|
(void)splx(s);
|
|
|
|
return(error);
|
|
}
|
|
|
|
|
|
void
|
|
oltr_poll(void *arg)
|
|
{
|
|
struct oltr_softc *sc = (struct oltr_softc *)arg;
|
|
int s;
|
|
|
|
s = splimp();
|
|
|
|
if (DEBUG_MASK & DEBUG_POLL) printf("P");
|
|
|
|
/* Set up next adapter poll */
|
|
sc->oltr_poll_ch = timeout(oltr_poll, (void *)sc, (TRlldPoll(sc->TRlldAdapter) * hz / 1000));
|
|
|
|
(void)splx(s);
|
|
}
|
|
|
|
#ifdef NOTYET
|
|
void
|
|
oltr_stat(void *arg)
|
|
{
|
|
struct oltr_softc *sc = (struct oltr_softc *)arg;
|
|
int s;
|
|
|
|
s = splimp();
|
|
|
|
/* Set up next adapter poll */
|
|
sc->oltr_stat_ch = timeout(oltr_stat, (void *)sc, 1*hz);
|
|
if (TRlldGetStatistics(sc->TRlldAdapter, &sc->current, 0) != 0) {
|
|
/*printf("oltr%d: statistics available immediately...\n", sc->unit);*/
|
|
DriverStatistics((void *)sc, &sc->current);
|
|
}
|
|
|
|
(void)splx(s);
|
|
}
|
|
#endif
|
|
static int
|
|
oltr_ifmedia_upd(struct ifnet *ifp)
|
|
{
|
|
struct oltr_softc *sc = ifp->if_softc;
|
|
struct ifmedia *ifm = &sc->ifmedia;
|
|
int rc;
|
|
|
|
if (IFM_TYPE(ifm->ifm_media) != IFM_TOKEN)
|
|
return(EINVAL);
|
|
|
|
switch(IFM_SUBTYPE(ifm->ifm_media)) {
|
|
case IFM_AUTO:
|
|
rc = TRlldSetSpeed(sc->TRlldAdapter, 0); /* TRLLD_SPEED_AUTO */
|
|
break;
|
|
case IFM_TOK_UTP4:
|
|
rc = TRlldSetSpeed(sc->TRlldAdapter, TRLLD_SPEED_4MBPS);
|
|
break;
|
|
case IFM_TOK_UTP16:
|
|
rc = TRlldSetSpeed(sc->TRlldAdapter, TRLLD_SPEED_16MBPS);
|
|
break;
|
|
case IFM_TOK_UTP100:
|
|
rc = TRlldSetSpeed(sc->TRlldAdapter, TRLLD_SPEED_100MBPS);
|
|
break;
|
|
default:
|
|
return(EINVAL);
|
|
break;
|
|
}
|
|
|
|
return(0);
|
|
|
|
}
|
|
|
|
static void
|
|
oltr_ifmedia_sts(struct ifnet *ifp, struct ifmediareq *ifmr)
|
|
{
|
|
struct oltr_softc *sc = ifp->if_softc;
|
|
struct ifmedia *ifm = &sc->ifmedia;
|
|
|
|
/*printf("oltr%d: oltr_ifmedia_sts\n", sc->unit);*/
|
|
|
|
ifmr->ifm_active = IFM_TYPE(ifm->ifm_media)|IFM_SUBTYPE(ifm->ifm_media);
|
|
|
|
}
|
|
|
|
/*
|
|
* ---------------------- PMW Callback Functions -----------------------
|
|
*/
|
|
|
|
void
|
|
DriverStatistics(void *DriverHandle, TRlldStatistics_t *statistics)
|
|
{
|
|
#ifdef NOTYET
|
|
struct oltr_softc *sc = (struct oltr_softc *)DriverHandle;
|
|
|
|
if (sc->statistics.LineErrors != statistics->LineErrors)
|
|
printf("oltr%d: Line Errors %lu\n", sc->unit,
|
|
statistics->LineErrors);
|
|
if (sc->statistics.InternalErrors != statistics->InternalErrors)
|
|
printf("oltr%d: Internal Errors %lu\n", sc->unit,
|
|
statistics->InternalErrors);
|
|
if (sc->statistics.BurstErrors != statistics->BurstErrors)
|
|
printf("oltr%d: Burst Errors %lu\n", sc->unit,
|
|
statistics->BurstErrors);
|
|
if (sc->statistics.AbortDelimiters != statistics->AbortDelimiters)
|
|
printf("oltr%d: Abort Delimiters %lu\n", sc->unit,
|
|
statistics->AbortDelimiters);
|
|
if (sc->statistics.ARIFCIErrors != statistics->ARIFCIErrors)
|
|
printf("oltr%d: ARIFCI Errors %lu\n", sc->unit,
|
|
statistics->ARIFCIErrors);
|
|
if (sc->statistics.LostFrames != statistics->LostFrames)
|
|
printf("oltr%d: Lost Frames %lu\n", sc->unit,
|
|
statistics->LostFrames);
|
|
if (sc->statistics.CongestionErrors != statistics->CongestionErrors)
|
|
printf("oltr%d: Congestion Errors %lu\n", sc->unit,
|
|
statistics->CongestionErrors);
|
|
if (sc->statistics.FrequencyErrors != statistics->FrequencyErrors)
|
|
printf("oltr%d: Frequency Errors %lu\n", sc->unit,
|
|
statistics->FrequencyErrors);
|
|
if (sc->statistics.TokenErrors != statistics->TokenErrors)
|
|
printf("oltr%d: Token Errors %lu\n", sc->unit,
|
|
statistics->TokenErrors);
|
|
if (sc->statistics.DMABusErrors != statistics->DMABusErrors)
|
|
printf("oltr%d: DMA Bus Errors %lu\n", sc->unit,
|
|
statistics->DMABusErrors);
|
|
if (sc->statistics.DMAParityErrors != statistics->DMAParityErrors)
|
|
printf("oltr%d: DMA Parity Errors %lu\n", sc->unit,
|
|
statistics->DMAParityErrors);
|
|
if (sc->statistics.ReceiveLongFrame != statistics->ReceiveLongFrame)
|
|
printf("oltr%d: Long frames received %lu\n", sc->unit,
|
|
statistics->ReceiveLongFrame);
|
|
if (sc->statistics.ReceiveCRCErrors != statistics->ReceiveCRCErrors)
|
|
printf("oltr%d: Receive CRC Errors %lu\n", sc->unit,
|
|
statistics->ReceiveCRCErrors);
|
|
if (sc->statistics.ReceiveOverflow != statistics->ReceiveOverflow)
|
|
printf("oltr%d: Recieve overflows %lu\n", sc->unit,
|
|
statistics->ReceiveOverflow);
|
|
if (sc->statistics.TransmitUnderrun != statistics->TransmitUnderrun)
|
|
printf("oltr%d: Frequency Errors %lu\n", sc->unit,
|
|
statistics->TransmitUnderrun);
|
|
bcopy(statistics, &sc->statistics, sizeof(TRlldStatistics_t));
|
|
#endif
|
|
}
|
|
|
|
static void
|
|
DriverSuspend(unsigned short MicroSeconds)
|
|
{
|
|
DELAY(MicroSeconds);
|
|
}
|
|
|
|
|
|
static void
|
|
DriverStatus(void *DriverHandle, TRlldStatus_t *Status)
|
|
{
|
|
struct oltr_softc *sc = (struct oltr_softc *)DriverHandle;
|
|
struct ifnet *ifp = sc->ifp;
|
|
|
|
char *Protocol[] = { /* 0 */ "Unknown",
|
|
/* 1 */ "TKP",
|
|
/* 2 */ "TXI" };
|
|
char *Timeout[] = { /* 0 */ "command",
|
|
/* 1 */ "transmit",
|
|
/* 2 */ "interrupt" };
|
|
|
|
switch (Status->Type) {
|
|
|
|
case TRLLD_STS_ON_WIRE:
|
|
printf("oltr%d: ring insert (%d Mbps - %s)\n", sc->unit,
|
|
Status->Specification.OnWireInformation.Speed,
|
|
Protocol[Status->Specification.OnWireInformation.AccessProtocol]);
|
|
sc->state = OL_OPEN;
|
|
wakeup(sc);
|
|
break;
|
|
case TRLLD_STS_SELFTEST_STATUS:
|
|
if (Status->Specification.SelftestStatus == TRLLD_ST_OK) {
|
|
sc->state = OL_CLOSED;
|
|
if (bootverbose)
|
|
printf("oltr%d: self test complete\n", sc->unit);
|
|
}
|
|
if (Status->Specification.SelftestStatus & TRLLD_ST_ERROR) {
|
|
printf("oltr%d: Adapter self test error %d", sc->unit,
|
|
Status->Specification.SelftestStatus & ~TRLLD_ST_ERROR);
|
|
sc->state = OL_DEAD;
|
|
}
|
|
if (Status->Specification.SelftestStatus & TRLLD_ST_TIMEOUT) {
|
|
printf("oltr%d: Adapter self test timed out.\n", sc->unit);
|
|
sc->state = OL_DEAD;
|
|
}
|
|
break;
|
|
case TRLLD_STS_INIT_STATUS:
|
|
if (Status->Specification.InitStatus == 0x800) {
|
|
oltr_stop(sc);
|
|
ifmedia_set(&sc->ifmedia, IFM_TOKEN|IFM_TOK_UTP16);
|
|
TRlldSetSpeed(sc->TRlldAdapter, TRLLD_SPEED_16MBPS);
|
|
oltr_init(sc);
|
|
break;
|
|
}
|
|
printf("oltr%d: adapter init failure 0x%03x\n", sc->unit,
|
|
Status->Specification.InitStatus);
|
|
oltr_stop(sc);
|
|
break;
|
|
case TRLLD_STS_RING_STATUS:
|
|
if (Status->Specification.RingStatus) {
|
|
printf("oltr%d: Ring status change: ", sc->unit);
|
|
if (Status->Specification.RingStatus &
|
|
TRLLD_RS_SIGNAL_LOSS)
|
|
printf(" [Signal Loss]");
|
|
if (Status->Specification.RingStatus &
|
|
TRLLD_RS_HARD_ERROR)
|
|
printf(" [Hard Error]");
|
|
if (Status->Specification.RingStatus &
|
|
TRLLD_RS_SOFT_ERROR)
|
|
printf(" [Soft Error]");
|
|
if (Status->Specification.RingStatus &
|
|
TRLLD_RS_TRANSMIT_BEACON)
|
|
printf(" [Beacon]");
|
|
if (Status->Specification.RingStatus &
|
|
TRLLD_RS_LOBE_WIRE_FAULT)
|
|
printf(" [Wire Fault]");
|
|
if (Status->Specification.RingStatus &
|
|
TRLLD_RS_AUTO_REMOVAL_ERROR)
|
|
printf(" [Auto Removal]");
|
|
if (Status->Specification.RingStatus &
|
|
TRLLD_RS_REMOVE_RECEIVED)
|
|
printf(" [Remove Received]");
|
|
if (Status->Specification.RingStatus &
|
|
TRLLD_RS_COUNTER_OVERFLOW)
|
|
printf(" [Counter Overflow]");
|
|
if (Status->Specification.RingStatus &
|
|
TRLLD_RS_SINGLE_STATION)
|
|
printf(" [Single Station]");
|
|
if (Status->Specification.RingStatus &
|
|
TRLLD_RS_RING_RECOVERY)
|
|
printf(" [Ring Recovery]");
|
|
printf("\n");
|
|
}
|
|
break;
|
|
case TRLLD_STS_ADAPTER_CHECK:
|
|
printf("oltr%d: adapter check (%04x %04x %04x %04x)\n", sc->unit,
|
|
Status->Specification.AdapterCheck[0],
|
|
Status->Specification.AdapterCheck[1],
|
|
Status->Specification.AdapterCheck[2],
|
|
Status->Specification.AdapterCheck[3]);
|
|
sc->state = OL_DEAD;
|
|
oltr_stop(sc);
|
|
break;
|
|
case TRLLD_STS_PROMISCUOUS_STOPPED:
|
|
printf("oltr%d: promiscuous mode ", sc->unit);
|
|
if (Status->Specification.PromRemovedCause == 1)
|
|
printf("remove received.");
|
|
if (Status->Specification.PromRemovedCause == 2)
|
|
printf("poll failure.");
|
|
if (Status->Specification.PromRemovedCause == 2)
|
|
printf("buffer size failure.");
|
|
printf("\n");
|
|
ifp->if_flags &= ~IFF_PROMISC;
|
|
break;
|
|
case TRLLD_STS_LLD_ERROR:
|
|
printf("oltr%d: low level driver internal error ", sc->unit);
|
|
printf("(%04x %04x %04x %04x).\n",
|
|
Status->Specification.InternalError[0],
|
|
Status->Specification.InternalError[1],
|
|
Status->Specification.InternalError[2],
|
|
Status->Specification.InternalError[3]);
|
|
sc->state = OL_DEAD;
|
|
oltr_stop(sc);
|
|
break;
|
|
case TRLLD_STS_ADAPTER_TIMEOUT:
|
|
printf("oltr%d: adapter %s timeout.\n", sc->unit,
|
|
Timeout[Status->Specification.AdapterTimeout]);
|
|
break;
|
|
default:
|
|
printf("oltr%d: driver status Type = %d\n", sc->unit, Status->Type);
|
|
break;
|
|
|
|
}
|
|
if (Status->Closed) {
|
|
sc->state = OL_CLOSING;
|
|
oltr_stop(sc);
|
|
}
|
|
|
|
}
|
|
|
|
static void
|
|
DriverCloseCompleted(void *DriverHandle)
|
|
{
|
|
struct oltr_softc *sc = (struct oltr_softc *)DriverHandle;
|
|
|
|
printf("oltr%d: adapter closed\n", sc->unit);
|
|
wakeup(sc);
|
|
sc->state = OL_CLOSED;
|
|
}
|
|
|
|
static void
|
|
DriverTransmitFrameCompleted(void *DriverHandle, void *FrameHandle, int TransmitStatus)
|
|
{
|
|
struct oltr_softc *sc = (struct oltr_softc *)DriverHandle;
|
|
struct ifnet *ifp = sc->ifp;
|
|
TRlldTransmit_t *frame = (TRlldTransmit_t *)FrameHandle;
|
|
|
|
/*printf("oltr%d: DriverTransmitFrameCompleted\n", sc->unit);*/
|
|
|
|
if (TransmitStatus != TRLLD_TRANSMIT_OK) {
|
|
ifp->if_oerrors++;
|
|
printf("oltr%d: transmit error %d\n", sc->unit, TransmitStatus);
|
|
} else {
|
|
ifp->if_opackets++;
|
|
}
|
|
|
|
sc->tx_avail += frame->FragmentCount;
|
|
|
|
if (ifp->if_drv_flags & IFF_DRV_OACTIVE) {
|
|
printf("oltr%d: queue restart\n", sc->unit);
|
|
ifp->if_drv_flags &= ~IFF_DRV_OACTIVE;
|
|
oltr_start(ifp);
|
|
}
|
|
|
|
|
|
}
|
|
|
|
static void
|
|
DriverReceiveFrameCompleted(void *DriverHandle, int ByteCount, int FragmentCount, void *FragmentHandle, int ReceiveStatus)
|
|
{
|
|
struct oltr_softc *sc = (struct oltr_softc *)DriverHandle;
|
|
struct ifnet *ifp = sc->ifp;
|
|
struct mbuf *m0, *m1, *m;
|
|
int frame_len = ByteCount, i = (int)FragmentHandle, rc, s;
|
|
int mbuf_offset, mbuf_size, frag_offset, copy_length;
|
|
char *fragment = sc->rx_ring[RING_BUFFER(i)].data;
|
|
|
|
if (sc->state > OL_CLOSED) {
|
|
if (ReceiveStatus == TRLLD_RCV_OK) {
|
|
MGETHDR(m0, M_DONTWAIT, MT_DATA);
|
|
mbuf_size = MHLEN - 2;
|
|
if (!m0) {
|
|
ifp->if_ierrors++;
|
|
goto dropped;
|
|
}
|
|
if (ByteCount + 2 > MHLEN) {
|
|
MCLGET(m0, M_DONTWAIT);
|
|
mbuf_size = MCLBYTES - 2;
|
|
if (!(m0->m_flags & M_EXT)) {
|
|
m_freem(m0);
|
|
ifp->if_ierrors++;
|
|
goto dropped;
|
|
}
|
|
}
|
|
m0->m_pkthdr.rcvif = ifp;
|
|
m0->m_pkthdr.len = ByteCount;
|
|
m0->m_len = 0;
|
|
m0->m_data += 2;
|
|
|
|
m = m0;
|
|
mbuf_offset = 0;
|
|
frag_offset = 0;
|
|
while (frame_len) {
|
|
copy_length = MIN3(frame_len,
|
|
(RX_BUFFER_LEN - frag_offset),
|
|
(mbuf_size - mbuf_offset));
|
|
bcopy(fragment + frag_offset, mtod(m, char *) +
|
|
mbuf_offset, copy_length);
|
|
m->m_len += copy_length;
|
|
mbuf_offset += copy_length;
|
|
frag_offset += copy_length;
|
|
frame_len -= copy_length;
|
|
|
|
if (frag_offset == RX_BUFFER_LEN) {
|
|
fragment =
|
|
sc->rx_ring[RING_BUFFER(++i)].data;
|
|
frag_offset = 0;
|
|
}
|
|
if ((mbuf_offset == mbuf_size) && (frame_len > 0)) {
|
|
MGET(m1, M_DONTWAIT, MT_DATA);
|
|
mbuf_size = MHLEN;
|
|
if (!m1) {
|
|
ifp->if_ierrors++;
|
|
m_freem(m0);
|
|
goto dropped;
|
|
}
|
|
if (frame_len > MHLEN) {
|
|
MCLGET(m1, M_DONTWAIT);
|
|
mbuf_size = MCLBYTES;
|
|
if (!(m1->m_flags & M_EXT)) {
|
|
m_freem(m0);
|
|
m_freem(m1);
|
|
ifp->if_ierrors++;
|
|
goto dropped;
|
|
}
|
|
}
|
|
m->m_next = m1;
|
|
m = m1;
|
|
mbuf_offset = 0;
|
|
m->m_len = 0;
|
|
}
|
|
}
|
|
iso88025_input(ifp, m0);
|
|
} else { /* Receiver error */
|
|
if (ReceiveStatus != TRLLD_RCV_NO_DATA) {
|
|
printf("oltr%d: receive error %d\n", sc->unit,
|
|
ReceiveStatus);
|
|
ifp->if_ierrors++;
|
|
}
|
|
}
|
|
|
|
dropped:
|
|
s = splimp();
|
|
i = (int)FragmentHandle;
|
|
while (FragmentCount--) {
|
|
rc = TRlldReceiveFragment(sc->TRlldAdapter,
|
|
(void *)sc->rx_ring[RING_BUFFER(i)].data,
|
|
sc->rx_ring[RING_BUFFER(i)].address,
|
|
RX_BUFFER_LEN, (void *)sc->rx_ring[RING_BUFFER(i)].index);
|
|
if (rc != TRLLD_RECEIVE_OK) {
|
|
printf("oltr%d: adapter refused receive fragment %d (rc = %d)\n", sc->unit, i, rc);
|
|
break;
|
|
}
|
|
i++;
|
|
}
|
|
(void)splx(s);
|
|
}
|
|
}
|
|
|
|
|
|
/*
|
|
* ---------------------------- PMW Glue -------------------------------
|
|
*/
|
|
|
|
#ifndef TRlldInlineIO
|
|
|
|
static void
|
|
DriverOutByte(unsigned short IOAddress, unsigned char value)
|
|
{
|
|
outbv(IOAddress, value);
|
|
}
|
|
|
|
static void
|
|
DriverOutWord(unsigned short IOAddress, unsigned short value)
|
|
{
|
|
outw(IOAddress, value);
|
|
}
|
|
|
|
static void
|
|
DriverOutDword(unsigned short IOAddress, unsigned long value)
|
|
{
|
|
outl(IOAddress, value);
|
|
}
|
|
|
|
static void
|
|
DriverRepOutByte(unsigned short IOAddress, unsigned char *DataPointer, int ByteCount)
|
|
{
|
|
outsb(IOAddress, (void *)DataPointer, ByteCount);
|
|
}
|
|
|
|
static void
|
|
DriverRepOutWord(unsigned short IOAddress, unsigned short *DataPointer, int WordCount)
|
|
{
|
|
outsw(IOAddress, (void *)DataPointer, WordCount);
|
|
}
|
|
|
|
static void
|
|
DriverRepOutDword(unsigned short IOAddress, unsigned long *DataPointer, int DWordCount)
|
|
{
|
|
outsl(IOAddress, (void *)DataPointer, DWordCount);
|
|
}
|
|
|
|
static unsigned char
|
|
DriverInByte(unsigned short IOAddress)
|
|
{
|
|
return(inbv(IOAddress));
|
|
}
|
|
|
|
static unsigned short
|
|
DriverInWord(unsigned short IOAddress)
|
|
{
|
|
return(inw(IOAddress));
|
|
}
|
|
|
|
static unsigned long
|
|
DriverInDword(unsigned short IOAddress)
|
|
{
|
|
return(inl(IOAddress));
|
|
}
|
|
|
|
static void
|
|
DriverRepInByte(unsigned short IOAddress, unsigned char *DataPointer, int ByteCount)
|
|
{
|
|
insb(IOAddress, (void *)DataPointer, ByteCount);
|
|
}
|
|
|
|
static void
|
|
DriverRepInWord(unsigned short IOAddress, unsigned short *DataPointer, int WordCount)
|
|
{
|
|
insw(IOAddress, (void *)DataPointer, WordCount);
|
|
}
|
|
static void
|
|
DriverRepInDword( unsigned short IOAddress, unsigned long *DataPointer, int DWordCount)
|
|
{
|
|
insl(IOAddress, (void *)DataPointer, DWordCount);
|
|
}
|
|
#endif /* TRlldInlineIO */
|