uboot-vybrid_public/board/spear/common/spr_misc.c

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

#include <common.h>
#include <command.h>
#include <i2c.h>
#include <net.h>
#include <asm/io.h>
#include <asm/arch/hardware.h>
#include <asm/arch/spr_xloader_table.h>
#include <asm/arch/spr_defs.h>

#define CPU		0
#define DDR		1
#define SRAM_REL	0xD2801000

DECLARE_GLOBAL_DATA_PTR;
static struct chip_data chip_data;

int dram_init(void)
{
	struct xloader_table *xloader_tb =
	    (struct xloader_table *)XLOADER_TABLE_ADDRESS;
	struct xloader_table_1_1 *table_1_1;
	struct xloader_table_1_2 *table_1_2;
	struct chip_data *chip = &chip_data;

	gd->bd->bi_dram[0].start = PHYS_SDRAM_1;
	gd->bd->bi_dram[0].size = get_ram_size(PHYS_SDRAM_1,
					       PHYS_SDRAM_1_MAXSIZE);

	if (XLOADER_TABLE_VERSION_1_1 == xloader_tb->table_version) {
		table_1_1 = &xloader_tb->table.table_1_1;
		chip->dramfreq = table_1_1->ddrfreq;
		chip->dramtype = table_1_1->ddrtype;

	} else if (XLOADER_TABLE_VERSION_1_2 == xloader_tb->table_version) {
		table_1_2 = &xloader_tb->table.table_1_2;
		chip->dramfreq = table_1_2->ddrfreq;
		chip->dramtype = table_1_2->ddrtype;
	} else {
		chip->dramfreq = -1;
	}

	return 0;
}

int misc_init_r(void)
{
#if defined(CONFIG_CMD_NET)
	uchar mac_id[6];

	if (!eth_getenv_enetaddr("ethaddr", mac_id) && !i2c_read_mac(mac_id))
		eth_setenv_enetaddr("ethaddr", mac_id);
#endif
	setenv("verify", "n");

#if defined(CONFIG_SPEAR_USBTTY)
	setenv("stdin", "usbtty");
	setenv("stdout", "usbtty");
	setenv("stderr", "usbtty");
#endif
	return 0;
}

int spear_board_init(ulong mach_type)
{
	struct xloader_table *xloader_tb =
	    (struct xloader_table *)XLOADER_TABLE_ADDRESS;
	struct xloader_table_1_2 *table_1_2;
	struct chip_data *chip = &chip_data;

	gd->bd->bi_arch_number = mach_type;

	/* adress of boot parameters */
	gd->bd->bi_boot_params = CONFIG_BOOT_PARAMS_ADDR;

	/* CPU is initialized to work at 333MHz in Xloader */
	chip->cpufreq = 333;

	if (XLOADER_TABLE_VERSION_1_2 == xloader_tb->table_version) {
		table_1_2 = &xloader_tb->table.table_1_2;
		memcpy(chip->version, table_1_2->version,
		       sizeof(chip->version));
	}

	return 0;
}

static int i2c_read_mac(uchar *buffer)
{
	u8 buf[2];

	i2c_read(CONFIG_I2C_CHIPADDRESS, MAGIC_OFF, 1, buf, MAGIC_LEN);

	/* Check if mac in i2c memory is valid */
	if ((buf[0] == MAGIC_BYTE0) && (buf[1] == MAGIC_BYTE1)) {
		/* Valid mac address is saved in i2c eeprom */
		i2c_read(CONFIG_I2C_CHIPADDRESS, MAC_OFF, 1, buffer, MAC_LEN);
		return 0;
	}

	return -1;
}

static int write_mac(uchar *mac)
{
	u8 buf[2];

	buf[0] = (u8)MAGIC_BYTE0;
	buf[1] = (u8)MAGIC_BYTE1;
	i2c_write(CONFIG_I2C_CHIPADDRESS, MAGIC_OFF, 1, buf, MAGIC_LEN);

	buf[0] = (u8)~MAGIC_BYTE0;
	buf[1] = (u8)~MAGIC_BYTE1;

	i2c_read(CONFIG_I2C_CHIPADDRESS, MAGIC_OFF, 1, buf, MAGIC_LEN);

	/* check if valid MAC address is saved in I2C EEPROM or not? */
	if ((buf[0] == MAGIC_BYTE0) && (buf[1] == MAGIC_BYTE1)) {
		i2c_write(CONFIG_I2C_CHIPADDRESS, MAC_OFF, 1, mac, MAC_LEN);
		puts("I2C EEPROM written with mac address \n");
		return 0;
	}

	puts("I2C EEPROM writing failed \n");
	return -1;
}

int do_chip_config(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
{
	void (*sram_setfreq) (unsigned int, unsigned int);
	struct chip_data *chip = &chip_data;
	unsigned char mac[6];
	unsigned int reg, frequency;
	char *s, *e;
	char i2c_mac[20];

	if ((argc > 3) || (argc < 2)) {
		cmd_usage(cmdtp);
		return 1;
	}

	if ((!strcmp(argv[1], "cpufreq")) || (!strcmp(argv[1], "ddrfreq"))) {

		frequency = simple_strtoul(argv[2], NULL, 0);

		if (frequency > 333) {
			printf("Frequency is limited to 333MHz\n");
			return 1;
		}

		sram_setfreq = memcpy((void *)SRAM_REL, setfreq, setfreq_sz);

		if (!strcmp(argv[1], "cpufreq")) {
			sram_setfreq(CPU, frequency);
			printf("CPU frequency changed to %u\n", frequency);

			chip->cpufreq = frequency;
		} else {
			sram_setfreq(DDR, frequency);
			printf("DDR frequency changed to %u\n", frequency);

			chip->dramfreq = frequency;
		}

		return 0;
	} else if (!strcmp(argv[1], "ethaddr")) {

		s = argv[2];
		for (reg = 0; reg < 6; ++reg) {
			mac[reg] = s ? simple_strtoul(s, &e, 16) : 0;
			if (s)
				s = (*e) ? e + 1 : e;
		}
		write_mac(mac);

		return 0;
	} else if (!strcmp(argv[1], "print")) {

		if (chip->cpufreq == -1)
			printf("CPU Freq    = Not Known\n");
		else
			printf("CPU Freq    = %d MHz\n", chip->cpufreq);

		if (chip->dramfreq == -1)
			printf("DDR Freq    = Not Known\n");
		else
			printf("DDR Freq    = %d MHz\n", chip->dramfreq);

		if (chip->dramtype == DDRMOBILE)
			printf("DDR Type    = MOBILE\n");
		else if (chip->dramtype == DDR2)
			printf("DDR Type    = DDR2\n");
		else
			printf("DDR Type    = Not Known\n");

		if (!i2c_read_mac(mac)) {
			sprintf(i2c_mac, "%pM", mac);
			printf("Ethaddr (from i2c mem) = %s\n", i2c_mac);
		} else {
			printf("Ethaddr (from i2c mem) = Not set\n");
		}

		printf("Xloader Rev = %s\n", chip->version);

		return 0;
	}

	cmd_usage(cmdtp);
	return 1;
}

U_BOOT_CMD(chip_config, 3, 1, do_chip_config,
	   "configure chip",
	   "chip_config cpufreq/ddrfreq frequency\n"
	   "chip_config print");