[people/ms/u-boot.git] / common / cmd_dcr.c

/*
 * (C) Copyright 2001
 * Erik Theisen,  Wave 7 Optics, etheisen@mindspring.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
 */

/*
 * AMCC 4XX DCR Functions
 */

#include <common.h>
#include <config.h>
#include <command.h>

unsigned long get_dcr (unsigned short);
unsigned long set_dcr (unsigned short, unsigned long);

/* =======================================================================
 * Interpreter command to retrieve an AMCC PPC 4xx Device Control Register
 * =======================================================================
 */
int do_getdcr ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[] )
{
	unsigned short dcrn;	/* Device Control Register Num */
	unsigned long value;	/* DCR's value */

	unsigned long get_dcr (unsigned short);

	/* Validate arguments */
	if (argc < 2) {
		cmd_usage(cmdtp);
		return 1;
	}

	/* Get a DCR */
	dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
	value = get_dcr (dcrn);

	printf ("%04x: %08lx\n", dcrn, value);

	return 0;
}


/* ======================================================================
 * Interpreter command to set an AMCC PPC 4xx Device Control Register
 * ======================================================================
*/
int do_setdcr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
{
	unsigned short dcrn;	/* Device Control Register Num */
	unsigned long value;

	/* DCR's value */
	int nbytes;
	extern char console_buffer[];

	/* Validate arguments */
	if (argc < 2) {
		cmd_usage(cmdtp);
		return 1;
	}

	/* Set a DCR */
	dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
	do {
		value = get_dcr (dcrn);
		printf ("%04x: %08lx", dcrn, value);
		nbytes = readline (" ? ");
		if (nbytes == 0) {
			/*
			 * <CR> pressed as only input, don't modify current
			 * location and exit command.
			 */
			nbytes = 1;
			return 0;
		} else {
			unsigned long i;
			char *endp;

			i = simple_strtoul (console_buffer, &endp, 16);
			nbytes = endp - console_buffer;
			if (nbytes)
				set_dcr (dcrn, i);
		}
	} while (nbytes);

	return 0;
}

/* =======================================================================
 * Interpreter command to retrieve an register value through AMCC PPC 4xx
 * Device Control Register inderect addressing.
 * =======================================================================
 */
int do_getidcr (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
{
	unsigned short adr_dcrn;	/* Device Control Register Num for Address */
	unsigned short dat_dcrn;	/* Device Control Register Num for Data */
	unsigned short offset;		/* Register's offset */
	unsigned long value;		/* Register's value */
	char *ptr = NULL;
	char buf[80];

	/* Validate arguments */
	if (argc < 3) {
		cmd_usage(cmdtp);
		return 1;
	}

	/* Find out whether ther is '.' (dot) symbol in the first parameter. */
	strncpy (buf, argv[1], sizeof(buf)-1);
	buf[sizeof(buf)-1] = 0; /* will guarantee zero-end string */
	ptr = strchr (buf, '.');

	if (ptr != NULL) {
		/* First parameter has format adr_dcrn.dat_dcrn */
		*ptr++ = 0; /* erase '.', create zero-end string */
		adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
		dat_dcrn = (unsigned short) simple_strtoul (ptr, NULL, 16);
	} else {
		/*
		 * First parameter has format adr_dcrn; dat_dcrn will be
		 * calculated as adr_dcrn+1.
		 */
		adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
		dat_dcrn = adr_dcrn+1;
	}

	/* Register's offset */
	offset = (unsigned short) simple_strtoul (argv[2], NULL, 16);

	/* Disable interrupts */
	disable_interrupts ();
	/* Set offset */
	set_dcr (adr_dcrn, offset);
	/* get data */
	value = get_dcr (dat_dcrn);
	/* Enable interrupts */
	enable_interrupts ();

	printf ("%04x.%04x-%04x Read  %08lx\n", adr_dcrn, dat_dcrn, offset, value);

	return 0;
}

/* =======================================================================
 * Interpreter command to update an register value through AMCC PPC 4xx
 * Device Control Register inderect addressing.
 * =======================================================================
 */
int do_setidcr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
{
	unsigned short adr_dcrn;	/* Device Control Register Num for Address */
	unsigned short dat_dcrn;	/* Device Control Register Num for Data */
	unsigned short offset;		/* Register's offset */
	unsigned long value;		/* Register's value */
	char *ptr = NULL;
	char buf[80];

	/* Validate arguments */
	if (argc < 4) {
		cmd_usage(cmdtp);
		return 1;
	}

	/* Find out whether ther is '.' (dot) symbol in the first parameter. */
	strncpy (buf, argv[1], sizeof(buf)-1);
	buf[sizeof(buf)-1] = 0; /* will guarantee zero-end string */
	ptr = strchr (buf, '.');

	if (ptr != NULL) {
		/* First parameter has format adr_dcrn.dat_dcrn */
		*ptr++ = 0;	/* erase '.', create zero-end string */
		adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
		dat_dcrn = (unsigned short) simple_strtoul (ptr, NULL, 16);
	} else {
		/*
		 * First parameter has format adr_dcrn; dat_dcrn will be
		 * calculated as adr_dcrn+1.
		 */
		adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
		dat_dcrn = adr_dcrn+1;
	}

	/* Register's offset */
	offset = (unsigned short) simple_strtoul (argv[2], NULL, 16);
	/* New value */
	value  = (unsigned  long) simple_strtoul (argv[3], NULL, 16);

	/* Disable interrupts */
	disable_interrupts ();
	/* Set offset */
	set_dcr (adr_dcrn, offset);
	/* set data */
	set_dcr (dat_dcrn, value);
	/* Enable interrupts */
	enable_interrupts ();

	printf ("%04x.%04x-%04x Write %08lx\n", adr_dcrn, dat_dcrn, offset, value);

	return 0;
}

/***************************************************/

U_BOOT_CMD(
	getdcr,	2,	1,	do_getdcr,
	"getdcr  - Get an AMCC PPC 4xx DCR's value\n",
	"dcrn - return a DCR's value.\n"
);
U_BOOT_CMD(
	setdcr,	2,	1,	do_setdcr,
	"setdcr  - Set an AMCC PPC 4xx DCR's value\n",
	"dcrn - set a DCR's value.\n"
);

U_BOOT_CMD(
	getidcr,	3,	1,	do_getidcr,
	"getidcr - Get a register value via indirect DCR addressing\n",
	"adr_dcrn[.dat_dcrn] offset - write offset to adr_dcrn, read value from dat_dcrn.\n"
);

U_BOOT_CMD(
	setidcr,	4,	1,	do_setidcr,
	"setidcr - Set a register value via indirect DCR addressing\n",
	"adr_dcrn[.dat_dcrn] offset value - write offset to adr_dcrn, write value to dat_dcrn.\n"
);
Commit	Line	Data
3863585b WD	1	/*
	2	* (C) Copyright 2001
	3	* Erik Theisen, Wave 7 Optics, etheisen@mindspring.com.
	4	*
	5	* See file CREDITS for list of people who contributed to this
	6	* project.
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License as
	10	* published by the Free Software Foundation; either version 2 of
	11	* the License, or (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	21	* MA 02111-1307 USA
	22	*/
	23
	24	/*
0c8721a4	25	* AMCC 4XX DCR Functions
3863585b WD	26	*/
	27
	28	#include <common.h>
	29	#include <config.h>
	30	#include <command.h>
3863585b	31
af9e1f5b SR	32	unsigned long get_dcr (unsigned short);
	33	unsigned long set_dcr (unsigned short, unsigned long);
	34
0c8721a4 WD	35	/* =======================================================================
	36	* Interpreter command to retrieve an AMCC PPC 4xx Device Control Register
	37	* =======================================================================
3863585b WD	38	*/
	39	int do_getdcr ( cmd_tbl_t cmdtp, int flag, int argc, char argv[] )
	40	{
0c8721a4 WD	41	unsigned short dcrn; /* Device Control Register Num */
0c8721a4 WD	42	unsigned long value; /* DCR's value */
3863585b	43
0c8721a4	44	unsigned long get_dcr (unsigned short);
8bde7f77	45
0c8721a4 WD	46	/* Validate arguments */
0c8721a4 WD	47	if (argc < 2) {
62c3ae7c	48	cmd_usage(cmdtp);
0c8721a4 WD	49	return 1;
0c8721a4 WD	50	}
3863585b	51
0c8721a4 WD	52	/* Get a DCR */
	53	dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
	54	value = get_dcr (dcrn);
3863585b	55
0c8721a4	56	printf ("%04x: %08lx\n", dcrn, value);
3863585b	57
0c8721a4 WD	58	return 0;
0c8721a4 WD	59	}
3863585b WD	60
	61
	62	/* ======================================================================
0c8721a4	63	* Interpreter command to set an AMCC PPC 4xx Device Control Register
3863585b WD	64	* ======================================================================
3863585b WD	65	*/
0c8721a4	66	int do_setdcr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
3863585b	67	{
0c8721a4 WD	68	unsigned short dcrn; /* Device Control Register Num */
	69	unsigned long value;
	70
	71	/* DCR's value */
	72	int nbytes;
	73	extern char console_buffer[];
	74
	75	/* Validate arguments */
	76	if (argc < 2) {
62c3ae7c	77	cmd_usage(cmdtp);
0c8721a4	78	return 1;
8bde7f77	79	}
3863585b	80
0c8721a4 WD	81	/* Set a DCR */
	82	dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
	83	do {
	84	value = get_dcr (dcrn);
	85	printf ("%04x: %08lx", dcrn, value);
	86	nbytes = readline (" ? ");
	87	if (nbytes == 0) {
	88	/*
	89	* <CR> pressed as only input, don't modify current
	90	* location and exit command.
	91	*/
	92	nbytes = 1;
	93	return 0;
	94	} else {
	95	unsigned long i;
	96	char *endp;
	97
	98	i = simple_strtoul (console_buffer, &endp, 16);
	99	nbytes = endp - console_buffer;
	100	if (nbytes)
	101	set_dcr (dcrn, i);
	102	}
	103	} while (nbytes);
	104
	105	return 0;
	106	}
3863585b	107
af9e1f5b SR	108	/* =======================================================================
	109	* Interpreter command to retrieve an register value through AMCC PPC 4xx
	110	* Device Control Register inderect addressing.
	111	* =======================================================================
	112	*/
	113	int do_getidcr (cmd_tbl_t cmdtp, int flag, int argc, char argv[])
	114	{
	115	unsigned short adr_dcrn; /* Device Control Register Num for Address */
	116	unsigned short dat_dcrn; /* Device Control Register Num for Data */
	117	unsigned short offset; /* Register's offset */
	118	unsigned long value; /* Register's value */
	119	char *ptr = NULL;
	120	char buf[80];
	121
	122	/* Validate arguments */
	123	if (argc < 3) {
62c3ae7c	124	cmd_usage(cmdtp);
af9e1f5b	125	return 1;
53677ef1	126	}
af9e1f5b SR	127
	128	/* Find out whether ther is '.' (dot) symbol in the first parameter. */
	129	strncpy (buf, argv[1], sizeof(buf)-1);
	130	buf[sizeof(buf)-1] = 0; /* will guarantee zero-end string */
	131	ptr = strchr (buf, '.');
	132
	133	if (ptr != NULL) {
	134	/* First parameter has format adr_dcrn.dat_dcrn */
	135	ptr++ = 0; / erase '.', create zero-end string */
	136	adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
	137	dat_dcrn = (unsigned short) simple_strtoul (ptr, NULL, 16);
	138	} else {
	139	/*
	140	* First parameter has format adr_dcrn; dat_dcrn will be
	141	* calculated as adr_dcrn+1.
	142	*/
	143	adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
	144	dat_dcrn = adr_dcrn+1;
	145	}
	146
	147	/* Register's offset */
	148	offset = (unsigned short) simple_strtoul (argv[2], NULL, 16);
	149
	150	/* Disable interrupts */
	151	disable_interrupts ();
	152	/* Set offset */
	153	set_dcr (adr_dcrn, offset);
	154	/* get data */
	155	value = get_dcr (dat_dcrn);
	156	/* Enable interrupts */
	157	enable_interrupts ();
	158
	159	printf ("%04x.%04x-%04x Read %08lx\n", adr_dcrn, dat_dcrn, offset, value);
	160
	161	return 0;
	162	}
	163
	164	/* =======================================================================
	165	* Interpreter command to update an register value through AMCC PPC 4xx
	166	* Device Control Register inderect addressing.
	167	* =======================================================================
	168	*/
	169	int do_setidcr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[])
	170	{
	171	unsigned short adr_dcrn; /* Device Control Register Num for Address */
	172	unsigned short dat_dcrn; /* Device Control Register Num for Data */
	173	unsigned short offset; /* Register's offset */
	174	unsigned long value; /* Register's value */
	175	char *ptr = NULL;
	176	char buf[80];
	177
	178	/* Validate arguments */
	179	if (argc < 4) {
62c3ae7c	180	cmd_usage(cmdtp);
af9e1f5b	181	return 1;
2b2a40be	182	}
af9e1f5b SR	183
	184	/* Find out whether ther is '.' (dot) symbol in the first parameter. */
	185	strncpy (buf, argv[1], sizeof(buf)-1);
	186	buf[sizeof(buf)-1] = 0; /* will guarantee zero-end string */
	187	ptr = strchr (buf, '.');
	188
	189	if (ptr != NULL) {
	190	/* First parameter has format adr_dcrn.dat_dcrn */
	191	ptr++ = 0; / erase '.', create zero-end string */
	192	adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
	193	dat_dcrn = (unsigned short) simple_strtoul (ptr, NULL, 16);
	194	} else {
	195	/*
	196	* First parameter has format adr_dcrn; dat_dcrn will be
	197	* calculated as adr_dcrn+1.
	198	*/
2b2a40be WD	199	adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
	200	dat_dcrn = adr_dcrn+1;
	201	}
af9e1f5b SR	202
	203	/* Register's offset */
	204	offset = (unsigned short) simple_strtoul (argv[2], NULL, 16);
	205	/* New value */
	206	value = (unsigned long) simple_strtoul (argv[3], NULL, 16);
	207
	208	/* Disable interrupts */
	209	disable_interrupts ();
	210	/* Set offset */
	211	set_dcr (adr_dcrn, offset);
	212	/* set data */
	213	set_dcr (dat_dcrn, value);
	214	/* Enable interrupts */
	215	enable_interrupts ();
	216
	217	printf ("%04x.%04x-%04x Write %08lx\n", adr_dcrn, dat_dcrn, offset, value);
	218
	219	return 0;
	220	}
	221
8bde7f77 WD	222	/***************************************************/
8bde7f77 WD	223
0d498393 WD	224	U_BOOT_CMD(
0d498393 WD	225	getdcr, 2, 1, do_getdcr,
0c8721a4	226	"getdcr - Get an AMCC PPC 4xx DCR's value\n",
8bde7f77 WD	227	"dcrn - return a DCR's value.\n"
8bde7f77 WD	228	);
0d498393 WD	229	U_BOOT_CMD(
0d498393 WD	230	setdcr, 2, 1, do_setdcr,
0c8721a4	231	"setdcr - Set an AMCC PPC 4xx DCR's value\n",
8bde7f77 WD	232	"dcrn - set a DCR's value.\n"
	233	);
	234
af9e1f5b SR	235	U_BOOT_CMD(
	236	getidcr, 3, 1, do_getidcr,
	237	"getidcr - Get a register value via indirect DCR addressing\n",
	238	"adr_dcrn[.dat_dcrn] offset - write offset to adr_dcrn, read value from dat_dcrn.\n"
	239	);
	240
	241	U_BOOT_CMD(
	242	setidcr, 4, 1, do_setidcr,
	243	"setidcr - Set a register value via indirect DCR addressing\n",
	244	"adr_dcrn[.dat_dcrn] offset value - write offset to adr_dcrn, write value to dat_dcrn.\n"
	245	);