-
-/*
- * Routines supporting UNIBUS network interfaces.
- */
-
-/*
- * Init UNIBUS for interface on uban whose headers of size hlen are to
- * end on a page boundary. We allocate a UNIBUS map register for the page
- * with the header, and nmr more UNIBUS map registers for i/o on the adapter,
- * doing this for each receive and transmit buffer. We also
- * allocate page frames in the mbuffer pool for these pages.
- */
-dmc_ubainit(ifu, uban, hlen, nmr)
- register struct dmcuba *ifu;
- int uban, hlen, nmr;
-{
- register caddr_t cp, dp;
- register struct ifrw *ifrw;
- register struct ifxmt *ifxp;
- int i, ncl;
-
- ncl = clrnd(nmr + CLSIZE) / CLSIZE;
- if (ifu->ifu_r[0].ifrw_addr)
- /*
- * If the first read buffer has a non-zero
- * address, it means we have already allocated core
- */
- cp = ifu->ifu_r[0].ifrw_addr - (CLBYTES - hlen);
- else {
- cp = m_clalloc(NTOT * ncl, MPG_SPACE);
- if (cp == 0)
- return (0);
- ifu->ifu_hlen = hlen;
- ifu->ifu_uban = uban;
- ifu->ifu_uba = uba_hd[uban].uh_uba;
- dp = cp + CLBYTES - hlen;
- for (ifrw = ifu->ifu_r; ifrw < &ifu->ifu_r[NRCV]; ifrw++) {
- ifrw->ifrw_addr = dp;
- dp += ncl * CLBYTES;
- }
- for (ifxp = ifu->ifu_w; ifxp < &ifu->ifu_w[NXMT]; ifxp++) {
- ifxp->x_ifrw.ifrw_addr = dp;
- dp += ncl * CLBYTES;
- }
- }
- /* allocate for receive ring */
- for (ifrw = ifu->ifu_r; ifrw < &ifu->ifu_r[NRCV]; ifrw++) {
- if (dmc_ubaalloc(ifu, ifrw, nmr) == 0) {
- struct ifrw *rw;
-
- for (rw = ifu->ifu_r; rw < ifrw; rw++)
- ubarelse(ifu->ifu_uban, &rw->ifrw_info);
- goto bad;
- }
- }
- /* and now transmit ring */
- for (ifxp = ifu->ifu_w; ifxp < &ifu->ifu_w[NXMT]; ifxp++) {
- ifrw = &ifxp->x_ifrw;
- if (dmc_ubaalloc(ifu, ifrw, nmr) == 0) {
- struct ifxmt *xp;
-
- for (xp = ifu->ifu_w; xp < ifxp; xp++)
- ubarelse(ifu->ifu_uban, &xp->x_ifrw.ifrw_info);
- for (ifrw = ifu->ifu_r; ifrw < &ifu->ifu_r[NRCV]; ifrw++)
- ubarelse(ifu->ifu_uban, &ifrw->ifrw_info);
- goto bad;
- }
- for (i = 0; i < nmr; i++)
- ifxp->x_map[i] = ifrw->ifrw_mr[i];
- ifxp->x_xswapd = 0;
- }
- return (1);
-bad:
- m_pgfree(cp, NTOT * ncl);
- ifu->ifu_r[0].ifrw_addr = 0;
- return (0);
-}
-
-/*
- * Setup either a ifrw structure by allocating UNIBUS map registers,
- * possibly a buffered data path, and initializing the fields of
- * the ifrw structure to minimize run-time overhead.
- */
-static
-dmc_ubaalloc(ifu, ifrw, nmr)
- struct dmcuba *ifu;
- register struct ifrw *ifrw;
- int nmr;
-{
- register int info;
-
- info =
- uballoc(ifu->ifu_uban, ifrw->ifrw_addr, nmr*NBPG + ifu->ifu_hlen,
- ifu->ifu_flags);
- if (info == 0)
- return (0);
- ifrw->ifrw_info = info;
- ifrw->ifrw_bdp = UBAI_BDP(info);
- ifrw->ifrw_proto = UBAMR_MRV | (UBAI_BDP(info) << UBAMR_DPSHIFT);
- ifrw->ifrw_mr = &ifu->ifu_uba->uba_map[UBAI_MR(info) + 1];
- 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 full cluster sized units are present
- * on the interface on cluster boundaries we can get them more
- * easily by remapping, and take advantage of this here.
- */
-struct mbuf *
-dmc_get(ifu, ifrw, totlen, off0)
- register struct dmcuba *ifu;
- register struct ifrw *ifrw;
- int totlen, off0;
-{
- struct mbuf *top, **mp, *m;
- int off = off0, len;
- register caddr_t cp = ifrw->ifrw_addr + ifu->ifu_hlen;
-
- top = 0;
- mp = ⊤
- while (totlen > 0) {
- MGET(m, M_DONTWAIT, MT_DATA);
- if (m == 0)
- goto bad;
- if (off) {
- len = totlen - off;
- cp = ifrw->ifrw_addr + ifu->ifu_hlen + off;
- } else
- len = totlen;
- if (len >= CLBYTES) {
- struct mbuf *p;
- struct pte *cpte, *ppte;
- int x, *ip, i;
-
- MCLGET(p, 1);
- if (p == 0)
- goto nopage;
- len = m->m_len = CLBYTES;
- m->m_off = (int)p - (int)m;
- if (!claligned(cp))
- goto copy;
-
- /*
- * Switch pages mapped to UNIBUS with new page p,
- * as quick form of copy. Remap UNIBUS and invalidate.
- */
- cpte = &Mbmap[mtocl(cp)*CLSIZE];
- ppte = &Mbmap[mtocl(p)*CLSIZE];
- x = btop(cp - ifrw->ifrw_addr);
- ip = (int *)&ifrw->ifrw_mr[x];
- for (i = 0; i < CLSIZE; i++) {
- struct pte t;
- t = *ppte; *ppte++ = *cpte; *cpte = t;
- *ip++ =
- cpte++->pg_pfnum|ifrw->ifrw_proto;
- mtpr(TBIS, cp);
- cp += NBPG;
- mtpr(TBIS, (caddr_t)p);
- p += NBPG / sizeof (*p);
- }
- goto nocopy;
- }
-nopage:
- m->m_len = MIN(MLEN, len);
- m->m_off = MMINOFF;
-copy:
- bcopy(cp, mtod(m, caddr_t), (unsigned)m->m_len);
- cp += m->m_len;
-nocopy:
- *mp = m;
- mp = &m->m_next;
- if (off) {
- /* sort of an ALGOL-W style for statement... */
- off += m->m_len;
- if (off == totlen) {
- cp = ifrw->ifrw_addr + ifu->ifu_hlen;
- off = 0;
- totlen = off0;
- }
- } else
- totlen -= m->m_len;
- }
- return (top);
-bad:
- m_freem(top);
- return (0);
-}
-
-/*
- * 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 which is copied to be in the mapped, aligned
- * i/o space.
- */
-dmcput(ifu, n, m)
- struct dmcuba *ifu;
- int n;
- register struct mbuf *m;
-{
- register struct mbuf *mp;
- register caddr_t cp;
- register struct ifxmt *ifxp;
- register struct ifrw *ifrw;
- register int i;
- int xswapd = 0;
- int x, cc, t;
- caddr_t dp;
-
- ifxp = &ifu->ifu_w[n];
- ifrw = &ifxp->x_ifrw;
- cp = ifrw->ifrw_addr;
- while (m) {
- dp = mtod(m, char *);
- if (claligned(cp) && claligned(dp) && m->m_len == CLBYTES) {
- struct pte *pte; int *ip;
- pte = &Mbmap[mtocl(dp)*CLSIZE];
- x = btop(cp - ifrw->ifrw_addr);
- ip = (int *)&ifrw->ifrw_mr[x];
- for (i = 0; i < CLSIZE; i++)
- *ip++ = ifrw->ifrw_proto | pte++->pg_pfnum;
- xswapd |= 1 << (x>>(CLSHIFT-PGSHIFT));
- mp = m->m_next;
- m->m_next = ifxp->x_xtofree;
- ifxp->x_xtofree = m;
- cp += m->m_len;
- } else {
- bcopy(mtod(m, caddr_t), cp, (unsigned)m->m_len);
- cp += m->m_len;
- MFREE(m, mp);
- }
- m = mp;
- }
-
- /*
- * Xswapd is the set of clusters we just mapped out. Ifxp->x_xswapd
- * is the set of clusters mapped out from before. We compute
- * the number of clusters involved in this operation in x.
- * Clusters mapped out before and involved in this operation
- * should be unmapped so original pages will be accessed by the device.
- */
- cc = cp - ifrw->ifrw_addr;
- x = ((cc - ifu->ifu_hlen) + CLBYTES - 1) >> CLSHIFT;
- ifxp->x_xswapd &= ~xswapd;
- while (i = ffs(ifxp->x_xswapd)) {
- i--;
- if (i >= x)
- break;
- ifxp->x_xswapd &= ~(1<<i);
- i *= CLSIZE;
- for (t = 0; t < CLSIZE; t++) {
- ifrw->ifrw_mr[i] = ifxp->x_map[i];
- i++;
- }
- }
- ifxp->x_xswapd |= xswapd;
- return (cc);
-}
-
projects / unix-history / blobdiff