123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800 |
- #include <common.h>
- #include <command.h>
- #include <net.h>
- #include <malloc.h>
- #include <linux/compiler.h>
- void uboot_push_packet_len(int len);
- void uboot_push_tx_done(int key, int val);
- #include "ne2000_base.h"
- #if defined(CONFIG_DRIVER_AX88796L)
- #include "ax88796.h"
- #else
- #include "ne2000.h"
- #endif
- static dp83902a_priv_data_t nic;
- static bool
- dp83902a_init(unsigned char *enetaddr)
- {
- dp83902a_priv_data_t *dp = &nic;
- u8* base;
- #if defined(NE2000_BASIC_INIT)
- int i;
- #endif
- DEBUG_FUNCTION();
- base = dp->base;
- if (!base)
- return false;
- DEBUG_LINE();
- #if defined(NE2000_BASIC_INIT)
-
-
- DP_OUT(base, DP_CR, DP_CR_NODMA | DP_CR_PAGE1);
-
- for (i = 0; i < 6; i++)
- DP_IN(base, DP_P1_PAR0+i, dp->esa[i]);
- DP_OUT(base, DP_CR, DP_CR_NODMA | DP_CR_PAGE0);
- printf("NE2000 - %s ESA: %02x:%02x:%02x:%02x:%02x:%02x\n",
- "eeprom",
- dp->esa[0],
- dp->esa[1],
- dp->esa[2],
- dp->esa[3],
- dp->esa[4],
- dp->esa[5] );
- memcpy(enetaddr, dp->esa, 6);
- #endif
- return true;
- }
- static void
- dp83902a_stop(void)
- {
- dp83902a_priv_data_t *dp = &nic;
- u8 *base = dp->base;
- DEBUG_FUNCTION();
- DP_OUT(base, DP_CR, DP_CR_PAGE0 | DP_CR_NODMA | DP_CR_STOP);
- DP_OUT(base, DP_ISR, 0xFF);
- DP_OUT(base, DP_IMR, 0x00);
- dp->running = false;
- }
- static void
- dp83902a_start(u8 * enaddr)
- {
- dp83902a_priv_data_t *dp = &nic;
- u8 *base = dp->base;
- int i;
- debug("The MAC is %pM\n", enaddr);
- DEBUG_FUNCTION();
- DP_OUT(base, DP_CR, DP_CR_PAGE0 | DP_CR_NODMA | DP_CR_STOP);
- DP_OUT(base, DP_DCR, DP_DCR_INIT);
- DP_OUT(base, DP_RBCH, 0);
- DP_OUT(base, DP_RBCL, 0);
- DP_OUT(base, DP_RCR, DP_RCR_MON);
- DP_OUT(base, DP_TCR, DP_TCR_LOCAL);
- DP_OUT(base, DP_TPSR, dp->tx_buf1);
- dp->tx1 = dp->tx2 = 0;
- dp->tx_next = dp->tx_buf1;
- dp->tx_started = false;
- dp->running = true;
- DP_OUT(base, DP_PSTART, dp->rx_buf_start);
- DP_OUT(base, DP_BNDRY, dp->rx_buf_end - 1);
- DP_OUT(base, DP_PSTOP, dp->rx_buf_end);
- dp->rx_next = dp->rx_buf_start - 1;
- dp->running = true;
- DP_OUT(base, DP_ISR, 0xFF);
- DP_OUT(base, DP_IMR, DP_IMR_All);
- DP_OUT(base, DP_CR, DP_CR_NODMA | DP_CR_PAGE1 | DP_CR_STOP);
- DP_OUT(base, DP_P1_CURP, dp->rx_buf_start);
- dp->running = true;
- for (i = 0; i < ETHER_ADDR_LEN; i++) {
-
-
- DP_OUT(base, DP_P1_PAR0+i, enaddr[i]);
- }
-
- DP_OUT(base, DP_CR, DP_CR_PAGE0 | DP_CR_NODMA | DP_CR_START);
- DP_OUT(base, DP_TCR, DP_TCR_NORMAL);
- DP_OUT(base, DP_RCR, DP_RCR_AB);
- dp->running = true;
- }
- static void
- dp83902a_start_xmit(int start_page, int len)
- {
- dp83902a_priv_data_t *dp = (dp83902a_priv_data_t *) &nic;
- u8 *base = dp->base;
- DEBUG_FUNCTION();
- #if DEBUG & 1
- printf("Tx pkt %d len %d\n", start_page, len);
- if (dp->tx_started)
- printf("TX already started?!?\n");
- #endif
- DP_OUT(base, DP_ISR, (DP_ISR_TxP | DP_ISR_TxE));
- DP_OUT(base, DP_CR, DP_CR_PAGE0 | DP_CR_NODMA | DP_CR_START);
- DP_OUT(base, DP_TBCL, len & 0xFF);
- DP_OUT(base, DP_TBCH, len >> 8);
- DP_OUT(base, DP_TPSR, start_page);
- DP_OUT(base, DP_CR, DP_CR_NODMA | DP_CR_TXPKT | DP_CR_START);
- dp->tx_started = true;
- }
- static void
- dp83902a_send(u8 *data, int total_len, u32 key)
- {
- struct dp83902a_priv_data *dp = (struct dp83902a_priv_data *) &nic;
- u8 *base = dp->base;
- int len, start_page, pkt_len, i, isr;
- #if DEBUG & 4
- int dx;
- #endif
- DEBUG_FUNCTION();
- len = pkt_len = total_len;
- if (pkt_len < IEEE_8023_MIN_FRAME)
- pkt_len = IEEE_8023_MIN_FRAME;
- start_page = dp->tx_next;
- if (dp->tx_next == dp->tx_buf1) {
- dp->tx1 = start_page;
- dp->tx1_len = pkt_len;
- dp->tx1_key = key;
- dp->tx_next = dp->tx_buf2;
- } else {
- dp->tx2 = start_page;
- dp->tx2_len = pkt_len;
- dp->tx2_key = key;
- dp->tx_next = dp->tx_buf1;
- }
- #if DEBUG & 5
- printf("TX prep page %d len %d\n", start_page, pkt_len);
- #endif
- DP_OUT(base, DP_ISR, DP_ISR_RDC);
- {
-
- __maybe_unused u16 tmp;
- int len = 1;
- DP_OUT(base, DP_RSAL, 0x100 - len);
- DP_OUT(base, DP_RSAH, (start_page - 1) & 0xff);
- DP_OUT(base, DP_RBCL, len);
- DP_OUT(base, DP_RBCH, 0);
- DP_OUT(base, DP_CR, DP_CR_PAGE0 | DP_CR_RDMA | DP_CR_START);
- DP_IN_DATA(dp->data, tmp);
- }
- #ifdef CYGHWR_NS_DP83902A_PLF_BROKEN_TX_DMA
-
- CYGACC_CALL_IF_DELAY_US(1);
- #endif
-
- DP_OUT(base, DP_RSAL, 0);
- DP_OUT(base, DP_RSAH, start_page);
- DP_OUT(base, DP_RBCL, pkt_len & 0xFF);
- DP_OUT(base, DP_RBCH, pkt_len >> 8);
- DP_OUT(base, DP_CR, DP_CR_WDMA | DP_CR_START);
-
- #if DEBUG & 4
- printf(" sg buf %08lx len %08x\n ", (u32)data, len);
- dx = 0;
- #endif
- while (len > 0) {
- #if DEBUG & 4
- printf(" %02x", *data);
- if (0 == (++dx % 16)) printf("\n ");
- #endif
- DP_OUT_DATA(dp->data, *data++);
- len--;
- }
- #if DEBUG & 4
- printf("\n");
- #endif
- if (total_len < pkt_len) {
- #if DEBUG & 4
- printf(" + %d bytes of padding\n", pkt_len - total_len);
- #endif
-
- for (i = total_len; i < pkt_len;) {
- i++;
- DP_OUT_DATA(dp->data, 0);
- }
- }
- #ifdef CYGHWR_NS_DP83902A_PLF_BROKEN_TX_DMA
-
- CYGACC_CALL_IF_DELAY_US(1);
- #endif
-
- do {
- DP_IN(base, DP_ISR, isr);
- } while ((isr & DP_ISR_RDC) == 0);
-
- DP_OUT(base, DP_CR, DP_CR_PAGE0 | DP_CR_NODMA | DP_CR_START);
-
- if (!dp->tx_started) {
- if (start_page == dp->tx1) {
- dp->tx_int = 1;
- } else {
- dp->tx_int = 2;
- }
- dp83902a_start_xmit(start_page, pkt_len);
- }
- }
- static void
- dp83902a_RxEvent(void)
- {
- struct dp83902a_priv_data *dp = (struct dp83902a_priv_data *) &nic;
- u8 *base = dp->base;
- __maybe_unused u8 rsr;
- u8 rcv_hdr[4];
- int i, len, pkt, cur;
- DEBUG_FUNCTION();
- DP_IN(base, DP_RSR, rsr);
- while (true) {
-
- DP_OUT(base, DP_CR, DP_CR_PAGE1 | DP_CR_NODMA | DP_CR_START);
- DP_IN(base, DP_P1_CURP, cur);
- DP_OUT(base, DP_P1_CR, DP_CR_PAGE0 | DP_CR_NODMA | DP_CR_START);
- DP_IN(base, DP_BNDRY, pkt);
- pkt += 1;
- if (pkt == dp->rx_buf_end)
- pkt = dp->rx_buf_start;
- if (pkt == cur) {
- break;
- }
- DP_OUT(base, DP_RBCL, sizeof(rcv_hdr));
- DP_OUT(base, DP_RBCH, 0);
- DP_OUT(base, DP_RSAL, 0);
- DP_OUT(base, DP_RSAH, pkt);
- if (dp->rx_next == pkt) {
- if (cur == dp->rx_buf_start)
- DP_OUT(base, DP_BNDRY, dp->rx_buf_end - 1);
- else
- DP_OUT(base, DP_BNDRY, cur - 1);
- return;
- }
- dp->rx_next = pkt;
- DP_OUT(base, DP_ISR, DP_ISR_RDC);
- DP_OUT(base, DP_CR, DP_CR_RDMA | DP_CR_START);
- #ifdef CYGHWR_NS_DP83902A_PLF_BROKEN_RX_DMA
- CYGACC_CALL_IF_DELAY_US(10);
- #endif
-
- for (i = 0; i < sizeof(rcv_hdr);) {
- DP_IN_DATA(dp->data, rcv_hdr[i++]);
- }
- #if DEBUG & 5
- printf("rx hdr %02x %02x %02x %02x\n",
- rcv_hdr[0], rcv_hdr[1], rcv_hdr[2], rcv_hdr[3]);
- #endif
- len = ((rcv_hdr[3] << 8) | rcv_hdr[2]) - sizeof(rcv_hdr);
-
- uboot_push_packet_len(len);
- if (rcv_hdr[1] == dp->rx_buf_start)
- DP_OUT(base, DP_BNDRY, dp->rx_buf_end - 1);
- else
- DP_OUT(base, DP_BNDRY, rcv_hdr[1] - 1);
- }
- }
- static void
- dp83902a_recv(u8 *data, int len)
- {
- struct dp83902a_priv_data *dp = (struct dp83902a_priv_data *) &nic;
- u8 *base = dp->base;
- int i, mlen;
- u8 saved_char = 0;
- bool saved;
- #if DEBUG & 4
- int dx;
- #endif
- DEBUG_FUNCTION();
- #if DEBUG & 5
- printf("Rx packet %d length %d\n", dp->rx_next, len);
- #endif
-
- DP_OUT(base, DP_CR, DP_CR_PAGE0 | DP_CR_NODMA | DP_CR_START);
- DP_OUT(base, DP_RBCL, len & 0xFF);
- DP_OUT(base, DP_RBCH, len >> 8);
- DP_OUT(base, DP_RSAL, 4);
- DP_OUT(base, DP_RSAH, dp->rx_next);
- DP_OUT(base, DP_ISR, DP_ISR_RDC);
- DP_OUT(base, DP_CR, DP_CR_RDMA | DP_CR_START);
- #ifdef CYGHWR_NS_DP83902A_PLF_BROKEN_RX_DMA
- CYGACC_CALL_IF_DELAY_US(10);
- #endif
- saved = false;
- for (i = 0; i < 1; i++) {
- if (data) {
- mlen = len;
- #if DEBUG & 4
- printf(" sg buf %08lx len %08x \n", (u32) data, mlen);
- dx = 0;
- #endif
- while (0 < mlen) {
-
- if (saved) {
- *data++ = saved_char;
- mlen--;
- saved = false;
- continue;
- }
- {
- u8 tmp;
- DP_IN_DATA(dp->data, tmp);
- #if DEBUG & 4
- printf(" %02x", tmp);
- if (0 == (++dx % 16)) printf("\n ");
- #endif
- *data++ = tmp;;
- mlen--;
- }
- }
- #if DEBUG & 4
- printf("\n");
- #endif
- }
- }
- }
- static void
- dp83902a_TxEvent(void)
- {
- struct dp83902a_priv_data *dp = (struct dp83902a_priv_data *) &nic;
- u8 *base = dp->base;
- __maybe_unused u8 tsr;
- u32 key;
- DEBUG_FUNCTION();
- DP_IN(base, DP_TSR, tsr);
- if (dp->tx_int == 1) {
- key = dp->tx1_key;
- dp->tx1 = 0;
- } else {
- key = dp->tx2_key;
- dp->tx2 = 0;
- }
-
- dp->tx_started = false;
- if (dp->tx1) {
- dp83902a_start_xmit(dp->tx1, dp->tx1_len);
- dp->tx_int = 1;
- } else if (dp->tx2) {
- dp83902a_start_xmit(dp->tx2, dp->tx2_len);
- dp->tx_int = 2;
- } else {
- dp->tx_int = 0;
- }
-
- uboot_push_tx_done(key, 0);
- }
- static void
- dp83902a_ClearCounters(void)
- {
- struct dp83902a_priv_data *dp = (struct dp83902a_priv_data *) &nic;
- u8 *base = dp->base;
- __maybe_unused u8 cnt1, cnt2, cnt3;
- DP_IN(base, DP_FER, cnt1);
- DP_IN(base, DP_CER, cnt2);
- DP_IN(base, DP_MISSED, cnt3);
- DP_OUT(base, DP_ISR, DP_ISR_CNT);
- }
- static void
- dp83902a_Overflow(void)
- {
- struct dp83902a_priv_data *dp = (struct dp83902a_priv_data *)&nic;
- u8 *base = dp->base;
- u8 isr;
-
- DP_OUT(base, DP_CR, DP_CR_STOP | DP_CR_NODMA);
- CYGACC_CALL_IF_DELAY_US(1600);
-
- DP_OUT(base, DP_RBCL, 0);
- DP_OUT(base, DP_RBCH, 0);
-
- DP_OUT(base, DP_TCR, DP_TCR_LOCAL);
- DP_OUT(base, DP_CR, DP_CR_START | DP_CR_NODMA);
-
- dp83902a_RxEvent();
- DP_OUT(base, DP_ISR, DP_ISR_RxP|DP_ISR_RxE);
-
- DP_OUT(base, DP_ISR, DP_ISR_OFLW);
- DP_OUT(base, DP_TCR, DP_TCR_NORMAL);
-
- DP_IN(base, DP_ISR, isr);
- if (dp->tx_started && !(isr & (DP_ISR_TxP|DP_ISR_TxE))) {
- DP_OUT(base, DP_CR, DP_CR_NODMA | DP_CR_TXPKT | DP_CR_START);
- }
- }
- static void
- dp83902a_poll(void)
- {
- struct dp83902a_priv_data *dp = (struct dp83902a_priv_data *) &nic;
- u8 *base = dp->base;
- u8 isr;
- DP_OUT(base, DP_CR, DP_CR_NODMA | DP_CR_PAGE0 | DP_CR_START);
- DP_IN(base, DP_ISR, isr);
- while (0 != isr) {
-
- if (isr & DP_ISR_CNT) {
- dp83902a_ClearCounters();
- }
-
- if (isr & DP_ISR_OFLW) {
- dp83902a_Overflow();
- } else {
-
- DP_OUT(base, DP_ISR, isr);
- if (!dp->running) break;
-
- if (isr & (DP_ISR_TxP|DP_ISR_TxE) && dp->tx_started) {
- dp83902a_TxEvent();
- }
- if (isr & (DP_ISR_RxP|DP_ISR_RxE)) {
- dp83902a_RxEvent();
- }
- }
- DP_IN(base, DP_ISR, isr);
- }
- }
- static u8 *pbuf = NULL;
- static int pkey = -1;
- static int initialized = 0;
- void uboot_push_packet_len(int len) {
- PRINTK("pushed len = %d\n", len);
- if (len >= 2000) {
- printf("NE2000: packet too big\n");
- return;
- }
- dp83902a_recv(&pbuf[0], len);
-
- net_process_received_packet(&pbuf[0], len);
- }
- void uboot_push_tx_done(int key, int val) {
- PRINTK("pushed key = %d\n", key);
- pkey = key;
- }
- static int ne2k_setup_driver(struct eth_device *dev)
- {
- PRINTK("### ne2k_setup_driver\n");
- if (!pbuf) {
- pbuf = malloc(2000);
- if (!pbuf) {
- printf("Cannot allocate rx buffer\n");
- return -1;
- }
- }
- #ifdef CONFIG_DRIVER_NE2000_CCR
- {
- vu_char *p = (vu_char *) CONFIG_DRIVER_NE2000_CCR;
- PRINTK("CCR before is %x\n", *p);
- *p = CONFIG_DRIVER_NE2000_VAL;
- PRINTK("CCR after is %x\n", *p);
- }
- #endif
- nic.base = (u8 *) CONFIG_DRIVER_NE2000_BASE;
- nic.data = nic.base + DP_DATA;
- nic.tx_buf1 = START_PG;
- nic.tx_buf2 = START_PG2;
- nic.rx_buf_start = RX_START;
- nic.rx_buf_end = RX_END;
-
- if (!eth_getenv_enetaddr("ethaddr", dev->enetaddr)) {
-
- if (!get_prom(dev->enetaddr, nic.base))
- dp83902a_init(dev->enetaddr);
-
- eth_setenv_enetaddr("ethaddr", dev->enetaddr);
- }
- return 0;
- }
- static int ne2k_init(struct eth_device *dev, bd_t *bd)
- {
- dp83902a_start(dev->enetaddr);
- initialized = 1;
- return 0;
- }
- static void ne2k_halt(struct eth_device *dev)
- {
- debug("### ne2k_halt\n");
- if(initialized)
- dp83902a_stop();
- initialized = 0;
- }
- static int ne2k_recv(struct eth_device *dev)
- {
- dp83902a_poll();
- return 1;
- }
- static int ne2k_send(struct eth_device *dev, void *packet, int length)
- {
- int tmo;
- debug("### ne2k_send\n");
- pkey = -1;
- dp83902a_send((u8 *) packet, length, 666);
- tmo = get_timer (0) + TOUT * CONFIG_SYS_HZ;
- while(1) {
- dp83902a_poll();
- if (pkey != -1) {
- PRINTK("Packet sucesfully sent\n");
- return 0;
- }
- if (get_timer (0) >= tmo) {
- printf("transmission error (timoeut)\n");
- return 0;
- }
- }
- return 0;
- }
- int ne2k_register(void)
- {
- struct eth_device *dev;
- dev = calloc(sizeof(*dev), 1);
- if (dev == NULL)
- return -1;
- if (ne2k_setup_driver(dev))
- return -1;
- dev->init = ne2k_init;
- dev->halt = ne2k_halt;
- dev->send = ne2k_send;
- dev->recv = ne2k_recv;
- strcpy(dev->name, "NE2000");
- return eth_register(dev);
- }
|