blob: afe122a337527df119bf63c6cdfed594a6dbaeec [file] [log] [blame]
Aubrey Li26bf7de2007-03-19 01:24:52 +08001/*
Mike Frysinger395bce42008-02-24 23:58:13 -05002 * Driver for Blackfin On-Chip MAC device
Aubrey Li26bf7de2007-03-19 01:24:52 +08003 *
Mike Frysinger395bce42008-02-24 23:58:13 -05004 * Copyright (c) 2005-2008 Analog Device, Inc.
Aubrey Li26bf7de2007-03-19 01:24:52 +08005 *
Mike Frysinger395bce42008-02-24 23:58:13 -05006 * Licensed under the GPL-2 or later.
Aubrey Li26bf7de2007-03-19 01:24:52 +08007 */
8
9#include <common.h>
10#include <config.h>
Aubrey Li26bf7de2007-03-19 01:24:52 +080011#include <net.h>
12#include <command.h>
13#include <malloc.h>
Aubrey Li26bf7de2007-03-19 01:24:52 +080014
Mike Frysinger395bce42008-02-24 23:58:13 -050015#include <asm/blackfin.h>
Mike Frysingerd4d77302008-02-04 19:26:55 -050016#include <asm/mach-common/bits/dma.h>
17#include <asm/mach-common/bits/emac.h>
18#include <asm/mach-common/bits/pll.h>
19
Mike Frysinger395bce42008-02-24 23:58:13 -050020#include "bfin_mac.h"
21
Aubrey Li26bf7de2007-03-19 01:24:52 +080022#ifdef CONFIG_POST
23#include <post.h>
24#endif
25
26#undef DEBUG_ETHERNET
27
28#ifdef DEBUG_ETHERNET
Mike Frysinger395bce42008-02-24 23:58:13 -050029#define DEBUGF(fmt, args...) printf(fmt, ##args)
Aubrey Li26bf7de2007-03-19 01:24:52 +080030#else
Mike Frysinger395bce42008-02-24 23:58:13 -050031#define DEBUGF(fmt, args...)
Aubrey Li26bf7de2007-03-19 01:24:52 +080032#endif
33
Aubrey Li26bf7de2007-03-19 01:24:52 +080034#define RXBUF_BASE_ADDR 0xFF900000
35#define TXBUF_BASE_ADDR 0xFF800000
36#define TX_BUF_CNT 1
37
Mike Frysinger395bce42008-02-24 23:58:13 -050038#define TOUT_LOOP 1000000
Aubrey Li26bf7de2007-03-19 01:24:52 +080039
40ADI_ETHER_BUFFER *txbuf[TX_BUF_CNT];
41ADI_ETHER_BUFFER *rxbuf[PKTBUFSRX];
42static u16 txIdx; /* index of the current RX buffer */
43static u16 rxIdx; /* index of the current TX buffer */
44
Aubrey Li26bf7de2007-03-19 01:24:52 +080045u16 PHYregs[NO_PHY_REGS]; /* u16 PHYADDR; */
46
47/* DMAx_CONFIG values at DMA Restart */
Mike Frysinger395bce42008-02-24 23:58:13 -050048const ADI_DMA_CONFIG_REG rxdmacfg = {
49 .b_DMA_EN = 1, /* enabled */
50 .b_WNR = 1, /* write to memory */
51 .b_WDSIZE = 2, /* wordsize is 32 bits */
52 .b_DMA2D = 0,
53 .b_RESTART = 0,
54 .b_DI_SEL = 0,
55 .b_DI_EN = 0, /* no interrupt */
56 .b_NDSIZE = 5, /* 5 half words is desc size */
57 .b_FLOW = 7 /* large desc flow */
58};
Aubrey Li26bf7de2007-03-19 01:24:52 +080059
Mike Frysinger395bce42008-02-24 23:58:13 -050060const ADI_DMA_CONFIG_REG txdmacfg = {
61 .b_DMA_EN = 1, /* enabled */
62 .b_WNR = 0, /* read from memory */
63 .b_WDSIZE = 2, /* wordsize is 32 bits */
64 .b_DMA2D = 0,
65 .b_RESTART = 0,
66 .b_DI_SEL = 0,
67 .b_DI_EN = 0, /* no interrupt */
68 .b_NDSIZE = 5, /* 5 half words is desc size */
69 .b_FLOW = 7 /* large desc flow */
70};
Aubrey Li26bf7de2007-03-19 01:24:52 +080071
Mike Frysinger395bce42008-02-24 23:58:13 -050072int bfin_EMAC_initialize(bd_t *bis)
Aubrey Li26bf7de2007-03-19 01:24:52 +080073{
74 struct eth_device *dev;
75 dev = (struct eth_device *)malloc(sizeof(*dev));
76 if (dev == NULL)
77 hang();
78
79 memset(dev, 0, sizeof(*dev));
Mike Frysinger395bce42008-02-24 23:58:13 -050080 sprintf(dev->name, "Blackfin EMAC");
Aubrey Li26bf7de2007-03-19 01:24:52 +080081
82 dev->iobase = 0;
83 dev->priv = 0;
84 dev->init = bfin_EMAC_init;
85 dev->halt = bfin_EMAC_halt;
86 dev->send = bfin_EMAC_send;
87 dev->recv = bfin_EMAC_recv;
88
89 eth_register(dev);
90
91 return 1;
92}
93
94static int bfin_EMAC_send(struct eth_device *dev, volatile void *packet,
95 int length)
96{
97 int i;
98 int result = 0;
99 unsigned int *buf;
100 buf = (unsigned int *)packet;
101
102 if (length <= 0) {
103 printf("Ethernet: bad packet size: %d\n", length);
104 goto out;
105 }
106
107 if ((*pDMA2_IRQ_STATUS & DMA_ERR) != 0) {
108 printf("Ethernet: tx DMA error\n");
109 goto out;
110 }
111
112 for (i = 0; (*pDMA2_IRQ_STATUS & DMA_RUN) != 0; i++) {
113 if (i > TOUT_LOOP) {
114 puts("Ethernet: tx time out\n");
115 goto out;
116 }
117 }
118 txbuf[txIdx]->FrmData->NoBytes = length;
119 memcpy(txbuf[txIdx]->FrmData->Dest, (void *)packet, length);
120 txbuf[txIdx]->Dma[0].START_ADDR = (u32) txbuf[txIdx]->FrmData;
121 *pDMA2_NEXT_DESC_PTR = &txbuf[txIdx]->Dma[0];
122 *pDMA2_CONFIG = *(u16 *) (void *)(&txdmacfg);
123 *pEMAC_OPMODE |= TE;
124
125 for (i = 0; (txbuf[txIdx]->StatusWord & TX_COMP) == 0; i++) {
126 if (i > TOUT_LOOP) {
127 puts("Ethernet: tx error\n");
128 goto out;
129 }
130 }
131 result = txbuf[txIdx]->StatusWord;
132 txbuf[txIdx]->StatusWord = 0;
133 if ((txIdx + 1) >= TX_BUF_CNT)
134 txIdx = 0;
135 else
136 txIdx++;
Mike Frysinger395bce42008-02-24 23:58:13 -0500137 out:
Aubrey Li26bf7de2007-03-19 01:24:52 +0800138 DEBUGF("BFIN EMAC send: length = %d\n", length);
139 return result;
140}
141
142static int bfin_EMAC_recv(struct eth_device *dev)
143{
144 int length = 0;
145
146 for (;;) {
147 if ((rxbuf[rxIdx]->StatusWord & RX_COMP) == 0) {
148 length = -1;
149 break;
150 }
151 if ((rxbuf[rxIdx]->StatusWord & RX_DMAO) != 0) {
152 printf("Ethernet: rx dma overrun\n");
153 break;
154 }
155 if ((rxbuf[rxIdx]->StatusWord & RX_OK) == 0) {
156 printf("Ethernet: rx error\n");
157 break;
158 }
159 length = rxbuf[rxIdx]->StatusWord & 0x000007FF;
160 if (length <= 4) {
161 printf("Ethernet: bad frame\n");
162 break;
163 }
164 NetRxPackets[rxIdx] =
165 (volatile uchar *)(rxbuf[rxIdx]->FrmData->Dest);
166 NetReceive(NetRxPackets[rxIdx], length - 4);
167 *pDMA1_IRQ_STATUS |= DMA_DONE | DMA_ERR;
168 rxbuf[rxIdx]->StatusWord = 0x00000000;
169 if ((rxIdx + 1) >= PKTBUFSRX)
170 rxIdx = 0;
171 else
172 rxIdx++;
173 }
174
175 return length;
176}
177
178/**************************************************************
179 *
180 * Ethernet Initialization Routine
181 *
182 *************************************************************/
183
Mike Frysinger395bce42008-02-24 23:58:13 -0500184static int bfin_EMAC_init(struct eth_device *dev, bd_t *bd)
Aubrey Li26bf7de2007-03-19 01:24:52 +0800185{
186 u32 opmode;
187 int dat;
188 int i;
189 DEBUGF("Eth_init: ......\n");
190
191 txIdx = 0;
192 rxIdx = 0;
193
194/* Initialize System Register */
195 if (SetupSystemRegs(&dat) < 0)
196 return -1;
197
198/* Initialize EMAC address */
Mike Frysinger395bce42008-02-24 23:58:13 -0500199 bfin_EMAC_setup_addr(bd);
Aubrey Li26bf7de2007-03-19 01:24:52 +0800200
201/* Initialize TX and RX buffer */
202 for (i = 0; i < PKTBUFSRX; i++) {
203 rxbuf[i] = SetupRxBuffer(i);
204 if (i > 0) {
205 rxbuf[i - 1]->Dma[1].NEXT_DESC_PTR =
206 &(rxbuf[i]->Dma[0]);
207 if (i == (PKTBUFSRX - 1))
208 rxbuf[i]->Dma[1].NEXT_DESC_PTR =
209 &(rxbuf[0]->Dma[0]);
210 }
211 }
212 for (i = 0; i < TX_BUF_CNT; i++) {
213 txbuf[i] = SetupTxBuffer(i);
214 if (i > 0) {
215 txbuf[i - 1]->Dma[1].NEXT_DESC_PTR =
216 &(txbuf[i]->Dma[0]);
217 if (i == (TX_BUF_CNT - 1))
218 txbuf[i]->Dma[1].NEXT_DESC_PTR =
219 &(txbuf[0]->Dma[0]);
220 }
221 }
222
223 /* Set RX DMA */
224 *pDMA1_NEXT_DESC_PTR = &rxbuf[0]->Dma[0];
225 *pDMA1_CONFIG = *((u16 *) (void *)&rxbuf[0]->Dma[0].CONFIG);
226
227 /* Wait MII done */
228 PollMdcDone();
229
230 /* We enable only RX here */
231 /* ASTP : Enable Automatic Pad Stripping
232 PR : Promiscuous Mode for test
233 PSF : Receive frames with total length less than 64 bytes.
234 FDMODE : Full Duplex Mode
235 LB : Internal Loopback for test
236 RE : Receiver Enable */
237 if (dat == FDMODE)
238 opmode = ASTP | FDMODE | PSF;
239 else
240 opmode = ASTP | PSF;
241 opmode |= RE;
242#ifdef CONFIG_BFIN_MAC_RMII
243 opmode |= TE | RMII;
244#endif
245 /* Turn on the EMAC */
246 *pEMAC_OPMODE = opmode;
247 return 0;
248}
249
250static void bfin_EMAC_halt(struct eth_device *dev)
251{
252 DEBUGF("Eth_halt: ......\n");
253 /* Turn off the EMAC */
254 *pEMAC_OPMODE = 0x00000000;
255 /* Turn off the EMAC RX DMA */
256 *pDMA1_CONFIG = 0x0000;
257 *pDMA2_CONFIG = 0x0000;
258
259}
260
Mike Frysinger395bce42008-02-24 23:58:13 -0500261void bfin_EMAC_setup_addr(bd_t *bd)
Aubrey Li26bf7de2007-03-19 01:24:52 +0800262{
Mike Frysinger395bce42008-02-24 23:58:13 -0500263 *pEMAC_ADDRLO =
264 bd->bi_enetaddr[0] |
265 bd->bi_enetaddr[1] << 8 |
266 bd->bi_enetaddr[2] << 16 |
267 bd->bi_enetaddr[3] << 24;
268 *pEMAC_ADDRHI =
269 bd->bi_enetaddr[4] |
270 bd->bi_enetaddr[5] << 8;
Aubrey Li26bf7de2007-03-19 01:24:52 +0800271}
272
Mike Frysinger395bce42008-02-24 23:58:13 -0500273static void PollMdcDone(void)
Aubrey Li26bf7de2007-03-19 01:24:52 +0800274{
275 /* poll the STABUSY bit */
276 while (*pEMAC_STAADD & STABUSY) ;
277}
278
Mike Frysinger395bce42008-02-24 23:58:13 -0500279static void WrPHYReg(u16 PHYAddr, u16 RegAddr, u16 Data)
Aubrey Li26bf7de2007-03-19 01:24:52 +0800280{
281 PollMdcDone();
282
283 *pEMAC_STADAT = Data;
284
285 *pEMAC_STAADD = SET_PHYAD(PHYAddr) | SET_REGAD(RegAddr) |
286 STAOP | STAIE | STABUSY;
287}
288
289/*********************************************************************************
290 * Read an off-chip register in a PHY through the MDC/MDIO port *
291 *********************************************************************************/
Mike Frysinger395bce42008-02-24 23:58:13 -0500292static u16 RdPHYReg(u16 PHYAddr, u16 RegAddr)
Aubrey Li26bf7de2007-03-19 01:24:52 +0800293{
294 u16 Data;
295
296 PollMdcDone();
297
298 *pEMAC_STAADD = SET_PHYAD(PHYAddr) | SET_REGAD(RegAddr) |
299 STAIE | STABUSY;
300
301 PollMdcDone();
302
303 Data = (u16) * pEMAC_STADAT;
304
305 PHYregs[RegAddr] = Data; /* save shadow copy */
306
307 return Data;
308}
309
Mike Frysinger395bce42008-02-24 23:58:13 -0500310#if 0 /* dead code ? */
311static void SoftResetPHY(void)
Aubrey Li26bf7de2007-03-19 01:24:52 +0800312{
313 u16 phydat;
314 /* set the reset bit */
315 WrPHYReg(PHYADDR, PHY_MODECTL, PHY_RESET);
316 /* and clear it again */
317 WrPHYReg(PHYADDR, PHY_MODECTL, 0x0000);
318 do {
319 /* poll until reset is complete */
320 phydat = RdPHYReg(PHYADDR, PHY_MODECTL);
321 } while ((phydat & PHY_RESET) != 0);
322}
Mike Frysinger395bce42008-02-24 23:58:13 -0500323#endif
Aubrey Li26bf7de2007-03-19 01:24:52 +0800324
Mike Frysinger395bce42008-02-24 23:58:13 -0500325static int SetupSystemRegs(int *opmode)
Aubrey Li26bf7de2007-03-19 01:24:52 +0800326{
327 u16 sysctl, phydat;
328 int count = 0;
329 /* Enable PHY output */
Mike Frysingerd4d77302008-02-04 19:26:55 -0500330 *pVR_CTL |= CLKBUFOE;
Mike Frysinger395bce42008-02-24 23:58:13 -0500331 /* Set all the pins to peripheral mode */
332
333#ifndef CONFIG_BFIN_MAC_RMII
334 *pPORTH_FER = 0xFFFF;
335#ifdef __ADSPBF52x__
336 *pPORTH_MUX = PORT_x_MUX_0_FUNC_2 | PORT_x_MUX_1_FUNC_2 | PORT_x_MUX_2_FUNC_2;
337#endif
338#else
339#if defined(__ADSPBF536__) || defined(__ADSPBF537__)
340 *pPORTH_FER = 0xC373;
341#endif
342#ifdef __ADSPBF52x__
343 *pPORTH_FER = 0x01FF;
344 *pPORTH_MUX = PORT_x_MUX_0_FUNC_2 | PORT_x_MUX_1_FUNC_2;
345#endif
346#endif
Aubrey Li26bf7de2007-03-19 01:24:52 +0800347 /* MDC = 2.5 MHz */
348 sysctl = SET_MDCDIV(24);
349 /* Odd word alignment for Receive Frame DMA word */
350 /* Configure checksum support and rcve frame word alignment */
351 sysctl |= RXDWA | RXCKS;
352 *pEMAC_SYSCTL = sysctl;
353 /* auto negotiation on */
354 /* full duplex */
355 /* 100 Mbps */
356 phydat = PHY_ANEG_EN | PHY_DUPLEX | PHY_SPD_SET;
357 WrPHYReg(PHYADDR, PHY_MODECTL, phydat);
358 do {
359 udelay(1000);
360 phydat = RdPHYReg(PHYADDR, PHY_MODESTAT);
361 if (count > 3000) {
362 printf
363 ("Link is down, please check your network connection\n");
364 return -1;
365 }
366 count++;
367 } while (!(phydat & 0x0004));
368
369 phydat = RdPHYReg(PHYADDR, PHY_ANLPAR);
370
371 if ((phydat & 0x0100) || (phydat & 0x0040))
372 *opmode = FDMODE;
373 else
374 *opmode = 0;
375
376 *pEMAC_MMC_CTL = RSTC | CROLL;
377
378 /* Initialize the TX DMA channel registers */
379 *pDMA2_X_COUNT = 0;
380 *pDMA2_X_MODIFY = 4;
381 *pDMA2_Y_COUNT = 0;
382 *pDMA2_Y_MODIFY = 0;
383
384 /* Initialize the RX DMA channel registers */
385 *pDMA1_X_COUNT = 0;
386 *pDMA1_X_MODIFY = 4;
387 *pDMA1_Y_COUNT = 0;
388 *pDMA1_Y_MODIFY = 0;
389 return 0;
390}
391
392ADI_ETHER_BUFFER *SetupRxBuffer(int no)
393{
394 ADI_ETHER_FRAME_BUFFER *frmbuf;
395 ADI_ETHER_BUFFER *buf;
396 int nobytes_buffer = sizeof(ADI_ETHER_BUFFER[2]) / 2; /* ensure a multi. of 4 */
397 int total_size = nobytes_buffer + RECV_BUFSIZE;
398
399 buf = (ADI_ETHER_BUFFER *) (RXBUF_BASE_ADDR + no * total_size);
400 frmbuf =
401 (ADI_ETHER_FRAME_BUFFER *) (RXBUF_BASE_ADDR + no * total_size +
402 nobytes_buffer);
403
404 memset(buf, 0x00, nobytes_buffer);
405 buf->FrmData = frmbuf;
406 memset(frmbuf, 0xfe, RECV_BUFSIZE);
407
408 /* set up first desc to point to receive frame buffer */
409 buf->Dma[0].NEXT_DESC_PTR = &(buf->Dma[1]);
410 buf->Dma[0].START_ADDR = (u32) buf->FrmData;
411 buf->Dma[0].CONFIG.b_DMA_EN = 1; /* enabled */
412 buf->Dma[0].CONFIG.b_WNR = 1; /* Write to memory */
413 buf->Dma[0].CONFIG.b_WDSIZE = 2; /* wordsize is 32 bits */
414 buf->Dma[0].CONFIG.b_NDSIZE = 5; /* 5 half words is desc size. */
415 buf->Dma[0].CONFIG.b_FLOW = 7; /* large desc flow */
416
417 /* set up second desc to point to status word */
418 buf->Dma[1].NEXT_DESC_PTR = &(buf->Dma[0]);
419 buf->Dma[1].START_ADDR = (u32) & buf->IPHdrChksum;
420 buf->Dma[1].CONFIG.b_DMA_EN = 1; /* enabled */
421 buf->Dma[1].CONFIG.b_WNR = 1; /* Write to memory */
422 buf->Dma[1].CONFIG.b_WDSIZE = 2; /* wordsize is 32 bits */
423 buf->Dma[1].CONFIG.b_DI_EN = 1; /* enable interrupt */
424 buf->Dma[1].CONFIG.b_NDSIZE = 5; /* must be 0 when FLOW is 0 */
425 buf->Dma[1].CONFIG.b_FLOW = 7; /* stop */
426
427 return buf;
428}
429
430ADI_ETHER_BUFFER *SetupTxBuffer(int no)
431{
432 ADI_ETHER_FRAME_BUFFER *frmbuf;
433 ADI_ETHER_BUFFER *buf;
434 int nobytes_buffer = sizeof(ADI_ETHER_BUFFER[2]) / 2; /* ensure a multi. of 4 */
435 int total_size = nobytes_buffer + RECV_BUFSIZE;
436
437 buf = (ADI_ETHER_BUFFER *) (TXBUF_BASE_ADDR + no * total_size);
438 frmbuf =
439 (ADI_ETHER_FRAME_BUFFER *) (TXBUF_BASE_ADDR + no * total_size +
440 nobytes_buffer);
441
442 memset(buf, 0x00, nobytes_buffer);
443 buf->FrmData = frmbuf;
444 memset(frmbuf, 0x00, RECV_BUFSIZE);
445
446 /* set up first desc to point to receive frame buffer */
447 buf->Dma[0].NEXT_DESC_PTR = &(buf->Dma[1]);
448 buf->Dma[0].START_ADDR = (u32) buf->FrmData;
449 buf->Dma[0].CONFIG.b_DMA_EN = 1; /* enabled */
450 buf->Dma[0].CONFIG.b_WNR = 0; /* Read to memory */
451 buf->Dma[0].CONFIG.b_WDSIZE = 2; /* wordsize is 32 bits */
452 buf->Dma[0].CONFIG.b_NDSIZE = 5; /* 5 half words is desc size. */
453 buf->Dma[0].CONFIG.b_FLOW = 7; /* large desc flow */
454
455 /* set up second desc to point to status word */
456 buf->Dma[1].NEXT_DESC_PTR = &(buf->Dma[0]);
457 buf->Dma[1].START_ADDR = (u32) & buf->StatusWord;
458 buf->Dma[1].CONFIG.b_DMA_EN = 1; /* enabled */
459 buf->Dma[1].CONFIG.b_WNR = 1; /* Write to memory */
460 buf->Dma[1].CONFIG.b_WDSIZE = 2; /* wordsize is 32 bits */
461 buf->Dma[1].CONFIG.b_DI_EN = 1; /* enable interrupt */
462 buf->Dma[1].CONFIG.b_NDSIZE = 0; /* must be 0 when FLOW is 0 */
463 buf->Dma[1].CONFIG.b_FLOW = 0; /* stop */
464
465 return buf;
466}
467
468#if defined(CONFIG_POST) && defined(CFG_POST_ETHER)
469int ether_post_test(int flags)
470{
471 uchar buf[64];
472 int i, value = 0;
473 int length;
474
475 printf("\n--------");
476 bfin_EMAC_init(NULL, NULL);
477 /* construct the package */
478 buf[0] = buf[6] = (unsigned char)(*pEMAC_ADDRLO & 0xFF);
479 buf[1] = buf[7] = (unsigned char)((*pEMAC_ADDRLO & 0xFF00) >> 8);
480 buf[2] = buf[8] = (unsigned char)((*pEMAC_ADDRLO & 0xFF0000) >> 16);
481 buf[3] = buf[9] = (unsigned char)((*pEMAC_ADDRLO & 0xFF000000) >> 24);
482 buf[4] = buf[10] = (unsigned char)(*pEMAC_ADDRHI & 0xFF);
483 buf[5] = buf[11] = (unsigned char)((*pEMAC_ADDRHI & 0xFF00) >> 8);
484 buf[12] = 0x08; /* Type: ARP */
485 buf[13] = 0x06;
486 buf[14] = 0x00; /* Hardware type: Ethernet */
487 buf[15] = 0x01;
488 buf[16] = 0x08; /* Protocal type: IP */
489 buf[17] = 0x00;
490 buf[18] = 0x06; /* Hardware size */
491 buf[19] = 0x04; /* Protocol size */
492 buf[20] = 0x00; /* Opcode: request */
493 buf[21] = 0x01;
494
495 for (i = 0; i < 42; i++)
496 buf[i + 22] = i;
497 printf("--------Send 64 bytes......\n");
498 bfin_EMAC_send(NULL, (volatile void *)buf, 64);
499 for (i = 0; i < 100; i++) {
500 udelay(10000);
501 if ((rxbuf[rxIdx]->StatusWord & RX_COMP) != 0) {
502 value = 1;
503 break;
504 }
505 }
506 if (value == 0) {
507 printf("--------EMAC can't receive any data\n");
508 eth_halt();
509 return -1;
510 }
511 length = rxbuf[rxIdx]->StatusWord & 0x000007FF - 4;
512 for (i = 0; i < length; i++) {
513 if (rxbuf[rxIdx]->FrmData->Dest[i] != buf[i]) {
514 printf("--------EMAC receive error data!\n");
515 eth_halt();
516 return -1;
517 }
518 }
519 printf("--------receive %d bytes, matched\n", length);
520 bfin_EMAC_halt(NULL);
521 return 0;
522}
523#endif