/*
 * (C) Copyright 2001
 * Josh Huber <huber@mclx.com>, Mission Critical Linux, Inc.
 *
 * 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
 *
 * modifications for the DB64360 eval board based by Ingo.Assmus@keymile.com
 */

/*
 * db64360.c - main board support/init for the Galileo Eval board.
 */

#include <common.h>
#include <74xx_7xx.h>
#include "../include/memory.h"
#include "../include/pci.h"
#include "../include/mv_gen_reg.h"
#include <net.h>
#include <netdev.h>

#include "eth.h"
#include "mpsc.h"
#include "i2c.h"
#include "64360.h"
#include "mv_regs.h"

#undef  DEBUG
/*#define       DEBUG */

#define MAP_PCI

#ifdef DEBUG
#define DP(x) x
#else
#define DP(x)
#endif

/* ------------------------------------------------------------------------- */

/* this is the current GT register space location */
/* it starts at CONFIG_SYS_DFL_GT_REGS but moves later to CONFIG_SYS_GT_REGS */

/* Unfortunately, we cant change it while we are in flash, so we initialize it
 * to the "final" value. This means that any debug_led calls before
 * board_early_init_f wont work right (like in cpu_init_f).
 * See also my_remap_gt_regs below. (NTL)
 */

void board_prebootm_init (void);
unsigned int INTERNAL_REG_BASE_ADDR = CONFIG_SYS_GT_REGS;
int display_mem_map (void);

/* ------------------------------------------------------------------------- */

/*
 * This is a version of the GT register space remapping function that
 * doesn't touch globals (meaning, it's ok to run from flash.)
 *
 * Unfortunately, this has the side effect that a writable
 * INTERNAL_REG_BASE_ADDR is impossible. Oh well.
 */

void my_remap_gt_regs (u32 cur_loc, u32 new_loc)
{
        u32 temp;

        /* check and see if it's already moved */

/* original ppcboot 1.1.6 source

        temp = in_le32((u32 *)(new_loc + INTERNAL_SPACE_DECODE));
        if ((temp & 0xffff) == new_loc >> 20)
                return;

        temp = (in_le32((u32 *)(cur_loc + INTERNAL_SPACE_DECODE)) &
                0xffff0000) | (new_loc >> 20);

        out_le32((u32 *)(cur_loc + INTERNAL_SPACE_DECODE), temp);

        while (GTREGREAD(INTERNAL_SPACE_DECODE) != temp);
original ppcboot 1.1.6 source end */

        temp = in_le32 ((u32 *) (new_loc + INTERNAL_SPACE_DECODE));
        if ((temp & 0xffff) == new_loc >> 16)
                return;

        temp = (in_le32 ((u32 *) (cur_loc + INTERNAL_SPACE_DECODE)) &
                0xffff0000) | (new_loc >> 16);

        out_le32 ((u32 *) (cur_loc + INTERNAL_SPACE_DECODE), temp);

        while (GTREGREAD (INTERNAL_SPACE_DECODE) != temp);
}

#ifdef CONFIG_PCI

static void gt_pci_config (void)
{
        unsigned int stat;
        unsigned int val = 0x00fff864;  /* DINK32: BusNum 23:16,  DevNum 15:11, FuncNum 10:8, RegNum 7:2 */

        /* In PCIX mode devices provide their own bus and device numbers. We query the Discovery II's
         * config registers by writing ones to the bus and device.
         * We then update the Virtual register with the correct value for the bus and device.
         */
        if ((GTREGREAD (PCI_0_MODE) & (BIT4 | BIT5)) != 0) {    /*if  PCI-X */
                GT_REG_WRITE (PCI_0_CONFIG_ADDR, BIT31 | val);

                GT_REG_READ (PCI_0_CONFIG_DATA_VIRTUAL_REG, &stat);

                GT_REG_WRITE (PCI_0_CONFIG_ADDR, BIT31 | val);
                GT_REG_WRITE (PCI_0_CONFIG_DATA_VIRTUAL_REG,
                              (stat & 0xffff0000) | CONFIG_SYS_PCI_IDSEL);

        }
        if ((GTREGREAD (PCI_1_MODE) & (BIT4 | BIT5)) != 0) {    /*if  PCI-X */
                GT_REG_WRITE (PCI_1_CONFIG_ADDR, BIT31 | val);
                GT_REG_READ (PCI_1_CONFIG_DATA_VIRTUAL_REG, &stat);

                GT_REG_WRITE (PCI_1_CONFIG_ADDR, BIT31 | val);
                GT_REG_WRITE (PCI_1_CONFIG_DATA_VIRTUAL_REG,
                              (stat & 0xffff0000) | CONFIG_SYS_PCI_IDSEL);
        }

        /* Enable master */
        PCI_MASTER_ENABLE (0, SELF);
        PCI_MASTER_ENABLE (1, SELF);

        /* Enable PCI0/1 Mem0 and IO 0 disable all others */
        GT_REG_READ (BASE_ADDR_ENABLE, &stat);
        stat |= (1 << 11) | (1 << 12) | (1 << 13) | (1 << 16) | (1 << 17) | (1
                                                                             <<
                                                                             18);
        stat &= ~((1 << 9) | (1 << 10) | (1 << 14) | (1 << 15));
        GT_REG_WRITE (BASE_ADDR_ENABLE, stat);

        /* ronen- add write to pci remap registers for 64460.
           in 64360 when writing to pci base go and overide remap automaticaly,
           in 64460 it doesn't */
        GT_REG_WRITE (PCI_0_IO_BASE_ADDR, CONFIG_SYS_PCI0_IO_BASE >> 16);
        GT_REG_WRITE (PCI_0I_O_ADDRESS_REMAP, CONFIG_SYS_PCI0_IO_BASE >> 16);
        GT_REG_WRITE (PCI_0_IO_SIZE, (CONFIG_SYS_PCI0_IO_SIZE - 1) >> 16);

        GT_REG_WRITE (PCI_0_MEMORY0_BASE_ADDR, CONFIG_SYS_PCI0_MEM_BASE >> 16);
        GT_REG_WRITE (PCI_0MEMORY0_ADDRESS_REMAP, CONFIG_SYS_PCI0_MEM_BASE >> 16);
        GT_REG_WRITE (PCI_0_MEMORY0_SIZE, (CONFIG_SYS_PCI0_MEM_SIZE - 1) >> 16);

        GT_REG_WRITE (PCI_1_IO_BASE_ADDR, CONFIG_SYS_PCI1_IO_BASE >> 16);
        GT_REG_WRITE (PCI_1I_O_ADDRESS_REMAP, CONFIG_SYS_PCI1_IO_BASE >> 16);
        GT_REG_WRITE (PCI_1_IO_SIZE, (CONFIG_SYS_PCI1_IO_SIZE - 1) >> 16);

        GT_REG_WRITE (PCI_1_MEMORY0_BASE_ADDR, CONFIG_SYS_PCI1_MEM_BASE >> 16);
        GT_REG_WRITE (PCI_1MEMORY0_ADDRESS_REMAP, CONFIG_SYS_PCI1_MEM_BASE >> 16);
        GT_REG_WRITE (PCI_1_MEMORY0_SIZE, (CONFIG_SYS_PCI1_MEM_SIZE - 1) >> 16);

        /* PCI interface settings */
        /* Timeout set to retry forever */
        GT_REG_WRITE (PCI_0TIMEOUT_RETRY, 0x0);
        GT_REG_WRITE (PCI_1TIMEOUT_RETRY, 0x0);

        /* ronen - enable only CS0 and Internal reg!! */
        GT_REG_WRITE (PCI_0BASE_ADDRESS_REGISTERS_ENABLE, 0xfffffdfe);
        GT_REG_WRITE (PCI_1BASE_ADDRESS_REGISTERS_ENABLE, 0xfffffdfe);

/*ronen update the pci internal registers base address.*/
#ifdef MAP_PCI
        for (stat = 0; stat <= PCI_HOST1; stat++)
                pciWriteConfigReg (stat,
                                   PCI_INTERNAL_REGISTERS_MEMORY_MAPPED_BASE_ADDRESS,
                                   SELF, CONFIG_SYS_GT_REGS);
#endif

}
#endif

/* Setup CPU interface paramaters */
static void gt_cpu_config (void)
{
        cpu_t cpu = get_cpu_type ();
        ulong tmp;

        /* cpu configuration register */
        tmp = GTREGREAD (CPU_CONFIGURATION);

        /* set the SINGLE_CPU bit  see MV64360 P.399 */
#ifndef CONFIG_SYS_GT_DUAL_CPU          /* SINGLE_CPU seems to cause JTAG problems */
        tmp |= CPU_CONF_SINGLE_CPU;
#endif

        tmp &= ~CPU_CONF_AACK_DELAY_2;

        tmp |= CPU_CONF_DP_VALID;
        tmp |= CPU_CONF_AP_VALID;

        tmp |= CPU_CONF_PIPELINE;

        GT_REG_WRITE (CPU_CONFIGURATION, tmp);  /* Marvell (VXWorks) writes 0x20220FF */

        /* CPU master control register */
        tmp = GTREGREAD (CPU_MASTER_CONTROL);

        tmp |= CPU_MAST_CTL_ARB_EN;

        if ((cpu == CPU_7400) ||
            (cpu == CPU_7410) || (cpu == CPU_7455) || (cpu == CPU_7450)) {

                tmp |= CPU_MAST_CTL_CLEAN_BLK;
                tmp |= CPU_MAST_CTL_FLUSH_BLK;

        } else {
                /* cleanblock must be cleared for CPUs
                 * that do not support this command (603e, 750)
                 * see Res#1 */
                tmp &= ~CPU_MAST_CTL_CLEAN_BLK;
                tmp &= ~CPU_MAST_CTL_FLUSH_BLK;
        }
        GT_REG_WRITE (CPU_MASTER_CONTROL, tmp);
}

/*
 * board_early_init_f.
 *
 * set up gal. device mappings, etc.
 */
int board_early_init_f (void)
{
        uchar sram_boot = 0;

        /*
         * set up the GT the way the kernel wants it
         * the call to move the GT register space will obviously
         * fail if it has already been done, but we're going to assume
         * that if it's not at the power-on location, it's where we put
         * it last time. (huber)
         */

        my_remap_gt_regs (CONFIG_SYS_DFL_GT_REGS, CONFIG_SYS_GT_REGS);

        /* No PCI in first release of Port To_do: enable it. */
#ifdef CONFIG_PCI
        gt_pci_config ();
#endif
        /* mask all external interrupt sources */
        GT_REG_WRITE (CPU_INTERRUPT_MASK_REGISTER_LOW, 0);
        GT_REG_WRITE (CPU_INTERRUPT_MASK_REGISTER_HIGH, 0);
        /* new in MV6436x */
        GT_REG_WRITE (CPU_INTERRUPT_1_MASK_REGISTER_LOW, 0);
        GT_REG_WRITE (CPU_INTERRUPT_1_MASK_REGISTER_HIGH, 0);
        /* --------------------- */
        GT_REG_WRITE (PCI_0INTERRUPT_CAUSE_MASK_REGISTER_LOW, 0);
        GT_REG_WRITE (PCI_0INTERRUPT_CAUSE_MASK_REGISTER_HIGH, 0);
        GT_REG_WRITE (PCI_1INTERRUPT_CAUSE_MASK_REGISTER_LOW, 0);
        GT_REG_WRITE (PCI_1INTERRUPT_CAUSE_MASK_REGISTER_HIGH, 0);
        /* does not exist in MV6436x
           GT_REG_WRITE(CPU_INT_0_MASK, 0);
           GT_REG_WRITE(CPU_INT_1_MASK, 0);
           GT_REG_WRITE(CPU_INT_2_MASK, 0);
           GT_REG_WRITE(CPU_INT_3_MASK, 0);
           --------------------- */


        /* ----- DEVICE BUS SETTINGS ------ */

        /*
         * EVB
         * 0 - SRAM   ????
         * 1 - RTC      ????
         * 2 - UART     ????
         * 3 - Flash    checked 32Bit Intel Strata
         * boot - BootCS checked 8Bit 29LV040B
         *
         * Zuma
         * 0 - Flash
         * boot - BootCS
         */

        /*
         * the dual 7450 module requires burst access to the boot
         * device, so the serial rom copies the boot device to the
         * on-board sram on the eval board, and updates the correct
         * registers to boot from the sram. (device0)
         */
        if (memoryGetDeviceBaseAddress (DEVICE0) == CONFIG_SYS_DFL_BOOTCS_BASE)
                sram_boot = 1;
        if (!sram_boot)
                memoryMapDeviceSpace (DEVICE0, CONFIG_SYS_DEV0_SPACE, CONFIG_SYS_DEV0_SIZE);

        memoryMapDeviceSpace (DEVICE1, CONFIG_SYS_DEV1_SPACE, CONFIG_SYS_DEV1_SIZE);
        memoryMapDeviceSpace (DEVICE2, CONFIG_SYS_DEV2_SPACE, CONFIG_SYS_DEV2_SIZE);
        memoryMapDeviceSpace (DEVICE3, CONFIG_SYS_DEV3_SPACE, CONFIG_SYS_DEV3_SIZE);


        /* configure device timing */
#ifdef CONFIG_SYS_DEV0_PAR              /* set port parameters for SRAM device module access */
        if (!sram_boot)
                GT_REG_WRITE (DEVICE_BANK0PARAMETERS, CONFIG_SYS_DEV0_PAR);
#endif

#ifdef CONFIG_SYS_DEV1_PAR              /* set port parameters for RTC device module access */
        GT_REG_WRITE (DEVICE_BANK1PARAMETERS, CONFIG_SYS_DEV1_PAR);
#endif
#ifdef CONFIG_SYS_DEV2_PAR              /* set port parameters for DUART device module access */
        GT_REG_WRITE (DEVICE_BANK2PARAMETERS, CONFIG_SYS_DEV2_PAR);
#endif

#ifdef CONFIG_SYS_32BIT_BOOT_PAR        /* set port parameters for Flash device module access */
        /* detect if we are booting from the 32 bit flash */
        if (GTREGREAD (DEVICE_BOOT_BANK_PARAMETERS) & (0x3 << 20)) {
                /* 32 bit boot flash */
                GT_REG_WRITE (DEVICE_BANK3PARAMETERS, CONFIG_SYS_8BIT_BOOT_PAR);
                GT_REG_WRITE (DEVICE_BOOT_BANK_PARAMETERS,
                              CONFIG_SYS_32BIT_BOOT_PAR);
        } else {
                /* 8 bit boot flash */
                GT_REG_WRITE (DEVICE_BANK3PARAMETERS, CONFIG_SYS_32BIT_BOOT_PAR);
                GT_REG_WRITE (DEVICE_BOOT_BANK_PARAMETERS, CONFIG_SYS_8BIT_BOOT_PAR);
        }
#else
        /* 8 bit boot flash only */
/*      GT_REG_WRITE(DEVICE_BOOT_BANK_PARAMETERS, CONFIG_SYS_8BIT_BOOT_PAR);*/
#endif


        gt_cpu_config ();

        /* MPP setup */
        GT_REG_WRITE (MPP_CONTROL0, CONFIG_SYS_MPP_CONTROL_0);
        GT_REG_WRITE (MPP_CONTROL1, CONFIG_SYS_MPP_CONTROL_1);
        GT_REG_WRITE (MPP_CONTROL2, CONFIG_SYS_MPP_CONTROL_2);
        GT_REG_WRITE (MPP_CONTROL3, CONFIG_SYS_MPP_CONTROL_3);

        GT_REG_WRITE (GPP_LEVEL_CONTROL, CONFIG_SYS_GPP_LEVEL_CONTROL);
        DEBUG_LED0_ON ();
        DEBUG_LED1_ON ();
        DEBUG_LED2_ON ();

        return 0;
}

/* various things to do after relocation */

int misc_init_r ()
{
        icache_enable ();
#ifdef CONFIG_SYS_L2
        l2cache_enable ();
#endif
#ifdef CONFIG_MPSC

        mpsc_sdma_init ();
        mpsc_init2 ();
#endif

#if 0
        /* disable the dcache and MMU */
        dcache_lock ();
#endif
        return 0;
}

void after_reloc (ulong dest_addr, gd_t * gd)
{
        /* check to see if we booted from the sram.  If so, move things
         * back to the way they should be. (we're running from main
         * memory at this point now */
        if (memoryGetDeviceBaseAddress (DEVICE0) == CONFIG_SYS_DFL_BOOTCS_BASE) {
                memoryMapDeviceSpace (DEVICE0, CONFIG_SYS_DEV0_SPACE, CONFIG_SYS_DEV0_SIZE);
                memoryMapDeviceSpace (BOOT_DEVICE, CONFIG_SYS_DFL_BOOTCS_BASE, _8M);
        }
        display_mem_map ();
        /* now, jump to the main ppcboot board init code */
        board_init_r (gd, dest_addr);
        /* NOTREACHED */
}

/* ------------------------------------------------------------------------- */

/*
 * Check Board Identity:
 *
 * right now, assume borad type. (there is just one...after all)
 */

int checkboard (void)
{
        int l_type = 0;

        printf ("BOARD: %s\n", CONFIG_SYS_BOARD_NAME);
        return (l_type);
}

/* utility functions */
void debug_led (int led, int mode)
{
        volatile int *addr = 0;
        int dummy;

        if (mode == 1) {
                switch (led) {
                case 0:
                        addr = (int *) ((unsigned int) CONFIG_SYS_DEV1_SPACE |
                                        0x08000);
                        break;

                case 1:
                        addr = (int *) ((unsigned int) CONFIG_SYS_DEV1_SPACE |
                                        0x0c000);
                        break;

                case 2:
                        addr = (int *) ((unsigned int) CONFIG_SYS_DEV1_SPACE |
                                        0x10000);
                        break;
                }
        } else if (mode == 0) {
                switch (led) {
                case 0:
                        addr = (int *) ((unsigned int) CONFIG_SYS_DEV1_SPACE |
                                        0x14000);
                        break;

                case 1:
                        addr = (int *) ((unsigned int) CONFIG_SYS_DEV1_SPACE |
                                        0x18000);
                        break;

                case 2:
                        addr = (int *) ((unsigned int) CONFIG_SYS_DEV1_SPACE |
                                        0x1c000);
                        break;
                }
        }

        dummy = *addr;
}

int display_mem_map (void)
{
        int i, j;
        unsigned int base, size, width;

        /* SDRAM */
        printf ("SD (DDR) RAM\n");
        for (i = 0; i <= BANK3; i++) {
                base = memoryGetBankBaseAddress (i);
                size = memoryGetBankSize (i);
                if (size != 0) {
                        printf ("BANK%d: base - 0x%08x\tsize - %dM bytes\n",
                                i, base, size >> 20);
                }
        }

        /* CPU's PCI windows */
        for (i = 0; i <= PCI_HOST1; i++) {
                printf ("\nCPU's PCI %d windows\n", i);
                base = pciGetSpaceBase (i, PCI_IO);
                size = pciGetSpaceSize (i, PCI_IO);
                printf ("      IO: base - 0x%08x\tsize - %dM bytes\n", base,
                        size >> 20);
                for (j = 0;
                     j <=
                     PCI_REGION0
                     /*ronen currently only first PCI MEM is used 3 */ ;
                     j++) {
                        base = pciGetSpaceBase (i, j);
                        size = pciGetSpaceSize (i, j);
                        printf ("MEMORY %d: base - 0x%08x\tsize - %dM bytes\n", j, base, size >> 20);
                }
        }

        /* Devices */
        printf ("\nDEVICES\n");
        for (i = 0; i <= DEVICE3; i++) {
                base = memoryGetDeviceBaseAddress (i);
                size = memoryGetDeviceSize (i);
                width = memoryGetDeviceWidth (i) * 8;
                printf ("DEV %d:  base - 0x%08x  size - %dM bytes\twidth - %d bits", i, base, size >> 20, width);
                if (i == 0)
                        printf ("\t- EXT SRAM (actual - 1M)\n");
                else if (i == 1)
                        printf ("\t- RTC\n");
                else if (i == 2)
                        printf ("\t- UART\n");
                else
                        printf ("\t- LARGE FLASH\n");
        }

        /* Bootrom */
        base = memoryGetDeviceBaseAddress (BOOT_DEVICE);        /* Boot */
        size = memoryGetDeviceSize (BOOT_DEVICE);
        width = memoryGetDeviceWidth (BOOT_DEVICE) * 8;
        printf (" BOOT:  base - 0x%08x  size - %dM bytes\twidth - %d bits\n",
                base, size >> 20, width);
        return (0);
}

/* DRAM check routines copied from gw8260 */

#if defined (CONFIG_SYS_DRAM_TEST)

/*********************************************************************/
/* NAME:  move64() -  moves a double word (64-bit)                   */
/*                                                                   */
/* DESCRIPTION:                                                      */
/*   this function performs a double word move from the data at      */
/*   the source pointer to the location at the destination pointer.  */
/*                                                                   */
/* INPUTS:                                                           */
/*   unsigned long long *src  - pointer to data to move              */
/*                                                                   */
/* OUTPUTS:                                                          */
/*   unsigned long long *dest - pointer to locate to move data       */
/*                                                                   */
/* RETURNS:                                                          */
/*   None                                                            */
/*                                                                   */
/* RESTRICTIONS/LIMITATIONS:                                         */
/*   May cloober fr0.                                                */
/*                                                                   */
/*********************************************************************/
static void move64 (unsigned long long *src, unsigned long long *dest)
{
        asm ("lfd  0, 0(3)\n\t" /* fpr0   =  *scr       */
             "stfd 0, 0(4)"     /* *dest  =  fpr0       */
      : : : "fr0");             /* Clobbers fr0         */
        return;
}


#if defined (CONFIG_SYS_DRAM_TEST_DATA)

unsigned long long pattern[] = {
        0xaaaaaaaaaaaaaaaaULL,
        0xccccccccccccccccULL,
        0xf0f0f0f0f0f0f0f0ULL,
        0xff00ff00ff00ff00ULL,
        0xffff0000ffff0000ULL,
        0xffffffff00000000ULL,
        0x00000000ffffffffULL,
        0x0000ffff0000ffffULL,
        0x00ff00ff00ff00ffULL,
        0x0f0f0f0f0f0f0f0fULL,
        0x3333333333333333ULL,
        0x5555555555555555ULL,
};

/*********************************************************************/
/* NAME:  mem_test_data() -  test data lines for shorts and opens    */
/*                                                                   */
/* DESCRIPTION:                                                      */
/*   Tests data lines for shorts and opens by forcing adjacent data  */
/*   to opposite states. Because the data lines could be routed in   */
/*   an arbitrary manner the must ensure test patterns ensure that   */
/*   every case is tested. By using the following series of binary   */
/*   patterns every combination of adjacent bits is test regardless  */
/*   of routing.                                                     */
/*                                                                   */
/*     ...101010101010101010101010                                   */
/*     ...110011001100110011001100                                   */
/*     ...111100001111000011110000                                   */
/*     ...111111110000000011111111                                   */
/*                                                                   */
/*   Carrying this out, gives us six hex patterns as follows:        */
/*                                                                   */
/*     0xaaaaaaaaaaaaaaaa                                            */
/*     0xcccccccccccccccc                                            */
/*     0xf0f0f0f0f0f0f0f0                                            */
/*     0xff00ff00ff00ff00                                            */
/*     0xffff0000ffff0000                                            */
/*     0xffffffff00000000                                            */
/*                                                                   */
/*   The number test patterns will always be given by:               */
/*                                                                   */
/*   log(base 2)(number data bits) = log2 (64) = 6                   */
/*                                                                   */
/*   To test for short and opens to other signals on our boards. we  */
/*   simply                                                          */
/*   test with the 1's complemnt of the paterns as well.             */
/*                                                                   */
/* OUTPUTS:                                                          */
/*   Displays failing test pattern                                   */
/*                                                                   */
/* RETURNS:                                                          */
/*   0 -  Passed test                                                */
/*   1 -  Failed test                                                */
/*                                                                   */
/* RESTRICTIONS/LIMITATIONS:                                         */
/*  Assumes only one one SDRAM bank                                  */
/*                                                                   */
/*********************************************************************/
int mem_test_data (void)
{
        unsigned long long *pmem = (unsigned long long *) CONFIG_SYS_MEMTEST_START;
        unsigned long long temp64 = 0;
        int num_patterns = sizeof (pattern) / sizeof (pattern[0]);
        int i;
        unsigned int hi, lo;

        for (i = 0; i < num_patterns; i++) {
                move64 (&(pattern[i]), pmem);
                move64 (pmem, &temp64);

                /* hi = (temp64>>32) & 0xffffffff;          */
                /* lo = temp64 & 0xffffffff;                */
                /* printf("\ntemp64 = 0x%08x%08x", hi, lo); */

                hi = (pattern[i] >> 32) & 0xffffffff;
                lo = pattern[i] & 0xffffffff;
                /* printf("\npattern[%d] = 0x%08x%08x", i, hi, lo);  */

                if (temp64 != pattern[i]) {
                        printf ("\n   Data Test Failed, pattern 0x%08x%08x",
                                hi, lo);
                        return 1;
                }
        }

        return 0;
}
#endif /* CONFIG_SYS_DRAM_TEST_DATA */

#if defined (CONFIG_SYS_DRAM_TEST_ADDRESS)
/*********************************************************************/
/* NAME:  mem_test_address() -  test address lines                   */
/*                                                                   */
/* DESCRIPTION:                                                      */
/*   This function performs a test to verify that each word im       */
/*   memory is uniquly addressable. The test sequence is as follows: */
/*                                                                   */
/*   1) write the address of each word to each word.                 */
/*   2) verify that each location equals its address                 */
/*                                                                   */
/* OUTPUTS:                                                          */
/*   Displays failing test pattern and address                       */
/*                                                                   */
/* RETURNS:                                                          */
/*   0 -  Passed test                                                */
/*   1 -  Failed test                                                */
/*                                                                   */
/* RESTRICTIONS/LIMITATIONS:                                         */
/*                                                                   */
/*                                                                   */
/*********************************************************************/
int mem_test_address (void)
{
        volatile unsigned int *pmem =
                (volatile unsigned int *) CONFIG_SYS_MEMTEST_START;
        const unsigned int size = (CONFIG_SYS_MEMTEST_END - CONFIG_SYS_MEMTEST_START) / 4;
        unsigned int i;

        /* write address to each location */
        for (i = 0; i < size; i++) {
                pmem[i] = i;
        }

        /* verify each loaction */
        for (i = 0; i < size; i++) {
                if (pmem[i] != i) {
                        printf ("\n   Address Test Failed at 0x%x", i);
                        return 1;
                }
        }
        return 0;
}
#endif /* CONFIG_SYS_DRAM_TEST_ADDRESS */

#if defined (CONFIG_SYS_DRAM_TEST_WALK)
/*********************************************************************/
/* NAME:   mem_march() -  memory march                               */
/*                                                                   */
/* DESCRIPTION:                                                      */
/*   Marches up through memory. At each location verifies rmask if   */
/*   read = 1. At each location write wmask if  write = 1. Displays  */
/*   failing address and pattern.                                    */
/*                                                                   */
/* INPUTS:                                                           */
/*   volatile unsigned long long * base - start address of test      */
/*   unsigned int size - number of dwords(64-bit) to test            */
/*   unsigned long long rmask - read verify mask                     */
/*   unsigned long long wmask - wrtie verify mask                    */
/*   short read - verifies rmask if read = 1                         */
/*   short write  - writes wmask if write = 1                        */
/*                                                                   */
/* OUTPUTS:                                                          */
/*   Displays failing test pattern and address                       */
/*                                                                   */
/* RETURNS:                                                          */
/*   0 -  Passed test                                                */
/*   1 -  Failed test                                                */
/*                                                                   */
/* RESTRICTIONS/LIMITATIONS:                                         */
/*                                                                   */
/*                                                                   */
/*********************************************************************/
int mem_march (volatile unsigned long long *base,
               unsigned int size,
               unsigned long long rmask,
               unsigned long long wmask, short read, short write)
{
        unsigned int i;
        unsigned long long temp = 0;
        unsigned int hitemp, lotemp, himask, lomask;

        for (i = 0; i < size; i++) {
                if (read != 0) {
                        /* temp = base[i]; */
                        move64 ((unsigned long long *) &(base[i]), &temp);
                        if (rmask != temp) {
                                hitemp = (temp >> 32) & 0xffffffff;
                                lotemp = temp & 0xffffffff;
                                himask = (rmask >> 32) & 0xffffffff;
                                lomask = rmask & 0xffffffff;

                                printf ("\n Walking one's test failed: address = 0x%08x," "\n\texpected 0x%08x%08x, found 0x%08x%08x", i << 3, himask, lomask, hitemp, lotemp);
                                return 1;
                        }
                }
                if (write != 0) {
                        /*  base[i] = wmask; */
                        move64 (&wmask, (unsigned long long *) &(base[i]));
                }
        }
        return 0;
}
#endif /* CONFIG_SYS_DRAM_TEST_WALK */

/*********************************************************************/
/* NAME:   mem_test_walk() -  a simple walking ones test             */
/*                                                                   */
/* DESCRIPTION:                                                      */
/*   Performs a walking ones through entire physical memory. The     */
/*   test uses as series of memory marches, mem_march(), to verify   */
/*   and write the test patterns to memory. The test sequence is as  */
/*   follows:                                                        */
/*     1) march writing 0000...0001                                  */
/*     2) march verifying 0000...0001  , writing  0000...0010        */
/*     3) repeat step 2 shifting masks left 1 bit each time unitl    */
/*         the write mask equals 1000...0000                         */
/*     4) march verifying 1000...0000                                */
/*   The test fails if any of the memory marches return a failure.   */
/*                                                                   */
/* OUTPUTS:                                                          */
/*   Displays which pass on the memory test is executing             */
/*                                                                   */
/* RETURNS:                                                          */
/*   0 -  Passed test                                                */
/*   1 -  Failed test                                                */
/*                                                                   */
/* RESTRICTIONS/LIMITATIONS:                                         */
/*                                                                   */
/*                                                                   */
/*********************************************************************/
int mem_test_walk (void)
{
        unsigned long long mask;
        volatile unsigned long long *pmem =
                (volatile unsigned long long *) CONFIG_SYS_MEMTEST_START;
        const unsigned long size = (CONFIG_SYS_MEMTEST_END - CONFIG_SYS_MEMTEST_START) / 8;

        unsigned int i;

        mask = 0x01;

        printf ("Initial Pass");
        mem_march (pmem, size, 0x0, 0x1, 0, 1);

        printf ("\b\b\b\b\b\b\b\b\b\b\b\b");
        printf ("               ");
        printf ("         ");
        printf ("\b\b\b\b\b\b\b\b\b\b\b\b");

        for (i = 0; i < 63; i++) {
                printf ("Pass %2d", i + 2);
                if (mem_march (pmem, size, mask, mask << 1, 1, 1) != 0) {
                        /*printf("mask: 0x%x, pass: %d, ", mask, i); */
                        return 1;
                }
                mask = mask << 1;
                printf ("\b\b\b\b\b\b\b");
        }

        printf ("Last Pass");
        if (mem_march (pmem, size, 0, mask, 0, 1) != 0) {
                /* printf("mask: 0x%x", mask); */
                return 1;
        }
        printf ("\b\b\b\b\b\b\b\b\b");
        printf ("            ");
        printf ("\b\b\b\b\b\b\b\b\b");

        return 0;
}

/*********************************************************************/
/* NAME:    testdram() -  calls any enabled memory tests             */
/*                                                                   */
/* DESCRIPTION:                                                      */
/*   Runs memory tests if the environment test variables are set to  */
/*   'y'.                                                            */
/*                                                                   */
/* INPUTS:                                                           */
/*   testdramdata    - If set to 'y', data test is run.              */
/*   testdramaddress - If set to 'y', address test is run.           */
/*   testdramwalk    - If set to 'y', walking ones test is run       */
/*                                                                   */
/* OUTPUTS:                                                          */
/*   None                                                            */
/*                                                                   */
/* RETURNS:                                                          */
/*   0 -  Passed test                                                */
/*   1 -  Failed test                                                */
/*                                                                   */
/* RESTRICTIONS/LIMITATIONS:                                         */
/*                                                                   */
/*                                                                   */
/*********************************************************************/
int testdram (void)
{
        char *s;
        int rundata, runaddress, runwalk;

        s = getenv ("testdramdata");
        rundata = (s && (*s == 'y')) ? 1 : 0;
        s = getenv ("testdramaddress");
        runaddress = (s && (*s == 'y')) ? 1 : 0;
        s = getenv ("testdramwalk");
        runwalk = (s && (*s == 'y')) ? 1 : 0;

/*    rundata = 1; */
/*    runaddress = 0; */
/*    runwalk = 0; */

        if ((rundata == 1) || (runaddress == 1) || (runwalk == 1)) {
                printf ("Testing RAM from 0x%08x to 0x%08x ...  (don't panic... that will take a moment !!!!)\n", CONFIG_SYS_MEMTEST_START, CONFIG_SYS_MEMTEST_END);
        }
#ifdef CONFIG_SYS_DRAM_TEST_DATA
        if (rundata == 1) {
                printf ("Test DATA ...  ");
                if (mem_test_data () == 1) {
                        printf ("failed \n");
                        return 1;
                } else
                        printf ("ok \n");
        }
#endif
#ifdef CONFIG_SYS_DRAM_TEST_ADDRESS
        if (runaddress == 1) {
                printf ("Test ADDRESS ...  ");
                if (mem_test_address () == 1) {
                        printf ("failed \n");
                        return 1;
                } else
                        printf ("ok \n");
        }
#endif
#ifdef CONFIG_SYS_DRAM_TEST_WALK
        if (runwalk == 1) {
                printf ("Test WALKING ONEs ...  ");
                if (mem_test_walk () == 1) {
                        printf ("failed \n");
                        return 1;
                } else
                        printf ("ok \n");
        }
#endif
        if ((rundata == 1) || (runaddress == 1) || (runwalk == 1)) {
                printf ("passed\n");
        }
        return 0;

}
#endif /* CONFIG_SYS_DRAM_TEST */

/* ronen - the below functions are used by the bootm function           */
/*  - we map the base register to fbe00000 (same mapping as in the LSP) */
/*  - we turn off the RX gig dmas - to prevent the dma from overunning  */
/*    the kernel data areas.                                            */
/*  - we diable and invalidate the icache and dcache.                   */
void my_remap_gt_regs_bootm (u32 cur_loc, u32 new_loc)
{
        u32 temp;

        temp = in_le32 ((u32 *) (new_loc + INTERNAL_SPACE_DECODE));
        if ((temp & 0xffff) == new_loc >> 16)
                return;

        temp = (in_le32 ((u32 *) (cur_loc + INTERNAL_SPACE_DECODE)) &
                0xffff0000) | (new_loc >> 16);

        out_le32 ((u32 *) (cur_loc + INTERNAL_SPACE_DECODE), temp);

        while ((WORD_SWAP (*((volatile unsigned int *) (NONE_CACHEABLE |
                                                        new_loc |
                                                        (INTERNAL_SPACE_DECODE)))))
               != temp);

}

void board_prebootm_init ()
{

/* change window size of PCI1 IO in order tp prevent overlaping with REG BASE. */
                GT_REG_WRITE (PCI_1_IO_SIZE, (_64K - 1) >> 16);

/* Stop GigE Rx DMA engines */
        GT_REG_WRITE (MV64360_ETH_RECEIVE_QUEUE_COMMAND_REG (0), 0x0000ff00);
        GT_REG_WRITE (MV64360_ETH_RECEIVE_QUEUE_COMMAND_REG (1), 0x0000ff00);
/* MV_REG_WRITE (MV64360_ETH_RECEIVE_QUEUE_COMMAND_REG(2), 0x0000ff00); */

/* Relocate MV64360 internal regs */
        my_remap_gt_regs_bootm (CONFIG_SYS_GT_REGS, BRIDGE_REG_BASE_BOOTM);

        icache_disable ();
        dcache_disable ();
}

int board_eth_init(bd_t *bis)
{
        return pci_eth_init(bis);
}