123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798 |
- #include <common.h>
- #include <command.h>
- #include <malloc.h>
- #include "lan91c96.h"
- #include <net.h>
- #include <linux/compiler.h>
- #define POWER_DOWN 0
- #define MEMORY_WAIT_TIME 16
- #define SMC_DEBUG 0
- #if (SMC_DEBUG > 2 )
- #define PRINTK3(args...) printf(args)
- #else
- #define PRINTK3(args...)
- #endif
- #if SMC_DEBUG > 1
- #define PRINTK2(args...) printf(args)
- #else
- #define PRINTK2(args...)
- #endif
- #ifdef SMC_DEBUG
- #define PRINTK(args...) printf(args)
- #else
- #define PRINTK(args...)
- #endif
- #define DRIVER_NAME "LAN91C96"
- #define SMC_ALLOC_MAX_TRY 5
- #define SMC_TX_TIMEOUT 30
- #define ETH_ZLEN 60
- #ifdef CONFIG_LAN91C96_USE_32_BIT
- #define USE_32_BIT 1
- #else
- #undef USE_32_BIT
- #endif
- static int smc_get_ethaddr(bd_t *bd, struct eth_device *dev);
- static int get_rom_mac(struct eth_device *dev, unsigned char *v_rom_mac);
- static unsigned char smc_mac_addr[] = { 0xc0, 0x00, 0x00, 0x1b, 0x62, 0x9c };
- static void smc_set_mac_addr(const unsigned char *addr)
- {
- int i;
- for (i = 0; i < sizeof (smc_mac_addr); i++) {
- smc_mac_addr[i] = addr[i];
- }
- }
- void dump_memory_info(struct eth_device *dev)
- {
- __maybe_unused word mem_info;
- word old_bank;
- old_bank = SMC_inw(dev, LAN91C96_BANK_SELECT) & 0xF;
- SMC_SELECT_BANK(dev, 0);
- mem_info = SMC_inw(dev, LAN91C96_MIR);
- PRINTK2 ("Memory: %4d available\n", (mem_info >> 8) * 2048);
- SMC_SELECT_BANK(dev, old_bank);
- }
- #if SMC_DEBUG > 2
- static void print_packet (byte *, int);
- #endif
- static int poll4int (struct eth_device *dev, byte mask, int timeout)
- {
- int tmo = get_timer (0) + timeout * CONFIG_SYS_HZ;
- int is_timeout = 0;
- word old_bank = SMC_inw(dev, LAN91C96_BANK_SELECT);
- PRINTK2 ("Polling...\n");
- SMC_SELECT_BANK(dev, 2);
- while ((SMC_inw(dev, LAN91C96_INT_STATS) & mask) == 0) {
- if (get_timer (0) >= tmo) {
- is_timeout = 1;
- break;
- }
- }
-
- SMC_SELECT_BANK(dev, old_bank);
- if (is_timeout)
- return 1;
- else
- return 0;
- }
- static void smc_reset(struct eth_device *dev)
- {
- PRINTK2("%s:smc_reset\n", dev->name);
-
- SMC_SELECT_BANK(dev, 0);
- SMC_outw(dev, LAN91C96_RCR_SOFT_RST, LAN91C96_RCR);
- udelay (10);
-
- SMC_outw(dev, 0, LAN91C96_RCR);
- SMC_outw(dev, 0, LAN91C96_TCR);
-
- SMC_SELECT_BANK(dev, 1);
- SMC_outw(dev, SMC_inw(dev, LAN91C96_CONTROL) | LAN91C96_CTR_BIT_8,
- LAN91C96_CONTROL);
-
- SMC_outb(dev, 0, LAN91C96_INT_MASK);
- }
- static void smc_enable(struct eth_device *dev)
- {
- PRINTK2("%s:smc_enable\n", dev->name);
- SMC_SELECT_BANK(dev, 0);
-
- SMC_outw(dev, LAN91C96_MCR_TRANSMIT_PAGES, LAN91C96_MCR);
-
- SMC_outw(dev, LAN91C96_TCR_TXENA, LAN91C96_TCR);
-
- SMC_outw(dev, LAN91C96_RCR_RXEN | LAN91C96_RCR_PRMS, LAN91C96_RCR);
- }
- static void smc_shutdown(struct eth_device *dev)
- {
- PRINTK2("%s:smc_shutdown\n", dev->name);
-
- SMC_SELECT_BANK(dev, 2);
- SMC_outb(dev, 0, LAN91C96_INT_MASK);
-
- SMC_SELECT_BANK(dev, 0);
- SMC_outb(dev, 0, LAN91C96_RCR);
- SMC_outb(dev, 0, LAN91C96_TCR);
- }
- static int smc_send_packet(struct eth_device *dev, void *packet,
- int packet_length)
- {
- byte packet_no;
- byte *buf;
- int length;
- int numPages;
- int try = 0;
- int time_out;
- byte status;
- PRINTK3("%s:smc_hardware_send_packet\n", dev->name);
- length = ETH_ZLEN < packet_length ? packet_length : ETH_ZLEN;
-
- numPages = ((length & 0xfffe) + 6);
- numPages >>= 8;
- if (numPages > 7) {
- printf("%s: Far too big packet error. \n", dev->name);
- return 0;
- }
-
- SMC_SELECT_BANK(dev, 2);
- SMC_outw(dev, LAN91C96_MMUCR_ALLOC_TX | numPages, LAN91C96_MMU);
- again:
- try++;
- time_out = MEMORY_WAIT_TIME;
- do {
- status = SMC_inb(dev, LAN91C96_INT_STATS);
- if (status & LAN91C96_IST_ALLOC_INT) {
- SMC_outb(dev, LAN91C96_IST_ALLOC_INT,
- LAN91C96_INT_STATS);
- break;
- }
- } while (--time_out);
- if (!time_out) {
- PRINTK2 ("%s: memory allocation, try %d failed ...\n",
- dev->name, try);
- if (try < SMC_ALLOC_MAX_TRY)
- goto again;
- else
- return 0;
- }
- PRINTK2 ("%s: memory allocation, try %d succeeded ...\n",
- dev->name, try);
-
- buf = (byte *) packet;
-
- packet_no = SMC_inb(dev, LAN91C96_ARR);
- if (packet_no & LAN91C96_ARR_FAILED) {
-
- printf("%s: Memory allocation failed. \n", dev->name);
- return 0;
- }
-
- SMC_outb(dev, packet_no, LAN91C96_PNR);
-
- SMC_outw(dev, LAN91C96_PTR_AUTO_INCR, LAN91C96_POINTER);
- PRINTK3("%s: Trying to xmit packet of length %x\n",
- dev->name, length);
- #if SMC_DEBUG > 2
- printf ("Transmitting Packet\n");
- print_packet (buf, length);
- #endif
-
- #ifdef USE_32_BIT
- SMC_outl(dev, (length + 6) << 16, LAN91C96_DATA_HIGH);
- #else
- SMC_outw(dev, 0, LAN91C96_DATA_HIGH);
-
- SMC_outw(dev, (length + 6), LAN91C96_DATA_HIGH);
- #endif
-
- #ifdef USE_32_BIT
- SMC_outsl(dev, LAN91C96_DATA_HIGH, buf, length >> 2);
- if (length & 0x2)
- SMC_outw(dev, *((word *) (buf + (length & 0xFFFFFFFC))),
- LAN91C96_DATA_HIGH);
- #else
- SMC_outsw(dev, LAN91C96_DATA_HIGH, buf, (length) >> 1);
- #endif
-
- if ((length & 1) == 0) {
- SMC_outw(dev, 0, LAN91C96_DATA_HIGH);
- } else {
- SMC_outw(dev, buf[length - 1] | 0x2000, LAN91C96_DATA_HIGH);
- }
-
- SMC_outw(dev, LAN91C96_MMUCR_ENQUEUE, LAN91C96_MMU);
-
- if (poll4int (dev, LAN91C96_MSK_TX_INT, SMC_TX_TIMEOUT)) {
-
- PRINTK2("%s: TX timeout, sending failed...\n", dev->name);
-
- SMC_outw(dev, LAN91C96_MMUCR_RELEASE_TX, LAN91C96_MMU);
-
- while (SMC_inw(dev, LAN91C96_MMU) & LAN91C96_MMUCR_NO_BUSY)
- udelay (10);
- PRINTK2("MMU ready\n");
- return 0;
- } else {
-
- SMC_outw(dev, LAN91C96_IST_TX_INT, LAN91C96_INT_STATS);
- PRINTK2("%s: Sent packet of length %d \n", dev->name, length);
-
- SMC_outw(dev, LAN91C96_MMUCR_RELEASE_TX, LAN91C96_MMU);
-
- while (SMC_inw(dev, LAN91C96_MMU) & LAN91C96_MMUCR_NO_BUSY)
- udelay (10);
- PRINTK2 ("MMU ready\n");
- }
- return length;
- }
- static int smc_open(bd_t *bd, struct eth_device *dev)
- {
- int i, err;
- PRINTK2("%s:smc_open\n", dev->name);
-
- smc_reset(dev);
- smc_enable(dev);
- SMC_SELECT_BANK(dev, 1);
-
- err = smc_get_ethaddr(bd, dev);
- if (err < 0)
- return -1;
- #ifdef USE_32_BIT
- for (i = 0; i < 6; i += 2) {
- word address;
- address = smc_mac_addr[i + 1] << 8;
- address |= smc_mac_addr[i];
- SMC_outw(dev, address, LAN91C96_IA0 + i);
- }
- #else
- for (i = 0; i < 6; i++)
- SMC_outb(dev, smc_mac_addr[i], LAN91C96_IA0 + i);
- #endif
- return 0;
- }
- static int smc_rcv(struct eth_device *dev)
- {
- int packet_number;
- word status;
- word packet_length;
- int is_error = 0;
- #ifdef USE_32_BIT
- dword stat_len;
- #endif
- SMC_SELECT_BANK(dev, 2);
- packet_number = SMC_inw(dev, LAN91C96_FIFO);
- if (packet_number & LAN91C96_FIFO_RXEMPTY) {
- return 0;
- }
- PRINTK3("%s:smc_rcv\n", dev->name);
-
- SMC_outw(dev, LAN91C96_PTR_READ | LAN91C96_PTR_RCV |
- LAN91C96_PTR_AUTO_INCR, LAN91C96_POINTER);
-
- #ifdef USE_32_BIT
- stat_len = SMC_inl(dev, LAN91C96_DATA_HIGH);
- status = stat_len & 0xffff;
- packet_length = stat_len >> 16;
- #else
- status = SMC_inw(dev, LAN91C96_DATA_HIGH);
- packet_length = SMC_inw(dev, LAN91C96_DATA_HIGH);
- #endif
- packet_length &= 0x07ff;
- PRINTK2 ("RCV: STATUS %4x LENGTH %4x\n", status, packet_length);
- if (!(status & FRAME_FILTER)) {
-
- packet_length -= 4;
-
-
-
- #ifdef USE_32_BIT
- PRINTK3 (" Reading %d dwords (and %d bytes) \n",
- packet_length >> 2, packet_length & 3);
-
- SMC_insl(dev, LAN91C96_DATA_HIGH, net_rx_packets[0],
- packet_length >> 2);
-
- if (packet_length & 3) {
- int i;
- byte *tail = (byte *)(net_rx_packets[0] +
- (packet_length & ~3));
- dword leftover = SMC_inl(dev, LAN91C96_DATA_HIGH);
- for (i = 0; i < (packet_length & 3); i++)
- *tail++ = (byte) (leftover >> (8 * i)) & 0xff;
- }
- #else
- PRINTK3(" Reading %d words and %d byte(s)\n",
- (packet_length >> 1), packet_length & 1);
- SMC_insw(dev, LAN91C96_DATA_HIGH, net_rx_packets[0],
- packet_length >> 1);
- #endif
- #if SMC_DEBUG > 2
- printf ("Receiving Packet\n");
- print_packet((byte *)net_rx_packets[0], packet_length);
- #endif
- } else {
-
-
- is_error = 1;
- }
- while (SMC_inw(dev, LAN91C96_MMU) & LAN91C96_MMUCR_NO_BUSY)
- udelay (1);
-
- SMC_outw(dev, LAN91C96_MMUCR_RELEASE_RX, LAN91C96_MMU);
- while (SMC_inw(dev, LAN91C96_MMU) & LAN91C96_MMUCR_NO_BUSY)
- udelay (1);
- if (!is_error) {
-
- net_process_received_packet(net_rx_packets[0], packet_length);
- return packet_length;
- } else {
- return 0;
- }
- }
- static int smc_close(struct eth_device *dev)
- {
- PRINTK2("%s:smc_close\n", dev->name);
-
- smc_shutdown(dev);
- return 0;
- }
- #if SMC_DEBUG > 2
- static void print_packet(byte *buf, int length)
- {
- #if 0
- int i;
- int remainder;
- int lines;
- printf ("Packet of length %d \n", length);
- lines = length / 16;
- remainder = length % 16;
- for (i = 0; i < lines; i++) {
- int cur;
- for (cur = 0; cur < 8; cur++) {
- byte a, b;
- a = *(buf++);
- b = *(buf++);
- printf ("%02x%02x ", a, b);
- }
- printf ("\n");
- }
- for (i = 0; i < remainder / 2; i++) {
- byte a, b;
- a = *(buf++);
- b = *(buf++);
- printf ("%02x%02x ", a, b);
- }
- printf ("\n");
- #endif
- }
- #endif
- static int lan91c96_init(struct eth_device *dev, bd_t *bd)
- {
- return smc_open(bd, dev);
- }
- static void lan91c96_halt(struct eth_device *dev)
- {
- smc_close(dev);
- }
- static int lan91c96_recv(struct eth_device *dev)
- {
- return smc_rcv(dev);
- }
- static int lan91c96_send(struct eth_device *dev, void *packet,
- int length)
- {
- return smc_send_packet(dev, packet, length);
- }
- static int smc_get_ethaddr(bd_t *bd, struct eth_device *dev)
- {
- uchar v_mac[6];
- if (!eth_getenv_enetaddr("ethaddr", v_mac)) {
-
- if (!get_rom_mac(dev, v_mac)) {
- printf("\n*** ERROR: ethaddr is NOT set !!\n");
- return -1;
- }
- eth_setenv_enetaddr("ethaddr", v_mac);
- }
- smc_set_mac_addr(v_mac);
- PRINTK("Using MAC Address %pM\n", v_mac);
- return 0;
- }
- static int get_rom_mac(struct eth_device *dev, unsigned char *v_rom_mac)
- {
- int i;
- SMC_SELECT_BANK(dev, 1);
- for (i=0; i<6; i++)
- {
- v_rom_mac[i] = SMC_inb(dev, LAN91C96_IA0 + i);
- }
- return (1);
- }
- struct id_type {
- u8 id;
- char *name;
- };
- static struct id_type supported_chips[] = {
- {0, ""},
- {9, "LAN91C110"},
- {8, "LAN91C100FD"},
- {7, "LAN91C100"},
- {5, "LAN91C95"},
- {4, "LAN91C94/96"},
- {3, "LAN91C90/92"},
- };
- static int lan91c96_detect_chip(struct eth_device *dev)
- {
- u8 chip_id;
- int r;
- SMC_SELECT_BANK(dev, 3);
- chip_id = (SMC_inw(dev, 0xA) & LAN91C96_REV_CHIPID) >> 4;
- SMC_SELECT_BANK(dev, 0);
- for (r = 0; r < ARRAY_SIZE(supported_chips); r++)
- if (chip_id == supported_chips[r].id)
- return r;
- return 0;
- }
- int lan91c96_initialize(u8 dev_num, int base_addr)
- {
- struct eth_device *dev;
- int r = 0;
- dev = malloc(sizeof(*dev));
- if (!dev) {
- return 0;
- }
- memset(dev, 0, sizeof(*dev));
- dev->iobase = base_addr;
-
- r = lan91c96_detect_chip(dev);
- if (!r) {
- free(dev);
- return 0;
- }
- get_rom_mac(dev, dev->enetaddr);
- dev->init = lan91c96_init;
- dev->halt = lan91c96_halt;
- dev->send = lan91c96_send;
- dev->recv = lan91c96_recv;
- sprintf(dev->name, "%s-%hu", supported_chips[r].name, dev_num);
- eth_register(dev);
- return 0;
- }
|