435 lines
		
	
	
		
			10 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			435 lines
		
	
	
		
			10 KiB
		
	
	
	
		
			C
		
	
	
	
| /*
 | |
|  * (C) Copyright 2008
 | |
|  * Sergei Poselenov, Emcraft Systems, sposelenov@emcraft.com.
 | |
|  *
 | |
|  * Copyright 2004 Freescale Semiconductor.
 | |
|  * (C) Copyright 2002,2003, Motorola Inc.
 | |
|  * Xianghua Xiao, (X.Xiao@motorola.com)
 | |
|  *
 | |
|  * (C) Copyright 2002 Scott McNutt <smcnutt@artesyncp.com>
 | |
|  *
 | |
|  * SPDX-License-Identifier:	GPL-2.0+
 | |
|  */
 | |
| 
 | |
| #include <common.h>
 | |
| #include <pci.h>
 | |
| #include <asm/processor.h>
 | |
| #include <asm/immap_85xx.h>
 | |
| #include <ioports.h>
 | |
| #include <flash.h>
 | |
| #include <libfdt.h>
 | |
| #include <fdt_support.h>
 | |
| #include <asm/io.h>
 | |
| #include <i2c.h>
 | |
| #include <mb862xx.h>
 | |
| #include <video_fb.h>
 | |
| #include "upm_table.h"
 | |
| 
 | |
| DECLARE_GLOBAL_DATA_PTR;
 | |
| 
 | |
| extern flash_info_t flash_info[];	/* FLASH chips info */
 | |
| extern GraphicDevice mb862xx;
 | |
| 
 | |
| void local_bus_init (void);
 | |
| ulong flash_get_size (ulong base, int banknum);
 | |
| 
 | |
| int checkboard (void)
 | |
| {
 | |
| 	volatile ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
 | |
| 	char buf[64];
 | |
| 	int f;
 | |
| 	int i = getenv_f("serial#", buf, sizeof(buf));
 | |
| #ifdef CONFIG_PCI
 | |
| 	char *src;
 | |
| #endif
 | |
| 
 | |
| 	puts("Board: Socrates");
 | |
| 	if (i > 0) {
 | |
| 		puts(", serial# ");
 | |
| 		puts(buf);
 | |
| 	}
 | |
| 	putc('\n');
 | |
| 
 | |
| #ifdef CONFIG_PCI
 | |
| 	/* Check the PCI_clk sel bit */
 | |
| 	if (in_be32(&gur->porpllsr) & (1<<15)) {
 | |
| 		src = "SYSCLK";
 | |
| 		f = CONFIG_SYS_CLK_FREQ;
 | |
| 	} else {
 | |
| 		src = "PCI_CLK";
 | |
| 		f = CONFIG_PCI_CLK_FREQ;
 | |
| 	}
 | |
| 	printf ("PCI1:  32 bit, %d MHz (%s)\n",	f/1000000, src);
 | |
| #else
 | |
| 	printf ("PCI1:  disabled\n");
 | |
| #endif
 | |
| 
 | |
| 	/*
 | |
| 	 * Initialize local bus.
 | |
| 	 */
 | |
| 	local_bus_init ();
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| int misc_init_r (void)
 | |
| {
 | |
| 	/*
 | |
| 	 * Adjust flash start and offset to detected values
 | |
| 	 */
 | |
| 	gd->bd->bi_flashstart = 0 - gd->bd->bi_flashsize;
 | |
| 	gd->bd->bi_flashoffset = 0;
 | |
| 
 | |
| 	/*
 | |
| 	 * Check if boot FLASH isn't max size
 | |
| 	 */
 | |
| 	if (gd->bd->bi_flashsize < (0 - CONFIG_SYS_FLASH0)) {
 | |
| 		set_lbc_or(0, gd->bd->bi_flashstart |
 | |
| 			   (CONFIG_SYS_OR0_PRELIM & 0x00007fff));
 | |
| 		set_lbc_br(0, gd->bd->bi_flashstart |
 | |
| 			   (CONFIG_SYS_BR0_PRELIM & 0x00007fff));
 | |
| 
 | |
| 		/*
 | |
| 		 * Re-check to get correct base address
 | |
| 		 */
 | |
| 		flash_get_size(gd->bd->bi_flashstart, CONFIG_SYS_MAX_FLASH_BANKS - 1);
 | |
| 	}
 | |
| 
 | |
| 	/*
 | |
| 	 * Check if only one FLASH bank is available
 | |
| 	 */
 | |
| 	if (gd->bd->bi_flashsize != CONFIG_SYS_MAX_FLASH_BANKS * (0 - CONFIG_SYS_FLASH0)) {
 | |
| 		set_lbc_or(1, 0);
 | |
| 		set_lbc_br(1, 0);
 | |
| 
 | |
| 		/*
 | |
| 		 * Re-do flash protection upon new addresses
 | |
| 		 */
 | |
| 		flash_protect (FLAG_PROTECT_CLEAR,
 | |
| 			       gd->bd->bi_flashstart, 0xffffffff,
 | |
| 			       &flash_info[CONFIG_SYS_MAX_FLASH_BANKS - 1]);
 | |
| 
 | |
| 		/* Monitor protection ON by default */
 | |
| 		flash_protect (FLAG_PROTECT_SET,
 | |
| 			       CONFIG_SYS_MONITOR_BASE, CONFIG_SYS_MONITOR_BASE + monitor_flash_len - 1,
 | |
| 			       &flash_info[CONFIG_SYS_MAX_FLASH_BANKS - 1]);
 | |
| 
 | |
| 		/* Environment protection ON by default */
 | |
| 		flash_protect (FLAG_PROTECT_SET,
 | |
| 			       CONFIG_ENV_ADDR,
 | |
| 			       CONFIG_ENV_ADDR + CONFIG_ENV_SECT_SIZE - 1,
 | |
| 			       &flash_info[CONFIG_SYS_MAX_FLASH_BANKS - 1]);
 | |
| 
 | |
| 		/* Redundant environment protection ON by default */
 | |
| 		flash_protect (FLAG_PROTECT_SET,
 | |
| 			       CONFIG_ENV_ADDR_REDUND,
 | |
| 			       CONFIG_ENV_ADDR_REDUND + CONFIG_ENV_SECT_SIZE - 1,
 | |
| 			       &flash_info[CONFIG_SYS_MAX_FLASH_BANKS - 1]);
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Initialize Local Bus
 | |
|  */
 | |
| void local_bus_init (void)
 | |
| {
 | |
| 	volatile fsl_lbc_t *lbc = LBC_BASE_ADDR;
 | |
| 	volatile ccsr_local_ecm_t *ecm = (void *)(CONFIG_SYS_MPC85xx_ECM_ADDR);
 | |
| 	sys_info_t sysinfo;
 | |
| 	uint clkdiv;
 | |
| 	uint lbc_mhz;
 | |
| 	uint lcrr = CONFIG_SYS_LBC_LCRR;
 | |
| 
 | |
| 	get_sys_info (&sysinfo);
 | |
| 	clkdiv = lbc->lcrr & LCRR_CLKDIV;
 | |
| 	lbc_mhz = sysinfo.freq_systembus / 1000000 / clkdiv;
 | |
| 
 | |
| 	/* Disable PLL bypass for Local Bus Clock >= 66 MHz */
 | |
| 	if (lbc_mhz >= 66)
 | |
| 		lcrr &= ~LCRR_DBYP;	/* DLL Enabled */
 | |
| 	else
 | |
| 		lcrr |= LCRR_DBYP;	/* DLL Bypass */
 | |
| 
 | |
| 	out_be32 (&lbc->lcrr, lcrr);
 | |
| 	asm ("sync;isync;msync");
 | |
| 
 | |
| 	out_be32 (&lbc->ltesr, 0xffffffff);	/* Clear LBC error interrupts */
 | |
| 	out_be32 (&lbc->lteir, 0xffffffff);	/* Enable LBC error interrupts */
 | |
| 	out_be32 (&ecm->eedr, 0xffffffff);	/* Clear ecm errors */
 | |
| 	out_be32 (&ecm->eeer, 0xffffffff);	/* Enable ecm errors */
 | |
| 
 | |
| 	/* Init UPMA for FPGA access */
 | |
| 	out_be32 (&lbc->mamr, 0x44440); /* Use a customer-supplied value */
 | |
| 	upmconfig (UPMA, (uint *)UPMTableA, sizeof(UPMTableA)/sizeof(int));
 | |
| 
 | |
| 	/* Init UPMB for Lime controller access */
 | |
| 	out_be32 (&lbc->mbmr, 0x444440); /* Use a customer-supplied value */
 | |
| 	upmconfig (UPMB, (uint *)UPMTableB, sizeof(UPMTableB)/sizeof(int));
 | |
| }
 | |
| 
 | |
| #if defined(CONFIG_PCI)
 | |
| /*
 | |
|  * Initialize PCI Devices, report devices found.
 | |
|  */
 | |
| 
 | |
| #ifndef CONFIG_PCI_PNP
 | |
| static struct pci_config_table pci_mpc85xxads_config_table[] = {
 | |
| 	{PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID,
 | |
| 	 PCI_IDSEL_NUMBER, PCI_ANY_ID,
 | |
| 	 pci_cfgfunc_config_device, {PCI_ENET0_IOADDR,
 | |
| 				     PCI_ENET0_MEMADDR,
 | |
| 				     PCI_COMMAND_MEMORY |
 | |
| 				     PCI_COMMAND_MASTER}},
 | |
| 	{}
 | |
| };
 | |
| #endif
 | |
| 
 | |
| 
 | |
| static struct pci_controller hose = {
 | |
| #ifndef CONFIG_PCI_PNP
 | |
| 	config_table:pci_mpc85xxads_config_table,
 | |
| #endif
 | |
| };
 | |
| 
 | |
| #endif /* CONFIG_PCI */
 | |
| 
 | |
| 
 | |
| void pci_init_board (void)
 | |
| {
 | |
| #ifdef CONFIG_PCI
 | |
| 	pci_mpc85xx_init (&hose);
 | |
| #endif /* CONFIG_PCI */
 | |
| }
 | |
| 
 | |
| #ifdef CONFIG_BOARD_EARLY_INIT_R
 | |
| int board_early_init_r (void)
 | |
| {
 | |
| 	volatile ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
 | |
| 
 | |
| 	/* set and reset the GPIO pin 2 which will reset the W83782G chip */
 | |
| 	out_8((unsigned char*)&gur->gpoutdr, 0x3F );
 | |
| 	out_be32((unsigned int*)&gur->gpiocr, 0x200 );	/* enable GPOut */
 | |
| 	udelay(200);
 | |
| 	out_8( (unsigned char*)&gur->gpoutdr, 0x1F );
 | |
| 
 | |
| 	return (0);
 | |
| }
 | |
| #endif /* CONFIG_BOARD_EARLY_INIT_R */
 | |
| 
 | |
| #ifdef CONFIG_OF_BOARD_SETUP
 | |
| int ft_board_setup(void *blob, bd_t *bd)
 | |
| {
 | |
| 	u32 val[12];
 | |
| 	int rc, i = 0;
 | |
| 
 | |
| 	ft_cpu_setup(blob, bd);
 | |
| 
 | |
| 	/* Fixup NOR FLASH mapping */
 | |
| 	val[i++] = 0;				/* chip select number */
 | |
| 	val[i++] = 0;				/* always 0 */
 | |
| 	val[i++] = gd->bd->bi_flashstart;
 | |
| 	val[i++] = gd->bd->bi_flashsize;
 | |
| 
 | |
| 	if (mb862xx.frameAdrs == CONFIG_SYS_LIME_BASE) {
 | |
| 		/* Fixup LIME mapping */
 | |
| 		val[i++] = 2;			/* chip select number */
 | |
| 		val[i++] = 0;			/* always 0 */
 | |
| 		val[i++] = CONFIG_SYS_LIME_BASE;
 | |
| 		val[i++] = CONFIG_SYS_LIME_SIZE;
 | |
| 	}
 | |
| 
 | |
| 	/* Fixup FPGA mapping */
 | |
| 	val[i++] = 3;				/* chip select number */
 | |
| 	val[i++] = 0;				/* always 0 */
 | |
| 	val[i++] = CONFIG_SYS_FPGA_BASE;
 | |
| 	val[i++] = CONFIG_SYS_FPGA_SIZE;
 | |
| 
 | |
| 	rc = fdt_find_and_setprop(blob, "/localbus", "ranges",
 | |
| 				  val, i * sizeof(u32), 1);
 | |
| 	if (rc)
 | |
| 		printf("Unable to update localbus ranges, err=%s\n",
 | |
| 		       fdt_strerror(rc));
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| #endif /* CONFIG_OF_BOARD_SETUP */
 | |
| 
 | |
| #define DEFAULT_BRIGHTNESS	25
 | |
| #define BACKLIGHT_ENABLE	(1 << 31)
 | |
| 
 | |
| static const gdc_regs init_regs [] =
 | |
| {
 | |
| 	{0x0100, 0x00010f00},
 | |
| 	{0x0020, 0x801901df},
 | |
| 	{0x0024, 0x00000000},
 | |
| 	{0x0028, 0x00000000},
 | |
| 	{0x002c, 0x00000000},
 | |
| 	{0x0110, 0x00000000},
 | |
| 	{0x0114, 0x00000000},
 | |
| 	{0x0118, 0x01df0320},
 | |
| 	{0x0004, 0x041f0000},
 | |
| 	{0x0008, 0x031f031f},
 | |
| 	{0x000c, 0x017f0349},
 | |
| 	{0x0010, 0x020c0000},
 | |
| 	{0x0014, 0x01df01e9},
 | |
| 	{0x0018, 0x00000000},
 | |
| 	{0x001c, 0x01e00320},
 | |
| 	{0x0100, 0x80010f00},
 | |
| 	{0x0, 0x0}
 | |
| };
 | |
| 
 | |
| const gdc_regs *board_get_regs (void)
 | |
| {
 | |
| 	return init_regs;
 | |
| }
 | |
| 
 | |
| int lime_probe(void)
 | |
| {
 | |
| 	uint cfg_br2;
 | |
| 	uint cfg_or2;
 | |
| 	int type;
 | |
| 
 | |
| 	cfg_br2 = get_lbc_br(2);
 | |
| 	cfg_or2 = get_lbc_or(2);
 | |
| 
 | |
| 	/* Configure GPCM for CS2 */
 | |
| 	set_lbc_br(2, 0);
 | |
| 	set_lbc_or(2, 0xfc000410);
 | |
| 	set_lbc_br(2, (CONFIG_SYS_LIME_BASE) | 0x00001901);
 | |
| 
 | |
| 	/* Get controller type */
 | |
| 	type = mb862xx_probe(CONFIG_SYS_LIME_BASE);
 | |
| 
 | |
| 	/* Restore previous CS2 configuration */
 | |
| 	set_lbc_br(2, 0);
 | |
| 	set_lbc_or(2, cfg_or2);
 | |
| 	set_lbc_br(2, cfg_br2);
 | |
| 
 | |
| 	return (type == MB862XX_TYPE_LIME) ? 1 : 0;
 | |
| }
 | |
| 
 | |
| /* Returns Lime base address */
 | |
| unsigned int board_video_init (void)
 | |
| {
 | |
| 	if (!lime_probe())
 | |
| 		return 0;
 | |
| 
 | |
| 	mb862xx.winSizeX = 800;
 | |
| 	mb862xx.winSizeY = 480;
 | |
| 	mb862xx.gdfIndex = GDF_15BIT_555RGB;
 | |
| 	mb862xx.gdfBytesPP = 2;
 | |
| 
 | |
| 	return CONFIG_SYS_LIME_BASE;
 | |
| }
 | |
| 
 | |
| #define W83782D_REG_CFG		0x40
 | |
| #define W83782D_REG_BANK_SEL	0x4e
 | |
| #define W83782D_REG_ADCCLK	0x4b
 | |
| #define W83782D_REG_BEEP_CTRL	0x4d
 | |
| #define W83782D_REG_BEEP_CTRL2	0x57
 | |
| #define W83782D_REG_PWMOUT1	0x5b
 | |
| #define W83782D_REG_VBAT	0x5d
 | |
| 
 | |
| static int w83782d_hwmon_init(void)
 | |
| {
 | |
| 	u8 buf;
 | |
| 
 | |
| 	if (i2c_read(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_CFG, 1, &buf, 1))
 | |
| 		return -1;
 | |
| 
 | |
| 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_CFG, 0x80);
 | |
| 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_BANK_SEL, 0);
 | |
| 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_ADCCLK, 0x40);
 | |
| 
 | |
| 	buf = i2c_reg_read(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_BEEP_CTRL);
 | |
| 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_BEEP_CTRL,
 | |
| 		      buf | 0x80);
 | |
| 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_BEEP_CTRL2, 0);
 | |
| 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_PWMOUT1, 0x47);
 | |
| 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_VBAT, 0x01);
 | |
| 
 | |
| 	buf = i2c_reg_read(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_CFG);
 | |
| 	i2c_reg_write(CONFIG_SYS_I2C_W83782G_ADDR, W83782D_REG_CFG,
 | |
| 		      (buf & 0xf4) | 0x01);
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void board_backlight_brightness(int br)
 | |
| {
 | |
| 	u32 reg;
 | |
| 	u8 buf;
 | |
| 	u8 old_buf;
 | |
| 
 | |
| 	/* Select bank 0 */
 | |
| 	if (i2c_read(CONFIG_SYS_I2C_W83782G_ADDR, 0x4e, 1, &old_buf, 1))
 | |
| 		goto err;
 | |
| 	else
 | |
| 		buf = old_buf & 0xf8;
 | |
| 
 | |
| 	if (i2c_write(CONFIG_SYS_I2C_W83782G_ADDR, 0x4e, 1, &buf, 1))
 | |
| 		goto err;
 | |
| 
 | |
| 	if (br > 0) {
 | |
| 		/* PWMOUT1 duty cycle ctrl */
 | |
| 		buf = 255 / (100 / br);
 | |
| 		if (i2c_write(CONFIG_SYS_I2C_W83782G_ADDR, 0x5b, 1, &buf, 1))
 | |
| 			goto err;
 | |
| 
 | |
| 		/* LEDs on */
 | |
| 		reg = in_be32((void *)(CONFIG_SYS_FPGA_BASE + 0x0c));
 | |
| 		if (!(reg & BACKLIGHT_ENABLE))
 | |
| 			out_be32((void *)(CONFIG_SYS_FPGA_BASE + 0x0c),
 | |
| 				 reg | BACKLIGHT_ENABLE);
 | |
| 	} else {
 | |
| 		buf = 0;
 | |
| 		if (i2c_write(CONFIG_SYS_I2C_W83782G_ADDR, 0x5b, 1, &buf, 1))
 | |
| 			goto err;
 | |
| 
 | |
| 		/* LEDs off */
 | |
| 		reg = in_be32((void *)(CONFIG_SYS_FPGA_BASE + 0x0c));
 | |
| 		reg &= ~BACKLIGHT_ENABLE;
 | |
| 		out_be32((void *)(CONFIG_SYS_FPGA_BASE + 0x0c), reg);
 | |
| 	}
 | |
| 	/* Restore previous bank setting */
 | |
| 	if (i2c_write(CONFIG_SYS_I2C_W83782G_ADDR, 0x4e, 1, &old_buf, 1))
 | |
| 		goto err;
 | |
| 
 | |
| 	return;
 | |
| err:
 | |
| 	printf("W83782G I2C access failed\n");
 | |
| }
 | |
| 
 | |
| void board_backlight_switch (int flag)
 | |
| {
 | |
| 	char * param;
 | |
| 	int rc;
 | |
| 
 | |
| 	if (w83782d_hwmon_init())
 | |
| 		printf ("hwmon IC init failed\n");
 | |
| 
 | |
| 	if (flag) {
 | |
| 		param = getenv("brightness");
 | |
| 		rc = param ? simple_strtol(param, NULL, 10) : -1;
 | |
| 		if (rc < 0)
 | |
| 			rc = DEFAULT_BRIGHTNESS;
 | |
| 	} else {
 | |
| 		rc = 0;
 | |
| 	}
 | |
| 	board_backlight_brightness(rc);
 | |
| }
 | |
| 
 | |
| #if defined(CONFIG_CONSOLE_EXTRA_INFO)
 | |
| /*
 | |
|  * Return text to be printed besides the logo.
 | |
|  */
 | |
| void video_get_info_str (int line_number, char *info)
 | |
| {
 | |
| 	if (line_number == 1) {
 | |
| 		strcpy (info, " Board: Socrates");
 | |
| 	} else {
 | |
| 		info [0] = '\0';
 | |
| 	}
 | |
| }
 | |
| #endif
 |