cmd_dcr.c 6.75 KB
Newer Older
wdenk's avatar
wdenk committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
/*
 * (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
 */

/*
25
 * AMCC 4XX DCR Functions
wdenk's avatar
wdenk committed
26 27 28 29 30 31
 */

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

32 33 34
unsigned long get_dcr (unsigned short);
unsigned long set_dcr (unsigned short, unsigned long);

35 36 37
/* =======================================================================
 * Interpreter command to retrieve an AMCC PPC 4xx Device Control Register
 * =======================================================================
wdenk's avatar
wdenk committed
38
 */
39
int do_getdcr ( cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[] )
wdenk's avatar
wdenk committed
40
{
41 42
	unsigned short dcrn;	/* Device Control Register Num */
	unsigned long value;	/* DCR's value */
wdenk's avatar
wdenk committed
43

44
	unsigned long get_dcr (unsigned short);
wdenk's avatar
wdenk committed
45

46
	/* Validate arguments */
47
	if (argc < 2)
48
		return CMD_RET_USAGE;
wdenk's avatar
wdenk committed
49

50 51 52
	/* Get a DCR */
	dcrn = (unsigned short) simple_strtoul (argv[1], NULL, 16);
	value = get_dcr (dcrn);
wdenk's avatar
wdenk committed
53

54
	printf ("%04x: %08lx\n", dcrn, value);
wdenk's avatar
wdenk committed
55

56 57
	return 0;
}
wdenk's avatar
wdenk committed
58 59 60


/* ======================================================================
61
 * Interpreter command to set an AMCC PPC 4xx Device Control Register
wdenk's avatar
wdenk committed
62 63
 * ======================================================================
*/
64
int do_setdcr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
wdenk's avatar
wdenk committed
65
{
66 67 68 69 70 71 72
	unsigned short dcrn;	/* Device Control Register Num */
	unsigned long value;

	/* DCR's value */
	int nbytes;

	/* Validate arguments */
73
	if (argc < 2)
74
		return CMD_RET_USAGE;
wdenk's avatar
wdenk committed
75

76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101
	/* 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;
}
wdenk's avatar
wdenk committed
102

103 104 105 106 107
/* =======================================================================
 * Interpreter command to retrieve an register value through AMCC PPC 4xx
 * Device Control Register inderect addressing.
 * =======================================================================
 */
108
int do_getidcr (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
109 110 111 112 113 114 115 116 117
{
	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 */
118
	if (argc < 3)
119
		return CMD_RET_USAGE;
120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161

	/* 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.
 * =======================================================================
 */
162
int do_setidcr (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
163 164 165 166 167 168 169 170 171
{
	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 */
172
	if (argc < 4)
173
		return CMD_RET_USAGE;
174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189

	/* 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.
		 */
Wolfgang Denk's avatar
Wolfgang Denk committed
190 191 192
		adr_dcrn = (unsigned short) simple_strtoul (buf, NULL, 16);
		dat_dcrn = adr_dcrn+1;
	}
193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212

	/* 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;
}

wdenk's avatar
wdenk committed
213 214
/***************************************************/

215 216
U_BOOT_CMD(
	getdcr,	2,	1,	do_getdcr,
Peter Tyser's avatar
Peter Tyser committed
217
	"Get an AMCC PPC 4xx DCR's value",
218
	"dcrn - return a DCR's value."
wdenk's avatar
wdenk committed
219
);
220 221
U_BOOT_CMD(
	setdcr,	2,	1,	do_setdcr,
Peter Tyser's avatar
Peter Tyser committed
222
	"Set an AMCC PPC 4xx DCR's value",
223
	"dcrn - set a DCR's value."
wdenk's avatar
wdenk committed
224 225
);

226 227
U_BOOT_CMD(
	getidcr,	3,	1,	do_getidcr,
Peter Tyser's avatar
Peter Tyser committed
228
	"Get a register value via indirect DCR addressing",
229
	"adr_dcrn[.dat_dcrn] offset - write offset to adr_dcrn, read value from dat_dcrn."
230 231 232 233
);

U_BOOT_CMD(
	setidcr,	4,	1,	do_setidcr,
Peter Tyser's avatar
Peter Tyser committed
234
	"Set a register value via indirect DCR addressing",
235
	"adr_dcrn[.dat_dcrn] offset value - write offset to adr_dcrn, write value to dat_dcrn."
236
);