[people/ms/u-boot.git] / post / cpu / ppc4xx / ether.c

/*
 * (C) Copyright 2007
 * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
 *
 * Author: Igor Lisitsin <igor@emcraft.com>
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

#include <common.h>

/*
 * Ethernet test
 *
 * The Ethernet Media Access Controllers (EMAC) are tested in the
 * internal loopback mode.
 * The controllers are configured accordingly and several packets
 * are transmitted. The configurable test parameters are:
 *   MIN_PACKET_LENGTH - minimum size of packet to transmit
 *   MAX_PACKET_LENGTH - maximum size of packet to transmit
 *   TEST_NUM - number of tests
 */

#include <post.h>

#if CONFIG_POST & CONFIG_SYS_POST_ETHER

#include <asm/cache.h>
#include <asm/io.h>
#include <asm/processor.h>
#include <405_mal.h>
#include <ppc4xx_enet.h>
#include <malloc.h>

DECLARE_GLOBAL_DATA_PTR;

/*
 * Get count of EMAC devices (doesn't have to be the max. possible number
 * supported by the cpu)
 *
 * CONFIG_BOARD_EMAC_COUNT added so now a "dynamic" way to configure the
 * EMAC count is possible. As it is needed for the Kilauea/Haleakala
 * 405EX/405EXr eval board, using the same binary.
 */
#if defined(CONFIG_BOARD_EMAC_COUNT)
#define LAST_EMAC_NUM	board_emac_count()
#else /* CONFIG_BOARD_EMAC_COUNT */
#if defined(CONFIG_HAS_ETH3)
#define LAST_EMAC_NUM	4
#elif defined(CONFIG_HAS_ETH2)
#define LAST_EMAC_NUM	3
#elif defined(CONFIG_HAS_ETH1)
#define LAST_EMAC_NUM	2
#else
#define LAST_EMAC_NUM	1
#endif
#endif /* CONFIG_BOARD_EMAC_COUNT */

#if defined(CONFIG_440SPE) || defined(CONFIG_440EPX) || defined(CONFIG_440GRX)
#define SDR0_MFR_ETH_CLK_SEL_V(n)	((0x01<<27) / (n+1))
#endif

#define MIN_PACKET_LENGTH	64
#define MAX_PACKET_LENGTH	256
#define TEST_NUM		1

static volatile mal_desc_t tx __cacheline_aligned;
static volatile mal_desc_t rx __cacheline_aligned;
static char *tx_buf;
static char *rx_buf;

int board_emac_count(void);

static void ether_post_init (int devnum, int hw_addr)
{
	int i;
#if defined(CONFIG_440GX) || \
    defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
    defined(CONFIG_440SP) || defined(CONFIG_440SPE)
	unsigned mode_reg;
	sys_info_t sysinfo;
#endif
#if defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || defined(CONFIG_440SPE)
	unsigned long mfr;
#endif

#if defined(CONFIG_440GX) || \
    defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
    defined(CONFIG_440SP) || defined(CONFIG_440SPE)
	/* Need to get the OPB frequency so we can access the PHY */
	get_sys_info (&sysinfo);
#endif

#if defined(CONFIG_440SPE) || defined(CONFIG_440EPX) || defined(CONFIG_440GRX)
	/* provide clocks for EMAC internal loopback  */
	mfsdr (sdr_mfr, mfr);
	mfr |= SDR0_MFR_ETH_CLK_SEL_V(devnum);
	mtsdr (sdr_mfr, mfr);
	sync ();
#endif
	/* reset emac */
	out_be32 ((void*)(EMAC_M0 + hw_addr), EMAC_M0_SRST);
	sync ();

	for (i = 0;; i++) {
		if (!(in_be32 ((void*)(EMAC_M0 + hw_addr)) & EMAC_M0_SRST))
			break;
		if (i >= 1000) {
			printf ("Timeout resetting EMAC\n");
			break;
		}
		udelay (1000);
	}
#if defined(CONFIG_440GX) || \
    defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
    defined(CONFIG_440SP) || defined(CONFIG_440SPE)
	/* Whack the M1 register */
	mode_reg = 0x0;
	if (sysinfo.freqOPB <= 50000000);
	else if (sysinfo.freqOPB <= 66666667)
		mode_reg |= EMAC_M1_OBCI_66;
	else if (sysinfo.freqOPB <= 83333333)
		mode_reg |= EMAC_M1_OBCI_83;
	else if (sysinfo.freqOPB <= 100000000)
		mode_reg |= EMAC_M1_OBCI_100;
	else
		mode_reg |= EMAC_M1_OBCI_GT100;

	out_be32 ((void*)(EMAC_M1 + hw_addr), mode_reg);

#endif /* defined(CONFIG_440GX) || defined(CONFIG_440SP) */

	/* set the Mal configuration reg */
#if defined(CONFIG_440GX) || \
    defined(CONFIG_440EPX) || defined(CONFIG_440GRX) || \
    defined(CONFIG_440SP) || defined(CONFIG_440SPE)
	mtdcr (malmcr, MAL_CR_PLBB | MAL_CR_OPBBL | MAL_CR_LEA |
	       MAL_CR_PLBLT_DEFAULT | 0x00330000);
#else
	mtdcr (malmcr, MAL_CR_PLBB | MAL_CR_OPBBL | MAL_CR_LEA | MAL_CR_PLBLT_DEFAULT);
	/* Errata 1.12: MAL_1 -- Disable MAL bursting */
	if (get_pvr() == PVR_440GP_RB) {
		mtdcr (malmcr, mfdcr(malmcr) & ~MAL_CR_PLBB);
	}
#endif
	/* setup buffer descriptors */
	tx.ctrl = MAL_TX_CTRL_WRAP;
	tx.data_len = 0;
	tx.data_ptr = (char*)L1_CACHE_ALIGN((u32)tx_buf);

	rx.ctrl = MAL_TX_CTRL_WRAP | MAL_RX_CTRL_EMPTY;
	rx.data_len = 0;
	rx.data_ptr = (char*)L1_CACHE_ALIGN((u32)rx_buf);
	flush_dcache_range((u32)&rx, (u32)&rx + sizeof(mal_desc_t));
	flush_dcache_range((u32)&tx, (u32)&tx + sizeof(mal_desc_t));

	switch (devnum) {
	case 1:
		/* setup MAL tx & rx channel pointers */
#if defined (CONFIG_405EP) || defined (CONFIG_440EP) || defined (CONFIG_440GR)
		mtdcr (maltxctp2r, &tx);
#else
		mtdcr (maltxctp1r, &tx);
#endif
#if defined(CONFIG_440)
		mtdcr (maltxbattr, 0x0);
		mtdcr (malrxbattr, 0x0);
#endif
		mtdcr (malrxctp1r, &rx);
		/* set RX buffer size */
		mtdcr (malrcbs1, PKTSIZE_ALIGN / 16);
		break;
	case 0:
	default:
		/* setup MAL tx & rx channel pointers */
#if defined(CONFIG_440)
		mtdcr (maltxbattr, 0x0);
		mtdcr (malrxbattr, 0x0);
#endif
		mtdcr (maltxctp0r, &tx);
		mtdcr (malrxctp0r, &rx);
		/* set RX buffer size */
		mtdcr (malrcbs0, PKTSIZE_ALIGN / 16);
		break;
	}

	/* Enable MAL transmit and receive channels */
#if defined(CONFIG_405EP) || defined(CONFIG_440EP) || defined(CONFIG_440GR)
	mtdcr (maltxcasr, (MAL_TXRX_CASR >> (devnum*2)));
#else
	mtdcr (maltxcasr, (MAL_TXRX_CASR >> devnum));
#endif
	mtdcr (malrxcasr, (MAL_TXRX_CASR >> devnum));

	/* set internal loopback mode */
#ifdef CONFIG_SYS_POST_ETHER_EXT_LOOPBACK
	out_be32 ((void*)(EMAC_M1 + hw_addr), EMAC_M1_FDE | 0 |
		  EMAC_M1_RFS_4K | EMAC_M1_TX_FIFO_2K |
		  EMAC_M1_MF_100MBPS | EMAC_M1_IST |
		  in_be32 ((void*)(EMAC_M1 + hw_addr)));
#else
	out_be32 ((void*)(EMAC_M1 + hw_addr), EMAC_M1_FDE | EMAC_M1_ILE |
		  EMAC_M1_RFS_4K | EMAC_M1_TX_FIFO_2K |
		  EMAC_M1_MF_100MBPS | EMAC_M1_IST |
		  in_be32 ((void*)(EMAC_M1 + hw_addr)));
#endif

	/* set transmit enable & receive enable */
	out_be32 ((void*)(EMAC_M0 + hw_addr), EMAC_M0_TXE | EMAC_M0_RXE);

	/* enable broadcast address */
	out_be32 ((void*)(EMAC_RXM + hw_addr), EMAC_RMR_BAE);

	/* set transmit request threshold register */
	out_be32 ((void*)(EMAC_TRTR + hw_addr), 0x18000000);	/* 256 byte threshold */

	/* set receive	low/high water mark register */
#if defined(CONFIG_440)
	/* 440s has a 64 byte burst length */
	out_be32 ((void*)(EMAC_RX_HI_LO_WMARK + hw_addr), 0x80009000);
#else
	/* 405s have a 16 byte burst length */
	out_be32 ((void*)(EMAC_RX_HI_LO_WMARK + hw_addr), 0x0f002000);
#endif /* defined(CONFIG_440) */
	out_be32 ((void*)(EMAC_TXM1 + hw_addr), 0xf8640000);

	/* Set fifo limit entry in tx mode 0 */
	out_be32 ((void*)(EMAC_TXM0 + hw_addr), 0x00000003);
	/* Frame gap set */
	out_be32 ((void*)(EMAC_I_FRAME_GAP_REG + hw_addr), 0x00000008);
	sync ();
}

static void ether_post_halt (int devnum, int hw_addr)
{
	int i = 0;
#if defined(CONFIG_440SPE) || defined(CONFIG_440EPX) || defined(CONFIG_440GRX)
	unsigned long mfr;
#endif

	/* 1st reset MAL channel */
	/* Note: writing a 0 to a channel has no effect */
#if defined(CONFIG_405EP) || defined(CONFIG_440EP) || defined(CONFIG_440GR)
	mtdcr (maltxcarr, MAL_TXRX_CASR >> (devnum * 2));
#else
	mtdcr (maltxcarr, MAL_TXRX_CASR >> devnum);
#endif
	mtdcr (malrxcarr, MAL_TXRX_CASR >> devnum);

	/* wait for reset */
	while (mfdcr (malrxcasr) & (MAL_TXRX_CASR >> devnum)) {
		if (i++ >= 1000)
			break;
		udelay (1000);
	}
	/* emac reset */
	out_be32 ((void*)(EMAC_M0 + hw_addr), EMAC_M0_SRST);

#if defined(CONFIG_440SPE) || defined(CONFIG_440EPX) || defined(CONFIG_440GRX)
	/* remove clocks for EMAC internal loopback  */
	mfsdr (sdr_mfr, mfr);
	mfr &= ~SDR0_MFR_ETH_CLK_SEL_V(devnum);
	mtsdr (sdr_mfr, mfr);
#endif
}

static void ether_post_send (int devnum, int hw_addr, void *packet, int length)
{
	int i = 0;

	while (tx.ctrl & MAL_TX_CTRL_READY) {
		if (i++ > 100) {
			printf ("TX timeout\n");
			return;
		}
		udelay (1000);
		invalidate_dcache_range((u32)&tx, (u32)&tx + sizeof(mal_desc_t));
	}
	tx.ctrl = MAL_TX_CTRL_READY | MAL_TX_CTRL_WRAP | MAL_TX_CTRL_LAST |
		EMAC_TX_CTRL_GFCS | EMAC_TX_CTRL_GP;
	tx.data_len = length;
	memcpy (tx.data_ptr, packet, length);
	flush_dcache_range((u32)&tx, (u32)&tx + sizeof(mal_desc_t));
	flush_dcache_range((u32)tx.data_ptr, (u32)tx.data_ptr + length);
	sync ();

	out_be32 ((void*)(EMAC_TXM0 + hw_addr), in_be32 ((void*)(EMAC_TXM0 + hw_addr)) | EMAC_TXM0_GNP0);
	sync ();
}

static int ether_post_recv (int devnum, int hw_addr, void *packet, int max_length)
{
	int length;
	int i = 0;

	while (rx.ctrl & MAL_RX_CTRL_EMPTY) {
		if (i++ > 100) {
			printf ("RX timeout\n");
			return 0;
		}
		udelay (1000);
		invalidate_dcache_range((u32)&rx, (u32)&rx + sizeof(mal_desc_t));
	}
	length = rx.data_len - 4;
	if (length <= max_length) {
		invalidate_dcache_range((u32)rx.data_ptr, (u32)rx.data_ptr + length);
		memcpy(packet, rx.data_ptr, length);
	}
	sync ();

	rx.ctrl |= MAL_RX_CTRL_EMPTY;
	flush_dcache_range((u32)&rx, (u32)&rx + sizeof(mal_desc_t));
	sync ();

	return length;
}

  /*
   * Test routines
   */

static void packet_fill (char *packet, int length)
{
	char c = (char) length;
	int i;

	/* set up ethernet header */
	memset (packet, 0xff, 14);

	for (i = 14; i < length; i++) {
		packet[i] = c++;
	}
}

static int packet_check (char *packet, int length)
{
	char c = (char) length;
	int i;

	for (i = 14; i < length; i++) {
		if (packet[i] != c++)
			return -1;
	}

	return 0;
}

static int test_ctlr (int devnum, int hw_addr)
{
	int res = -1;
	char packet_send[MAX_PACKET_LENGTH];
	char packet_recv[MAX_PACKET_LENGTH];
	int length;
	int i;
	int l;

	ether_post_init (devnum, hw_addr);

	for (i = 0; i < TEST_NUM; i++) {
		for (l = MIN_PACKET_LENGTH; l <= MAX_PACKET_LENGTH; l++) {
			packet_fill (packet_send, l);

			ether_post_send (devnum, hw_addr, packet_send, l);

			length = ether_post_recv (devnum, hw_addr, packet_recv,
						  sizeof (packet_recv));

			if (length != l || packet_check (packet_recv, length) < 0) {
				goto Done;
			}
		}
	}

	res = 0;

Done:

	ether_post_halt (devnum, hw_addr);

	if (res != 0) {
		post_log ("EMAC%d test failed\n", devnum);
	}

	return res;
}

int ether_post_test (int flags)
{
	int res = 0;
	int i;

	/* Allocate tx & rx packet buffers */
	tx_buf = malloc (PKTSIZE_ALIGN + CONFIG_SYS_CACHELINE_SIZE);
	rx_buf = malloc (PKTSIZE_ALIGN + CONFIG_SYS_CACHELINE_SIZE);

	if (!tx_buf || !rx_buf) {
		printf ("Failed to allocate packet buffers\n");
		res = -1;
		goto out_free;
	}

	for (i = 0; i < LAST_EMAC_NUM; i++) {
		if (test_ctlr (i, i*0x100))
			res = -1;
	}

out_free:
	free (tx_buf);
	free (rx_buf);

	return res;
}

#endif /* CONFIG_POST & CONFIG_SYS_POST_ETHER */
Commit	Line	Data
b4489621 SP	1	/*
	2	* (C) Copyright 2007
	3	* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
	4	*
	5	* Author: Igor Lisitsin <igor@emcraft.com>
	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>
	27
	28	/*
	29	* Ethernet test
	30	*
	31	* The Ethernet Media Access Controllers (EMAC) are tested in the
	32	* internal loopback mode.
	33	* The controllers are configured accordingly and several packets
	34	* are transmitted. The configurable test parameters are:
	35	* MIN_PACKET_LENGTH - minimum size of packet to transmit
	36	* MAX_PACKET_LENGTH - maximum size of packet to transmit
	37	* TEST_NUM - number of tests
	38	*/
	39
b4489621 SP	40	#include <post.h>
b4489621 SP	41
6d0f6bcf	42	#if CONFIG_POST & CONFIG_SYS_POST_ETHER
b4489621 SP	43
	44	#include <asm/cache.h>
	45	#include <asm/io.h>
	46	#include <asm/processor.h>
	47	#include <405_mal.h>
	48	#include <ppc4xx_enet.h>
	49	#include <malloc.h>
	50
	51	DECLARE_GLOBAL_DATA_PTR;
	52
7d47cee2 SR	53	/*
	54	* Get count of EMAC devices (doesn't have to be the max. possible number
	55	* supported by the cpu)
	56	*
	57	* CONFIG_BOARD_EMAC_COUNT added so now a "dynamic" way to configure the
	58	* EMAC count is possible. As it is needed for the Kilauea/Haleakala
	59	* 405EX/405EXr eval board, using the same binary.
	60	*/
	61	#if defined(CONFIG_BOARD_EMAC_COUNT)
	62	#define LAST_EMAC_NUM board_emac_count()
	63	#else /* CONFIG_BOARD_EMAC_COUNT */
	64	#if defined(CONFIG_HAS_ETH3)
	65	#define LAST_EMAC_NUM 4
	66	#elif defined(CONFIG_HAS_ETH2)
	67	#define LAST_EMAC_NUM 3
	68	#elif defined(CONFIG_HAS_ETH1)
	69	#define LAST_EMAC_NUM 2
	70	#else
	71	#define LAST_EMAC_NUM 1
	72	#endif
	73	#endif /* CONFIG_BOARD_EMAC_COUNT */
	74
b4489621 SP	75	#if defined(CONFIG_440SPE) \|\| defined(CONFIG_440EPX) \|\| defined(CONFIG_440GRX)
	76	#define SDR0_MFR_ETH_CLK_SEL_V(n) ((0x01<<27) / (n+1))
	77	#endif
	78
	79	#define MIN_PACKET_LENGTH 64
	80	#define MAX_PACKET_LENGTH 256
	81	#define TEST_NUM 1
	82
	83	static volatile mal_desc_t tx __cacheline_aligned;
	84	static volatile mal_desc_t rx __cacheline_aligned;
	85	static char *tx_buf;
	86	static char *rx_buf;
	87
7d47cee2 SR	88	int board_emac_count(void);
7d47cee2 SR	89
b4489621 SP	90	static void ether_post_init (int devnum, int hw_addr)
	91	{
	92	int i;
b4489621 SP	93	#if defined(CONFIG_440GX) \|\| \
	94	defined(CONFIG_440EPX) \|\| defined(CONFIG_440GRX) \|\| \
	95	defined(CONFIG_440SP) \|\| defined(CONFIG_440SPE)
c5a172a5	96	unsigned mode_reg;
b4489621 SP	97	sys_info_t sysinfo;
	98	#endif
	99	#if defined(CONFIG_440EPX) \|\| defined(CONFIG_440GRX) \|\| defined(CONFIG_440SPE)
	100	unsigned long mfr;
	101	#endif
	102
	103	#if defined(CONFIG_440GX) \|\| \
	104	defined(CONFIG_440EPX) \|\| defined(CONFIG_440GRX) \|\| \
	105	defined(CONFIG_440SP) \|\| defined(CONFIG_440SPE)
	106	/* Need to get the OPB frequency so we can access the PHY */
	107	get_sys_info (&sysinfo);
	108	#endif
	109
	110	#if defined(CONFIG_440SPE) \|\| defined(CONFIG_440EPX) \|\| defined(CONFIG_440GRX)
	111	/* provide clocks for EMAC internal loopback */
	112	mfsdr (sdr_mfr, mfr);
	113	mfr \|= SDR0_MFR_ETH_CLK_SEL_V(devnum);
	114	mtsdr (sdr_mfr, mfr);
	115	sync ();
	116	#endif
	117	/* reset emac */
c29d2d36	118	out_be32 ((void*)(EMAC_M0 + hw_addr), EMAC_M0_SRST);
b4489621 SP	119	sync ();
	120
	121	for (i = 0;; i++) {
c29d2d36	122	if (!(in_be32 ((void*)(EMAC_M0 + hw_addr)) & EMAC_M0_SRST))
b4489621 SP	123	break;
	124	if (i >= 1000) {
	125	printf ("Timeout resetting EMAC\n");
	126	break;
	127	}
	128	udelay (1000);
	129	}
	130	#if defined(CONFIG_440GX) \|\| \
	131	defined(CONFIG_440EPX) \|\| defined(CONFIG_440GRX) \|\| \
	132	defined(CONFIG_440SP) \|\| defined(CONFIG_440SPE)
	133	/* Whack the M1 register */
	134	mode_reg = 0x0;
	135	if (sysinfo.freqOPB <= 50000000);
	136	else if (sysinfo.freqOPB <= 66666667)
	137	mode_reg \|= EMAC_M1_OBCI_66;
	138	else if (sysinfo.freqOPB <= 83333333)
	139	mode_reg \|= EMAC_M1_OBCI_83;
	140	else if (sysinfo.freqOPB <= 100000000)
	141	mode_reg \|= EMAC_M1_OBCI_100;
	142	else
	143	mode_reg \|= EMAC_M1_OBCI_GT100;
	144
c29d2d36	145	out_be32 ((void*)(EMAC_M1 + hw_addr), mode_reg);
b4489621 SP	146
	147	#endif /* defined(CONFIG_440GX) \|\| defined(CONFIG_440SP) */
	148
	149	/* set the Mal configuration reg */
	150	#if defined(CONFIG_440GX) \|\| \
	151	defined(CONFIG_440EPX) \|\| defined(CONFIG_440GRX) \|\| \
	152	defined(CONFIG_440SP) \|\| defined(CONFIG_440SPE)
	153	mtdcr (malmcr, MAL_CR_PLBB \| MAL_CR_OPBBL \| MAL_CR_LEA \|
	154	MAL_CR_PLBLT_DEFAULT \| 0x00330000);
	155	#else
	156	mtdcr (malmcr, MAL_CR_PLBB \| MAL_CR_OPBBL \| MAL_CR_LEA \| MAL_CR_PLBLT_DEFAULT);
	157	/* Errata 1.12: MAL_1 -- Disable MAL bursting */
	158	if (get_pvr() == PVR_440GP_RB) {
	159	mtdcr (malmcr, mfdcr(malmcr) & ~MAL_CR_PLBB);
	160	}
	161	#endif
	162	/* setup buffer descriptors */
	163	tx.ctrl = MAL_TX_CTRL_WRAP;
	164	tx.data_len = 0;
	165	tx.data_ptr = (char*)L1_CACHE_ALIGN((u32)tx_buf);
	166
	167	rx.ctrl = MAL_TX_CTRL_WRAP \| MAL_RX_CTRL_EMPTY;
	168	rx.data_len = 0;
	169	rx.data_ptr = (char*)L1_CACHE_ALIGN((u32)rx_buf);
f71b2888 SR	170	flush_dcache_range((u32)&rx, (u32)&rx + sizeof(mal_desc_t));
f71b2888 SR	171	flush_dcache_range((u32)&tx, (u32)&tx + sizeof(mal_desc_t));
b4489621 SP	172
	173	switch (devnum) {
	174	case 1:
	175	/* setup MAL tx & rx channel pointers */
	176	#if defined (CONFIG_405EP) \|\| defined (CONFIG_440EP) \|\| defined (CONFIG_440GR)
	177	mtdcr (maltxctp2r, &tx);
	178	#else
	179	mtdcr (maltxctp1r, &tx);
	180	#endif
	181	#if defined(CONFIG_440)
	182	mtdcr (maltxbattr, 0x0);
	183	mtdcr (malrxbattr, 0x0);
	184	#endif
	185	mtdcr (malrxctp1r, &rx);
	186	/* set RX buffer size */
	187	mtdcr (malrcbs1, PKTSIZE_ALIGN / 16);
	188	break;
	189	case 0:
	190	default:
	191	/* setup MAL tx & rx channel pointers */
	192	#if defined(CONFIG_440)
	193	mtdcr (maltxbattr, 0x0);
	194	mtdcr (malrxbattr, 0x0);
	195	#endif
	196	mtdcr (maltxctp0r, &tx);
	197	mtdcr (malrxctp0r, &rx);
	198	/* set RX buffer size */
	199	mtdcr (malrcbs0, PKTSIZE_ALIGN / 16);
	200	break;
	201	}
	202
	203	/* Enable MAL transmit and receive channels */
	204	#if defined(CONFIG_405EP) \|\| defined(CONFIG_440EP) \|\| defined(CONFIG_440GR)
	205	mtdcr (maltxcasr, (MAL_TXRX_CASR >> (devnum*2)));
	206	#else
	207	mtdcr (maltxcasr, (MAL_TXRX_CASR >> devnum));
	208	#endif
	209	mtdcr (malrxcasr, (MAL_TXRX_CASR >> devnum));
	210
	211	/* set internal loopback mode */
6d0f6bcf	212	#ifdef CONFIG_SYS_POST_ETHER_EXT_LOOPBACK
c29d2d36 MF	213	out_be32 ((void*)(EMAC_M1 + hw_addr), EMAC_M1_FDE \| 0 \|
	214	EMAC_M1_RFS_4K \| EMAC_M1_TX_FIFO_2K \|
	215	EMAC_M1_MF_100MBPS \| EMAC_M1_IST \|
	216	in_be32 ((void*)(EMAC_M1 + hw_addr)));
c5a172a5	217	#else
c29d2d36 MF	218	out_be32 ((void*)(EMAC_M1 + hw_addr), EMAC_M1_FDE \| EMAC_M1_ILE \|
	219	EMAC_M1_RFS_4K \| EMAC_M1_TX_FIFO_2K \|
	220	EMAC_M1_MF_100MBPS \| EMAC_M1_IST \|
	221	in_be32 ((void*)(EMAC_M1 + hw_addr)));
c5a172a5	222	#endif
b4489621 SP	223
b4489621 SP	224	/* set transmit enable & receive enable */
c29d2d36	225	out_be32 ((void*)(EMAC_M0 + hw_addr), EMAC_M0_TXE \| EMAC_M0_RXE);
b4489621 SP	226
b4489621 SP	227	/* enable broadcast address */
c29d2d36	228	out_be32 ((void*)(EMAC_RXM + hw_addr), EMAC_RMR_BAE);
b4489621 SP	229
b4489621 SP	230	/* set transmit request threshold register */
c29d2d36	231	out_be32 ((void)(EMAC_TRTR + hw_addr), 0x18000000); / 256 byte threshold */
b4489621 SP	232
	233	/* set receive low/high water mark register */
	234	#if defined(CONFIG_440)
	235	/* 440s has a 64 byte burst length */
c29d2d36	236	out_be32 ((void*)(EMAC_RX_HI_LO_WMARK + hw_addr), 0x80009000);
b4489621 SP	237	#else
b4489621 SP	238	/* 405s have a 16 byte burst length */
c29d2d36	239	out_be32 ((void*)(EMAC_RX_HI_LO_WMARK + hw_addr), 0x0f002000);
b4489621	240	#endif /* defined(CONFIG_440) */
c29d2d36	241	out_be32 ((void*)(EMAC_TXM1 + hw_addr), 0xf8640000);
b4489621 SP	242
b4489621 SP	243	/* Set fifo limit entry in tx mode 0 */
c29d2d36	244	out_be32 ((void*)(EMAC_TXM0 + hw_addr), 0x00000003);
b4489621	245	/* Frame gap set */
c29d2d36	246	out_be32 ((void*)(EMAC_I_FRAME_GAP_REG + hw_addr), 0x00000008);
b4489621 SP	247	sync ();
	248	}
	249
	250	static void ether_post_halt (int devnum, int hw_addr)
	251	{
	252	int i = 0;
	253	#if defined(CONFIG_440SPE) \|\| defined(CONFIG_440EPX) \|\| defined(CONFIG_440GRX)
	254	unsigned long mfr;
	255	#endif
	256
	257	/* 1st reset MAL channel */
	258	/* Note: writing a 0 to a channel has no effect */
	259	#if defined(CONFIG_405EP) \|\| defined(CONFIG_440EP) \|\| defined(CONFIG_440GR)
	260	mtdcr (maltxcarr, MAL_TXRX_CASR >> (devnum * 2));
	261	#else
	262	mtdcr (maltxcarr, MAL_TXRX_CASR >> devnum);
	263	#endif
	264	mtdcr (malrxcarr, MAL_TXRX_CASR >> devnum);
	265
	266	/* wait for reset */
	267	while (mfdcr (malrxcasr) & (MAL_TXRX_CASR >> devnum)) {
	268	if (i++ >= 1000)
	269	break;
	270	udelay (1000);
	271	}
	272	/* emac reset */
c29d2d36	273	out_be32 ((void*)(EMAC_M0 + hw_addr), EMAC_M0_SRST);
b4489621 SP	274
	275	#if defined(CONFIG_440SPE) \|\| defined(CONFIG_440EPX) \|\| defined(CONFIG_440GRX)
	276	/* remove clocks for EMAC internal loopback */
	277	mfsdr (sdr_mfr, mfr);
	278	mfr &= ~SDR0_MFR_ETH_CLK_SEL_V(devnum);
	279	mtsdr (sdr_mfr, mfr);
	280	#endif
	281	}
	282
	283	static void ether_post_send (int devnum, int hw_addr, void *packet, int length)
	284	{
	285	int i = 0;
	286
	287	while (tx.ctrl & MAL_TX_CTRL_READY) {
	288	if (i++ > 100) {
	289	printf ("TX timeout\n");
	290	return;
	291	}
	292	udelay (1000);
f71b2888	293	invalidate_dcache_range((u32)&tx, (u32)&tx + sizeof(mal_desc_t));
b4489621 SP	294	}
	295	tx.ctrl = MAL_TX_CTRL_READY \| MAL_TX_CTRL_WRAP \| MAL_TX_CTRL_LAST \|
	296	EMAC_TX_CTRL_GFCS \| EMAC_TX_CTRL_GP;
	297	tx.data_len = length;
	298	memcpy (tx.data_ptr, packet, length);
f71b2888 SR	299	flush_dcache_range((u32)&tx, (u32)&tx + sizeof(mal_desc_t));
f71b2888 SR	300	flush_dcache_range((u32)tx.data_ptr, (u32)tx.data_ptr + length);
b4489621 SP	301	sync ();
b4489621 SP	302
c29d2d36	303	out_be32 ((void)(EMAC_TXM0 + hw_addr), in_be32 ((void)(EMAC_TXM0 + hw_addr)) \| EMAC_TXM0_GNP0);
b4489621 SP	304	sync ();
	305	}
	306
	307	static int ether_post_recv (int devnum, int hw_addr, void *packet, int max_length)
	308	{
	309	int length;
	310	int i = 0;
	311
	312	while (rx.ctrl & MAL_RX_CTRL_EMPTY) {
	313	if (i++ > 100) {
	314	printf ("RX timeout\n");
	315	return 0;
	316	}
	317	udelay (1000);
f71b2888	318	invalidate_dcache_range((u32)&rx, (u32)&rx + sizeof(mal_desc_t));
b4489621 SP	319	}
b4489621 SP	320	length = rx.data_len - 4;
f71b2888 SR	321	if (length <= max_length) {
f71b2888 SR	322	invalidate_dcache_range((u32)rx.data_ptr, (u32)rx.data_ptr + length);
b4489621	323	memcpy(packet, rx.data_ptr, length);
f71b2888	324	}
b4489621 SP	325	sync ();
	326
	327	rx.ctrl \|= MAL_RX_CTRL_EMPTY;
f71b2888	328	flush_dcache_range((u32)&rx, (u32)&rx + sizeof(mal_desc_t));
b4489621 SP	329	sync ();
	330
	331	return length;
	332	}
	333
	334	/*
	335	* Test routines
	336	*/
	337
	338	static void packet_fill (char *packet, int length)
	339	{
	340	char c = (char) length;
	341	int i;
	342
	343	/* set up ethernet header */
	344	memset (packet, 0xff, 14);
	345
	346	for (i = 14; i < length; i++) {
	347	packet[i] = c++;
	348	}
	349	}
	350
	351	static int packet_check (char *packet, int length)
	352	{
	353	char c = (char) length;
	354	int i;
	355
	356	for (i = 14; i < length; i++) {
	357	if (packet[i] != c++)
	358	return -1;
	359	}
	360
	361	return 0;
	362	}
	363
	364	static int test_ctlr (int devnum, int hw_addr)
	365	{
	366	int res = -1;
	367	char packet_send[MAX_PACKET_LENGTH];
	368	char packet_recv[MAX_PACKET_LENGTH];
	369	int length;
	370	int i;
	371	int l;
	372
	373	ether_post_init (devnum, hw_addr);
	374
	375	for (i = 0; i < TEST_NUM; i++) {
	376	for (l = MIN_PACKET_LENGTH; l <= MAX_PACKET_LENGTH; l++) {
	377	packet_fill (packet_send, l);
	378
	379	ether_post_send (devnum, hw_addr, packet_send, l);
	380
	381	length = ether_post_recv (devnum, hw_addr, packet_recv,
	382	sizeof (packet_recv));
	383
	384	if (length != l \|\| packet_check (packet_recv, length) < 0) {
	385	goto Done;
	386	}
	387	}
	388	}
	389
	390	res = 0;
	391
	392	Done:
393
394	ether_post_halt (devnum, hw_addr);
395
396	if (res != 0) {
397	post_log ("EMAC%d test failed\n", devnum);
398	}
399
400	return res;
401	}
402
403	int ether_post_test (int flags)
404	{
405	int res = 0;
7d47cee2	406	int i;
b4489621 SP	407
b4489621 SP	408	/* Allocate tx & rx packet buffers */
6d0f6bcf JCPV	409	tx_buf = malloc (PKTSIZE_ALIGN + CONFIG_SYS_CACHELINE_SIZE);
6d0f6bcf JCPV	410	rx_buf = malloc (PKTSIZE_ALIGN + CONFIG_SYS_CACHELINE_SIZE);
b4489621 SP	411
	412	if (!tx_buf \|\| !rx_buf) {
	413	printf ("Failed to allocate packet buffers\n");
	414	res = -1;
	415	goto out_free;
	416	}
	417
7d47cee2 SR	418	for (i = 0; i < LAST_EMAC_NUM; i++) {
	419	if (test_ctlr (i, i*0x100))
	420	res = -1;
	421	}
b4489621 SP	422
	423	out_free:
	424	free (tx_buf);
	425	free (rx_buf);
	426
	427	return res;
	428	}
	429
6d0f6bcf	430	#endif /* CONFIG_POST & CONFIG_SYS_POST_ETHER */