examples/standalone/82559_eeprom.c

   1
   2 /*
   3  * Copyright 1998-2001 by Donald Becker.
   4  * This software may be used and distributed according to the terms of
   5  * the GNU General Public License (GPL), incorporated herein by reference.
   6  * Contact the author for use under other terms.
   7  *
   8  * This program must be compiled with "-O"!
   9  * See the bottom of this file for the suggested compile-command.
  10  *
  11  * The author may be reached as becker@scyld.com, or C/O
  12  *  Scyld Computing Corporation
  13  *  410 Severn Ave., Suite 210
  14  *  Annapolis MD 21403
  15  *
  16  * Common-sense licensing statement: Using any portion of this program in
  17  * your own program means that you must give credit to the original author
  18  * and release the resulting code under the GPL.
  19  */
  20
  21 #define _PPC_STRING_H_          /* avoid unnecessary str/mem functions */
  22
  23 #include <common.h>
  24 #include <exports.h>
  25 #include <asm/io.h>
  26
  27
  28 /* Default EEPROM for i82559 */
  29 static unsigned short default_eeprom[64] = {
  30         0x0100, 0x0302, 0x0504, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
  31         0xffff, 0xffff, 0x40c0, 0x0000, 0x0000, 0xffff, 0xffff, 0xffff,
  32         0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
  33         0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
  34         0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
  35         0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
  36         0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff,
  37         0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff, 0xffff
  38 };
  39
  40 static unsigned short eeprom[256];
  41
  42 static int eeprom_size = 64;
  43 static int eeprom_addr_size = 6;
  44
  45 static int debug = 0;
  46
  47 static inline unsigned short swap16(unsigned short x)
  48 {
  49         return (((x & 0xff) << 8) | ((x & 0xff00) >> 8));
  50 }
  51
  52
  53 void * memcpy(void * dest,const void *src,size_t count)
  54 {
  55         char *tmp = (char *) dest, *s = (char *) src;
  56
  57         while (count--)
  58                 *tmp++ = *s++;
  59
  60         return dest;
  61 }
  62
  63
  64 /* The EEPROM commands include the alway-set leading bit. */
  65 #define EE_WRITE_CMD    (5)
  66 #define EE_READ_CMD             (6)
  67 #define EE_ERASE_CMD    (7)
  68
  69 /* Serial EEPROM section. */
  70 #define EE_SHIFT_CLK    0x01    /* EEPROM shift clock. */
  71 #define EE_CS                   0x02    /* EEPROM chip select. */
  72 #define EE_DATA_WRITE   0x04    /* EEPROM chip data in. */
  73 #define EE_DATA_READ    0x08    /* EEPROM chip data out. */
  74 #define EE_ENB                  (0x4800 | EE_CS)
  75 #define EE_WRITE_0              0x4802
  76 #define EE_WRITE_1              0x4806
  77 #define EE_OFFSET               14
  78
  79 /* Delay between EEPROM clock transitions. */
  80 #define eeprom_delay(ee_addr)   inw(ee_addr)
  81
  82 /* Wait for the EEPROM to finish the previous operation. */
  83 static int eeprom_busy_poll(long ee_ioaddr)
  84 {
  85         int i;
  86         outw(EE_ENB, ee_ioaddr);
  87         for (i = 0; i < 10000; i++)                     /* Typical 2000 ticks */
  88                 if (inw(ee_ioaddr) & EE_DATA_READ)
  89                         break;
  90         return i;
  91 }
  92
  93 /* This executes a generic EEPROM command, typically a write or write enable.
  94    It returns the data output from the EEPROM, and thus may also be used for
  95    reads. */
  96 static int do_eeprom_cmd(long ioaddr, int cmd, int cmd_len)
  97 {
  98         unsigned retval = 0;
  99         long ee_addr = ioaddr + EE_OFFSET;
 100
 101         if (debug > 1)
 102                 printf(" EEPROM op 0x%x: ", cmd);
 103
 104         outw(EE_ENB | EE_SHIFT_CLK, ee_addr);
 105
 106         /* Shift the command bits out. */
 107         do {
 108                 short dataval = (cmd & (1 << cmd_len)) ? EE_WRITE_1 : EE_WRITE_0;
 109                 outw(dataval, ee_addr);
 110                 eeprom_delay(ee_addr);
 111                 if (debug > 2)
 112                         printf("%X", inw(ee_addr) & 15);
 113                 outw(dataval | EE_SHIFT_CLK, ee_addr);
 114                 eeprom_delay(ee_addr);
 115                 retval = (retval << 1) | ((inw(ee_addr) & EE_DATA_READ) ? 1 : 0);
 116         } while (--cmd_len >= 0);
 117 #if 0
 118         outw(EE_ENB, ee_addr);
 119 #endif
 120         /* Terminate the EEPROM access. */
 121         outw(EE_ENB & ~EE_CS, ee_addr);
 122         if (debug > 1)
 123                 printf(" EEPROM result is 0x%5.5x.\n", retval);
 124         return retval;
 125 }
 126
 127 static int read_eeprom(long ioaddr, int location, int addr_len)
 128 {
 129         return do_eeprom_cmd(ioaddr, ((EE_READ_CMD << addr_len) | location)
 130                 << 16 , 3 + addr_len + 16) & 0xffff;
 131 }
 132
 133 static void write_eeprom(long ioaddr, int index, int value, int addr_len)
 134 {
 135         long ee_ioaddr = ioaddr + EE_OFFSET;
 136         int i;
 137
 138         /* Poll for previous op finished. */
 139         eeprom_busy_poll(ee_ioaddr);                    /* Typical 0 ticks */
 140         /* Enable programming modes. */
 141         do_eeprom_cmd(ioaddr, (0x4f << (addr_len-4)), 3 + addr_len);
 142         /* Do the actual write. */
 143         do_eeprom_cmd(ioaddr,
 144                                   (((EE_WRITE_CMD<<addr_len) | index)<<16) | (value & 0xffff),
 145                                   3 + addr_len + 16);
 146         /* Poll for write finished. */
 147         i = eeprom_busy_poll(ee_ioaddr);                        /* Typical 2000 ticks */
 148         if (debug)
 149                 printf(" Write finished after %d ticks.\n", i);
 150         /* Disable programming. This command is not instantaneous, so we check
 151            for busy before the next op. */
 152         do_eeprom_cmd(ioaddr, (0x40 << (addr_len-4)), 3 + addr_len);
 153         eeprom_busy_poll(ee_ioaddr);
 154 }
 155
 156 static int reset_eeprom(unsigned long ioaddr, unsigned char *hwaddr)
 157 {
 158         unsigned short checksum = 0;
 159         int size_test;
 160         int i;
 161
 162         printf("Resetting i82559 EEPROM @ 0x%08lx ... ", ioaddr);
 163
 164         size_test = do_eeprom_cmd(ioaddr, (EE_READ_CMD << 8) << 16, 27);
 165         eeprom_addr_size = (size_test & 0xffe0000) == 0xffe0000 ? 8 : 6;
 166         eeprom_size = 1 << eeprom_addr_size;
 167
 168         memcpy(eeprom, default_eeprom, sizeof default_eeprom);
 169
 170         for (i = 0; i < 3; i++)
 171                 eeprom[i] = (hwaddr[i*2+1]<<8) + hwaddr[i*2];
 172
 173         /* Recalculate the checksum. */
 174         for (i = 0; i < eeprom_size - 1; i++)
 175                 checksum += eeprom[i];
 176         eeprom[i] = 0xBABA - checksum;
 177
 178         for (i = 0; i < eeprom_size; i++)
 179                 write_eeprom(ioaddr, i, eeprom[i], eeprom_addr_size);
 180
 181         for (i = 0; i < eeprom_size; i++)
 182                 if (read_eeprom(ioaddr, i, eeprom_addr_size) != eeprom[i]) {
 183                         printf("failed\n");
 184                         return 1;
 185                 }
 186
 187         printf("done\n");
 188         return 0;
 189 }
 190
 191 static unsigned int hatoi(char *p, char **errp)
 192 {
 193         unsigned int res = 0;
 194
 195         while (1) {
 196                 switch (*p) {
 197                 case 'a':
 198                 case 'b':
 199                 case 'c':
 200                 case 'd':
 201                 case 'e':
 202                 case 'f':
 203                         res |= (*p - 'a' + 10);
 204                         break;
 205                 case 'A':
 206                 case 'B':
 207                 case 'C':
 208                 case 'D':
 209                 case 'E':
 210                 case 'F':
 211                         res |= (*p - 'A' + 10);
 212                         break;
 213                 case '0':
 214                 case '1':
 215                 case '2':
 216                 case '3':
 217                 case '4':
 218                 case '5':
 219                 case '6':
 220                 case '7':
 221                 case '8':
 222                 case '9':
 223                         res |= (*p - '0');
 224                         break;
 225                 default:
 226                         if (errp) {
 227                                 *errp = p;
 228                         }
 229                 return res;
 230                 }
 231                 p++;
 232                 if (*p == 0) {
 233                         break;
 234                 }
 235                 res <<= 4;
 236         }
 237
 238         if (errp) {
 239                 *errp = NULL;
 240         }
 241
 242         return res;
 243 }
 244
 245 static unsigned char *gethwaddr(char *in, unsigned char *out)
 246 {
 247         char tmp[3];
 248         int i;
 249         char *err;
 250
 251         for (i=0;i<6;i++) {
 252                 if (in[i*3+2] == 0 && i == 5) {
 253                         out[i] = hatoi(&in[i*3], &err);
 254                         if (err) {
 255                                 return NULL;
 256                         }
 257                 } else if (in[i*3+2] == ':' && i < 5) {
 258                         tmp[0] = in[i*3];
 259                         tmp[1] = in[i*3+1];
 260                         tmp[2] = 0;
 261                         out[i] = hatoi(tmp, &err);
 262                         if (err) {
 263                                 return NULL;
 264                         }
 265                 } else {
 266                         return NULL;
 267                 }
 268         }
 269
 270         return out;
 271 }
 272
 273 static u32
 274 read_config_dword(int bus, int dev, int func, int reg)
 275 {
 276         u32 res;
 277
 278         outl(0x80000000|(bus&0xff)<<16|(dev&0x1f)<<11|(func&7)<<8|(reg&0xfc),
 279              0xcf8);
 280         res = inl(0xcfc);
 281         outl(0, 0xcf8);
 282         return res;
 283 }
 284
 285 static u16
 286 read_config_word(int bus, int dev, int func, int reg)
 287 {
 288         u32 res;
 289
 290         outl(0x80000000|(bus&0xff)<<16|(dev&0x1f)<<11|(func&7)<<8|(reg&0xfc),
 291              0xcf8);
 292         res = inw(0xcfc + (reg & 2));
 293         outl(0, 0xcf8);
 294         return res;
 295 }
 296
 297 static void
 298 write_config_word(int bus, int dev, int func, int reg, u16 data)
 299 {
 300
 301         outl(0x80000000|(bus&0xff)<<16|(dev&0x1f)<<11|(func&7)<<8|(reg&0xfc),
 302              0xcf8);
 303         outw(data, 0xcfc + (reg & 2));
 304         outl(0, 0xcf8);
 305 }
 306
 307
 308 int main (int argc, char *argv[])
 309 {
 310         unsigned char *eth_addr;
 311         uchar buf[6];
 312         int instance;
 313
 314         app_startup(argv);
 315         if (argc != 2) {
 316                 printf ("call with base Ethernet address\n");
 317                 return 1;
 318         }
 319
 320
 321         eth_addr = gethwaddr(argv[1], buf);
 322         if (NULL == eth_addr) {
 323                 printf ("Can not parse ethernet address\n");
 324                 return 1;
 325         }
 326         if (eth_addr[5] & 0x01) {
 327                 printf("Base Ethernet address must be even\n");
 328         }
 329
 330
 331         for (instance = 0; instance < 2; instance ++)  {
 332                 unsigned int io_addr;
 333                 unsigned char mac[6];
 334                 int bar1 = read_config_dword(0, 6+instance, 0, 0x14);
 335                 if (! (bar1 & 1)) {
 336                         printf("ETH%d is disabled %x\n", instance, bar1);
 337                 } else {
 338                         printf("ETH%d IO=0x%04x\n", instance, bar1 & ~3);
 339                 }
 340                 io_addr = (bar1 & (~3L));
 341
 342
 343                 write_config_word(0, 6+instance, 0, 4,
 344                                   read_config_word(0, 6+instance, 0, 4) | 1);
 345                 printf("ETH%d CMD %04x\n", instance,
 346                            read_config_word(0, 6+instance, 0, 4));
 347
 348                 memcpy(mac, eth_addr, 6);
 349                 mac[5] += instance;
 350
 351                 printf("got io=%04x, ha=%02x:%02x:%02x:%02x:%02x:%02x\n",
 352                            io_addr, mac[0], mac[1], mac[2],
 353                            mac[3], mac[4], mac[5]);
 354                 reset_eeprom(io_addr, mac);
 355         }
 356         return 0;
 357 }