]> git.ipfire.org Git - people/ms/u-boot.git/blame - drivers/net/plb2800_eth.c
UBI: Ensure that "background thread" operations are really executed
[people/ms/u-boot.git] / drivers / net / plb2800_eth.c
CommitLineData
60fbe254
WD
1/*
2 * PLB2800 internal switch ethernet driver.
3 *
4 * (C) Copyright 2003
5 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
6 *
7 * See file CREDITS for list of people who contributed to this
8 * project.
9 *
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License as
12 * published by the Free Software Foundation; either version 2 of
13 * the License, or (at your option) any later version.
14 *
15 * This program is distributed in the hope that it will be useful,
16 * but WITHOUT ANY WARRANTY; without even the implied warranty of
17 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
18 * GNU General Public License for more details.
19 *
20 * You should have received a copy of the GNU General Public License
21 * along with this program; if not, write to the Free Software
22 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
23 * MA 02111-1307 USA
24 */
25
26#include <common.h>
60fbe254
WD
27#include <malloc.h>
28#include <net.h>
4fce2ace 29#include <netdev.h>
60fbe254
WD
30#include <asm/addrspace.h>
31
32
33#define NUM_RX_DESC PKTBUFSRX
34#define TOUT_LOOP 1000000
35
36#define LONG_REF(addr) (*((volatile unsigned long*)addr))
37
38#define CMAC_CRX_CTRL LONG_REF(0xb800c870)
39#define CMAC_CTX_CTRL LONG_REF(0xb800c874)
40#define SYS_MAC_ADDR_0 LONG_REF(0xb800c878)
41#define SYS_MAC_ADDR_1 LONG_REF(0xb800c87c)
42#define MIPS_H_MASK LONG_REF(0xB800C810)
43
44#define MA_LEARN LONG_REF(0xb8008004)
45#define DA_LOOKUP LONG_REF(0xb8008008)
46
47#define CMAC_CRX_CTRL_PD 0x00000001
48#define CMAC_CRX_CTRL_CG 0x00000002
49#define CMAC_CRX_CTRL_PL_SHIFT 2
50#define CMAC_CRIT 0x0
51#define CMAC_NON_CRIT 0x1
52#define MBOX_STAT_ID_SHF 28
53#define MBOX_STAT_CP 0x80000000
54#define MBOX_STAT_MB 0x00000001
55#define EN_MA_LEARN 0x02000000
56#define EN_DA_LKUP 0x01000000
8bde7f77 57#define MA_DEST_SHF 11
60fbe254
WD
58#define DA_DEST_SHF 11
59#define DA_STATE_SHF 19
60#define TSTAMP_MS 0x00000000
61#define SW_H_MBOX4_MASK 0x08000000
62#define SW_H_MBOX3_MASK 0x04000000
63#define SW_H_MBOX2_MASK 0x02000000
64#define SW_H_MBOX1_MASK 0x01000000
65
66typedef volatile struct {
67 unsigned int stat;
68 unsigned int cmd;
69 unsigned int cnt;
70 unsigned int adr;
71} mailbox_t;
72
73#define MBOX_REG(mb) ((mailbox_t*)(0xb800c830+(mb<<4)))
74
75typedef volatile struct {
76 unsigned int word0;
77 unsigned int word1;
78 unsigned int word2;
79} mbhdr_t;
80
81#define MBOX_MEM(mb) ((void*)(0xb800a000+((3-mb)<<11)))
82
83
84static int plb2800_eth_init(struct eth_device *dev, bd_t * bis);
85static int plb2800_eth_send(struct eth_device *dev, volatile void *packet,
86 int length);
87static int plb2800_eth_recv(struct eth_device *dev);
88static void plb2800_eth_halt(struct eth_device *dev);
89
90static void plb2800_set_mac_addr(struct eth_device *dev, unsigned char * addr);
91static unsigned char * plb2800_get_mac_addr(void);
92
93static int rx_new;
94static int mac_addr_set = 0;
95
96
97int plb2800_eth_initialize(bd_t * bis)
98{
99 struct eth_device *dev;
100 ulong temp;
101
102#ifdef DEBUG
103 printf("Entered plb2800_eth_initialize()\n");
104#endif
105
106 if (!(dev = (struct eth_device *) malloc (sizeof *dev)))
107 {
108 printf("Failed to allocate memory\n");
4fce2ace 109 return -1;
60fbe254
WD
110 }
111 memset(dev, 0, sizeof(*dev));
112
113 sprintf(dev->name, "PLB2800 Switch");
114 dev->init = plb2800_eth_init;
115 dev->halt = plb2800_eth_halt;
116 dev->send = plb2800_eth_send;
117 dev->recv = plb2800_eth_recv;
118
119 eth_register(dev);
120
8bde7f77
WD
121 /* bug fix */
122 *(ulong *)0xb800e800 = 0x838;
60fbe254
WD
123
124 /* Set MBOX ownership */
125 temp = CMAC_CRIT << MBOX_STAT_ID_SHF;
126 MBOX_REG(0)->stat = temp;
127 MBOX_REG(1)->stat = temp;
128
8bde7f77 129 temp = CMAC_NON_CRIT << MBOX_STAT_ID_SHF;
60fbe254
WD
130 MBOX_REG(2)->stat = temp;
131 MBOX_REG(3)->stat = temp;
8bde7f77 132
60fbe254
WD
133 plb2800_set_mac_addr(dev, plb2800_get_mac_addr());
134
135 /* Disable all Mbox interrupt */
136 temp = MIPS_H_MASK;
8bde7f77 137 temp &= ~ (SW_H_MBOX1_MASK | SW_H_MBOX2_MASK | SW_H_MBOX3_MASK | SW_H_MBOX4_MASK) ;
60fbe254
WD
138 MIPS_H_MASK = temp;
139
140#ifdef DEBUG
141 printf("Leaving plb2800_eth_initialize()\n");
142#endif
143
4fce2ace 144 return 0;
60fbe254
WD
145}
146
147static int plb2800_eth_init(struct eth_device *dev, bd_t * bis)
148{
149#ifdef DEBUG
150 printf("Entering plb2800_eth_init()\n");
151#endif
152
153 plb2800_set_mac_addr(dev, dev->enetaddr);
154
155 rx_new = 0;
156
157#ifdef DEBUG
158 printf("Leaving plb2800_eth_init()\n");
159#endif
160
161 return 0;
162}
163
164
165static int plb2800_eth_send(struct eth_device *dev, volatile void *packet,
166 int length)
167{
168 int i;
169 int res = -1;
170 u32 temp;
171 mailbox_t * mb = MBOX_REG(0);
172 char * mem = MBOX_MEM(0);
173
174#ifdef DEBUG
175 printf("Entered plb2800_eth_send()\n");
176#endif
177
178 if (length <= 0)
179 {
180 printf ("%s: bad packet size: %d\n", dev->name, length);
181 goto Done;
182 }
183
184 if (length < 64)
185 {
186 length = 64;
187 }
188
189 temp = CMAC_CRX_CTRL_CG | ((length + 4) << CMAC_CRX_CTRL_PL_SHIFT);
190
191#ifdef DEBUG
192 printf("0 mb->stat = 0x%x\n", mb->stat);
193#endif
194
195 for(i = 0; mb->stat & (MBOX_STAT_CP | MBOX_STAT_MB); i++)
196 {
197 if (i >= TOUT_LOOP)
198 {
199 printf("%s: tx buffer not ready\n", dev->name);
200 printf("1 mb->stat = 0x%x\n", mb->stat);
201 goto Done;
202 }
203 }
204
205 /* For some strange reason, memcpy doesn't work, here!
206 */
207 do
208 {
209 int words = (length >> 2) + 1;
210 unsigned int* dst = (unsigned int*)(mem);
211 unsigned int* src = (unsigned int*)(packet);
212 for (i = 0; i < words; i++)
213 {
214 *dst = *src;
215 dst++;
216 src++;
217 };
218 } while(0);
219
220 CMAC_CRX_CTRL = temp;
221 mb->cmd = MBOX_STAT_CP;
8bde7f77 222
60fbe254
WD
223#ifdef DEBUG
224 printf("2 mb->stat = 0x%x\n", mb->stat);
225#endif
226
227 res = length;
228Done:
229
230#ifdef DEBUG
231 printf("Leaving plb2800_eth_send()\n");
232#endif
233
234 return res;
235}
236
237
238static int plb2800_eth_recv(struct eth_device *dev)
239{
240 int length = 0;
241 mailbox_t * mbox = MBOX_REG(3);
242 unsigned char * hdr = MBOX_MEM(3);
243 unsigned int stat;
244
245#ifdef DEBUG
246 printf("Entered plb2800_eth_recv()\n");
247#endif
248
249 for (;;)
250 {
251 stat = mbox->stat;
252
253 if (!(stat & MBOX_STAT_CP))
254 {
255 break;
256 }
8bde7f77 257
60fbe254
WD
258 length = ((*(hdr + 6) & 0x3f) << 8) + *(hdr + 7);
259 memcpy((void *)NetRxPackets[rx_new], hdr + 12, length);
260
261 stat &= ~MBOX_STAT_CP;
262 mbox->stat = stat;
263#ifdef DEBUG
264 {
265 int i;
266 for (i=0;i<length - 4;i++)
267 {
268 if (i % 16 == 0) printf("\n%04x: ", i);
269 printf("%02X ", NetRxPackets[rx_new][i]);
270 }
271 printf("\n");
272 }
273#endif
274
275 if (length)
276 {
277#ifdef DEBUG
278 printf("Received %d bytes\n", length);
279#endif
280 NetReceive((void*)(NetRxPackets[rx_new]),
281 length - 4);
282 }
283 else
284 {
285#if 1
286 printf("Zero length!!!\n");
287#endif
288 }
289
290 rx_new = (rx_new + 1) % NUM_RX_DESC;
291 }
292
293#ifdef DEBUG
294 printf("Leaving plb2800_eth_recv()\n");
295#endif
296
297 return length;
298}
299
300
301static void plb2800_eth_halt(struct eth_device *dev)
302{
303#ifdef DEBUG
304 printf("Entered plb2800_eth_halt()\n");
305#endif
306
307#ifdef DEBUG
308 printf("Leaving plb2800_eth_halt()\n");
309#endif
310}
311
312static void plb2800_set_mac_addr(struct eth_device *dev, unsigned char * addr)
313{
314 char packet[60];
315 ulong temp;
316 int ix;
317
318 if (mac_addr_set ||
319 NULL == addr || memcmp(addr, "\0\0\0\0\0\0", 6) == 0)
320 {
321 return;
322 }
8bde7f77 323
60fbe254
WD
324 /* send one packet through CPU port
325 * in order to learn system MAC address
8bde7f77 326 */
60fbe254
WD
327
328 /* Set DA_LOOKUP register */
8bde7f77 329 temp = EN_MA_LEARN | (0 << DA_STATE_SHF) | (63 << DA_DEST_SHF);
60fbe254
WD
330 DA_LOOKUP = temp;
331
332 /* Set MA_LEARN register */
53677ef1 333 temp = 50 << MA_DEST_SHF; /* static entry */
60fbe254
WD
334 MA_LEARN = temp;
335
336 /* set destination address */
337 for (ix=0;ix<6;ix++)
338 packet[ix] = 0xff;
8bde7f77 339
60fbe254
WD
340 /* set source address = system MAC address */
341 for (ix=0;ix<6;ix++)
342 packet[6+ix] = addr[ix];
343
344 /* set type field */
345 packet[12]=0xaa;
346 packet[13]=0x55;
347
348 /* set data field */
349 for(ix=14;ix<60;ix++)
350 packet[ix] = 0x00;
8bde7f77 351
60fbe254
WD
352#ifdef DEBUG
353 for (ix=0;ix<6;ix++)
354 printf("mac_addr[%d]=%02X\n", ix, (unsigned char)packet[6+ix]);
355#endif
356
357 /* set one packet */
358 plb2800_eth_send(dev, packet, sizeof(packet));
359
360 /* delay for a while */
361 for(ix=0;ix<65535;ix++)
362 temp = ~temp;
363
8bde7f77 364 /* Set CMAC_CTX_CTRL register */
60fbe254
WD
365 temp = TSTAMP_MS; /* no autocast */
366 CMAC_CTX_CTRL = temp;
8bde7f77 367
60fbe254
WD
368 /* Set DA_LOOKUP register */
369 temp = EN_DA_LKUP;
370 DA_LOOKUP = temp;
371
372 mac_addr_set = 1;
373}
374
375static unsigned char * plb2800_get_mac_addr(void)
376{
377 static unsigned char addr[6];
378 char *tmp, *end;
379 int i;
8bde7f77 380
60fbe254
WD
381 tmp = getenv ("ethaddr");
382 if (NULL == tmp) return NULL;
8bde7f77 383
60fbe254
WD
384 for (i=0; i<6; i++) {
385 addr[i] = tmp ? simple_strtoul(tmp, &end, 16) : 0;
386 if (tmp)
387 tmp = (*end) ? end+1 : end;
388 }
389
390 return addr;
391}