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