drivers/net/lan91c96.c

   1 /*------------------------------------------------------------------------
   2  * lan91c96.c
   3  * This is a driver for SMSC's LAN91C96 single-chip Ethernet device, based
   4  * on the SMC91111 driver from U-Boot.
   5  *
   6  * (C) Copyright 2002
   7  * Sysgo Real-Time Solutions, GmbH <www.elinos.com>
   8  * Rolf Offermanns <rof@sysgo.de>
   9  *
  10  * Copyright (C) 2001 Standard Microsystems Corporation (SMSC)
  11  *       Developed by Simple Network Magic Corporation (SNMC)
  12  * Copyright (C) 1996 by Erik Stahlman (ES)
  13  *
  14  * SPDX-License-Identifier:     GPL-2.0+
  15  *
  16  * Information contained in this file was obtained from the LAN91C96
  17  * manual from SMC.  To get a copy, if you really want one, you can find
  18  * information under www.smsc.com.
  19  *
  20  * "Features" of the SMC chip:
  21  *   6144 byte packet memory. ( for the 91C96 )
  22  *   EEPROM for configuration
  23  *   AUI/TP selection  ( mine has 10Base2/10BaseT select )
  24  *
  25  * Arguments:
  26  *      io      = for the base address
  27  *      irq     = for the IRQ
  28  *
  29  * author:
  30  *      Erik Stahlman                           ( erik@vt.edu )
  31  *      Daris A Nevil                           ( dnevil@snmc.com )
  32  *
  33  *
  34  * Hardware multicast code from Peter Cammaert ( pc@denkart.be )
  35  *
  36  * Sources:
  37  *    o   SMSC LAN91C96 databook (www.smsc.com)
  38  *    o   smc91111.c (u-boot driver)
  39  *    o   smc9194.c (linux kernel driver)
  40  *    o   lan91c96.c (Intel Diagnostic Manager driver)
  41  *
  42  * History:
  43  *      04/30/03  Mathijs Haarman       Modified smc91111.c (u-boot version)
  44  *                                      for lan91c96
  45  *---------------------------------------------------------------------------
  46  */
  47
  48 #include <common.h>
  49 #include <command.h>
  50 #include <malloc.h>
  51 #include "lan91c96.h"
  52 #include <net.h>
  53 #include <linux/compiler.h>
  54
  55 /*------------------------------------------------------------------------
  56  *
  57  * Configuration options, for the experienced user to change.
  58  *
  59  -------------------------------------------------------------------------*/
  60
  61 /* Use power-down feature of the chip */
  62 #define POWER_DOWN      0
  63
  64 /*
  65  * Wait time for memory to be free.  This probably shouldn't be
  66  * tuned that much, as waiting for this means nothing else happens
  67  * in the system
  68 */
  69 #define MEMORY_WAIT_TIME 16
  70
  71 #define SMC_DEBUG 0
  72
  73 #if (SMC_DEBUG > 2 )
  74 #define PRINTK3(args...) printf(args)
  75 #else
  76 #define PRINTK3(args...)
  77 #endif
  78
  79 #if SMC_DEBUG > 1
  80 #define PRINTK2(args...) printf(args)
  81 #else
  82 #define PRINTK2(args...)
  83 #endif
  84
  85 #ifdef SMC_DEBUG
  86 #define PRINTK(args...) printf(args)
  87 #else
  88 #define PRINTK(args...)
  89 #endif
  90
  91
  92 /*------------------------------------------------------------------------
  93  *
  94  * The internal workings of the driver.  If you are changing anything
  95  * here with the SMC stuff, you should have the datasheet and know
  96  * what you are doing.
  97  *
  98  *------------------------------------------------------------------------
  99  */
 100 #define DRIVER_NAME "LAN91C96"
 101 #define SMC_ALLOC_MAX_TRY 5
 102 #define SMC_TX_TIMEOUT 30
 103
 104 #define ETH_ZLEN 60
 105
 106 #ifdef  CONFIG_LAN91C96_USE_32_BIT
 107 #define USE_32_BIT  1
 108 #else
 109 #undef USE_32_BIT
 110 #endif
 111
 112 /* See if a MAC address is defined in the current environment. If so use it. If not
 113  . print a warning and set the environment and other globals with the default.
 114  . If an EEPROM is present it really should be consulted.
 115 */
 116 static int smc_get_ethaddr(bd_t *bd, struct eth_device *dev);
 117 static int get_rom_mac(struct eth_device *dev, unsigned char *v_rom_mac);
 118
 119 /* ------------------------------------------------------------
 120  * Internal routines
 121  * ------------------------------------------------------------
 122  */
 123
 124 static unsigned char smc_mac_addr[] = { 0xc0, 0x00, 0x00, 0x1b, 0x62, 0x9c };
 125
 126 /*
 127  * This function must be called before smc_open() if you want to override
 128  * the default mac address.
 129  */
 130
 131 static void smc_set_mac_addr(const unsigned char *addr)
 132 {
 133         int i;
 134
 135         for (i = 0; i < sizeof (smc_mac_addr); i++) {
 136                 smc_mac_addr[i] = addr[i];
 137         }
 138 }
 139
 140 /***********************************************
 141  * Show available memory                       *
 142  ***********************************************/
 143 void dump_memory_info(struct eth_device *dev)
 144 {
 145         __maybe_unused word mem_info;
 146         word old_bank;
 147
 148         old_bank = SMC_inw(dev, LAN91C96_BANK_SELECT) & 0xF;
 149
 150         SMC_SELECT_BANK(dev, 0);
 151         mem_info = SMC_inw(dev, LAN91C96_MIR);
 152         PRINTK2 ("Memory: %4d available\n", (mem_info >> 8) * 2048);
 153
 154         SMC_SELECT_BANK(dev, old_bank);
 155 }
 156
 157 /*
 158  * A rather simple routine to print out a packet for debugging purposes.
 159  */
 160 #if SMC_DEBUG > 2
 161 static void print_packet (byte *, int);
 162 #endif
 163
 164 static int poll4int (struct eth_device *dev, byte mask, int timeout)
 165 {
 166         int tmo = get_timer (0) + timeout * CONFIG_SYS_HZ;
 167         int is_timeout = 0;
 168         word old_bank = SMC_inw(dev, LAN91C96_BANK_SELECT);
 169
 170         PRINTK2 ("Polling...\n");
 171         SMC_SELECT_BANK(dev, 2);
 172         while ((SMC_inw(dev, LAN91C96_INT_STATS) & mask) == 0) {
 173                 if (get_timer (0) >= tmo) {
 174                         is_timeout = 1;
 175                         break;
 176                 }
 177         }
 178
 179         /* restore old bank selection */
 180         SMC_SELECT_BANK(dev, old_bank);
 181
 182         if (is_timeout)
 183                 return 1;
 184         else
 185                 return 0;
 186 }
 187
 188 /*
 189  * Function: smc_reset
 190  * Purpose:
 191  *      This sets the SMC91111 chip to its normal state, hopefully from whatever
 192  *      mess that any other DOS driver has put it in.
 193  *
 194  * Maybe I should reset more registers to defaults in here?  SOFTRST  should
 195  * do that for me.
 196  *
 197  * Method:
 198  *      1.  send a SOFT RESET
 199  *      2.  wait for it to finish
 200  *      3.  enable autorelease mode
 201  *      4.  reset the memory management unit
 202  *      5.  clear all interrupts
 203  *
 204 */
 205 static void smc_reset(struct eth_device *dev)
 206 {
 207         PRINTK2("%s:smc_reset\n", dev->name);
 208
 209         /* This resets the registers mostly to defaults, but doesn't
 210            affect EEPROM.  That seems unnecessary */
 211         SMC_SELECT_BANK(dev, 0);
 212         SMC_outw(dev, LAN91C96_RCR_SOFT_RST, LAN91C96_RCR);
 213
 214         udelay (10);
 215
 216         /* Disable transmit and receive functionality */
 217         SMC_outw(dev, 0, LAN91C96_RCR);
 218         SMC_outw(dev, 0, LAN91C96_TCR);
 219
 220         /* set the control register */
 221         SMC_SELECT_BANK(dev, 1);
 222         SMC_outw(dev, SMC_inw(dev, LAN91C96_CONTROL) | LAN91C96_CTR_BIT_8,
 223                           LAN91C96_CONTROL);
 224
 225         /* Disable all interrupts */
 226         SMC_outb(dev, 0, LAN91C96_INT_MASK);
 227 }
 228
 229 /*
 230  * Function: smc_enable
 231  * Purpose: let the chip talk to the outside work
 232  * Method:
 233  *      1.  Initialize the Memory Configuration Register
 234  *      2.  Enable the transmitter
 235  *      3.  Enable the receiver
 236 */
 237 static void smc_enable(struct eth_device *dev)
 238 {
 239         PRINTK2("%s:smc_enable\n", dev->name);
 240         SMC_SELECT_BANK(dev, 0);
 241
 242         /* Initialize the Memory Configuration Register. See page
 243            49 of the LAN91C96 data sheet for details. */
 244         SMC_outw(dev, LAN91C96_MCR_TRANSMIT_PAGES, LAN91C96_MCR);
 245
 246         /* Initialize the Transmit Control Register */
 247         SMC_outw(dev, LAN91C96_TCR_TXENA, LAN91C96_TCR);
 248         /* Initialize the Receive Control Register
 249          * FIXME:
 250          * The promiscuous bit set because I could not receive ARP reply
 251          * packets from the server when I send a ARP request. It only works
 252          * when I set the promiscuous bit
 253          */
 254         SMC_outw(dev, LAN91C96_RCR_RXEN | LAN91C96_RCR_PRMS, LAN91C96_RCR);
 255 }
 256
 257 /*
 258  * Function: smc_shutdown
 259  * Purpose:  closes down the SMC91xxx chip.
 260  * Method:
 261  *      1. zero the interrupt mask
 262  *      2. clear the enable receive flag
 263  *      3. clear the enable xmit flags
 264  *
 265  * TODO:
 266  *   (1) maybe utilize power down mode.
 267  *      Why not yet?  Because while the chip will go into power down mode,
 268  *      the manual says that it will wake up in response to any I/O requests
 269  *      in the register space.   Empirical results do not show this working.
 270  */
 271 static void smc_shutdown(struct eth_device *dev)
 272 {
 273         PRINTK2("%s:smc_shutdown\n", dev->name);
 274
 275         /* no more interrupts for me */
 276         SMC_SELECT_BANK(dev, 2);
 277         SMC_outb(dev, 0, LAN91C96_INT_MASK);
 278
 279         /* and tell the card to stay away from that nasty outside world */
 280         SMC_SELECT_BANK(dev, 0);
 281         SMC_outb(dev, 0, LAN91C96_RCR);
 282         SMC_outb(dev, 0, LAN91C96_TCR);
 283 }
 284
 285
 286 /*
 287  * Function:  smc_hardware_send_packet(struct net_device * )
 288  * Purpose:
 289  *      This sends the actual packet to the SMC9xxx chip.
 290  *
 291  * Algorithm:
 292  *      First, see if a saved_skb is available.
 293  *              ( this should NOT be called if there is no 'saved_skb'
 294  *      Now, find the packet number that the chip allocated
 295  *      Point the data pointers at it in memory
 296  *      Set the length word in the chip's memory
 297  *      Dump the packet to chip memory
 298  *      Check if a last byte is needed ( odd length packet )
 299  *              if so, set the control flag right
 300  *      Tell the card to send it
 301  *      Enable the transmit interrupt, so I know if it failed
 302  *      Free the kernel data if I actually sent it.
 303  */
 304 static int smc_send_packet(struct eth_device *dev, void *packet,
 305                 int packet_length)
 306 {
 307         byte packet_no;
 308         byte *buf;
 309         int length;
 310         int numPages;
 311         int try = 0;
 312         int time_out;
 313         byte status;
 314
 315
 316         PRINTK3("%s:smc_hardware_send_packet\n", dev->name);
 317
 318         length = ETH_ZLEN < packet_length ? packet_length : ETH_ZLEN;
 319
 320         /* allocate memory
 321          ** The MMU wants the number of pages to be the number of 256 bytes
 322          ** 'pages', minus 1 ( since a packet can't ever have 0 pages :) )
 323          **
 324          ** The 91C111 ignores the size bits, but the code is left intact
 325          ** for backwards and future compatibility.
 326          **
 327          ** Pkt size for allocating is data length +6 (for additional status
 328          ** words, length and ctl!)
 329          **
 330          ** If odd size then last byte is included in this header.
 331          */
 332         numPages = ((length & 0xfffe) + 6);
 333         numPages >>= 8;                         /* Divide by 256 */
 334
 335         if (numPages > 7) {
 336                 printf("%s: Far too big packet error. \n", dev->name);
 337                 return 0;
 338         }
 339
 340         /* now, try to allocate the memory */
 341
 342         SMC_SELECT_BANK(dev, 2);
 343         SMC_outw(dev, LAN91C96_MMUCR_ALLOC_TX | numPages, LAN91C96_MMU);
 344
 345   again:
 346         try++;
 347         time_out = MEMORY_WAIT_TIME;
 348         do {
 349                 status = SMC_inb(dev, LAN91C96_INT_STATS);
 350                 if (status & LAN91C96_IST_ALLOC_INT) {
 351
 352                         SMC_outb(dev, LAN91C96_IST_ALLOC_INT,
 353                                         LAN91C96_INT_STATS);
 354                         break;
 355                 }
 356         } while (--time_out);
 357
 358         if (!time_out) {
 359                 PRINTK2 ("%s: memory allocation, try %d failed ...\n",
 360                                  dev->name, try);
 361                 if (try < SMC_ALLOC_MAX_TRY)
 362                         goto again;
 363                 else
 364                         return 0;
 365         }
 366
 367         PRINTK2 ("%s: memory allocation, try %d succeeded ...\n",
 368                          dev->name, try);
 369
 370         /* I can send the packet now.. */
 371         buf = (byte *) packet;
 372
 373         /* If I get here, I _know_ there is a packet slot waiting for me */
 374         packet_no = SMC_inb(dev, LAN91C96_ARR);
 375         if (packet_no & LAN91C96_ARR_FAILED) {
 376                 /* or isn't there?  BAD CHIP! */
 377                 printf("%s: Memory allocation failed. \n", dev->name);
 378                 return 0;
 379         }
 380
 381         /* we have a packet address, so tell the card to use it */
 382         SMC_outb(dev, packet_no, LAN91C96_PNR);
 383
 384         /* point to the beginning of the packet */
 385         SMC_outw(dev, LAN91C96_PTR_AUTO_INCR, LAN91C96_POINTER);
 386
 387         PRINTK3("%s: Trying to xmit packet of length %x\n",
 388                          dev->name, length);
 389
 390 #if SMC_DEBUG > 2
 391         printf ("Transmitting Packet\n");
 392         print_packet (buf, length);
 393 #endif
 394
 395         /* send the packet length ( +6 for status, length and ctl byte )
 396            and the status word ( set to zeros ) */
 397 #ifdef USE_32_BIT
 398         SMC_outl(dev, (length + 6) << 16, LAN91C96_DATA_HIGH);
 399 #else
 400         SMC_outw(dev, 0, LAN91C96_DATA_HIGH);
 401         /* send the packet length ( +6 for status words, length, and ctl */
 402         SMC_outw(dev, (length + 6), LAN91C96_DATA_HIGH);
 403 #endif /* USE_32_BIT */
 404
 405         /* send the actual data
 406          * I _think_ it's faster to send the longs first, and then
 407          * mop up by sending the last word.  It depends heavily
 408          * on alignment, at least on the 486.  Maybe it would be
 409          * a good idea to check which is optimal?  But that could take
 410          * almost as much time as is saved?
 411          */
 412 #ifdef USE_32_BIT
 413         SMC_outsl(dev, LAN91C96_DATA_HIGH, buf, length >> 2);
 414         if (length & 0x2)
 415                 SMC_outw(dev, *((word *) (buf + (length & 0xFFFFFFFC))),
 416                                   LAN91C96_DATA_HIGH);
 417 #else
 418         SMC_outsw(dev, LAN91C96_DATA_HIGH, buf, (length) >> 1);
 419 #endif /* USE_32_BIT */
 420
 421         /* Send the last byte, if there is one.   */
 422         if ((length & 1) == 0) {
 423                 SMC_outw(dev, 0, LAN91C96_DATA_HIGH);
 424         } else {
 425                 SMC_outw(dev, buf[length - 1] | 0x2000, LAN91C96_DATA_HIGH);
 426         }
 427
 428         /* and let the chipset deal with it */
 429         SMC_outw(dev, LAN91C96_MMUCR_ENQUEUE, LAN91C96_MMU);
 430
 431         /* poll for TX INT */
 432         if (poll4int (dev, LAN91C96_MSK_TX_INT, SMC_TX_TIMEOUT)) {
 433                 /* sending failed */
 434                 PRINTK2("%s: TX timeout, sending failed...\n", dev->name);
 435
 436                 /* release packet */
 437                 SMC_outw(dev, LAN91C96_MMUCR_RELEASE_TX, LAN91C96_MMU);
 438
 439                 /* wait for MMU getting ready (low) */
 440                 while (SMC_inw(dev, LAN91C96_MMU) & LAN91C96_MMUCR_NO_BUSY)
 441                         udelay (10);
 442
 443                 PRINTK2("MMU ready\n");
 444
 445
 446                 return 0;
 447         } else {
 448                 /* ack. int */
 449                 SMC_outw(dev, LAN91C96_IST_TX_INT, LAN91C96_INT_STATS);
 450
 451                 PRINTK2("%s: Sent packet of length %d \n", dev->name, length);
 452
 453                 /* release packet */
 454                 SMC_outw(dev, LAN91C96_MMUCR_RELEASE_TX, LAN91C96_MMU);
 455
 456                 /* wait for MMU getting ready (low) */
 457                 while (SMC_inw(dev, LAN91C96_MMU) & LAN91C96_MMUCR_NO_BUSY)
 458                         udelay (10);
 459
 460                 PRINTK2 ("MMU ready\n");
 461         }
 462
 463         return length;
 464 }
 465
 466
 467 /*
 468  * Open and Initialize the board
 469  *
 470  * Set up everything, reset the card, etc ..
 471  *
 472  */
 473 static int smc_open(bd_t *bd, struct eth_device *dev)
 474 {
 475         int i, err;                     /* used to set hw ethernet address */
 476
 477         PRINTK2("%s:smc_open\n", dev->name);
 478
 479         /* reset the hardware */
 480
 481         smc_reset(dev);
 482         smc_enable(dev);
 483
 484         SMC_SELECT_BANK(dev, 1);
 485         /* set smc_mac_addr, and sync it with u-boot globals */
 486         err = smc_get_ethaddr(bd, dev);
 487         if (err < 0)
 488                 return -1;
 489 #ifdef USE_32_BIT
 490         for (i = 0; i < 6; i += 2) {
 491                 word address;
 492
 493                 address = smc_mac_addr[i + 1] << 8;
 494                 address |= smc_mac_addr[i];
 495                 SMC_outw(dev, address, LAN91C96_IA0 + i);
 496         }
 497 #else
 498         for (i = 0; i < 6; i++)
 499                 SMC_outb(dev, smc_mac_addr[i], LAN91C96_IA0 + i);
 500 #endif
 501         return 0;
 502 }
 503
 504 /*-------------------------------------------------------------
 505  *
 506  * smc_rcv -  receive a packet from the card
 507  *
 508  * There is ( at least ) a packet waiting to be read from
 509  * chip-memory.
 510  *
 511  * o Read the status
 512  * o If an error, record it
 513  * o otherwise, read in the packet
 514  *-------------------------------------------------------------
 515  */
 516 static int smc_rcv(struct eth_device *dev)
 517 {
 518         int packet_number;
 519         word status;
 520         word packet_length;
 521         int is_error = 0;
 522
 523 #ifdef USE_32_BIT
 524         dword stat_len;
 525 #endif
 526
 527
 528         SMC_SELECT_BANK(dev, 2);
 529         packet_number = SMC_inw(dev, LAN91C96_FIFO);
 530
 531         if (packet_number & LAN91C96_FIFO_RXEMPTY) {
 532                 return 0;
 533         }
 534
 535         PRINTK3("%s:smc_rcv\n", dev->name);
 536         /*  start reading from the start of the packet */
 537         SMC_outw(dev, LAN91C96_PTR_READ | LAN91C96_PTR_RCV |
 538                           LAN91C96_PTR_AUTO_INCR, LAN91C96_POINTER);
 539
 540         /* First two words are status and packet_length */
 541 #ifdef USE_32_BIT
 542         stat_len = SMC_inl(dev, LAN91C96_DATA_HIGH);
 543         status = stat_len & 0xffff;
 544         packet_length = stat_len >> 16;
 545 #else
 546         status = SMC_inw(dev, LAN91C96_DATA_HIGH);
 547         packet_length = SMC_inw(dev, LAN91C96_DATA_HIGH);
 548 #endif
 549
 550         packet_length &= 0x07ff;        /* mask off top bits */
 551
 552         PRINTK2 ("RCV: STATUS %4x LENGTH %4x\n", status, packet_length);
 553
 554         if (!(status & FRAME_FILTER)) {
 555                 /* Adjust for having already read the first two words */
 556                 packet_length -= 4;             /*4; */
 557
 558
 559                 /* set odd length for bug in LAN91C111, */
 560                 /* which never sets RS_ODDFRAME */
 561                 /* TODO ? */
 562
 563
 564 #ifdef USE_32_BIT
 565                 PRINTK3 (" Reading %d dwords (and %d bytes) \n",
 566                          packet_length >> 2, packet_length & 3);
 567                 /* QUESTION:  Like in the TX routine, do I want
 568                    to send the DWORDs or the bytes first, or some
 569                    mixture.  A mixture might improve already slow PIO
 570                    performance  */
 571                 SMC_insl(dev, LAN91C96_DATA_HIGH, net_rx_packets[0],
 572                          packet_length >> 2);
 573                 /* read the left over bytes */
 574                 if (packet_length & 3) {
 575                         int i;
 576
 577                         byte *tail = (byte *)(net_rx_packets[0] +
 578                                 (packet_length & ~3));
 579                         dword leftover = SMC_inl(dev, LAN91C96_DATA_HIGH);
 580
 581                         for (i = 0; i < (packet_length & 3); i++)
 582                                 *tail++ = (byte) (leftover >> (8 * i)) & 0xff;
 583                 }
 584 #else
 585                 PRINTK3(" Reading %d words and %d byte(s)\n",
 586                         (packet_length >> 1), packet_length & 1);
 587                 SMC_insw(dev, LAN91C96_DATA_HIGH, net_rx_packets[0],
 588                          packet_length >> 1);
 589
 590 #endif /* USE_32_BIT */
 591
 592 #if     SMC_DEBUG > 2
 593                 printf ("Receiving Packet\n");
 594                 print_packet((byte *)net_rx_packets[0], packet_length);
 595 #endif
 596         } else {
 597                 /* error ... */
 598                 /* TODO ? */
 599                 is_error = 1;
 600         }
 601
 602         while (SMC_inw(dev, LAN91C96_MMU) & LAN91C96_MMUCR_NO_BUSY)
 603                 udelay (1);             /* Wait until not busy */
 604
 605         /*  error or good, tell the card to get rid of this packet */
 606         SMC_outw(dev, LAN91C96_MMUCR_RELEASE_RX, LAN91C96_MMU);
 607
 608         while (SMC_inw(dev, LAN91C96_MMU) & LAN91C96_MMUCR_NO_BUSY)
 609                 udelay (1);             /* Wait until not busy */
 610
 611         if (!is_error) {
 612                 /* Pass the packet up to the protocol layers. */
 613                 net_process_received_packet(net_rx_packets[0], packet_length);
 614                 return packet_length;
 615         } else {
 616                 return 0;
 617         }
 618
 619 }
 620
 621 /*----------------------------------------------------
 622  * smc_close
 623  *
 624  * this makes the board clean up everything that it can
 625  * and not talk to the outside world.   Caused by
 626  * an 'ifconfig ethX down'
 627  *
 628  -----------------------------------------------------*/
 629 static int smc_close(struct eth_device *dev)
 630 {
 631         PRINTK2("%s:smc_close\n", dev->name);
 632
 633         /* clear everything */
 634         smc_shutdown(dev);
 635
 636         return 0;
 637 }
 638
 639 #if SMC_DEBUG > 2
 640 static void print_packet(byte *buf, int length)
 641 {
 642 #if 0
 643         int i;
 644         int remainder;
 645         int lines;
 646
 647         printf ("Packet of length %d \n", length);
 648
 649         lines = length / 16;
 650         remainder = length % 16;
 651
 652         for (i = 0; i < lines; i++) {
 653                 int cur;
 654
 655                 for (cur = 0; cur < 8; cur++) {
 656                         byte a, b;
 657
 658                         a = *(buf++);
 659                         b = *(buf++);
 660                         printf ("%02x%02x ", a, b);
 661                 }
 662                 printf ("\n");
 663         }
 664         for (i = 0; i < remainder / 2; i++) {
 665                 byte a, b;
 666
 667                 a = *(buf++);
 668                 b = *(buf++);
 669                 printf ("%02x%02x ", a, b);
 670         }
 671         printf ("\n");
 672 #endif /* 0 */
 673 }
 674 #endif /* SMC_DEBUG > 2 */
 675
 676 static int  lan91c96_init(struct eth_device *dev, bd_t *bd)
 677 {
 678         return smc_open(bd, dev);
 679 }
 680
 681 static void lan91c96_halt(struct eth_device *dev)
 682 {
 683         smc_close(dev);
 684 }
 685
 686 static int lan91c96_recv(struct eth_device *dev)
 687 {
 688         return smc_rcv(dev);
 689 }
 690
 691 static int lan91c96_send(struct eth_device *dev, void *packet,
 692                 int length)
 693 {
 694         return smc_send_packet(dev, packet, length);
 695 }
 696
 697 /* smc_get_ethaddr
 698  *
 699  * This checks both the environment and the ROM for an ethernet address. If
 700  * found, the environment takes precedence.
 701  */
 702
 703 static int smc_get_ethaddr(bd_t *bd, struct eth_device *dev)
 704 {
 705         uchar v_mac[6];
 706
 707         if (!eth_getenv_enetaddr("ethaddr", v_mac)) {
 708                 /* get ROM mac value if any */
 709                 if (!get_rom_mac(dev, v_mac)) {
 710                         printf("\n*** ERROR: ethaddr is NOT set !!\n");
 711                         return -1;
 712                 }
 713                 eth_setenv_enetaddr("ethaddr", v_mac);
 714         }
 715
 716         smc_set_mac_addr(v_mac); /* use old function to update smc default */
 717         PRINTK("Using MAC Address %pM\n", v_mac);
 718         return 0;
 719 }
 720
 721 /*
 722  * get_rom_mac()
 723  * Note, this has omly been tested for the OMAP730 P2.
 724  */
 725
 726 static int get_rom_mac(struct eth_device *dev, unsigned char *v_rom_mac)
 727 {
 728         int i;
 729         SMC_SELECT_BANK(dev, 1);
 730         for (i=0; i<6; i++)
 731         {
 732                 v_rom_mac[i] = SMC_inb(dev, LAN91C96_IA0 + i);
 733         }
 734         return (1);
 735 }
 736
 737 /* Structure to detect the device IDs */
 738 struct id_type {
 739         u8 id;
 740         char *name;
 741 };
 742 static struct id_type supported_chips[] = {
 743         {0, ""}, /* Dummy entry to prevent id check failure */
 744         {9, "LAN91C110"},
 745         {8, "LAN91C100FD"},
 746         {7, "LAN91C100"},
 747         {5, "LAN91C95"},
 748         {4, "LAN91C94/96"},
 749         {3, "LAN91C90/92"},
 750 };
 751 /* lan91c96_detect_chip
 752  * See:
 753  * http://www.embeddedsys.com/subpages/resources/images/documents/LAN91C96_datasheet.pdf
 754  * page 71 - that is the closest we get to detect this device
 755  */
 756 static int lan91c96_detect_chip(struct eth_device *dev)
 757 {
 758         u8 chip_id;
 759         int r;
 760         SMC_SELECT_BANK(dev, 3);
 761         chip_id = (SMC_inw(dev, 0xA) & LAN91C96_REV_CHIPID) >> 4;
 762         SMC_SELECT_BANK(dev, 0);
 763         for (r = 0; r < ARRAY_SIZE(supported_chips); r++)
 764                 if (chip_id == supported_chips[r].id)
 765                         return r;
 766         return 0;
 767 }
 768
 769 int lan91c96_initialize(u8 dev_num, int base_addr)
 770 {
 771         struct eth_device *dev;
 772         int r = 0;
 773
 774         dev = malloc(sizeof(*dev));
 775         if (!dev) {
 776                 return 0;
 777         }
 778         memset(dev, 0, sizeof(*dev));
 779
 780         dev->iobase = base_addr;
 781
 782         /* Try to detect chip. Will fail if not present. */
 783         r = lan91c96_detect_chip(dev);
 784         if (!r) {
 785                 free(dev);
 786                 return 0;
 787         }
 788         get_rom_mac(dev, dev->enetaddr);
 789
 790         dev->init = lan91c96_init;
 791         dev->halt = lan91c96_halt;
 792         dev->send = lan91c96_send;
 793         dev->recv = lan91c96_recv;
 794         sprintf(dev->name, "%s-%hu", supported_chips[r].name, dev_num);
 795
 796         eth_register(dev);
 797         return 0;
 798 }