994 lines
27 KiB
C
994 lines
27 KiB
C
/*
|
|
* (C) Copyright 2009-2011
|
|
* Max Tretene, ACube Systems Srl. mtretene@acube-systems.com.
|
|
*
|
|
* 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 <ppc440.h>
|
|
#include <libfdt.h>
|
|
#include <fdt_support.h>
|
|
#include <i2c.h>
|
|
#include <asm/processor.h>
|
|
#include <asm/io.h>
|
|
#include <asm/mmu.h>
|
|
#include <asm/4xx_pcie.h>
|
|
#include <asm/gpio.h>
|
|
#include <asm/errno.h>
|
|
#include <sm501.h>
|
|
#include "../common/vesa.h"
|
|
|
|
#undef DEBUG
|
|
|
|
#ifdef DEBUG
|
|
#define PRINTF(fmt,args...) printf (fmt ,##args)
|
|
#else
|
|
#define PRINTF(fmt,args...)
|
|
#endif
|
|
|
|
#define SAMLOGO
|
|
#ifdef SAMLOGO
|
|
#include "../common/logo_acube.h"
|
|
#else
|
|
#define LOGO_WIDTH 176
|
|
#define LOGO_HEIGHT 48
|
|
unsigned char logo_acube[LOGO_WIDTH * LOGO_HEIGHT] = { 0 };
|
|
#endif
|
|
|
|
#ifndef CONFIG_SYS_NO_FLASH
|
|
extern flash_info_t flash_info[CONFIG_SYS_MAX_FLASH_BANKS]; /* info for FLASH chips */
|
|
#endif
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
#define BOARD_CANYONLANDS_PCIE 1
|
|
#define BOARD_CANYONLANDS_SATA 2
|
|
|
|
extern int onbus;
|
|
extern int console_col; /* cursor col */
|
|
extern int console_row; /* cursor row */
|
|
|
|
extern u32 *fb_base_phys_sm502;
|
|
extern unsigned char SM502INIT;
|
|
extern pci_dev_t dev_sm502;
|
|
extern struct FrameBufferInfo *fbi;
|
|
|
|
unsigned char SM502 = 0;
|
|
struct pci_controller *ppc460_hose = NULL;
|
|
|
|
/*
|
|
* Override the default functions in cpu/ppc4xx/44x_spd_ddr2.c with
|
|
* board specific values.
|
|
*/
|
|
|
|
u32 ddr_wrdtr(u32 default_val) {
|
|
return (SDRAM_WRDTR_LLWP_1_CYC | SDRAM_WRDTR_WTR_180_DEG_ADV | 0x823);
|
|
}
|
|
|
|
u32 ddr_clktr(u32 default_val) {
|
|
return (SDRAM_CLKTR_CLKP_90_DEG_ADV);
|
|
}
|
|
|
|
static int pvr_460ex(void)
|
|
{
|
|
u32 pvr = get_pvr();
|
|
|
|
if ((pvr == PVR_460EX_RA) || (pvr == PVR_460EX_SE_RA) ||
|
|
(pvr == PVR_460EX_RB))
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
|
|
int board_early_init_f(void)
|
|
{
|
|
u32 sdr0_cust0;
|
|
|
|
/*
|
|
* Setup the interrupt controller polarities, triggers, etc.
|
|
*/
|
|
|
|
// Sam460ex IRQ MAP:
|
|
// IRQ0 = ETH_INT
|
|
// IRQ1 = FPGA_INT
|
|
// IRQ2 = PCI_INT (PCIA, PCIB, PCIC, PCIB)
|
|
// IRQ3 = FPGA_INT2
|
|
// IRQ11 = RTC_INT
|
|
// IRQ12 = SM502_INT
|
|
|
|
mtdcr(UIC0SR, 0xffffffff); /* clear all */
|
|
mtdcr(UIC0ER, 0x00000000); /* disable all */
|
|
mtdcr(UIC0CR, 0x00000005); /* ATI & UIC1 crit are critical */
|
|
mtdcr(UIC0PR, 0xffffffff); /* per ref-board manual */
|
|
mtdcr(UIC0TR, 0x00000000); /* per ref-board manual */
|
|
mtdcr(UIC0VR, 0x00000000); /* int31 highest, base=0x000 */
|
|
mtdcr(UIC0SR, 0xffffffff); /* clear all */
|
|
|
|
mtdcr(UIC1SR, 0xffffffff); /* clear all */
|
|
mtdcr(UIC1ER, 0x00000000); /* disable all */
|
|
mtdcr(UIC1CR, 0x00000000); /* all non-critical */
|
|
mtdcr(UIC1PR, 0xefffffff); /* IRQ2 neg */
|
|
mtdcr(UIC1TR, 0x00000000); /* per ref-board manual */
|
|
mtdcr(UIC1VR, 0x00000000); /* int31 highest, base=0x000 */
|
|
mtdcr(UIC1SR, 0xffffffff); /* clear all */
|
|
|
|
mtdcr(UIC2SR, 0xffffffff); /* clear all */
|
|
mtdcr(UIC2ER, 0x00000000); /* disable all */
|
|
mtdcr(UIC2CR, 0x00000000); /* all non-critical */
|
|
mtdcr(UIC2PR, 0xffffffff); /* per ref-board manual */
|
|
mtdcr(UIC2TR, 0x00000000); /* per ref-board manual */
|
|
mtdcr(UIC2VR, 0x00000000); /* int31 highest, base=0x000 */
|
|
mtdcr(UIC2SR, 0xffffffff); /* clear all */
|
|
|
|
mtdcr(UIC3SR, 0xffffffff); /* clear all */
|
|
mtdcr(UIC3ER, 0x00000000); /* disable all */
|
|
mtdcr(UIC3CR, 0x00000000); /* all non-critical */
|
|
mtdcr(UIC3PR, 0xffefffff); /* IRQ12 neg */
|
|
mtdcr(UIC3TR, 0x00000000); /* per ref-board manual */
|
|
mtdcr(UIC3VR, 0x00000000); /* int31 highest, base=0x000 */
|
|
mtdcr(UIC3SR, 0xffffffff); /* clear all */
|
|
|
|
/* SDR Setting - enable NDFC */
|
|
mfsdr(SDR0_CUST0, sdr0_cust0);
|
|
sdr0_cust0 = SDR0_CUST0_MUX_NDFC_SEL |
|
|
SDR0_CUST0_NDFC_ENABLE |
|
|
SDR0_CUST0_NDFC_BW_8_BIT |
|
|
SDR0_CUST0_NDFC_ARE_MASK |
|
|
SDR0_CUST0_NDFC_BAC_ENCODE(3) |
|
|
(0x80000000 >> (28 + CONFIG_SYS_NAND_CS));
|
|
mtsdr(SDR0_CUST0, sdr0_cust0);
|
|
|
|
/*
|
|
* Configure PFC (Pin Function Control) registers
|
|
* Enable GPIO 49-63
|
|
* UART0: 8 pins
|
|
*/
|
|
mtsdr(SDR0_PFC0, 0x00007fff);
|
|
mtsdr(SDR0_PFC1, 0x00000000);
|
|
|
|
/* Enable PCI host functionality in SDR0_PCI0 */
|
|
mtsdr(SDR0_PCI0, 0xa0000000);
|
|
|
|
mtsdr(SDR0_SRST1, 0); /* Pull AHB out of reset default=1 */
|
|
|
|
/* Setup PLB4-AHB bridge based on the system address map */
|
|
mtdcr(AHB_TOP, 0x8000004B);
|
|
mtdcr(AHB_BOT, 0x8000004B);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void canyonlands_sata_init(int board_type)
|
|
{
|
|
u32 reg;
|
|
|
|
if (board_type == BOARD_CANYONLANDS_SATA) {
|
|
/* Put SATA in reset */
|
|
SDR_WRITE(SDR0_SRST1, 0x00020001);
|
|
|
|
/* Set the phy for SATA, not PCI-E port 0 */
|
|
reg = SDR_READ(PESDR0_PHY_CTL_RST);
|
|
SDR_WRITE(PESDR0_PHY_CTL_RST, (reg & 0xeffffffc) | 0x00000001);
|
|
reg = SDR_READ(PESDR0_L0CLK);
|
|
SDR_WRITE(PESDR0_L0CLK, (reg & 0xfffffff8) | 0x00000007);
|
|
SDR_WRITE(PESDR0_L0CDRCTL, 0x00003111);
|
|
SDR_WRITE(PESDR0_L0DRV, 0x00000104);
|
|
|
|
/* Bring SATA out of reset */
|
|
SDR_WRITE(SDR0_SRST1, 0x00000000);
|
|
}
|
|
}
|
|
|
|
int checkboard(void)
|
|
{
|
|
char s[64] = { 0 };
|
|
|
|
gd->board_type = BOARD_CANYONLANDS_PCIE;
|
|
getenv_r("serdes",s,64);
|
|
|
|
if (strcmp(s,"sata2") == 0)
|
|
gd->board_type = BOARD_CANYONLANDS_SATA;
|
|
|
|
puts("Board: Sam460ex, PCIe 4x + ");
|
|
|
|
switch (gd->board_type) {
|
|
case BOARD_CANYONLANDS_PCIE:
|
|
puts("PCIe 1x\n");
|
|
break;
|
|
|
|
case BOARD_CANYONLANDS_SATA:
|
|
puts("SATA-2\n");
|
|
break;
|
|
}
|
|
|
|
canyonlands_sata_init(gd->board_type);
|
|
|
|
return (0);
|
|
}
|
|
|
|
/*************************************************************************
|
|
* pci_pre_init
|
|
*
|
|
* This routine is called just prior to registering the hose and gives
|
|
* the board the opportunity to check things. Returning a value of zero
|
|
* indicates that things are bad & PCI initialization should be aborted.
|
|
*
|
|
* Different boards may wish to customize the pci controller structure
|
|
* (add regions, override default access routines, etc) or perform
|
|
* certain pre-initialization actions.
|
|
*
|
|
************************************************************************/
|
|
#if defined(CONFIG_PCI)
|
|
int pci_pre_init(struct pci_controller * hose )
|
|
{
|
|
ppc460_hose = hose;
|
|
|
|
return 1;
|
|
}
|
|
#endif /* defined(CONFIG_PCI) */
|
|
|
|
#if defined(CONFIG_PCI) && defined(CONFIG_SYS_PCI_MASTER_INIT)
|
|
void pci_master_init(struct pci_controller *hose)
|
|
{
|
|
/*--------------------------------------------------------------------------+
|
|
| PowerPC440 PCI Master configuration.
|
|
| Map PLB/processor addresses to PCI memory space.
|
|
| PLB address 0xA0000000-0xCFFFFFFF ==> PCI address 0x80000000-0xCFFFFFFF
|
|
| Use byte reversed out routines to handle endianess.
|
|
| Make this region non-prefetchable.
|
|
+--------------------------------------------------------------------------*/
|
|
out32r(PCIL0_POM0SA, 0 ); /* disable */
|
|
out32r(PCIL0_POM1SA, 0 ); /* disable */
|
|
out32r(PCIL0_POM2SA, 0 ); /* disable */
|
|
|
|
out32r(PCIL0_POM0LAL, CONFIG_SYS_PCI_MEMBASE); /* PMM0 Local Address */
|
|
out32r(PCIL0_POM0LAH, 0x0000000c); /* PMM0 Local Address */
|
|
out32r(PCIL0_POM0PCIAL, CONFIG_SYS_PCI_MEMBASE); /* PMM0 PCI Low Address */
|
|
out32r(PCIL0_POM0PCIAH, 0x00000000); /* PMM0 PCI High Address */
|
|
out32r(PCIL0_POM0SA, ~(0x10000000 - 1) | 1); /* 256MB + enable region */
|
|
|
|
out32r(PCIL0_POM1LAL, CONFIG_SYS_PCI_MEMBASE2); /* PMM0 Local Address */
|
|
out32r(PCIL0_POM1LAH, 0x0000000c); /* PMM0 Local Address */
|
|
out32r(PCIL0_POM1PCIAL, CONFIG_SYS_PCI_MEMBASE2); /* PMM0 PCI Low Address */
|
|
out32r(PCIL0_POM1PCIAH, 0x00000000); /* PMM0 PCI High Address */
|
|
out32r(PCIL0_POM1SA, ~(0x10000000 - 1) | 1); /* 256MB + enable region */
|
|
|
|
out_le16((void *)PCIL0_CMD, in16r(PCIL0_CMD) | PCI_COMMAND_MASTER);
|
|
}
|
|
#endif /* defined(CONFIG_PCI) && defined(CONFIG_SYS_PCI_MASTER_INIT) */
|
|
|
|
#if defined(CONFIG_PCI)
|
|
int board_pcie_first(void)
|
|
{
|
|
/*
|
|
* Canyonlands with SATA enabled has only one PCIe slot
|
|
* (2nd one).
|
|
*/
|
|
if (gd->board_type == BOARD_CANYONLANDS_SATA)
|
|
return 1;
|
|
|
|
return 0;
|
|
}
|
|
#endif /* CONFIG_PCI */
|
|
|
|
int board_early_init_r (void)
|
|
{
|
|
/*
|
|
* Clear potential errors resulting from auto-calibration.
|
|
* If not done, then we could get an interrupt later on when
|
|
* exceptions are enabled.
|
|
*/
|
|
|
|
set_mcsr(get_mcsr());
|
|
|
|
return 0;
|
|
}
|
|
|
|
int misc_init_r(void)
|
|
{
|
|
u32 sdr0_srst1 = 0;
|
|
u32 eth_cfg;
|
|
u8 val;
|
|
|
|
/*
|
|
* Set EMAC mode/configuration (GMII, SGMII, RGMII...).
|
|
* This is board specific, so let's do it here.
|
|
*/
|
|
mfsdr(SDR0_ETH_CFG, eth_cfg);
|
|
/* disable SGMII mode */
|
|
eth_cfg &= ~(SDR0_ETH_CFG_SGMII2_ENABLE |
|
|
SDR0_ETH_CFG_SGMII1_ENABLE |
|
|
SDR0_ETH_CFG_SGMII0_ENABLE);
|
|
/* Set the for 2 RGMII mode */
|
|
/* GMC0 EMAC4_0, GMC0 EMAC4_1, RGMII Bridge 0 */
|
|
eth_cfg &= ~SDR0_ETH_CFG_GMC0_BRIDGE_SEL;
|
|
if (pvr_460ex())
|
|
eth_cfg |= SDR0_ETH_CFG_GMC1_BRIDGE_SEL;
|
|
else
|
|
eth_cfg &= ~SDR0_ETH_CFG_GMC1_BRIDGE_SEL;
|
|
mtsdr(SDR0_ETH_CFG, eth_cfg);
|
|
|
|
/*
|
|
* The AHB Bridge core is held in reset after power-on or reset
|
|
* so enable it now
|
|
*/
|
|
mfsdr(SDR0_SRST1, sdr0_srst1);
|
|
sdr0_srst1 &= ~SDR0_SRST1_AHB;
|
|
mtsdr(SDR0_SRST1, sdr0_srst1);
|
|
|
|
/*
|
|
* RTC/M41T62:
|
|
* Disable square wave output: Batterie will be drained
|
|
* quickly, when this output is not disabled
|
|
*/
|
|
val = i2c_reg_read(CONFIG_SYS_I2C_RTC_ADDR, 0xa);
|
|
val &= ~0x40;
|
|
i2c_reg_write(CONFIG_SYS_I2C_RTC_ADDR, 0xa, val);
|
|
|
|
return 0;
|
|
}
|
|
|
|
#if defined(CONFIG_OF_LIBFDT) && defined(CONFIG_OF_BOARD_SETUP)
|
|
void ft_board_setup(void *blob, bd_t *bd)
|
|
{
|
|
u32 val[4];
|
|
int rc;
|
|
|
|
ft_cpu_setup(blob, bd);
|
|
|
|
/* Fixup NOR mapping */
|
|
val[0] = 0; /* chip select number */
|
|
val[1] = 0; /* always 0 */
|
|
val[2] = CONFIG_SYS_FLASH_BASE_PHYS_L; /* we fixed up this address */
|
|
val[3] = gd->bd->bi_flashsize;
|
|
rc = fdt_find_and_setprop(blob, "/plb/opb/ebc", "ranges",
|
|
val, sizeof(val), 1);
|
|
if (rc) {
|
|
printf("Unable to update property NOR mapping, err=%s\n",
|
|
fdt_strerror(rc));
|
|
}
|
|
|
|
if (gd->board_type == BOARD_CANYONLANDS_SATA) {
|
|
/*
|
|
* When SATA is selected we need to disable the first PCIe
|
|
* node in the device tree, so that Linux doesn't initialize
|
|
* it.
|
|
*/
|
|
rc = fdt_find_and_setprop(blob, "/plb/pciex@d00000000", "status",
|
|
"disabled", sizeof("disabled"), 1);
|
|
if (rc) {
|
|
printf("Unable to update property status in PCIe node, err=%s\n",
|
|
fdt_strerror(rc));
|
|
}
|
|
}
|
|
|
|
if (gd->board_type == BOARD_CANYONLANDS_PCIE) {
|
|
/*
|
|
* When PCIe is selected we need to disable the SATA
|
|
* node in the device tree, so that Linux doesn't initialize
|
|
* it.
|
|
*/
|
|
rc = fdt_find_and_setprop(blob, "/plb/sata@bffd1000", "status",
|
|
"disabled", sizeof("disabled"), 1);
|
|
if (rc) {
|
|
printf("Unable to update property status in PCIe node, err=%s\n",
|
|
fdt_strerror(rc));
|
|
}
|
|
}
|
|
}
|
|
#endif /* defined(CONFIG_OF_LIBFDT) && defined(CONFIG_OF_BOARD_SETUP) */
|
|
|
|
void pciauto_setup_device_mem(struct pci_controller *hose,
|
|
pci_dev_t dev, int bars_num,
|
|
struct pci_region *mem,
|
|
struct pci_region *prefetch,
|
|
struct pci_region *io,
|
|
pci_size_t bar_size_lower,
|
|
pci_size_t bar_size_upper)
|
|
{
|
|
unsigned int bar_response, bar_back;
|
|
pci_addr_t bar_value;
|
|
pci_size_t bar_size;
|
|
struct pci_region *bar_res;
|
|
int bar, bar_nr = 0;
|
|
int found_mem64 = 0;
|
|
|
|
for (bar = PCI_BASE_ADDRESS_0; bar < PCI_BASE_ADDRESS_0 + (bars_num*4); bar += 4) {
|
|
/* Tickle the BAR and get the response */
|
|
pci_hose_read_config_dword(hose, dev, bar, &bar_back);
|
|
pci_hose_write_config_dword(hose, dev, bar, 0xffffffff);
|
|
pci_hose_read_config_dword(hose, dev, bar, &bar_response);
|
|
pci_hose_write_config_dword(hose, dev, bar, bar_back);
|
|
|
|
/* If BAR is not implemented go to the next BAR */
|
|
if (!bar_response)
|
|
continue;
|
|
|
|
found_mem64 = 0;
|
|
|
|
/* Check the BAR type and set our address mask */
|
|
if ( ! (bar_response & PCI_BASE_ADDRESS_SPACE)) {
|
|
if ( (bar_response & PCI_BASE_ADDRESS_MEM_TYPE_MASK) ==
|
|
PCI_BASE_ADDRESS_MEM_TYPE_64) {
|
|
u32 bar_response_upper;
|
|
u64 bar64;
|
|
pci_hose_write_config_dword(hose, dev, bar+4, 0xffffffff);
|
|
pci_hose_read_config_dword(hose, dev, bar+4, &bar_response_upper);
|
|
|
|
bar64 = ((u64)bar_response_upper << 32) | bar_response;
|
|
|
|
bar_size = ~(bar64 & PCI_BASE_ADDRESS_MEM_MASK) + 1;
|
|
found_mem64 = 1;
|
|
} else {
|
|
bar_size = (u32)(~(bar_response & PCI_BASE_ADDRESS_MEM_MASK) + 1);
|
|
}
|
|
if (prefetch && (bar_response & PCI_BASE_ADDRESS_MEM_PREFETCH))
|
|
bar_res = prefetch;
|
|
else
|
|
bar_res = mem;
|
|
|
|
PRINTF("PCI Autoconfig: BAR %d, Mem, size=0x%llx, ", bar_nr, (u64)bar_size);
|
|
|
|
if ((bar_size >= bar_size_lower) && (bar_size <= bar_size_upper)) {
|
|
if (pciauto_region_allocate(bar_res, bar_size, &bar_value) == 0) {
|
|
/* Write it out and update our limit */
|
|
pci_hose_write_config_dword(hose, dev, bar, (u32)bar_value);
|
|
PRINTF(" BAR written value=0x%8x, ", (u32)bar_value);
|
|
|
|
if (found_mem64) {
|
|
bar += 4;
|
|
#ifdef CONFIG_SYS_PCI_64BIT
|
|
pci_hose_write_config_dword(hose, dev, bar, (u32)(bar_value>>32));
|
|
#else
|
|
/*
|
|
* If we are a 64-bit decoder then increment to the
|
|
* upper 32 bits of the bar and force it to locate
|
|
* in the lower 4GB of memory.
|
|
*/
|
|
pci_hose_write_config_dword(hose, dev, bar, 0x00000000);
|
|
#endif
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
PRINTF("\n");
|
|
|
|
bar_nr++;
|
|
}
|
|
}
|
|
|
|
void fix_pci_bars(void)
|
|
{
|
|
struct pci_controller *hose = ppc460_hose;
|
|
unsigned int found_multi=0,problem=0,sec_func=0;
|
|
unsigned short vendor, device, class;
|
|
unsigned char header_type;
|
|
pci_dev_t dev;
|
|
u32 bar0;
|
|
|
|
PRINTF("fix_pci_bars ++++++++++++++++++++++++++++++++++++++++++++++++++\n");
|
|
|
|
for (dev = PCI_BDF(0,0,0);
|
|
dev < PCI_BDF(0,PCI_MAX_PCI_DEVICES-1,PCI_MAX_PCI_FUNCTIONS-1);
|
|
dev += PCI_BDF(0,0,1)) {
|
|
|
|
if (pci_skip_dev(hose, dev))
|
|
continue;
|
|
|
|
if (PCI_FUNC(dev) && !found_multi)
|
|
continue;
|
|
|
|
pci_hose_read_config_byte(hose, dev, PCI_HEADER_TYPE, &header_type);
|
|
|
|
pci_hose_read_config_word(hose, dev, PCI_VENDOR_ID, &vendor);
|
|
|
|
if (vendor != 0xffff && vendor != 0x0000) {
|
|
|
|
if (!PCI_FUNC(dev))
|
|
found_multi = header_type & 0x80;
|
|
|
|
pci_hose_read_config_word(hose, dev, PCI_CLASS_DEVICE, &class);
|
|
|
|
PRINTF("PCI Scan: Found Bus %d, Device %d, Function %d - %x\n",
|
|
PCI_BUS(dev), PCI_DEV(dev), PCI_FUNC(dev), class );
|
|
|
|
if (((PCI_BUS(dev)==0) && (PCI_DEV(dev)==4) && (PCI_FUNC(dev)==0)) &&
|
|
((class==0x300) || (class==0x380))) problem +=1;
|
|
|
|
if (((PCI_BUS(dev)==0) && (PCI_DEV(dev)==4) && (PCI_FUNC(dev)==1)) &&
|
|
((class==0x300) || (class==0x380))) sec_func =1;
|
|
|
|
if ((PCI_BUS(dev)==0) && (PCI_DEV(dev)==6) && (PCI_FUNC(dev)==0)) {
|
|
pci_read_config_dword(dev, PCI_BASE_ADDRESS_0, &bar0);
|
|
bar0 = bar0 & 0xfffff000;
|
|
PRINTF("BAR0 = %8x\n",bar0);
|
|
|
|
if ((bar0 == 0) || (bar0 >= 0x9c000000)) problem +=1;
|
|
}
|
|
}
|
|
}
|
|
|
|
PRINTF("problem = %d\n",problem);
|
|
|
|
if (problem >= 2) {
|
|
|
|
pciauto_config_init(hose);
|
|
|
|
/* setup MEM SPACE for PCI gfx card (big BARs) */
|
|
dev = PCI_BDF(0,4,0);
|
|
pciauto_setup_device_mem(hose, dev, 6, hose->pci_mem, hose->pci_prefetch, hose->pci_io, 0x00100000, 0xFFFFFFFF);
|
|
|
|
if (sec_func) {
|
|
dev = PCI_BDF(0,4,1);
|
|
pciauto_setup_device_mem(hose, dev, 6, hose->pci_mem, hose->pci_prefetch, hose->pci_io, 0x00100000, 0xFFFFFFFF);
|
|
}
|
|
|
|
/* setup MEM SPACE for the onboard gfx card */
|
|
dev = PCI_BDF(0,6,0);
|
|
pciauto_setup_device(hose, dev, 6, hose->pci_mem, hose->pci_prefetch, hose->pci_io);
|
|
|
|
/* setup MEM SPACE for PCI gfx card (small BARs) */
|
|
dev = PCI_BDF(0,4,0);
|
|
pciauto_setup_device_mem(hose, dev, 6, hose->pci_mem, hose->pci_prefetch, hose->pci_io, 0x0, 0x000FFFFF);
|
|
|
|
if (sec_func) {
|
|
dev = PCI_BDF(0,4,1);
|
|
pciauto_setup_device_mem(hose, dev, 6, hose->pci_mem, hose->pci_prefetch, hose->pci_io, 0x0, 0x000FFFFF);
|
|
}
|
|
}
|
|
}
|
|
|
|
extern struct pci_controller pcie_hose[CONFIG_SYS_PCIE_NR_PORTS];
|
|
|
|
void assign_pci_irq (void)
|
|
{
|
|
u8 ii, class, pin;
|
|
int BusNum, Device, Function;
|
|
unsigned char HeaderType;
|
|
unsigned short VendorID;
|
|
pci_dev_t dev;
|
|
|
|
// On Board fixed PCI devices -------------------------
|
|
|
|
// Silicon Motion SM502
|
|
if ((dev = pci_find_device(PCI_VENDOR_SM, PCI_DEVICE_SM501, 0)) >= 0)
|
|
{
|
|
// video IRQ connected to UIC3-20 -----------------
|
|
pci_write_config_byte(dev, PCI_INTERRUPT_LINE, 116);
|
|
pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x20);
|
|
}
|
|
|
|
// Optional PCI devices on PCI Slots 33/66 Mhz --------
|
|
|
|
for (BusNum = 0; BusNum <= ppc460_hose->last_busno; BusNum++)
|
|
{
|
|
for (Device = 0; Device < PCI_MAX_PCI_DEVICES; Device++)
|
|
{
|
|
HeaderType = 0;
|
|
|
|
for (Function = 0; Function < PCI_MAX_PCI_FUNCTIONS; Function++)
|
|
{
|
|
if (Function && !(HeaderType & 0x80))
|
|
break;
|
|
|
|
dev = PCI_BDF(BusNum, Device, Function);
|
|
|
|
if (dev != -1)
|
|
{
|
|
pci_read_config_word(dev, PCI_VENDOR_ID, &VendorID);
|
|
if ((VendorID == 0xFFFF) || (VendorID == 0x0000))
|
|
continue;
|
|
|
|
if (!Function)
|
|
pci_read_config_byte(dev, PCI_HEADER_TYPE, &HeaderType);
|
|
|
|
if ((BusNum == 0) && (Device == 0x06)) continue;
|
|
|
|
pci_read_config_byte(dev, PCI_CLASS_CODE, &class);
|
|
|
|
//if (class != PCI_BASE_CLASS_BRIDGE)
|
|
{
|
|
pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &pin);
|
|
|
|
if (pin > 0)
|
|
{
|
|
// all pci IRQ on external slot are connected to UIC1-0
|
|
pci_write_config_byte(dev, PCI_INTERRUPT_LINE, 32);
|
|
}
|
|
|
|
pci_write_config_byte(dev, PCI_LATENCY_TIMER, 0x20);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
// PCI-Express bus ----------------------------------------------
|
|
|
|
struct pci_controller *hose;
|
|
|
|
for (ii = 0; ii < CONFIG_SYS_PCIE_NR_PORTS; ii++)
|
|
{
|
|
hose = &pcie_hose[ii];
|
|
|
|
if (hose)
|
|
{
|
|
if (hose->last_busno > hose->first_busno)
|
|
{
|
|
// there is card in the PCIE slot
|
|
// assume no bridge presents
|
|
|
|
dev = PCI_BDF(hose->last_busno,0,0);
|
|
|
|
if (dev != -1)
|
|
{
|
|
pci_read_config_byte(dev, PCI_INTERRUPT_PIN, &pin);
|
|
|
|
if (pin > 0)
|
|
{
|
|
// PCIE 1x slot is connected to UIC3-0
|
|
// PCIE 4x slot is connected to UIC3-6
|
|
pci_write_config_byte(dev, PCI_INTERRUPT_LINE, 0x60 + ii*0x6);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
/*
|
|
void show_tlb(void)
|
|
{
|
|
int i;
|
|
unsigned long tlb_word0_value;
|
|
unsigned long tlb_word1_value;
|
|
unsigned long tlb_word2_value;
|
|
|
|
for (i=0; i<PPC4XX_TLB_SIZE; i++)
|
|
{
|
|
tlb_word0_value = mftlb1(i);
|
|
tlb_word1_value = mftlb2(i);
|
|
tlb_word2_value = mftlb3(i);
|
|
|
|
printf("TLB %i, %08x %08x %08x\n",i,tlb_word0_value,tlb_word1_value,tlb_word2_value);
|
|
|
|
if ((tlb_word0_value & TLB_WORD0_V_MASK) == TLB_WORD0_V_DISABLE)
|
|
break;
|
|
}
|
|
}
|
|
*/
|
|
/*
|
|
void show_pcie_info(void)
|
|
{
|
|
volatile void *mbase = NULL;
|
|
|
|
mbase = (u32 *)CONFIG_SYS_PCIE0_XCFGBASE;
|
|
|
|
printf("0:PEGPL_OMR1BA=%08x.%08x MSK=%08x.%08x\n",
|
|
mfdcr(DCRN_PEGPL_OMR1BAH(PCIE0)),
|
|
mfdcr(DCRN_PEGPL_OMR1BAL(PCIE0)),
|
|
mfdcr(DCRN_PEGPL_OMR1MSKH(PCIE0)),
|
|
mfdcr(DCRN_PEGPL_OMR1MSKL(PCIE0)));
|
|
|
|
printf("0:PECFG_POM0LA=%08x.%08x\n", in_le32(mbase + PECFG_POM0LAH),
|
|
in_le32(mbase + PECFG_POM0LAL));
|
|
|
|
printf("0:PECFG_POM2LA=%08x.%08x\n", in_le32(mbase + PECFG_POM2LAH),
|
|
in_le32(mbase + PECFG_POM2LAL));
|
|
|
|
mbase = (u32 *)CONFIG_SYS_PCIE1_XCFGBASE;
|
|
|
|
// pci-express bar0
|
|
printf("1:PEGPL_OMR1BA=%08x.%08x MSK=%08x.%08x\n",
|
|
mfdcr(DCRN_PEGPL_OMR1BAH(PCIE1)),
|
|
mfdcr(DCRN_PEGPL_OMR1BAL(PCIE1)),
|
|
mfdcr(DCRN_PEGPL_OMR1MSKH(PCIE1)),
|
|
mfdcr(DCRN_PEGPL_OMR1MSKL(PCIE1)));
|
|
|
|
printf("1:PECFG_POM0LA=%08x.%08x\n", in_le32(mbase + PECFG_POM0LAH),
|
|
in_le32(mbase + PECFG_POM0LAL));
|
|
|
|
printf("1:PECFG_POM2LA=%08x.%08x\n", in_le32(mbase + PECFG_POM2LAH),
|
|
in_le32(mbase + PECFG_POM2LAL));
|
|
|
|
}
|
|
*/
|
|
|
|
int last_stage_init (void)
|
|
{
|
|
uchar buf;
|
|
int jj, ret = 0;
|
|
u16 fpga_val = 0;
|
|
|
|
u32 val = mfspr(SPRN_MMUCR);
|
|
val = 0x00010000;
|
|
mtspr(SPRN_MMUCR,val);
|
|
|
|
do_fpga();
|
|
|
|
// Red Led OFF ----------------------------------------
|
|
fpga_val = in_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E);
|
|
fpga_val &= ~0x0002;
|
|
out_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E, fpga_val);
|
|
|
|
// fix possible menuboot_cmd misconfiguration ---------
|
|
char *s = getenv("menuboot_cmd");
|
|
if ((!s) ||
|
|
((s) && (strlen(s) < 3)) ||
|
|
((s) && (strcmp(s,"noboot") == 0)))
|
|
{
|
|
setenv("menuboot_cmd","boota");
|
|
saveenv();
|
|
}
|
|
|
|
fix_pci_bars();
|
|
assign_pci_irq();
|
|
|
|
// cache on -------------------------------------------
|
|
change_tlb(0, 256*1024*1024, 0);
|
|
|
|
// SM502 Graphic card on PCI --------------------------
|
|
#ifdef CONFIG_VIDEO_SM502
|
|
init_sm502();
|
|
#endif
|
|
|
|
// x86 Graphic card on PCI ----------------------------
|
|
ret = init_radeon(ppc460_hose);
|
|
|
|
// active gfx card ------------------------------------
|
|
SM502 = 0; // default VGA card
|
|
|
|
#ifdef CONFIG_VIDEO_SM502
|
|
s = getenv("video_activate");
|
|
if ((strcmp(s, "sm502") == 0) && (SM502INIT)) SM502 = 1;
|
|
else if ((SM502INIT) && (ret == 0)) SM502 = 1;
|
|
#endif
|
|
|
|
if (SM502 && SM502INIT)
|
|
{
|
|
#ifdef CONFIG_VIDEO_SM502
|
|
fbi = (struct FrameBufferInfo *)(malloc(sizeof(struct FrameBufferInfo)));
|
|
if (fbi)
|
|
{
|
|
fbi->BaseAddress = fb_base_phys_sm502;
|
|
fbi->XSize = board_get_width();
|
|
fbi->YSize = board_get_height();
|
|
fbi->BitsPerPixel = 8;
|
|
fbi->Modulo = board_get_width();
|
|
|
|
onbus = 0;
|
|
drv_video_init();
|
|
}
|
|
#endif
|
|
}
|
|
else if (ret > 0)
|
|
{
|
|
if (SM502INIT)
|
|
{
|
|
// shutdown onboard gfx card
|
|
unsigned short cmd;
|
|
|
|
pci_read_config_word(dev_sm502, PCI_COMMAND, &cmd);
|
|
cmd &= ~(PCI_COMMAND_IO|PCI_COMMAND_MEMORY);
|
|
pci_write_config_word(dev_sm502, PCI_COMMAND, cmd);
|
|
}
|
|
}
|
|
|
|
// custom silent mode ---------------------------------
|
|
int hush = 0;
|
|
s = getenv("hush");
|
|
if (s) hush = atoi(s);
|
|
if (hush) {
|
|
s = getenv("stdout");
|
|
if ((s) && (strncmp(s,"vga",3) == 0))
|
|
gd->flags |= GD_FLG_SILENT;
|
|
}
|
|
|
|
#ifdef SAMLOGO
|
|
// Welcome Screen -------------------------------------
|
|
if (fbi)
|
|
{
|
|
unsigned int xx, yy, xoff = 0, yoff = 0;
|
|
|
|
if (gd->flags & GD_FLG_SILENT) {
|
|
xoff = (fbi->XSize-LOGO_WIDTH) / 2;
|
|
yoff = (fbi->YSize-LOGO_HEIGHT) / 9;
|
|
}
|
|
else puts("\n\n\n\n");
|
|
|
|
for (xx = 0; xx < LOGO_WIDTH; xx++)
|
|
{
|
|
for (yy = 0; yy < LOGO_HEIGHT; yy++)
|
|
{
|
|
buf = logo_acube[xx + (LOGO_HEIGHT-yy-1)*LOGO_WIDTH];
|
|
*((char *)(fbi->BaseAddress + (xx+xoff) + (yy+yoff)*fbi->XSize*(fbi->BitsPerPixel/8))) = buf;
|
|
}
|
|
}
|
|
}
|
|
#endif
|
|
|
|
puts("Config: PCIe 4x + ");
|
|
|
|
if (gd->board_type == BOARD_CANYONLANDS_PCIE)
|
|
puts("PCIe 1x\n");
|
|
else
|
|
puts("SATA-2\n");
|
|
|
|
// cache off ------------------------------------------
|
|
change_tlb(0, 256*1024*1024, TLB_WORD2_I_ENABLE);
|
|
|
|
// Yellow LED OFF -------------------------------------
|
|
fpga_val = in_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E);
|
|
fpga_val &= ~0x0004;
|
|
out_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E, fpga_val);
|
|
|
|
// Catweasel keyboard ---------------------------------
|
|
//ret = catw_kb_init();
|
|
|
|
// cleanup last 8 bytes of the RTC registers bank -----
|
|
|
|
char arr[8] = { 0 };
|
|
i2c_write(0x68, 0x08, 1, &arr, 8);
|
|
|
|
// USB Init -------------------------------------------
|
|
|
|
uint32_t cmd;
|
|
|
|
SDR_WRITE(SDR0_SRST1, 0x00000008);
|
|
|
|
//gpio_config(19, GPIO_OUT, GPIO_ALT1, GPIO_OUT_1);
|
|
gpio_config(16, GPIO_OUT, GPIO_ALT1, GPIO_OUT_1);
|
|
wait_ms(200);
|
|
|
|
fpga_val = in_be16((void *)CONFIG_SYS_FPGA_BASE + 0x30);
|
|
fpga_val |= 0x0004; //0x0014;
|
|
out_be16((void *)CONFIG_SYS_FPGA_BASE + 0x30, fpga_val);
|
|
wait_ms(200);
|
|
|
|
SDR_WRITE(SDR0_SRST1, 0);
|
|
|
|
cmd = in_le32(CONFIG_SYS_AHB_BASE | 0xd0410);
|
|
cmd |= 1 << 1;
|
|
out_le32(CONFIG_SYS_AHB_BASE | 0xd0410, cmd);
|
|
wait_ms(10);
|
|
|
|
cmd = in_le32(CONFIG_SYS_AHB_BASE | 0xd0454);
|
|
cmd |= 1 << 12;
|
|
out_le32(CONFIG_SYS_AHB_BASE | 0xd0454, cmd);
|
|
wait_ms(10);
|
|
|
|
cmd = in_le32(CONFIG_SYS_AHB_BASE | 0xd0410);
|
|
cmd |= 1 << 1;
|
|
out_le32(CONFIG_SYS_AHB_BASE | 0xd0410, cmd);
|
|
wait_ms(10);
|
|
|
|
out_le32((void *)CONFIG_SYS_AHB_BASE + 0xd0048,0xff000001);
|
|
|
|
s = getenv("usb_delay");
|
|
if (s) {
|
|
ret = atoi(s) * 10;
|
|
if (ret <= 0) ret = 0;
|
|
if (ret > 2000) ret = 2000;
|
|
for (jj=0;jj<ret;jj++) udelay(10000);
|
|
}
|
|
|
|
if (gd->flags & GD_FLG_SILENT) {
|
|
gd->flags &= ~GD_FLG_SILENT;
|
|
console_row = 29;
|
|
console_col = 28;
|
|
puts("Init USB... ");
|
|
gd->flags |= GD_FLG_SILENT;
|
|
}
|
|
|
|
ret = usb_init();
|
|
|
|
#ifdef CONFIG_USB_STORAGE
|
|
// try to recognize storage devices immediately -------
|
|
if (ret >= 0)
|
|
{
|
|
usb_event_poll();
|
|
s = getenv("scan_usb_storage");
|
|
if (s) usb_stor_scan(1);
|
|
}
|
|
#endif
|
|
|
|
// Init SATA controller -------------------------------
|
|
if (gd->flags & GD_FLG_SILENT) {
|
|
gd->flags &= ~GD_FLG_SILENT;
|
|
puts("Done - Init SATA... ");
|
|
gd->flags |= GD_FLG_SILENT;
|
|
}
|
|
|
|
ide_controllers_init();
|
|
|
|
// Ambra LED OFF --------------------------------------
|
|
fpga_val = in_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E);
|
|
fpga_val &= ~0x0008;
|
|
out_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E, fpga_val);
|
|
|
|
if (gd->flags & GD_FLG_SILENT) {
|
|
gd->flags &= ~GD_FLG_SILENT;
|
|
puts("Done\n");
|
|
gd->flags |= GD_FLG_SILENT;
|
|
}
|
|
|
|
//show_pcie_info();
|
|
|
|
//show_tlb();
|
|
|
|
return 0;
|
|
}
|
|
|
|
void do_fpga(void)
|
|
{
|
|
u8 tmp,dd,mm,yy,rv;
|
|
u16 fpga_val;
|
|
|
|
fpga_val = in_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2a);
|
|
tmp = fpga_val & 0xff;
|
|
mm = (tmp/16)*10 + (tmp%16);
|
|
tmp = (fpga_val >> 8) & 0xff;
|
|
dd = (tmp/16)*10 + (tmp%16);
|
|
|
|
fpga_val = in_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2c);
|
|
tmp = fpga_val & 0xff;
|
|
rv = (tmp/16)*10 + (tmp%16);
|
|
tmp = (fpga_val >> 8) & 0xff;;
|
|
yy = (tmp/16)*10 + (tmp%16);
|
|
|
|
printf("FPGA: Revision %02d (20%2d-%02d-%02d)\n",rv,yy,mm,dd);
|
|
}
|
|
|
|
void do_shutdown(void)
|
|
{
|
|
u16 fpga_val;
|
|
|
|
fpga_val = 0x000f;
|
|
out_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E, fpga_val);
|
|
wait_ms(300);
|
|
fpga_val = 0x0000;
|
|
out_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E, fpga_val);
|
|
wait_ms(300);
|
|
fpga_val = 0x000f;
|
|
out_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E, fpga_val);
|
|
wait_ms(300);
|
|
|
|
fpga_val = 0x0010;
|
|
out_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E, fpga_val);
|
|
|
|
while(1); // never return
|
|
}
|
|
|
|
void board_reset(void)
|
|
{
|
|
u16 fpga_val;
|
|
fpga_val = in_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E);
|
|
fpga_val |= 0x0010;
|
|
out_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E, fpga_val);
|
|
wait_ms(25);
|
|
fpga_val &= ~0x0010;
|
|
out_be16((void *)CONFIG_SYS_FPGA_BASE + 0x2E, fpga_val);
|
|
}
|
|
|
|
U_BOOT_CMD( fpga, 1, 0, do_fpga,
|
|
"show FPGA firmware revision",
|
|
"show FPGA firmware revision");
|
|
|
|
U_BOOT_CMD( shutdown, 1, 0, do_shutdown,
|
|
"switch machine off",
|
|
"switch machine off");
|