|
|
|
@ -31,6 +31,9 @@ |
|
|
|
|
|
|
|
|
|
#if defined(CONFIG_4xx) && (CONFIG_COMMANDS & CFG_CMD_SETGETDCR) |
|
|
|
|
|
|
|
|
|
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 |
|
|
|
|
* ======================================================================= |
|
|
|
@ -64,8 +67,6 @@ int do_getdcr ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[] ) |
|
|
|
|
*/ |
|
|
|
|
int do_setdcr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
|
|
|
|
{ |
|
|
|
|
unsigned long get_dcr (unsigned short); |
|
|
|
|
unsigned long set_dcr (unsigned short, unsigned long); |
|
|
|
|
unsigned short dcrn; /* Device Control Register Num */ |
|
|
|
|
unsigned long value; |
|
|
|
|
|
|
|
|
@ -106,6 +107,120 @@ int do_setdcr (cmd_tbl_t * cmdtp, int flag, int argc, char *argv[]) |
|
|
|
|
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) { |
|
|
|
|
printf ("Usage:\n%s\n", cmdtp->usage); |
|
|
|
|
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) { |
|
|
|
|
printf ("Usage:\n%s\n", cmdtp->usage); |
|
|
|
|
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( |
|
|
|
@ -119,4 +234,16 @@ U_BOOT_CMD( |
|
|
|
|
"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" |
|
|
|
|
); |
|
|
|
|
|
|
|
|
|
#endif /* CONFIG_4xx & CFG_CMD_SETGETDCR */ |
|
|
|
|