4.4BSD/usr/src/sys/news3400/if/if_news.c
/*
* Copyright (c) 1992, 1993
* The Regents of the University of California. All rights reserved.
*
* This code is derived from software contributed to Berkeley by
* Sony Corp. and Kazumasa Utashiro of Software Research Associates, Inc.
*
* 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.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by the University of
* California, Berkeley and its contributors.
* 4. Neither the name of the University nor the names of its contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE REGENTS 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 REGENTS 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.
*
* from: $Hdr: if_news.c,v 4.300 91/06/09 06:26:01 root Rel41 $ SONY
*
* @(#)if_news.c 8.1 (Berkeley) 6/11/93
*/
#include <sys/types.h>
#include <machine/pte.h>
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/mbuf.h>
#include <sys/map.h>
#include <sys/buf.h>
#include <sys/socket.h>
#include <sys/proc.h>
#include <sys/user.h>
#include <net/if.h>
#include <news3400/if/if_news.h>
#include <machine/cpu.h>
#if MCLBYTES == CLBYTES && defined(CPU_DOUBLE)
#define USE_CLUSTER
#endif
/*
* Routines supporting NEWS network interfaces.
*/
#define btomcl(x) (((x) + MCLBYTES - 1) >> MCLSHIFT)
/*
* Init NEWS for interface on uban whose headers of size hlen are to
* end on a page boundary. We also allocate page frames in the mbuffer pool
* for these pages.
*/
if_newsinit(ifn, hlen, nmr)
register struct ifnews *ifn;
int hlen, nmr;
{
#ifdef USE_CLUSTER
register caddr_t cp;
int ncl;
if (ifn->ifn_raddr)
return (1);
ncl = nmr;
cp = malloc(btomcl(ctob(2 * ncl)), M_DEVBUF, M_NOWAIT); /*XXX*/
if (cp == 0)
return (0);
ifn->ifn_raddr = cp + 4 - (hlen & 03);
ifn->ifn_waddr = cp + ncl * MCLBYTES;
#endif /* USE_CLUSTER */
ifn->ifn_hlen = hlen;
return (1);
}
/*
* Pull read data off a interface.
* Len is length of data, with local net header stripped.
* Off is non-zero if a trailer protocol was used, and
* gives the offset of the trailer information.
* We copy the trailer information and then all the normal
* data into mbufs. When large sized units are present
* on the interface on cluster boundaries we can get them more
* easily by remapping, and take advantage of this here.
*/
#ifdef NOTDEF /* use m_devget */
struct mbuf *
if_rnewsget(ifn, totlen, off, ifp)
register struct ifnews *ifn;
register int totlen, off;
struct ifnet *ifp;
{
register struct mbuf **mp, *m;
struct mbuf *top;
register int len;
register caddr_t cp = ifn->ifn_raddr + ifn->ifn_hlen;
caddr_t epkt = cp + totlen;
#ifdef USE_CLUSTER
if (totlen >= MHLEN && off == 0) {
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == 0)
return (0);
m->m_pkthdr.rcvif = ifp;
m->m_pkthdr.len = totlen;
MCLGET(m, M_DONTWAIT);
if (m->m_len != MCLBYTES) {
struct mbuf *n;
MFREE(m, n);
goto noncluster;
}
pageswap(cp - ifn->ifn_hlen, mtod(m, caddr_t),
totlen + ifn->ifn_hlen);
m->m_len = totlen;
m->m_data += ifn->ifn_hlen + 4 - (ifn->ifn_hlen & 03);
return (m);
}
noncluster:
#endif /* USE_CLUSTER */
top = 0;
mp = ⊤
/*
* Skip the trailer header (type and trailer length).
*/
if (off) {
off += 2 * sizeof(u_short);
totlen -= 2 * sizeof(u_short);
cp += off;
}
MGETHDR(m, M_DONTWAIT, MT_DATA);
if (m == 0)
return ((struct mbuf *)NULL);
m->m_pkthdr.rcvif = ifp;
m->m_pkthdr.len = totlen;
m->m_len = MHLEN;
while (totlen > 0) {
if (top) {
MGET(m, M_DONTWAIT, MT_DATA);
if (m == 0) {
m_freem(top);
return(0);
}
m->m_len = MLEN;
}
if (totlen >= MINCLSIZE)
MCLGET(m, M_DONTWAIT);
if (m->m_flags & M_EXT)
m->m_len = min(totlen, MCLBYTES);
else if (totlen < m->m_len) {
/*
* Place initial small packet/header at end of mbuf.
*/
if (top == 0 && totlen + max_linkhdr <= m->m_len)
m->m_data += max_linkhdr;
m->m_len = totlen;
}
len = m->m_len;
copy:
bcopy(cp, mtod(m, caddr_t), (unsigned)len);
cp += len;
nocopy:
*mp = m;
mp = &m->m_next;
totlen -= len;
if (cp == epkt)
cp = ifn->ifn_raddr + ifn->ifn_hlen;
}
return (top);
}
#endif /* NOTDEF */
/*
* Map a chain of mbufs onto a network interface
* in preparation for an i/o operation.
* The argument chain of mbufs includes the local network header.
*/
if_wnewsput(ifn, m)
register struct ifnews *ifn;
register struct mbuf *m;
{
#ifdef CPU_DOUBLE
register struct mbuf_segment *ms;
register int n, i;
ifn->ifn_mbuf = m;
ms = (struct mbuf_segment *)ifn->ifn_waddr;
n = 0;
while (m) {
ms->ms_physaddr = kvtophys(mtod(m, caddr_t));
ms->ms_size = m->m_len;
if ((i = (ms->ms_physaddr & PGOFSET) + ms->ms_size) > NBPG) {
i -= NBPG;
ms->ms_size -= i;
ms++;
ms->ms_physaddr =
kvtophys(mtod(m, caddr_t) + m->m_len - i);
ms->ms_size = i;
}
ms++;
n += m->m_len;
m = m->m_next;
}
ms->ms_physaddr = 0;
return (n);
#else /* CPU_DOUBLE */
register struct mbuf *mp;
register caddr_t cp;
cp = ifn->ifn_waddr;
while (m) {
#ifdef mips
bxcopy(mtod(m, caddr_t), cp, (unsigned)m->m_len);
#else
bcopy(mtod(m, caddr_t), cp, (unsigned)m->m_len);
#endif
cp += m->m_len;
MFREE(m, mp);
m = mp;
}
return (cp - ifn->ifn_waddr);
#endif /* CPU_DOUBLE */
}