diff options
Diffstat (limited to 'drivers/ap1000/mac.c')
| -rw-r--r-- | drivers/ap1000/mac.c | 1177 |
1 files changed, 0 insertions, 1177 deletions
diff --git a/drivers/ap1000/mac.c b/drivers/ap1000/mac.c deleted file mode 100644 index 8e85ff555..000000000 --- a/drivers/ap1000/mac.c +++ /dev/null @@ -1,1177 +0,0 @@ - /* - * Copyright 1996 The Australian National University. - * Copyright 1996 Fujitsu Laboratories Limited - * - * This software may be distributed under the terms of the Gnu - * Public License version 2 or later - */ -/* - * Routines for controlling the FORMAC+ - */ -#include <linux/types.h> -#include <linux/string.h> -#include <linux/kernel.h> -#include <linux/skbuff.h> -#include <linux/interrupt.h> -#include <linux/if_ether.h> /* For the statistics structure. */ -#include <linux/netdevice.h> -#include <linux/if_arp.h> -#include <linux/inet.h> -#include <net/sock.h> - -#include <asm/ap1000/apreg.h> -#include <asm/ap1000/apservice.h> -#include <asm/pgtable.h> - -#include "apfddi.h" -#include "smt-types.h" -#include "am79c830.h" -#include "mac.h" -#include "plc.h" -#include "apfddi-reg.h" - -#define MAC_DEBUG 0 - -/* Values for dma_state */ -#define IDLE 0 -#define XMITTING 1 -#define RECVING 2 - -/* - * Messages greater than this value are transferred to the FDDI send buffer - * using DMA. - */ -#define DMA_XMIT_THRESHOLD 64 -#define DMA_RECV_THRESHOLD 64 - -/* - * If the FDDI receive buffer is occupied by less than this value, then - * sending has priority. - */ -#define RECV_THRESHOLD (20*1024) - -#define DMA_RESET_MASKS ((AP_CLR_INTR_MASK<<DMA_INTR_NORMAL_SH) | \ - (AP_CLR_INTR_MASK<<DMA_INTR_ERROR_SH)) - -#define DMA_INTR_REQS ((AP_INTR_REQ<<DMA_INTR_NORMAL_SH) | \ - (AP_INTR_REQ<<DMA_INTR_ERROR_SH)) - -static void mac_print_state(void); - -typedef unsigned int mac_status_t; - -static volatile struct mac_queue *mac_queue_top = NULL; -static volatile struct mac_queue *mac_queue_bottom = NULL; - -struct formac_state { - LoopbackType loopback; - int ring_op; - int recv_ptr; - int recv_empty; - int recv_ovf; - int xmit_ptr; - int xmit_free; - int xmit_start; - int xmit_chains; - int xmit_more_ptr; - int frames_xmitted; - int xmit_chain_start[3]; - int frames_recvd; - int recv_aborted; - int xmit_aborted; - int wrong_bb; - int recv_error; - volatile struct mac_queue *cur_macq; /* Current queue el for send DMA */ - volatile struct mac_buf cur_mbuf; /* Current mac_buf for send DMA */ - struct sk_buff *cur_skb; /* skb for received packets by DMA */ - int dma_state; -}; - -#define SPFRAMES_SIZE 64 /* # words for special frames area */ -#define RECV_BUF_START SPFRAMES_SIZE -#define RECV_BUF_END (BUFFER_SIZE / 2 + 2048) -#define RECV_BUF_SIZE (RECV_BUF_END - RECV_BUF_START) -#define XMIT_BUF_START RECV_BUF_END -#define XMIT_BUF_END BUFFER_SIZE - -#define S2_RMT_EVENTS (S2_CLAIM_STATE | S2_MY_CLAIM | S2_HIGHER_CLAIM | \ - S2_LOWER_CLAIM | S2_BEACON_STATE | S2_MY_BEACON | \ - S2_OTHER_BEACON | S2_RING_OP | S2_MULTIPLE_DA | \ - S2_TOKEN_ERR | S2_DUPL_CLAIM | S2_TRT_EXP_RECOV) - -struct mac_info *this_mac_info; -struct formac_state this_mac_state; - -int -mac_init(struct mac_info *mip) -{ - struct formac_state *msp = &this_mac_state; - - bif_add_debug_key('f',mac_print_state,"show FDDI mac state"); - - this_mac_info = mip; - - mac->cmdreg1 = C1_SOFTWARE_RESET; - mac->said = (mip->s_address[0] << 8) + mip->s_address[1]; - mac->laim = (mip->l_address[0] << 8) + mip->l_address[1]; - mac->laic = (mip->l_address[2] << 8) + mip->l_address[3]; - mac->lail = (mip->l_address[4] << 8) + mip->l_address[5]; - mac->sagp = (mip->s_group_adrs[0] << 8) + mip->s_group_adrs[1]; - mac->lagm = (mip->l_group_adrs[0] << 8) + mip->l_group_adrs[1]; - mac->lagc = (mip->l_group_adrs[2] << 8) + mip->l_group_adrs[3]; - mac->lagl = (mip->l_group_adrs[4] << 8) + mip->l_group_adrs[5]; - mac->tmax = mip->tmax >> 5; - mac->tvx = (mip->tvx - 254) / 255; /* it's -ve, round downwards */ - mac->treq0 = mip->treq; - mac->treq1 = mip->treq >> 16; - mac->pri0 = ~0; - mac->pri1 = ~0; - mac->pri2 = ~0; - mac->mdreg2 = /*M2_STRIP_FCS +*/ M2_CHECK_PARITY + M2_EVEN_PARITY - + 3 * M2_RCV_BYTE_BDRY + M2_ENABLE_HSREQ - + M2_ENABLE_NPDMA + M2_SYNC_NPDMA + M2_RECV_BAD_FRAMES; - mac->eacb = RECV_BUF_START - 1; - mac->earv = XMIT_BUF_START - 1; - mac->eas = mac->earv; - mac->eaa0 = BUFFER_SIZE - 1; - mac->eaa1 = mac->eaa0; - mac->eaa2 = mac->eaa1; - mac->wpxsf = 0; - mac->rpr = RECV_BUF_START; - mac->wpr = RECV_BUF_START + 1; - mac->swpr = RECV_BUF_START; - mac->wpxs = mac->eas; - mac->swpxs = mac->eas; - mac->rpxs = mac->eas; - mac->wpxa0 = XMIT_BUF_START; - mac->rpxa0 = XMIT_BUF_START; - - memset(msp, 0, sizeof(*msp)); - msp->recv_ptr = RECV_BUF_START; - msp->recv_empty = 1; - msp->xmit_ptr = XMIT_BUF_START; - msp->xmit_free = XMIT_BUF_START + 1; - msp->xmit_start = XMIT_BUF_START; - msp->xmit_chains = 0; - msp->frames_xmitted = 0; - msp->frames_recvd = 0; - msp->recv_aborted = 0; - - mac->mdreg1 = M1_MODE_MEMORY; - - mac_make_spframes(); - - return 0; -} - -int -mac_inited(struct mac_info *mip) -{ - struct formac_state *msp = &this_mac_state; - mac_status_t st1, st2; - - if (mac->said != (mip->s_address[0] << 8) + mip->s_address[1] - || mac->laim != (mip->l_address[0] << 8) + mip->l_address[1] - || mac->laic != (mip->l_address[2] << 8) + mip->l_address[3] - || mac->lail != (mip->l_address[4] << 8) + mip->l_address[5] - || mac->sagp != (mip->s_group_adrs[0] << 8) + mip->s_group_adrs[1] - || mac->lagm != (mip->l_group_adrs[0] << 8) + mip->l_group_adrs[1] - || mac->lagc != (mip->l_group_adrs[2] << 8) + mip->l_group_adrs[3] - || mac->lagl != (mip->l_group_adrs[4] << 8) + mip->l_group_adrs[5]) - return 1; - if ((mac->mdreg1 & ~M1_ADDET) != (M1_MODE_ONLINE | M1_SELECT_RA - | M1_FULL_DUPLEX)) - return 3; - if (mac->treq0 != (mip->treq & 0xffff) - || mac->treq1 != ((unsigned)mip->treq >> 16)) - return 4; - - st1 = (mac->st1u << 16) + mac->st1l; - st2 = (mac->st2u << 16) + mac->st2l; - if ((st2 & S2_RING_OP) == 0) - return 5; - - /* It's probably OK, reset some things to be safe. */ - this_mac_info = mip; - *csr0 &= ~CS0_HREQ; - mac->tmax = mip->tmax >> 5; - mac->tvx = (mip->tvx - 254) / 255; /* it's -ve, round downwards */ - mac->pri0 = ~0; - mac->pri1 = ~0; - mac->pri2 = ~0; - mac->mdreg2 = /*M2_STRIP_FCS +*/ M2_CHECK_PARITY + M2_EVEN_PARITY - + 3 * M2_RCV_BYTE_BDRY + M2_ENABLE_HSREQ - + M2_ENABLE_NPDMA + M2_SYNC_NPDMA + M2_RECV_BAD_FRAMES; - - /* clear out the receive queue */ - mac->mdreg1 = (mac->mdreg1 & ~M1_ADDET) | M1_ADDET_DISABLE_RECV; - mac->rpr = RECV_BUF_START; - mac->wpr = RECV_BUF_START + 1; - mac->swpr = RECV_BUF_START; - - memset(msp, 0, sizeof(*msp)); - msp->recv_ptr = RECV_BUF_START; - msp->recv_empty = 1; - - /* XXX reset transmit pointers */ - mac->cmdreg2 = C2_ABORT_XMIT; - mac->cmdreg2 = C2_RESET_XMITQS; - mac->wpxa0 = XMIT_BUF_START; - mac->rpxa0 = XMIT_BUF_START; - msp->xmit_ptr = XMIT_BUF_START; - msp->xmit_free = XMIT_BUF_START + 1; - msp->xmit_start = XMIT_BUF_START; - msp->xmit_chains = 0; - - mac_make_spframes(); - mac->cmdreg1 = C1_CLR_ALL_LOCKS; - - msp->frames_xmitted = 0; - msp->frames_recvd = 0; - msp->recv_aborted = 0; - msp->ring_op = 1; - - mac->mdreg1 = (mac->mdreg1 & ~M1_ADDET) | M1_ADDET_NSA; - mac->imsk1u = ~(S1_XMIT_ABORT | S1_END_FRAME_ASYNC0) >> 16; - mac->imsk1l = ~(S1_PAR_ERROR_ASYNC0 | S1_QUEUE_LOCK_ASYNC0); - mac->imsk2u = ~(S2_RECV_COMPLETE | S2_RECV_BUF_FULL | S2_RECV_FIFO_OVF - | S2_ERR_SPECIAL_FR | S2_RMT_EVENTS - | S2_NP_SIMULT_LOAD) >> 16; - mac->imsk2l = ~(S2_RMT_EVENTS | S2_MISSED_FRAME); - - return 0; -} - -void mac_make_spframes(void) -{ - volatile int *bp; - struct mac_info *mip = this_mac_info; - int sa; - struct formac_state *msp = &this_mac_state; - - /* initialize memory to avoid parity errors */ - *csr0 &= ~CS0_HREQ; - *csr1 &= ~CS1_BUF_WR_TAG; - for (bp = &buffer_mem[BUFFER_SIZE]; bp > &buffer_mem[XMIT_BUF_START];) - *--bp = 0xdeadbeef; - for (; bp > buffer_mem;) - *--bp = 0xfeedf00d; - buffer_mem[msp->recv_ptr] = 0; - - bp = buffer_mem; - *bp++ = 0; /* auto-void frame pointer (not used) */ - - /* make claim frame */ - sa = bp - buffer_mem; - *bp++ = 0xd8000011; /* claim frame descr. + length */ - *bp++ = 0xc3; /* FC value for claim frame, long addr */ - *bp++ = (mip->l_address[0] << 24) + (mip->l_address[1] << 16) - + (mip->l_address[2] << 8) + mip->l_address[3]; - *bp++ = (mip->l_address[4] << 24) + (mip->l_address[5] << 16) - + (mip->l_address[0] << 8) + mip->l_address[1]; - *bp++ = (mip->l_address[2] << 24) + (mip->l_address[3] << 16) - + (mip->l_address[4] << 8) + mip->l_address[5]; - *bp++ = mip->treq; - mac->sacl = bp - buffer_mem; /* points to pointer to claim frame */ - *bp++ = 0xa0000000 + sa; /* pointer to start of claim frame */ - - /* make beacon frame */ - sa = bp - buffer_mem; - *bp++ = 0xd8000011; /* beacon frame descr. + length */ - *bp++ = 0xc2; /* FC value for beacon frame, long addr */ - *bp++ = 0; /* DA = 0 */ - *bp++ = (mip->l_address[0] << 8) + mip->l_address[1]; - *bp++ = (mip->l_address[2] << 24) + (mip->l_address[3] << 16) - + (mip->l_address[4] << 8) + mip->l_address[5]; - *bp++ = 0; /* beacon reason = failed claim */ - mac->sabc = bp - buffer_mem; - *bp++ = 0xa0000000 + sa; /* pointer to start of beacon frame */ -} - -void mac_reset(LoopbackType loopback) -{ - int mode; - struct formac_state *msp = &this_mac_state; - - msp->loopback = loopback; - switch (loopback) { - case loop_none: - mode = M1_MODE_ONLINE; - break; - case loop_formac: - mode = M1_MODE_INT_LOOP; - break; - default: - mode = M1_MODE_EXT_LOOP; - break; - } - mac->mdreg1 = mode | M1_ADDET_NSA | M1_SELECT_RA | M1_FULL_DUPLEX; - mac->cmdreg1 = C1_IDLE_LISTEN; - mac->cmdreg1 = C1_CLR_ALL_LOCKS; - mac->imsk1u = ~(S1_XMIT_ABORT | S1_END_FRAME_ASYNC0) >> 16; - mac->imsk1l = ~(S1_PAR_ERROR_ASYNC0 | S1_QUEUE_LOCK_ASYNC0); - mac->imsk2u = ~(S2_RECV_COMPLETE | S2_RECV_BUF_FULL | S2_RECV_FIFO_OVF - | S2_ERR_SPECIAL_FR | S2_RMT_EVENTS - | S2_NP_SIMULT_LOAD) >> 16; - mac->imsk2l = ~(S2_RMT_EVENTS | S2_MISSED_FRAME); -} - -void mac_claim(void) -{ - mac->cmdreg1 = C1_CLAIM_LISTEN; -} - -void mac_disable(void) -{ - mac->mdreg1 = M1_MODE_MEMORY; - mac->imsk1u = ~0; - mac->imsk1l = ~0; - mac->imsk2u = ~0; - mac->imsk2l = ~0; - mac->wpr = mac->swpr + 1; - if (mac->wpr > mac->earv) - mac->wpr = mac->eacb + 1; - buffer_mem[mac->swpr] = 0; -} - -void mac_stats(void) -{ - struct formac_state *msp = &this_mac_state; - - if (msp->recv_ovf) - printk("%d receive buffer overflows\n", msp->recv_ovf); - if (msp->wrong_bb) - printk("%d frames on wrong byte bdry\n", msp->wrong_bb); - printk("%d frames transmitted, %d aborted\n", msp->frames_xmitted, - msp->xmit_aborted); - printk("%d frames received, %d aborted\n", msp->frames_recvd, - msp->recv_aborted); - printk("%d frames received with errors\n", msp->recv_error); -} - -void mac_sleep(void) -{ - /* disable the receiver */ - mac->mdreg1 = (mac->mdreg1 & ~M1_ADDET) | M1_ADDET_DISABLE_RECV; -} - -void mac_poll(void) -{ - mac_status_t st1, st2; - struct formac_state *msp = &this_mac_state; - int up, f, d, l, r, e, i; - - st1 = (mac->st1u << 16) + mac->st1l; - st2 = (mac->st2u << 16) + mac->st2l; - - if (st2 & S2_NP_SIMULT_LOAD) - panic("NP/formac simultaneous load!!!"); - - up = (st2 & S2_RING_OP) != 0; - if (up != msp->ring_op) { - /* ring has come up or down */ - msp->ring_op = up; - printk("mac: ring %s\n", up? "up": "down"); - set_ring_op(up); - } - - if (up) { - if (st1 & S1_XMIT_ABORT) { - ++msp->xmit_aborted; - if (st1 & S1_QUEUE_LOCK_ASYNC0) { - printk("mac: xmit queue locked, resetting xmit buffer\n"); - mac->cmdreg2 = C2_RESET_XMITQS; /* XXX bit gross */ - mac->rpxa0 = XMIT_BUF_START; - buffer_mem[XMIT_BUF_START] = 0; - msp->xmit_ptr = XMIT_BUF_START; - msp->xmit_start = XMIT_BUF_START; - msp->xmit_chains = 0; - mac->cmdreg1 = C1_CLR_ASYNCQ0_LOCK; - st1 &= ~(S1_END_CHAIN_ASYNC0 | S1_END_FRAME_ASYNC0 - | S1_XINSTR_FULL_ASYNC0); - } else - st1 |= S1_END_FRAME_ASYNC0; - } else if (st1 & S1_QUEUE_LOCK_ASYNC0) { - printk("mac: xmit queue locked, why?\n"); - mac->cmdreg1 = C1_CLR_ASYNCQ0_LOCK; - } - - if (st1 & S1_END_FRAME_ASYNC0) { - /* advance xmit_start */ - e = msp->xmit_start; - while (e != msp->xmit_ptr) { - /* find the end of the current frame */ - f = buffer_mem[e]; /* read pointer */ - if (f == 0) - break; /* huh?? */ - f &= 0xffff; - d = buffer_mem[f]; /* read descriptor */ - l = ((d & 0xffff) + ((d >> TD_BYTE_BDRY_LG) & 3) + 3) >> 2; - e = f + 1 + l; /* index of ptr at end of frame */ - r = mac->rpxa0; - if ((r <= msp->xmit_ptr && r < e && e <= msp->xmit_ptr) - || (r > msp->xmit_ptr && (r < e || e <= msp->xmit_ptr))) - break; /* up to current frame */ - /* printk("frame @ %x done\n", msp->xmit_start); */ - msp->xmit_start = e; - if ((st1 & S1_XMIT_ABORT) == 0) - ++msp->frames_xmitted; - if ((msp->xmit_chains == 1 && e == msp->xmit_ptr) || - (msp->xmit_chains > 1 && e == msp->xmit_chain_start[1])) { - /* we've finished chain 0 */ - --msp->xmit_chains; - for (i = 0; i < msp->xmit_chains; ++i) - msp->xmit_chain_start[i] = msp->xmit_chain_start[i+1]; - if (msp->xmit_chains >= 2) { - mac->cmdreg2 = C2_XMIT_ASYNCQ0; - /* printk("mac_poll: xmit chain\n"); */ - } - if (msp->xmit_chains == 0) - *csr0 &= ~CS0_LED1; - } - } - /* - * Now that we have a bit more space in the transmit buffer, - * see if we want to put another frame in. - */ -#if MAC_DEBUG - printk("Removed space in transmit buffer.\n"); -#endif - mac_process(); - } - } - - if (st2 & S2_RMT_EVENTS) { - rmt_event(st2); - } - - if (st2 & S2_RECV_COMPLETE) { - /* - * A frame has just finished arriving in the receive buffer. - */ - *csr0 |= CS0_LED2; - msp->recv_empty = 0; -#if MAC_DEBUG - printk("Frame has just trickled in...\n"); -#endif - mac_process(); - } - - if (st2 & S2_RECV_BUF_FULL) { - /* - * receive buffer overflow: reset and unlock the receive buffer. - */ -/* printk("mac: receive buffer full\n"); */ - mac->rpr = RECV_BUF_START; - mac->wpr = RECV_BUF_START + 1; - mac->swpr = RECV_BUF_START; - msp->recv_ptr = RECV_BUF_START; - msp->recv_empty = 1; - buffer_mem[RECV_BUF_START] = 0; - mac->cmdreg1 = C1_CLR_RECVQ_LOCK; - ++msp->recv_ovf; - -#if 0 - } else if (st2 & S2_RECV_FIFO_OVF) { - printk("mac: receive FIFO overflow\n"); - /* any further action required here? */ - - } else if (st2 & S2_MISSED_FRAME) { - printk("mac: missed frame\n"); -#endif - } - - if (st2 & S2_ERR_SPECIAL_FR) { - printk("mac: bug: error in special frame\n"); - mac_disable(); - } -} - -void -mac_xmit_alloc(sp, bb) - struct mac_buf *sp; - int bb; -{ - int nwords; - - nwords = (sp->length + bb + 3) >> 2; - sp->fr_start = mac_xalloc(nwords + 2); - sp->fr_end = sp->fr_start + nwords + 1; - sp->ptr = (char *) &buffer_mem[sp->fr_start + 1] + bb; - buffer_mem[sp->fr_start] = TD_MAGIC + (bb << TD_BYTE_BDRY_LG) + sp->length; -} - -void -mac_queue_frame(sp) - struct mac_buf *sp; -{ - struct formac_state *msp = &this_mac_state; - - buffer_mem[sp->fr_end] = 0; /* null pointer at end of frame */ - buffer_mem[msp->xmit_ptr] = PT_MAGIC + sp->fr_start; - if (msp->xmit_chains <= 2) { - msp->xmit_chain_start[msp->xmit_chains] = msp->xmit_ptr; - if (msp->xmit_chains < 2) - mac->cmdreg2 = C2_XMIT_ASYNCQ0; - ++msp->xmit_chains; - } else { - buffer_mem[msp->xmit_more_ptr] |= TD_MORE; - } - msp->xmit_ptr = sp->fr_end; - msp->xmit_more_ptr = sp->fr_start; - *csr0 |= CS0_LED1; -} - -int -mac_xalloc(int nwords) -{ - int fr_start; - struct formac_state *msp = &this_mac_state; - - /* - * Find some room in the transmit buffer. - */ - fr_start = msp->xmit_free; - if (fr_start > msp->xmit_start) { - if (fr_start + nwords > XMIT_BUF_END) { - /* no space at end - see if we can start again from the front */ - fr_start = XMIT_BUF_START; - if (fr_start + nwords > msp->xmit_start) - panic("no space in xmit buffer (1)"); - } - } else { - if (fr_start + nwords > msp->xmit_start) - panic("no space in xmit buffer (2)"); - } - - msp->xmit_free = fr_start + nwords; - - return fr_start; -} - -int -mac_recv_frame(sp) - struct mac_buf *sp; -{ - struct formac_state *msp = &this_mac_state; - int status, bb, orig_recv_ptr; - - orig_recv_ptr = msp->recv_ptr; - for (;;) { - status = buffer_mem[msp->recv_ptr]; - if ((status & RS_VALID) == 0) { - if (status != 0) { - printk("recv buf out of sync: recv_ptr=%x status=%x\n", - msp->recv_ptr, status); - printk(" rpr=%x swpr=%x, buf[rpr]=%x\n", mac->rpr, mac->swpr, - buffer_mem[mac->rpr]); - msp->recv_ptr = mac->swpr; - } - *csr0 &= ~CS0_LED2; - msp->recv_empty = 1; - if (mac->rpr == orig_recv_ptr) - mac->rpr = msp->recv_ptr; - return 0; - } - if (status & RS_ABORTED) - ++msp->recv_aborted; - else { - bb = (status >> RS_BYTE_BDRY_LG) & 3; - if (bb != 3) { - ++msp->wrong_bb; - bb = 3; - } - if ((status & RS_ERROR) == 0) - break; - ++msp->recv_error; - msp->recv_ptr += NWORDS((status & RS_LENGTH) + bb); - } - if (++msp->recv_ptr >= RECV_BUF_END) - msp->recv_ptr -= RECV_BUF_SIZE; - } - ++msp->frames_recvd; - if (mac->rpr == orig_recv_ptr) - mac->rpr = msp->recv_ptr; - - sp->fr_start = msp->recv_ptr; - sp->length = (status & RS_LENGTH) + bb; /* + 4 (status) - 4 (FCS) */ - sp->ptr = (void *) &buffer_mem[sp->fr_start]; - if ((msp->recv_ptr += NWORDS(sp->length) + 1) >= RECV_BUF_END) - msp->recv_ptr -= RECV_BUF_SIZE; - sp->fr_end = msp->recv_ptr; - sp->wraplen = (RECV_BUF_END - sp->fr_start) * 4; - sp->wrapptr = (void *) &buffer_mem[RECV_BUF_START]; - - return 1; -} - -void -mac_discard_frame(sp) - struct mac_buf *sp; -{ - mac->rpr = sp->fr_end; -} - -/* - * Return the number of bytes free in the async 0 transmit queue. - */ -int -mac_xmit_space(void) -{ - struct formac_state *msp = &this_mac_state; - int nw; - - if (msp->xmit_free > msp->xmit_start) { - nw = XMIT_BUF_END - msp->xmit_free; - if (nw < msp->xmit_start - XMIT_BUF_START) - nw = msp->xmit_start - XMIT_BUF_START; - } else - nw = msp->xmit_start - msp->xmit_free; - return nw <= 2? 0: (nw - 2) << 2; -} - -/* - * Return the number of bytes of frames available in the receive queue. - */ -int -mac_recv_level(void) -{ - int nw; - - nw = mac->swpr - mac->rpr; - if (nw < 0) - nw += mac->earv - mac->eacb; - return nw << 2; -} - -/* - * Return 1 iff all transmission has been completed, 0 otherwise. - */ -int mac_xmit_done(void) -{ - struct formac_state *msp = &this_mac_state; - - return msp->xmit_chains == 0; -} - -/* - * Append skbuff packet to queue. - */ -int mac_queue_append (struct sk_buff *skb) -{ - struct mac_queue *el; - unsigned flags; - save_flags(flags); cli(); - -#if MAC_DEBUG - printk("Appending queue element skb 0x%x\n", skb); -#endif - - if ((el = (struct mac_queue *)kmalloc(sizeof(*el), GFP_ATOMIC)) == NULL) { - restore_flags(flags); - return 1; - } - el->next = NULL; - el->skb = skb; - - if (mac_queue_top == NULL) { - mac_queue_top = mac_queue_bottom = el; - } - else { - mac_queue_bottom->next = el; - mac_queue_bottom = el; - } - restore_flags(flags); - return 0; -} - -/* - * If the packet originated from the same FDDI subnet as we are on, - * there is no need to perform checksumming as FDDI will does this - * us. - */ -#define CHECK_IF_CHECKSUM_REQUIRED(skb) \ - if ((skb)->protocol == ETH_P_IP) { \ - extern struct cap_init cap_init; \ - int *from_ip = (int *)((skb)->data+12); \ - int *to_ip = (int *)((skb)->data+16); \ - if ((*from_ip & cap_init.netmask) == (*to_ip & cap_init.netmask)) \ - (skb)->ip_summed = CHECKSUM_UNNECESSARY; \ - } - -/* - * Try to send and/or recv frames. - */ -void mac_process(void) -{ - volatile struct dma_chan *dma = (volatile struct dma_chan *) DMA3; - struct formac_state *msp = &this_mac_state; - struct mac_queue *el; - int nw=0, mrl = 0, fstart, send_buffer_full = 0; - unsigned flags; - - save_flags(flags); cli(); - -#if MAC_DEBUG - printk("In mac_process()\n"); -#endif - - /* - * Check if the DMA is being used. - */ - if (msp->dma_state != IDLE) { - restore_flags(flags); - return; - } - - while (mac_queue_top != NULL || /* Something to transmit */ - (mrl = mac_recv_level()) > 0) { /* Frames in receive buffer */ - send_buffer_full = 0; -#if MAC_DEBUG - printk("mac_process(): something to do... mqt %x mrl is %d\n", - mac_queue_top, mrl); -#endif - if (mac_queue_top != NULL && mrl < RECV_THRESHOLD) { - el = (struct mac_queue *)mac_queue_top; - - /* - * Check there is enough space in the FDDI send buffer. - */ - if (mac_xmit_space() < el->skb->len) { -#if MAC_DEBUG - printk("process_queue(): FDDI send buffer is full\n"); -#endif - send_buffer_full = 1; - } - else { -#if MAC_DEBUG - printk("mac_process(): sending a frame\n"); -#endif - /* - * Update mac_queue_top. - */ - mac_queue_top = mac_queue_top->next; - - /* - * Allocate space in the FDDI send buffer. - */ - msp->cur_mbuf.length = el->skb->len-3; - mac_xmit_alloc((struct mac_buf *)&msp->cur_mbuf, 3); - - /* - * If message size is greater than DMA_XMIT_THRESHOLD, send - * using DMA, otherwise use memcpy(). - */ - if (el->skb->len > DMA_XMIT_THRESHOLD) { - /* - * Start the DMA. - */ -#if MAC_DEBUG - printk("mac_process(): Starting send DMA...\n"); -#endif - nw = msp->cur_mbuf.fr_end - msp->cur_mbuf.fr_start + 1; - mac->wpxa0 = msp->cur_mbuf.fr_start + 1; - - *csr0 |= CS0_HREQ_WA0; - - msp->cur_macq = el; - msp->dma_state = XMITTING; - dma->st = DMA_DMST_RST; - dma->st = DMA_RESET_MASKS; - dma->hskip = 1; /* skip = 0, count = 1 */ - dma->vskip = 1; /* skip = 0, count = 1 */ - dma->maddr = (u_char *) - mmu_v2p((unsigned long)el->skb->data); - dma->cmd = DMA_DCMD_ST + DMA_DCMD_TYP_AUTO + - DMA_DCMD_TD_MD + nw; - *csr0 &= ~CS0_DMA_RECV; - *csr0 |= CS0_DMA_ENABLE; - - /* - * Don't process any more packets since the DMA is - * being used. - */ - break; - } - else { /* el->skb->len <= DMA_XMIT_THRESHOLD */ - /* - * Copy the data directly into the FDDI buffer. - */ -#if MAC_DEBUG - printk("mac_proces(): Copying send data...\n"); -#endif - memcpy(msp->cur_mbuf.ptr - 3, el->skb->data, - ROUND4(el->skb->len)); - mac_queue_frame((struct mac_buf *)&msp->cur_mbuf); - dev_kfree_skb(el->skb); - kfree_s(el, sizeof(*el)); - continue; - } - } - - /* - * We have reached here if there is not enough space in the - * send buffer. Try to receive some packets instead. - */ - } - - if (mac_recv_frame((struct mac_buf *)&msp->cur_mbuf)) { - volatile int fc, llc_header_word2; - int pkt_len = 0; - -#if MAC_DEBUG - printk("mac_process(): Receiving frames...\n"); -#endif - /* - * Get the fc, note only word accesses are allowed from the - * FDDI buffers. - */ - if (msp->cur_mbuf.wraplen > 4) { - fc = *(int *)(msp->cur_mbuf.ptr+4); - } - else { - /* - * fc_word must be at the start of the FDDI buffer. - */ -#if MAC_DEBUG - printk("Grabbed fc_word from wrapptr, wraplen %d\n", - msp->cur_mbuf.wraplen); -#endif - fc = *(int *)msp->cur_mbuf.wrapptr; - } - fc &= 0xff; - -#if MAC_DEBUG - printk("fc is 0x%x\n", fc); -#endif - if (fc < 0x50 || fc > 0x57) { - mac_discard_frame((struct mac_buf *)&msp->cur_mbuf); - continue; - } - - /* - * Determine the size of the packet data and allocate a socket - * buffer. - */ - pkt_len = msp->cur_mbuf.length - FDDI_HARDHDR_LEN; -#if MAC_DEBUG - printk("Packet of length %d\n", pkt_len); -#endif - msp->cur_skb = dev_alloc_skb(ROUND4(pkt_len)); - - if (msp->cur_skb == NULL) { - printk("mac_process(): Memory squeeze, dropping packet.\n"); - apfddi_stats->rx_dropped++; - restore_flags(flags); - return; - } - msp->cur_skb->dev = apfddi_device; - - /* - * Hardware header isn't copied to skbuff. - */ - msp->cur_skb->mac.raw = msp->cur_skb->data; - apfddi_stats->rx_packets++; - - /* - * Determine protocol from llc header. - */ - if (msp->cur_mbuf.wraplen < FDDI_HARDHDR_LEN) { - llc_header_word2 = *(int *)(msp->cur_mbuf.wrapptr + - (FDDI_HARDHDR_LEN - - msp->cur_mbuf.wraplen - 4)); - } - else { - llc_header_word2 = *(int *)(msp->cur_mbuf.ptr + - FDDI_HARDHDR_LEN - 4); - } - msp->cur_skb->protocol = llc_header_word2 & 0xFFFF; -#if MAC_DEBUG - printk("Got protocol 0x%x\n", msp->cur_skb->protocol); -#endif - - /* - * Copy data into socket buffer, which may be wrapped around the - * FDDI buffer. Use memcpy if the size of the data is less - * than DMA_RECV_THRESHOLD. Note if DMA is used, then wrap- - * arounds are handled automatically. - */ - if (pkt_len < DMA_RECV_THRESHOLD) { - if (msp->cur_mbuf.length < msp->cur_mbuf.wraplen) { - memcpy(skb_put(msp->cur_skb, ROUND4(pkt_len)), - msp->cur_mbuf.ptr + FDDI_HARDHDR_LEN, - ROUND4(pkt_len)); - } - else if (msp->cur_mbuf.wraplen < FDDI_HARDHDR_LEN) { -#if MAC_DEBUG - printk("Wrap case 2\n"); -#endif - memcpy(skb_put(msp->cur_skb, ROUND4(pkt_len)), - msp->cur_mbuf.wrapptr + - (FDDI_HARDHDR_LEN - msp->cur_mbuf.wraplen), - ROUND4(pkt_len)); - } - else { -#if MAC_DEBUG - printk("wrap case 3\n"); -#endif - memcpy(skb_put(msp->cur_skb, - ROUND4(msp->cur_mbuf.wraplen- - FDDI_HARDHDR_LEN)), - msp->cur_mbuf.ptr + FDDI_HARDHDR_LEN, - ROUND4(msp->cur_mbuf.wraplen - FDDI_HARDHDR_LEN)); - memcpy(skb_put(msp->cur_skb, - ROUND4(msp->cur_mbuf.length - - msp->cur_mbuf.wraplen)), - msp->cur_mbuf.wrapptr, - ROUND4(msp->cur_mbuf.length - - msp->cur_mbuf.wraplen)); - } - -#if MAC_DEBUG - if (msp->cur_skb->protocol == ETH_P_IP) { - dump_packet("apfddi_rx:", msp->cur_skb->data, pkt_len, 0); - } - else if (msp->cur_skb->protocol == ETH_P_ARP) { - struct arphdr *arp = (struct arphdr *)msp->cur_skb->data; - printk("arp->ar_op is 0x%x ar_hrd %d ar_pro 0x%x ar_hln %d ar_ln %d\n", - arp->ar_op, arp->ar_hrd, arp->ar_pro, arp->ar_hln, - arp->ar_pln); - printk("sender hardware address: %x:%x:%x:%x:%x:%x\n", - *((u_char *)msp->cur_skb->data+8), - *((u_char *)msp->cur_skb->data+9), - *((u_char *)msp->cur_skb->data+10), - *((u_char *)msp->cur_skb->data+11), - *((u_char *)msp->cur_skb->data+12), - *((u_char *)msp->cur_skb->data+13)); - printk("sender IP number %d.%d.%d.%d\n", - *((u_char *)msp->cur_skb->data+14), - *((u_char *)msp->cur_skb->data+15), - *((u_char *)msp->cur_skb->data+16), - *((u_char *)msp->cur_skb->data+17)); - printk("receiver hardware address: %x:%x:%x:%x:%x:%x\n", - *((u_char *)msp->cur_skb->data+18), - *((u_char *)msp->cur_skb->data+19), - *((u_char *)msp->cur_skb->data+20), - *((u_char *)msp->cur_skb->data+21), - *((u_char *)msp->cur_skb->data+22), - *((u_char *)msp->cur_skb->data+23)); - printk("receiver IP number %d.%d.%d.%d\n", - *((u_char *)msp->cur_skb->data+24), - *((u_char *)msp->cur_skb->data+25), - *((u_char *)msp->cur_skb->data+26), - *((u_char *)msp->cur_skb->data+27)); - } -#endif - CHECK_IF_CHECKSUM_REQUIRED(msp->cur_skb); - - /* - * Inform the network layer of the new packet. - */ -#if MAC_DEBUG - printk("Calling netif_rx()\n"); -#endif - netif_rx(msp->cur_skb); - - /* - * Remove frame from FDDI buffer. - */ - mac_discard_frame((struct mac_buf *)&msp->cur_mbuf); - continue; - } - else { - /* - * Set up dma and break. - */ -#if MAC_DEBUG - printk("mac_process(): Starting receive DMA...\n"); -#endif - nw = NWORDS(pkt_len); - msp->dma_state = RECVING; - *csr0 &= ~(CS0_HREQ | CS0_DMA_ENABLE); -/* *csr1 |= CS1_RESET_FIFO; - *csr1 &= ~CS1_RESET_FIFO; */ - if ((*csr1 & CS1_FIFO_LEVEL) != 0) { - int x; - printk("fifo not empty! (csr1 = 0x%x) emptying...", *csr1); - do { - x = *fifo; - } while ((*csr1 & CS1_FIFO_LEVEL) != 0); - printk("done\n"); - } - fstart = msp->cur_mbuf.fr_start + NWORDS(FDDI_HARDHDR_LEN); - if (fstart >= RECV_BUF_END) - fstart -= RECV_BUF_SIZE; - mac->rpr = fstart; -#if MAC_DEBUG - printk("rpr=0x%x, nw=0x%x, stat=0x%x\n", - mac->rpr, nw, buffer_mem[msp->cur_mbuf.fr_start]); -#endif - dma->st = DMA_DMST_RST; - dma->st = DMA_RESET_MASKS; - dma->hskip = 1; /* skip = 0, count = 1 */ - dma->vskip = 1; /* skip = 0, count = 1 */ - dma->maddr = (u_char *) - mmu_v2p((unsigned long) - skb_put(msp->cur_skb, ROUND4(pkt_len))); - dma->cmd = DMA_DCMD_ST + DMA_DCMD_TYP_AUTO + DMA_DCMD_TD_DM - + nw - 4; - *csr0 |= CS0_HREQ_RECV | CS0_DMA_RECV; - *csr0 |= CS0_DMA_ENABLE; -#if MAC_DEBUG - printk("mac_process(): DMA is away!\n"); -#endif - break; - } - } - else { -#if MAC_DEBUG - printk("mac_recv_frame failed\n"); -#endif - if (msp->recv_empty && send_buffer_full) - break; - } - } - /* - * Update mac_queue_bottom. - */ - if (mac_queue_top == NULL) - mac_queue_bottom = NULL; - -#if MAC_DEBUG - printk("End of mac_process()\n"); -#endif - restore_flags(flags); -} - - -#define DMA_IN(reg) (*(volatile unsigned *)(reg)) -#define DMA_OUT(reg,v) (*(volatile unsigned *)(reg) = (v)) - -/* - * DMA completion handler. - */ -void mac_dma_complete(void) -{ - volatile struct dma_chan *dma; - struct formac_state *msp = &this_mac_state; - unsigned a; - - a = DMA_IN(DMA3_DMST); - if (!(a & DMA_INTR_REQS)) { - if (msp->dma_state != IDLE && (a & DMA_DMST_AC) == 0) { - printk("dma completed but no interrupt!\n"); - msp->dma_state = IDLE; - } - return; - } - - DMA_OUT(DMA3_DMST,AP_CLR_INTR_REQ<<DMA_INTR_NORMAL_SH); - DMA_OUT(DMA3_DMST,AP_CLR_INTR_REQ<<DMA_INTR_ERROR_SH); - - dma = (volatile struct dma_chan *) DMA3; - -#if MAC_DEBUG - printk("In mac_dma_complete\n"); -#endif - - if (msp->dma_state == XMITTING && ((dma->st & DMA_DMST_AC) == 0)) { - /* - * Transmit DMA finished. - */ - int i = 20; -#if MAC_DEBUG - printk("In mac_dma_complete for transmit complete\n"); -#endif - while (*csr1 & CS1_FIFO_LEVEL) { - if (--i <= 0) { - printk("csr0=0x%x csr1=0x%x: fifo not emptying\n", *csr0, - *csr1); - return; - } - } - *csr0 &= ~(CS0_HREQ | CS0_DMA_ENABLE); - msp->dma_state = IDLE; -#if MAC_DEBUG - printk("mac_dma_complete(): Calling mac_queue_frame\n"); -#endif - mac_queue_frame((struct mac_buf *)&msp->cur_mbuf); - dev_kfree_skb(msp->cur_macq->skb); - kfree_s((struct mac_buf *)msp->cur_macq, sizeof(*(msp->cur_macq))); - msp->cur_macq = NULL; -#if MAC_DEBUG - printk("mac_dma_complete(): Calling mac_process()\n"); -#endif - mac_process(); -#if MAC_DEBUG - printk("End of mac_dma_complete transmitting\n"); -#endif - } - else if (msp->dma_state == RECVING && ((dma->st & DMA_DMST_AC) == 0)) { - /* - * Receive DMA finished. Copy the last four words from the - * fifo into the buffer, after turning off the host requests. - * We do this to avoid reading past the end of frame. - */ - int *ip, i; - -#if MAC_DEBUG - printk("In mac_dma_complete for receive complete\n"); -#endif - msp->dma_state = IDLE; - ip = (int *)mmu_p2v((unsigned long)dma->cmaddr); - -#if MAC_DEBUG - printk("ip is 0x%x, skb->data is 0x%x\n", ip, msp->cur_skb->data); -#endif - - *csr0 &= ~(CS0_DMA_ENABLE | CS0_HREQ); - - for (i = 0; (*csr1 & CS1_FIFO_LEVEL); ++i) - ip[i] = *fifo; - if (i != 4) - printk("mac_dma_complete(): not four words remaining in fifo?\n"); -#if MAC_DEBUG - printk("Copied last four words out of fifo\n"); -#endif - - /* - * Remove the frame from the FDDI receive buffer. - */ - mac_discard_frame((struct mac_buf *)&msp->cur_mbuf); - - CHECK_IF_CHECKSUM_REQUIRED(msp->cur_skb); - - /* - * Now inject the packet into the network system. - */ - netif_rx(msp->cur_skb); - -#if MAC_DEBUG - dump_packet("mac_dma_complete:", msp->cur_skb->data, 0, 0); -#endif - - /* - * Check if any more frames can be processed. - */ - mac_process(); - -#if MAC_DEBUG - printk("End of mac_dma_complete receiving\n"); -#endif - } -#if MAC_DEBUG - printk("End of mac_dma_complete()\n"); -#endif -} - -static void mac_print_state(void) -{ - struct formac_state *msp = &this_mac_state; - - printk("DMA3_DMST is 0x%x dma_state is %d\n", DMA_IN(DMA3_DMST), - msp->dma_state); - printk("csr0 = 0x%x, csr1 = 0x%x\n", *csr0, *csr1); -} - - |