board/esd/tasreg/tasreg.c - uboot/armada - Git at Google

 /*
  * (C) Copyright 2004
  * Wolfgang Denk, DENX Software Engineering, wd@denx.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 <command.h>
 #include <malloc.h>
 #include <asm/m5249.h>
 #include <asm/io.h>


 /* Prototypes */
 int i2c_write(uchar chip, uint addr, int alen, uchar *buffer, int len);
 int i2c_read(uchar chip, uint addr, int alen, uchar *buffer, int len);


 #if 0
 #define FPGA_DEBUG
 #endif

 /* predefine these here for FPGA programming (before including fpga.c) */
 #define SET_FPGA(data)  mbar2_writeLong(MCFSIM_GPIO1_OUT, data)
 #define FPGA_DONE_STATE (mbar2_readLong(MCFSIM_GPIO1_READ) & CONFIG_SYS_FPGA_DONE)
 #define FPGA_INIT_STATE (mbar2_readLong(MCFSIM_GPIO1_READ) & CONFIG_SYS_FPGA_INIT)
 #define FPGA_PROG_ACTIVE_HIGH          /* on this platform is PROG active high!   */
 #define out32(a,b)                     /* nothing to do (gpio already configured) */


 /* fpga configuration data - generated by bin2cc */
 const unsigned char fpgadata[] =
 {
 #include "fpgadata.c"
 };

 /*
  * include common fpga code (for esd boards)
  */
 #include "../common/fpga.c"


 int checkboard (void) {
 	ulong val;
 	uchar val8;

 	puts ("Board: ");
 	puts("esd TASREG");
 	val8 = ((uchar)~((uchar)mbar2_readLong(MCFSIM_GPIO1_READ) >> 4)) & 0xf;
 	printf(" (Switch=%1X)\n", val8);

 	/*
 	 * Set LED on
 	 */
 	val = mbar2_readLong(MCFSIM_GPIO1_OUT) & ~CONFIG_SYS_GPIO1_LED;
 	mbar2_writeLong(MCFSIM_GPIO1_OUT, val);   /* Set LED on */

 	return 0;
 };


 phys_size_t initdram (int board_type) {
 	unsigned long	junk = 0xa5a59696;

 	/*
 	 *  Note:
 	 *	RC = ([(RefreshTime/#rows) / (1/BusClk)] / 16) - 1
 	 */

 #ifdef CONFIG_SYS_FAST_CLK
 	/*
 	 * Busclk=70MHz, RefreshTime=64ms, #rows=4096 (4K)
 	 * SO=1, NAM=0, COC=0, RTIM=01 (6clk refresh), RC=39
 	 */
 	mbar_writeShort(MCFSIM_DCR, 0x8239);
 #elif CONFIG_SYS_PLL_BYPASS
 	/*
 	 * Busclk=5.6448MHz, RefreshTime=64ms, #rows=8192 (8K)
 	 * SO=1, NAM=0, COC=0, RTIM=01 (6clk refresh), RC=02
 	 */
 	mbar_writeShort(MCFSIM_DCR, 0x8202);
 #else
 	/*
 	 * Busclk=36MHz, RefreshTime=64ms, #rows=4096 (4K)
 	 * SO=1, NAM=0, COC=0, RTIM=01 (6clk refresh), RC=22 (562 bus clock cycles)
 	 */
 	mbar_writeShort(MCFSIM_DCR, 0x8222);
 #endif

 	/*
 	 * SDRAM starts at 0x0000_0000, CASL=10, CBM=010, PS=10 (16bit port),
 	 * PM=1 (continuous page mode)
 	 */

 	/* RE=0 (keep auto-refresh disabled while setting up registers) */
 	mbar_writeLong(MCFSIM_DACR0, 0x00003324);

 	/* BAM=007c (bits 22,21 are bank selects; 256kB blocks) */
 	mbar_writeLong(MCFSIM_DMR0, 0x01fc0001);

 	/** Precharge sequence **/
 	mbar_writeLong(MCFSIM_DACR0, 0x0000332c); /* Set DACR0[IP] (bit 3) */
 	out_be32((void *)0, junk); /* write to a memory location to init. precharge */
 	udelay(0x10); /* Allow several Precharge cycles */

 	/** Refresh Sequence **/
 	mbar_writeLong(MCFSIM_DACR0, 0x0000b324); /* Enable the refresh bit, DACR0[RE] (bit 15) */
 	udelay(0x7d0); /* Allow gobs of refresh cycles */

 	/** Mode Register initialization **/
 	mbar_writeLong(MCFSIM_DACR0, 0x0000b364);  /* Enable DACR0[IMRS] (bit 6); RE remains enabled */
 	out_be32((void *)0x800, junk); /* Access RAM to initialize the mode register */

 	return CONFIG_SYS_SDRAM_SIZE * 1024 * 1024;
 };


 int testdram (void) {
 	/* TODO: XXX XXX XXX */
 	printf ("DRAM test not implemented!\n");

 	return (0);
 }


 int misc_init_r (void)
 {
 	unsigned char *dst;
 	ulong len = sizeof(fpgadata);
 	int status;
 	int index;
 	int i;
 	uchar buf[8];

 	dst = malloc(CONFIG_SYS_FPGA_MAX_SIZE);
 	if (gunzip (dst, CONFIG_SYS_FPGA_MAX_SIZE, (uchar *)fpgadata, &len) != 0) {
 		printf ("GUNZIP ERROR - must RESET board to recover\n");
 		do_reset (NULL, 0, 0, NULL);
 	}

 	status = fpga_boot(dst, len);
 	if (status != 0) {
 		printf("\nFPGA: Booting failed ");
 		switch (status) {
 		case ERROR_FPGA_PRG_INIT_LOW:
 			printf("(Timeout: INIT not low after asserting PROGRAM*)\n ");
 			break;
 		case ERROR_FPGA_PRG_INIT_HIGH:
 			printf("(Timeout: INIT not high after deasserting PROGRAM*)\n ");
 			break;
 		case ERROR_FPGA_PRG_DONE:
 			printf("(Timeout: DONE not high after programming FPGA)\n ");
 			break;
 		}

 		/* display infos on fpgaimage */
 		index = 15;
 		for (i=0; i<4; i++) {
 			len = dst[index];
 			printf("FPGA: %s\n", &(dst[index+1]));
 			index += len+3;
 		}
 		putc ('\n');
 		/* delayed reboot */
 		for (i=20; i>0; i--) {
 			printf("Rebooting in %2d seconds \r",i);
 			for (index=0;index<1000;index++)
 				udelay(1000);
 		}
 		putc ('\n');
 		do_reset(NULL, 0, 0, NULL);
 	}

 	puts("FPGA:  ");

 	/* display infos on fpgaimage */
 	index = 15;
 	for (i=0; i<4; i++) {
 		len = dst[index];
 		printf("%s ", &(dst[index+1]));
 		index += len+3;
 	}
 	putc ('\n');

 	free(dst);

 	/*
 	 *
 	 */
 	buf[0] = 0x00;
 	buf[1] = 0x32;
 	buf[2] = 0x3f;
 	i2c_write(0x38, 0, 0, buf, 3);

 	return (0);
 }


 #if 1 /* test-only: board specific test commands */
 int i2c_probe(uchar addr);

 /*
  */
 int do_iploop(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
 	ulong addr;

 	if (argc < 2) {
 		puts("ERROR!\n");
 		return -1;
 	}

 	addr = simple_strtol (argv[1], NULL, 16);

 	printf("i2c probe looping on addr 0x%lx (cntrl-c aborts)...\n", addr);

 	for (;;) {
 		i2c_probe(addr);

 		/* Abort if ctrl-c was pressed */
 		if (ctrlc()) {
 			puts("\nAbort\n");
 			return 0;
 		}

 		udelay(1000);
 	}

 	return 0;
 }
 U_BOOT_CMD(
 	iploop,	2,	1,	do_iploop,
 	"i2c probe loop <addr>",
 	""
 );

 /*
  */
 int do_codec(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
 	uchar buf[8];

 	out_be16((void *)0xe0000000, 0x4000);

 	udelay(5000); /* wait for 5ms */

 	buf[0] = 0x10;
 	buf[1] = 0x07;
 	buf[2] = 0x03;
 	i2c_write(0x10, 0, 0, buf, 3);

 	buf[0] = 0x10;
 	buf[1] = 0x01;
 	buf[2] = 0x80;
 	i2c_write(0x10, 0, 0, buf, 3);

 	buf[0] = 0x10;
 	buf[1] = 0x02;
 	buf[2] = 0x03;
 	i2c_write(0x10, 0, 0, buf, 3);

 	buf[0] = 0x10;
 	buf[1] = 0x03;
 	buf[2] = 0x29;
 	i2c_write(0x10, 0, 0, buf, 3);

 	buf[0] = 0x10;
 	buf[1] = 0x04;
 	buf[2] = 0x00;
 	i2c_write(0x10, 0, 0, buf, 3);

 	buf[0] = 0x10;
 	buf[1] = 0x05;
 	buf[2] = 0x00;
 	i2c_write(0x10, 0, 0, buf, 3);

 	buf[0] = 0x10;
 	buf[1] = 0x07;
 	buf[2] = 0x02;
 	i2c_write(0x10, 0, 0, buf, 3);

 	return 0;
 }
 U_BOOT_CMD(
 	codec,	1,	1,	do_codec,
 	"Enable codec",
 	""
 );

 /*
  */
 int do_saa(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
 	ulong addr;
 	ulong instr;
 	ulong cntrl;
 	ulong data;
 	uchar buf[8];

 	if (argc < 5) {
 		puts("ERROR!\n");
 		return -1;
 	}

 	addr = simple_strtol (argv[1], NULL, 16);
 	instr = simple_strtol (argv[2], NULL, 16);
 	cntrl = simple_strtol (argv[3], NULL, 16);
 	data = simple_strtol (argv[4], NULL, 16);

 	buf[0] = (uchar)instr;
 	buf[1] = (uchar)cntrl;
 	buf[2] = (uchar)data;
 	i2c_write(addr, 0, 0, buf, 3);

 	return 0;
 }
 U_BOOT_CMD(
 	saa,	5,	1,	do_saa,
 	"Write to SAA1064 <addr> <instr> <cntrl> <data>",
 	""
 );

 /*
  */
 int do_iwrite(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
 	ulong addr;
 	ulong data0;
 	ulong data1;
 	ulong data2;
 	ulong data3;
 	uchar buf[8];
 	int cnt;

 	if (argc < 3) {
 		puts("ERROR!\n");
 		return -1;
 	}

 	addr = simple_strtol (argv[1], NULL, 16);
 	cnt = simple_strtol (argv[2], NULL, 16);
 	data0 = simple_strtol (argv[3], NULL, 16);
 	data1 = simple_strtol (argv[4], NULL, 16);
 	data2 = simple_strtol (argv[5], NULL, 16);
 	data3 = simple_strtol (argv[6], NULL, 16);

 	printf("Writing %d bytes to device %lx!\n", cnt, addr);
 	buf[0] = (uchar)data0;
 	buf[1] = (uchar)data1;
 	buf[2] = (uchar)data2;
 	buf[3] = (uchar)data3;
 	i2c_write(addr, 0, 0, buf, cnt);

 	return 0;
 }
 U_BOOT_CMD(
 	iwrite,	6,	1,	do_iwrite,
 	"Write n bytes to I2C-device",
 	"addr cnt data0 ... datan"
 );

 /*
  */
 int do_iread(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
 	ulong addr;
 	ulong cnt;
 	uchar buf[32];
 	int i;

 	if (argc < 3) {
 		puts("ERROR!\n");
 		return -1;
 	}

 	addr = simple_strtol (argv[1], NULL, 16);
 	cnt = simple_strtol (argv[2], NULL, 16);

 	i2c_read(addr, 0, 0, buf, cnt);
 	printf("I2C Data:");
 	for (i=0; i<cnt; i++) {
 		printf(" %02X", buf[i]);
 	}
 	printf("\n");

 	return 0;
 }
 U_BOOT_CMD(
 	iread,	3,	1,	do_iread,
 	"Read from I2C <addr> <cnt>",
 	""
 );

 /*
  */
 int do_ireadl(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 {
 	ulong addr;
 	uchar buf[32];
 	int cnt;

 	if (argc < 2) {
 		puts("ERROR!\n");
 		return -1;
 	}

 	addr = simple_strtol (argv[1], NULL, 16);
 	cnt = 1;

 	printf("iread looping on addr 0x%lx (cntrl-c aborts)...\n", addr);

 	for (;;) {
 		i2c_read(addr, 0, 0, buf, cnt);

 		/* Abort if ctrl-c was pressed */
 		if (ctrlc()) {
 			puts("\nAbort\n");
 			return 0;
 		}

 		udelay(3000);
 	}

 	return 0;
 }
 U_BOOT_CMD(
 	ireadl,	2,	1,	do_ireadl,
 	"Read-loop from I2C <addr>",
 	""
 );
 #endif
	/*
	* (C) Copyright 2004
	* Wolfgang Denk, DENX Software Engineering, wd@denx.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 <command.h>
	#include <malloc.h>
	#include <asm/m5249.h>
	#include <asm/io.h>


	/* Prototypes */
	int i2c_write(uchar chip, uint addr, int alen, uchar *buffer, int len);
	int i2c_read(uchar chip, uint addr, int alen, uchar *buffer, int len);


	#if 0
	#define FPGA_DEBUG
	#endif

	/* predefine these here for FPGA programming (before including fpga.c) */
	#define SET_FPGA(data) mbar2_writeLong(MCFSIM_GPIO1_OUT, data)
	#define FPGA_DONE_STATE (mbar2_readLong(MCFSIM_GPIO1_READ) & CONFIG_SYS_FPGA_DONE)
	#define FPGA_INIT_STATE (mbar2_readLong(MCFSIM_GPIO1_READ) & CONFIG_SYS_FPGA_INIT)
	#define FPGA_PROG_ACTIVE_HIGH /* on this platform is PROG active high! */
	#define out32(a,b) /* nothing to do (gpio already configured) */


	/* fpga configuration data - generated by bin2cc */
	const unsigned char fpgadata[] =
	{
	#include "fpgadata.c"
	};

	/*
	* include common fpga code (for esd boards)
	*/
	#include "../common/fpga.c"


	int checkboard (void) {
	ulong val;
	uchar val8;

	puts ("Board: ");
	puts("esd TASREG");
	val8 = ((uchar)~((uchar)mbar2_readLong(MCFSIM_GPIO1_READ) >> 4)) & 0xf;
	printf(" (Switch=%1X)\n", val8);

	/*
	* Set LED on
	*/
	val = mbar2_readLong(MCFSIM_GPIO1_OUT) & ~CONFIG_SYS_GPIO1_LED;
	mbar2_writeLong(MCFSIM_GPIO1_OUT, val); /* Set LED on */

	return 0;
	};


	phys_size_t initdram (int board_type) {
	unsigned long junk = 0xa5a59696;

	/*
	* Note:
	* RC = ([(RefreshTime/#rows) / (1/BusClk)] / 16) - 1
	*/

	#ifdef CONFIG_SYS_FAST_CLK
	/*
	* Busclk=70MHz, RefreshTime=64ms, #rows=4096 (4K)
	* SO=1, NAM=0, COC=0, RTIM=01 (6clk refresh), RC=39
	*/
	mbar_writeShort(MCFSIM_DCR, 0x8239);
	#elif CONFIG_SYS_PLL_BYPASS
	/*
	* Busclk=5.6448MHz, RefreshTime=64ms, #rows=8192 (8K)
	* SO=1, NAM=0, COC=0, RTIM=01 (6clk refresh), RC=02
	*/
	mbar_writeShort(MCFSIM_DCR, 0x8202);
	#else
	/*
	* Busclk=36MHz, RefreshTime=64ms, #rows=4096 (4K)
	* SO=1, NAM=0, COC=0, RTIM=01 (6clk refresh), RC=22 (562 bus clock cycles)
	*/
	mbar_writeShort(MCFSIM_DCR, 0x8222);
	#endif

	/*
	* SDRAM starts at 0x0000_0000, CASL=10, CBM=010, PS=10 (16bit port),
	* PM=1 (continuous page mode)
	*/

	/* RE=0 (keep auto-refresh disabled while setting up registers) */
	mbar_writeLong(MCFSIM_DACR0, 0x00003324);

	/* BAM=007c (bits 22,21 are bank selects; 256kB blocks) */
	mbar_writeLong(MCFSIM_DMR0, 0x01fc0001);

	/ Precharge sequence /
	mbar_writeLong(MCFSIM_DACR0, 0x0000332c); /* Set DACR0[IP] (bit 3) */
	out_be32((void )0, junk); / write to a memory location to init. precharge */
	udelay(0x10); /* Allow several Precharge cycles */

	/ Refresh Sequence /
	mbar_writeLong(MCFSIM_DACR0, 0x0000b324); /* Enable the refresh bit, DACR0[RE] (bit 15) */
	udelay(0x7d0); /* Allow gobs of refresh cycles */

	/ Mode Register initialization /
	mbar_writeLong(MCFSIM_DACR0, 0x0000b364); /* Enable DACR0[IMRS] (bit 6); RE remains enabled */
	out_be32((void )0x800, junk); / Access RAM to initialize the mode register */

	return CONFIG_SYS_SDRAM_SIZE * 1024 * 1024;
	};


	int testdram (void) {
	/* TODO: XXX XXX XXX */
	printf ("DRAM test not implemented!\n");

	return (0);
	}


	int misc_init_r (void)
	{
	unsigned char *dst;
	ulong len = sizeof(fpgadata);
	int status;
	int index;
	int i;
	uchar buf[8];

	dst = malloc(CONFIG_SYS_FPGA_MAX_SIZE);
	if (gunzip (dst, CONFIG_SYS_FPGA_MAX_SIZE, (uchar *)fpgadata, &len) != 0) {
	printf ("GUNZIP ERROR - must RESET board to recover\n");
	do_reset (NULL, 0, 0, NULL);
	}

	status = fpga_boot(dst, len);
	if (status != 0) {
	printf("\nFPGA: Booting failed ");
	switch (status) {
	case ERROR_FPGA_PRG_INIT_LOW:
	printf("(Timeout: INIT not low after asserting PROGRAM*)\n ");
	break;
	case ERROR_FPGA_PRG_INIT_HIGH:
	printf("(Timeout: INIT not high after deasserting PROGRAM*)\n ");
	break;
	case ERROR_FPGA_PRG_DONE:
	printf("(Timeout: DONE not high after programming FPGA)\n ");
	break;
	}

	/* display infos on fpgaimage */
	index = 15;
	for (i=0; i<4; i++) {
	len = dst[index];
	printf("FPGA: %s\n", &(dst[index+1]));
	index += len+3;
	}
	putc ('\n');
	/* delayed reboot */
	for (i=20; i>0; i--) {
	printf("Rebooting in %2d seconds \r",i);
	for (index=0;index<1000;index++)
	udelay(1000);
	}
	putc ('\n');
	do_reset(NULL, 0, 0, NULL);
	}

	puts("FPGA: ");

	/* display infos on fpgaimage */
	index = 15;
	for (i=0; i<4; i++) {
	len = dst[index];
	printf("%s ", &(dst[index+1]));
	index += len+3;
	}
	putc ('\n');

	free(dst);

	/*
	*
	*/
	buf[0] = 0x00;
	buf[1] = 0x32;
	buf[2] = 0x3f;
	i2c_write(0x38, 0, 0, buf, 3);

	return (0);
	}


	#if 1 /* test-only: board specific test commands */
	int i2c_probe(uchar addr);

	/*
	*/
	int do_iploop(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
	{
	ulong addr;

	if (argc < 2) {
	puts("ERROR!\n");
	return -1;
	}

	addr = simple_strtol (argv[1], NULL, 16);

	printf("i2c probe looping on addr 0x%lx (cntrl-c aborts)...\n", addr);

	for (;;) {
	i2c_probe(addr);

	/* Abort if ctrl-c was pressed */
	if (ctrlc()) {
	puts("\nAbort\n");
	return 0;
	}

	udelay(1000);
	}

	return 0;
	}
	U_BOOT_CMD(
	iploop, 2, 1, do_iploop,
	"i2c probe loop <addr>",
	""
	);

	/*
	*/
	int do_codec(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
	{
	uchar buf[8];

	out_be16((void *)0xe0000000, 0x4000);

	udelay(5000); /* wait for 5ms */

	buf[0] = 0x10;
	buf[1] = 0x07;
	buf[2] = 0x03;
	i2c_write(0x10, 0, 0, buf, 3);

	buf[0] = 0x10;
	buf[1] = 0x01;
	buf[2] = 0x80;
	i2c_write(0x10, 0, 0, buf, 3);

	buf[0] = 0x10;
	buf[1] = 0x02;
	buf[2] = 0x03;
	i2c_write(0x10, 0, 0, buf, 3);

	buf[0] = 0x10;
	buf[1] = 0x03;
	buf[2] = 0x29;
	i2c_write(0x10, 0, 0, buf, 3);

	buf[0] = 0x10;
	buf[1] = 0x04;
	buf[2] = 0x00;
	i2c_write(0x10, 0, 0, buf, 3);

	buf[0] = 0x10;
	buf[1] = 0x05;
	buf[2] = 0x00;
	i2c_write(0x10, 0, 0, buf, 3);

	buf[0] = 0x10;
	buf[1] = 0x07;
	buf[2] = 0x02;
	i2c_write(0x10, 0, 0, buf, 3);

	return 0;
	}
	U_BOOT_CMD(
	codec, 1, 1, do_codec,
	"Enable codec",
	""
	);

	/*
	*/
	int do_saa(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
	{
	ulong addr;
	ulong instr;
	ulong cntrl;
	ulong data;
	uchar buf[8];

	if (argc < 5) {
	puts("ERROR!\n");
	return -1;
	}

	addr = simple_strtol (argv[1], NULL, 16);
	instr = simple_strtol (argv[2], NULL, 16);
	cntrl = simple_strtol (argv[3], NULL, 16);
	data = simple_strtol (argv[4], NULL, 16);

	buf[0] = (uchar)instr;
	buf[1] = (uchar)cntrl;
	buf[2] = (uchar)data;
	i2c_write(addr, 0, 0, buf, 3);

	return 0;
	}
	U_BOOT_CMD(
	saa, 5, 1, do_saa,
	"Write to SAA1064 <addr> <instr> <cntrl> <data>",
	""
	);

	/*
	*/
	int do_iwrite(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
	{
	ulong addr;
	ulong data0;
	ulong data1;
	ulong data2;
	ulong data3;
	uchar buf[8];
	int cnt;

	if (argc < 3) {
	puts("ERROR!\n");
	return -1;
	}

	addr = simple_strtol (argv[1], NULL, 16);
	cnt = simple_strtol (argv[2], NULL, 16);
	data0 = simple_strtol (argv[3], NULL, 16);
	data1 = simple_strtol (argv[4], NULL, 16);
	data2 = simple_strtol (argv[5], NULL, 16);
	data3 = simple_strtol (argv[6], NULL, 16);

	printf("Writing %d bytes to device %lx!\n", cnt, addr);
	buf[0] = (uchar)data0;
	buf[1] = (uchar)data1;
	buf[2] = (uchar)data2;
	buf[3] = (uchar)data3;
	i2c_write(addr, 0, 0, buf, cnt);

	return 0;
	}
	U_BOOT_CMD(
	iwrite, 6, 1, do_iwrite,
	"Write n bytes to I2C-device",
	"addr cnt data0 ... datan"
	);

	/*
	*/
	int do_iread(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
	{
	ulong addr;
	ulong cnt;
	uchar buf[32];
	int i;

	if (argc < 3) {
	puts("ERROR!\n");
	return -1;
	}

	addr = simple_strtol (argv[1], NULL, 16);
	cnt = simple_strtol (argv[2], NULL, 16);

	i2c_read(addr, 0, 0, buf, cnt);
	printf("I2C Data:");
	for (i=0; i<cnt; i++) {
	printf(" %02X", buf[i]);
	}
	printf("\n");

	return 0;
	}
	U_BOOT_CMD(
	iread, 3, 1, do_iread,
	"Read from I2C <addr> <cnt>",
	""
	);

	/*
	*/
	int do_ireadl(cmd_tbl_t cmdtp, int flag, int argc, char const argv[])
	{
	ulong addr;
	uchar buf[32];
	int cnt;

	if (argc < 2) {
	puts("ERROR!\n");
	return -1;
	}

	addr = simple_strtol (argv[1], NULL, 16);
	cnt = 1;

	printf("iread looping on addr 0x%lx (cntrl-c aborts)...\n", addr);

	for (;;) {
	i2c_read(addr, 0, 0, buf, cnt);

	/* Abort if ctrl-c was pressed */
	if (ctrlc()) {
	puts("\nAbort\n");
	return 0;
	}

	udelay(3000);
	}

	return 0;
	}
	U_BOOT_CMD(
	ireadl, 2, 1, do_ireadl,
	"Read-loop from I2C <addr>",
	""
	);
	#endif