2002-08-26 21:58:50 +00:00
|
|
|
/*
|
|
|
|
* (C) Copyright 2000, 2001
|
|
|
|
* Wolfgang Denk, DENX Software Engineering, wd@denx.de.
|
|
|
|
* Ulrich Lutz, Speech Design GmbH, ulutz@datalab.de.
|
|
|
|
*
|
|
|
|
* 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>
|
|
|
|
#include <mpc8xx.h>
|
|
|
|
#include <commproc.h>
|
|
|
|
|
|
|
|
#ifdef CONFIG_STATUS_LED
|
|
|
|
# include <status_led.h>
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
|
|
|
static long int dram_size (long int, long int *, long int);
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
|
|
|
#define _NOT_USED_ 0xFFFFFFFF
|
|
|
|
|
|
|
|
/*
|
|
|
|
* 50 MHz SHARC access using UPM A
|
|
|
|
*/
|
2004-01-06 22:38:14 +00:00
|
|
|
const uint sharc_table[] = {
|
2002-08-26 21:58:50 +00:00
|
|
|
/*
|
|
|
|
* Single Read. (Offset 0 in UPM RAM)
|
|
|
|
*/
|
|
|
|
0x0FF3FC04, 0x0FF3EC00, 0x7FFFEC04, 0xFFFFEC04,
|
2004-01-06 22:38:14 +00:00
|
|
|
0xFFFFEC05, /* last */
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_,
|
2002-08-26 21:58:50 +00:00
|
|
|
/*
|
|
|
|
* Burst Read. (Offset 8 in UPM RAM)
|
|
|
|
*/
|
|
|
|
/* last */
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
/*
|
|
|
|
* Single Write. (Offset 18 in UPM RAM)
|
|
|
|
*/
|
|
|
|
0x0FAFFC04, 0x0FAFEC00, 0x7FFFEC04, 0xFFFFEC04,
|
2004-01-06 22:38:14 +00:00
|
|
|
0xFFFFEC05, /* last */
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_,
|
2002-08-26 21:58:50 +00:00
|
|
|
/*
|
|
|
|
* Burst Write. (Offset 20 in UPM RAM)
|
|
|
|
*/
|
|
|
|
/* last */
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
/*
|
|
|
|
* Refresh (Offset 30 in UPM RAM)
|
|
|
|
*/
|
|
|
|
/* last */
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
/*
|
|
|
|
* Exception. (Offset 3c in UPM RAM)
|
|
|
|
*/
|
2004-01-06 22:38:14 +00:00
|
|
|
0x7FFFFC07, /* last */
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_,
|
2002-08-26 21:58:50 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
* 50 MHz SDRAM access using UPM B
|
|
|
|
*/
|
2004-01-06 22:38:14 +00:00
|
|
|
const uint sdram_table[] = {
|
2002-08-26 21:58:50 +00:00
|
|
|
/*
|
|
|
|
* Single Read. (Offset 0 in UPM RAM)
|
|
|
|
*/
|
|
|
|
0x0E26FC04, 0x11ADFC04, 0xEFBBBC00, 0x1FF77C45, /* last */
|
|
|
|
_NOT_USED_,
|
|
|
|
/*
|
|
|
|
* SDRAM Initialization (offset 5 in UPM RAM)
|
|
|
|
*
|
2003-06-27 21:31:46 +00:00
|
|
|
* This is no UPM entry point. The following definition uses
|
|
|
|
* the remaining space to establish an initialization
|
|
|
|
* sequence, which is executed by a RUN command.
|
2002-08-26 21:58:50 +00:00
|
|
|
*
|
|
|
|
*/
|
2004-01-06 22:38:14 +00:00
|
|
|
0x1FF77C35, 0xEFEABC34, 0x1FB57C35, /* last */
|
2002-08-26 21:58:50 +00:00
|
|
|
/*
|
|
|
|
* Burst Read. (Offset 8 in UPM RAM)
|
|
|
|
*/
|
|
|
|
0x0E26FC04, 0x10ADFC04, 0xF0AFFC00, 0xF0AFFC00,
|
2004-01-06 22:38:14 +00:00
|
|
|
0xF1AFFC00, 0xEFBBBC00, 0x1FF77C45, /* last */
|
|
|
|
_NOT_USED_,
|
2002-08-26 21:58:50 +00:00
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
/*
|
|
|
|
* Single Write. (Offset 18 in UPM RAM)
|
|
|
|
*/
|
2004-01-06 22:38:14 +00:00
|
|
|
0x1F27FC04, 0xEEAEBC04, 0x01B93C00, 0x1FF77C45, /* last */
|
2002-08-26 21:58:50 +00:00
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
/*
|
|
|
|
* Burst Write. (Offset 20 in UPM RAM)
|
|
|
|
*/
|
|
|
|
0x0E26BC00, 0x10AD7C00, 0xF0AFFC00, 0xF0AFFC00,
|
2004-01-06 22:38:14 +00:00
|
|
|
0xE1BBBC04, 0x1FF77C45, /* last */
|
|
|
|
_NOT_USED_, _NOT_USED_,
|
2002-08-26 21:58:50 +00:00
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
/*
|
|
|
|
* Refresh (Offset 30 in UPM RAM)
|
|
|
|
*/
|
|
|
|
0x1FF5FC84, 0xFFFFFC04, 0xFFFFFC04, 0xFFFFFC84,
|
2004-01-06 22:38:14 +00:00
|
|
|
0xFFFFFC05, /* last */
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_,
|
2002-08-26 21:58:50 +00:00
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_, _NOT_USED_,
|
|
|
|
/*
|
|
|
|
* Exception. (Offset 3c in UPM RAM)
|
|
|
|
*/
|
2004-01-06 22:38:14 +00:00
|
|
|
0x7FFFFC07, /* last */
|
|
|
|
_NOT_USED_, _NOT_USED_, _NOT_USED_,
|
2002-08-26 21:58:50 +00:00
|
|
|
};
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Check Board Identity:
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
|
|
|
int checkboard (void)
|
|
|
|
{
|
|
|
|
#ifdef CONFIG_IVMS8
|
|
|
|
puts ("Board: IVMS8\n");
|
|
|
|
#endif
|
|
|
|
#ifdef CONFIG_IVML24
|
|
|
|
puts ("Board: IVM-L8/24\n");
|
|
|
|
#endif
|
|
|
|
return (0);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
2008-06-09 21:03:40 +00:00
|
|
|
phys_size_t initdram (int board_type)
|
2002-08-26 21:58:50 +00:00
|
|
|
{
|
2008-10-16 13:01:15 +00:00
|
|
|
volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
|
2004-01-06 22:38:14 +00:00
|
|
|
volatile memctl8xx_t *memctl = &immr->im_memctl;
|
|
|
|
long int size_b0;
|
|
|
|
|
|
|
|
/* enable SDRAM clock ("switch on" SDRAM) */
|
2008-10-16 13:01:15 +00:00
|
|
|
immr->im_cpm.cp_pbpar &= ~(CONFIG_SYS_PB_SDRAM_CLKE); /* GPIO */
|
|
|
|
immr->im_cpm.cp_pbodr &= ~(CONFIG_SYS_PB_SDRAM_CLKE); /* active output */
|
|
|
|
immr->im_cpm.cp_pbdir |= CONFIG_SYS_PB_SDRAM_CLKE; /* output */
|
|
|
|
immr->im_cpm.cp_pbdat |= CONFIG_SYS_PB_SDRAM_CLKE; /* assert SDRAM CLKE */
|
2004-01-06 22:38:14 +00:00
|
|
|
udelay (1);
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Map controller bank 1 for ELIC SACCO
|
|
|
|
*/
|
2008-10-16 13:01:15 +00:00
|
|
|
memctl->memc_or1 = CONFIG_SYS_OR1;
|
|
|
|
memctl->memc_br1 = CONFIG_SYS_BR1;
|
2004-01-06 22:38:14 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Map controller bank 2 for ELIC EPIC
|
|
|
|
*/
|
2008-10-16 13:01:15 +00:00
|
|
|
memctl->memc_or2 = CONFIG_SYS_OR2;
|
|
|
|
memctl->memc_br2 = CONFIG_SYS_BR2;
|
2004-01-06 22:38:14 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Configure UPMA for SHARC
|
|
|
|
*/
|
|
|
|
upmconfig (UPMA, (uint *) sharc_table,
|
|
|
|
sizeof (sharc_table) / sizeof (uint));
|
2002-08-26 21:58:50 +00:00
|
|
|
|
|
|
|
#if defined(CONFIG_IVML24)
|
2004-01-06 22:38:14 +00:00
|
|
|
/*
|
|
|
|
* Map controller bank 4 for HDLC Address space
|
|
|
|
*/
|
2008-10-16 13:01:15 +00:00
|
|
|
memctl->memc_or4 = CONFIG_SYS_OR4;
|
|
|
|
memctl->memc_br4 = CONFIG_SYS_BR4;
|
2002-08-26 21:58:50 +00:00
|
|
|
#endif
|
|
|
|
|
2004-01-06 22:38:14 +00:00
|
|
|
/*
|
|
|
|
* Map controller bank 5 for SHARC
|
|
|
|
*/
|
2008-10-16 13:01:15 +00:00
|
|
|
memctl->memc_or5 = CONFIG_SYS_OR5;
|
|
|
|
memctl->memc_br5 = CONFIG_SYS_BR5;
|
2004-01-06 22:38:14 +00:00
|
|
|
|
|
|
|
memctl->memc_mamr = 0x00001000;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Configure UPMB for SDRAM
|
|
|
|
*/
|
|
|
|
upmconfig (UPMB, (uint *) sdram_table,
|
|
|
|
sizeof (sdram_table) / sizeof (uint));
|
|
|
|
|
2008-10-16 13:01:15 +00:00
|
|
|
memctl->memc_mptpr = CONFIG_SYS_MPTPR_1BK_8K;
|
2004-01-06 22:38:14 +00:00
|
|
|
|
|
|
|
memctl->memc_mar = 0x00000088;
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Map controller bank 3 to the SDRAM bank at preliminary address.
|
|
|
|
*/
|
2008-10-16 13:01:15 +00:00
|
|
|
memctl->memc_or3 = CONFIG_SYS_OR3_PRELIM;
|
|
|
|
memctl->memc_br3 = CONFIG_SYS_BR3_PRELIM;
|
2004-01-06 22:38:14 +00:00
|
|
|
|
2008-10-16 13:01:15 +00:00
|
|
|
memctl->memc_mbmr = CONFIG_SYS_MBMR_8COL; /* refresh not enabled yet */
|
2004-01-06 22:38:14 +00:00
|
|
|
|
|
|
|
udelay (200);
|
|
|
|
memctl->memc_mcr = 0x80806105; /* precharge */
|
|
|
|
udelay (1);
|
|
|
|
memctl->memc_mcr = 0x80806106; /* load mode register */
|
|
|
|
udelay (1);
|
|
|
|
memctl->memc_mcr = 0x80806130; /* autorefresh */
|
|
|
|
udelay (1);
|
|
|
|
memctl->memc_mcr = 0x80806130; /* autorefresh */
|
|
|
|
udelay (1);
|
|
|
|
memctl->memc_mcr = 0x80806130; /* autorefresh */
|
|
|
|
udelay (1);
|
|
|
|
memctl->memc_mcr = 0x80806130; /* autorefresh */
|
|
|
|
udelay (1);
|
|
|
|
memctl->memc_mcr = 0x80806130; /* autorefresh */
|
|
|
|
udelay (1);
|
|
|
|
memctl->memc_mcr = 0x80806130; /* autorefresh */
|
|
|
|
udelay (1);
|
|
|
|
memctl->memc_mcr = 0x80806130; /* autorefresh */
|
|
|
|
udelay (1);
|
|
|
|
memctl->memc_mcr = 0x80806130; /* autorefresh */
|
|
|
|
|
|
|
|
memctl->memc_mbmr |= MBMR_PTBE; /* refresh enabled */
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Check Bank 0 Memory Size for re-configuration
|
|
|
|
*/
|
|
|
|
size_b0 =
|
2008-10-16 13:01:15 +00:00
|
|
|
dram_size (CONFIG_SYS_MBMR_8COL, (long *) SDRAM_BASE3_PRELIM,
|
2004-01-06 22:38:14 +00:00
|
|
|
SDRAM_MAX_SIZE);
|
|
|
|
|
2008-10-16 13:01:15 +00:00
|
|
|
memctl->memc_mbmr = CONFIG_SYS_MBMR_8COL | MBMR_PTBE;
|
2004-01-06 22:38:14 +00:00
|
|
|
|
|
|
|
return (size_b0);
|
2002-08-26 21:58:50 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
|
|
|
/*
|
|
|
|
* Check memory range for valid RAM. A simple memory test determines
|
|
|
|
* the actually available RAM size between addresses `base' and
|
|
|
|
* `base + maxsize'. Some (not all) hardware errors are detected:
|
|
|
|
* - short between address lines
|
|
|
|
* - short between data lines
|
|
|
|
*/
|
|
|
|
|
2004-01-06 22:38:14 +00:00
|
|
|
static long int dram_size (long int mamr_value, long int *base,
|
|
|
|
long int maxsize)
|
2002-08-26 21:58:50 +00:00
|
|
|
{
|
2008-10-16 13:01:15 +00:00
|
|
|
volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
|
2004-01-06 22:38:14 +00:00
|
|
|
volatile memctl8xx_t *memctl = &immr->im_memctl;
|
2002-08-26 21:58:50 +00:00
|
|
|
|
2004-01-06 22:38:14 +00:00
|
|
|
memctl->memc_mbmr = mamr_value;
|
2002-08-26 21:58:50 +00:00
|
|
|
|
2004-01-06 22:38:14 +00:00
|
|
|
return (get_ram_size (base, maxsize));
|
2002-08-26 21:58:50 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
2004-01-06 22:38:14 +00:00
|
|
|
void reset_phy (void)
|
2002-08-26 21:58:50 +00:00
|
|
|
{
|
2008-10-16 13:01:15 +00:00
|
|
|
immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
|
2002-08-26 21:58:50 +00:00
|
|
|
|
|
|
|
/* De-assert Ethernet Powerdown */
|
2008-10-16 13:01:15 +00:00
|
|
|
immr->im_cpm.cp_pbpar &= ~(CONFIG_SYS_PB_ETH_POWERDOWN); /* GPIO */
|
|
|
|
immr->im_cpm.cp_pbodr &= ~(CONFIG_SYS_PB_ETH_POWERDOWN); /* active output */
|
|
|
|
immr->im_cpm.cp_pbdir |= CONFIG_SYS_PB_ETH_POWERDOWN; /* output */
|
|
|
|
immr->im_cpm.cp_pbdat &= ~(CONFIG_SYS_PB_ETH_POWERDOWN); /* Enable PHY power */
|
2004-01-06 22:38:14 +00:00
|
|
|
udelay (1000);
|
2002-08-26 21:58:50 +00:00
|
|
|
|
|
|
|
/*
|
2003-06-27 21:31:46 +00:00
|
|
|
* RESET is implemented by a positive pulse of at least 1 us
|
|
|
|
* at the reset pin.
|
2002-08-26 21:58:50 +00:00
|
|
|
*
|
|
|
|
* Configure RESET pins for NS DP83843 PHY, and RESET chip.
|
|
|
|
*
|
|
|
|
* Note: The RESET pin is high active, but there is an
|
2004-01-06 22:38:14 +00:00
|
|
|
* inverter on the SPD823TS board...
|
2002-08-26 21:58:50 +00:00
|
|
|
*/
|
2008-10-16 13:01:15 +00:00
|
|
|
immr->im_ioport.iop_pcpar &= ~(CONFIG_SYS_PC_ETH_RESET);
|
|
|
|
immr->im_ioport.iop_pcdir |= CONFIG_SYS_PC_ETH_RESET;
|
2002-08-26 21:58:50 +00:00
|
|
|
/* assert RESET signal of PHY */
|
2008-10-16 13:01:15 +00:00
|
|
|
immr->im_ioport.iop_pcdat &= ~(CONFIG_SYS_PC_ETH_RESET);
|
2002-08-26 21:58:50 +00:00
|
|
|
udelay (10);
|
|
|
|
/* de-assert RESET signal of PHY */
|
2008-10-16 13:01:15 +00:00
|
|
|
immr->im_ioport.iop_pcdat |= CONFIG_SYS_PC_ETH_RESET;
|
2002-08-26 21:58:50 +00:00
|
|
|
udelay (10);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
|
|
|
void show_boot_progress (int status)
|
|
|
|
{
|
|
|
|
#if defined(CONFIG_STATUS_LED)
|
|
|
|
# if defined(STATUS_LED_YELLOW)
|
|
|
|
status_led_set (STATUS_LED_YELLOW,
|
|
|
|
(status < 0) ? STATUS_LED_ON : STATUS_LED_OFF);
|
2004-01-06 22:38:14 +00:00
|
|
|
# endif /* STATUS_LED_YELLOW */
|
2002-08-26 21:58:50 +00:00
|
|
|
# if defined(STATUS_LED_BOOT)
|
2012-01-14 15:24:47 +00:00
|
|
|
if (status == BOOTSTAGE_ID_DECOMP_IMAGE)
|
2004-01-06 22:38:14 +00:00
|
|
|
status_led_set (STATUS_LED_BOOT, STATUS_LED_OFF);
|
|
|
|
# endif /* STATUS_LED_BOOT */
|
2002-08-26 21:58:50 +00:00
|
|
|
#endif /* CONFIG_STATUS_LED */
|
|
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|
|
|
|
|
2004-01-06 22:38:14 +00:00
|
|
|
void ide_set_reset (int on)
|
2002-08-26 21:58:50 +00:00
|
|
|
{
|
2008-10-16 13:01:15 +00:00
|
|
|
volatile immap_t *immr = (immap_t *) CONFIG_SYS_IMMR;
|
2012-10-07 05:56:07 +00:00
|
|
|
int i;
|
2002-08-26 21:58:50 +00:00
|
|
|
|
|
|
|
/*
|
|
|
|
* Configure PC for IDE Reset Pin
|
|
|
|
*/
|
|
|
|
if (on) { /* assert RESET */
|
2008-10-16 13:01:15 +00:00
|
|
|
immr->im_ioport.iop_pcdat &= ~(CONFIG_SYS_PC_IDE_RESET);
|
2012-10-07 05:56:07 +00:00
|
|
|
|
|
|
|
#ifdef CONFIG_SYS_PB_12V_ENABLE
|
|
|
|
/* 12V Enable output OFF */
|
|
|
|
immr->im_cpm.cp_pbdat &= ~(CONFIG_SYS_PB_12V_ENABLE);
|
|
|
|
|
|
|
|
immr->im_cpm.cp_pbpar &= ~(CONFIG_SYS_PB_12V_ENABLE);
|
|
|
|
immr->im_cpm.cp_pbodr &= ~(CONFIG_SYS_PB_12V_ENABLE);
|
|
|
|
immr->im_cpm.cp_pbdir |= CONFIG_SYS_PB_12V_ENABLE;
|
|
|
|
|
|
|
|
/* wait 500 ms for the voltage to stabilize */
|
|
|
|
for (i = 0; i < 500; ++i)
|
|
|
|
udelay(1000);
|
|
|
|
#endif /* CONFIG_SYS_PB_12V_ENABLE */
|
2002-08-26 21:58:50 +00:00
|
|
|
} else { /* release RESET */
|
2012-10-07 05:56:07 +00:00
|
|
|
#ifdef CONFIG_SYS_PB_12V_ENABLE
|
|
|
|
/* 12V Enable output ON */
|
|
|
|
immr->im_cpm.cp_pbdat |= CONFIG_SYS_PB_12V_ENABLE;
|
|
|
|
#endif /* CONFIG_SYS_PB_12V_ENABLE */
|
|
|
|
|
|
|
|
#ifdef CONFIG_SYS_PB_IDE_MOTOR
|
|
|
|
/* configure IDE Motor voltage monitor pin as input */
|
|
|
|
immr->im_cpm.cp_pbpar &= ~(CONFIG_SYS_PB_IDE_MOTOR);
|
|
|
|
immr->im_cpm.cp_pbodr &= ~(CONFIG_SYS_PB_IDE_MOTOR);
|
|
|
|
immr->im_cpm.cp_pbdir &= ~(CONFIG_SYS_PB_IDE_MOTOR);
|
|
|
|
|
|
|
|
/* wait up to 1 s for the motor voltage to stabilize */
|
|
|
|
for (i = 0; i < 1000; ++i) {
|
|
|
|
if ((immr->im_cpm.cp_pbdat
|
|
|
|
& CONFIG_SYS_PB_IDE_MOTOR) != 0)
|
|
|
|
break;
|
|
|
|
udelay(1000);
|
|
|
|
}
|
|
|
|
|
|
|
|
if (i == 1000) { /* Timeout */
|
|
|
|
printf("\nWarning: 5V for IDE Motor missing\n");
|
|
|
|
#ifdef CONFIG_STATUS_LED
|
|
|
|
#ifdef STATUS_LED_YELLOW
|
|
|
|
status_led_set(STATUS_LED_YELLOW, STATUS_LED_ON);
|
|
|
|
#endif
|
|
|
|
#ifdef STATUS_LED_GREEN
|
|
|
|
status_led_set(STATUS_LED_GREEN, STATUS_LED_OFF);
|
|
|
|
#endif
|
|
|
|
#endif /* CONFIG_STATUS_LED */
|
|
|
|
}
|
|
|
|
#endif /* CONFIG_SYS_PB_IDE_MOTOR */
|
|
|
|
|
2008-10-16 13:01:15 +00:00
|
|
|
immr->im_ioport.iop_pcdat |= CONFIG_SYS_PC_IDE_RESET;
|
2002-08-26 21:58:50 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* program port pin as GPIO output */
|
2008-10-16 13:01:15 +00:00
|
|
|
immr->im_ioport.iop_pcpar &= ~(CONFIG_SYS_PC_IDE_RESET);
|
|
|
|
immr->im_ioport.iop_pcso &= ~(CONFIG_SYS_PC_IDE_RESET);
|
|
|
|
immr->im_ioport.iop_pcdir |= CONFIG_SYS_PC_IDE_RESET;
|
2002-08-26 21:58:50 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------- */
|