char *env_get(char **env, char *var)
{
int addr;
addr = env_get_addr(env, var);
return ((addr == -1) ? NULL : (env[addr] + utl_strlen(var) + 1));
}
/*
* pseudo signature:
*
* int API_env_enum(const char *last, char **next)
*
* last: ptr to name of env var found in last iteration
*/
static int API_env_enum(va_list ap)
{
int i, n;
char *last, **next;
last = (char *)va_arg(ap, u_int32_t);
if ((next = (char **)va_arg(ap, u_int32_t)) == NULL)
return API_EINVAL;
if (last == NULL)
/* start over */
*next = ((char *)env_get_addr(0));
else {
*next = last;
for (i = 0; env_get_char(i) != '\0'; i = n + 1) {
for (n = i; env_get_char(n) != '\0'; ++n) {
if (n >= CONFIG_ENV_SIZE) {
/* XXX shouldn't we set *next = NULL?? */
return 0;
}
}
if (envmatch((uchar *)last, i) < 0)
continue;
/* try to get next name */
i = n + 1;
if (env_get_char(i) == '\0') {
/* no more left */
*next = NULL;
return 0;
}
*next = ((char *)env_get_addr(i));
return 0;
}
}
return 0;
}
static char *findenv(const char *name)
{
int i, nxt, val;
for (i = 0; env_get_char(i) != '\0'; i = nxt + 1) {
for (nxt = i; env_get_char(nxt) != '\0'; ++nxt) {
if (nxt >= CFG_ENV_SIZE)
return NULL;
}
val = envmatch((char *)name, i);
if (val < 0)
continue;
return (char *)env_get_addr(val);
}
return NULL;
}
static char *findenv(const char *name)
{
int i, nxt, val;
for (i = 0; env_get_char(i) != '\0'; i = nxt+1) {
for (nxt=i; env_get_char(nxt) != '\0'; ++nxt) {
if (nxt >= CFG_ENV_SIZE) {
return (NULL);
}
}
if ((val=envmatch((char *)name, i)) < 0) {
continue;
}
return ((char *)env_get_addr(val));
}
return (NULL);
}
int env_complete(char *var, int maxv, char *cmdv[], int bufsz, char *buf)
{
int i, nxt, len, vallen, found;
const char *lval, *rval;
found = 0;
cmdv[0] = NULL;
len = strlen(var);
/* now iterate over the variables and select those that match */
for (i=0; env_get_char(i) != '\0'; i=nxt+1) {
for (nxt=i; env_get_char(nxt) != '\0'; ++nxt)
;
lval = (char *)env_get_addr(i);
rval = strchr(lval, '=');
if (rval != NULL) {
vallen = rval - lval;
rval++;
} else
vallen = strlen(lval);
if (len > 0 && (vallen < len || memcmp(lval, var, len) != 0))
continue;
if (found >= maxv - 2 || bufsz < vallen + 1) {
cmdv[found++] = "...";
break;
}
cmdv[found++] = buf;
memcpy(buf, lval, vallen);
buf += vallen;
bufsz -= vallen;
*buf++ = '\0';
bufsz--;
}
cmdv[found] = NULL;
return found;
}
char *getenv (char *name)
{
int i, nxt;
WATCHDOG_RESET();
for (i=0; env_get_char(i) != '\0'; i=nxt+1) {
int val;
for (nxt=i; env_get_char(nxt) != '\0'; ++nxt) {
if (nxt >= CONFIG_ENV_SIZE) {
return (NULL);
}
}
if ((val=envmatch((uchar *)name, i)) < 0)
continue;
return ((char *)env_get_addr(val));
}
return (NULL);
}
char *get_env(char *name)
{
int i, nxt;
printk("[%s]get_env %s\n",MODULE_NAME,name);
if(!env_valid)
return NULL;
for (i=0; env_get_char(i) != '\0'; i=nxt+1) {
int val;
for (nxt=i; env_get_char(nxt) != '\0'; ++nxt) {
if (nxt >= CFG_ENV_SIZE) {
return (NULL);
}
}
if ((val=envmatch((char *)name, i)) < 0)
continue;
return ((char *)env_get_addr(val));
}
return (NULL);
}
int _do_setenv (int flag, int argc, char *argv[])
{
int i, len, oldval;
int console = -1;
uchar *env, *nxt = NULL;
char *name;
bd_t *bd = gd->bd;
uchar *env_data = env_get_addr(0);
if (!env_data) /* need copy in RAM */
return 1;
name = argv[1];
if (strchr(name, '=')) {
printf ("## Error: illegal character '=' in variable name \"%s\"\n", name);
return 1;
}
/*
* search if variable with this name already exists
*/
oldval = -1;
for (env=env_data; *env; env=nxt+1) {
for (nxt=env; *nxt; ++nxt)
;
if ((oldval = envmatch((uchar *)name, env-env_data)) >= 0)
break;
}
/*
* Delete any existing definition
*/
if (oldval >= 0) {
#ifndef CONFIG_ENV_OVERWRITE
/*
* Ethernet Address and serial# can be set only once,
* ver is readonly.
*/
if (
#ifdef CONFIG_HAS_UID
/* Allow serial# forced overwrite with 0xdeaf4add flag */
((strcmp (name, "serial#") == 0) && (flag != 0xdeaf4add)) ||
#else
(strcmp (name, "serial#") == 0) ||
#endif
((strcmp (name, "ethaddr") == 0)
#if defined(CONFIG_OVERWRITE_ETHADDR_ONCE) && defined(CONFIG_ETHADDR)
&& (strcmp ((char *)env_get_addr(oldval),MK_STR(CONFIG_ETHADDR)) != 0)
#endif /* CONFIG_OVERWRITE_ETHADDR_ONCE && CONFIG_ETHADDR */
) ) {
printf ("Can't overwrite \"%s\"\n", name);
return 1;
}
#endif
/* Check for console redirection */
if (strcmp(name,"stdin") == 0) {
console = stdin;
} else if (strcmp(name,"stdout") == 0) {
console = stdout;
} else if (strcmp(name,"stderr") == 0) {
console = stderr;
}
if (console != -1) {
if (argc < 3) { /* Cannot delete it! */
printf("Can't delete \"%s\"\n", name);
return 1;
}
#ifdef CONFIG_CONSOLE_MUX
i = iomux_doenv(console, argv[2]);
if (i)
return i;
#else
/* Try assigning specified device */
if (console_assign (console, argv[2]) < 0)
return 1;
#ifdef CONFIG_SERIAL_MULTI
if (serial_assign (argv[2]) < 0)
return 1;
#endif
#endif /* CONFIG_CONSOLE_MUX */
}
/*
* Switch to new baudrate if new baudrate is supported
*/
if (strcmp(argv[1],"baudrate") == 0) {
int baudrate = simple_strtoul(argv[2], NULL, 10);
int i;
for (i=0; i<N_BAUDRATES; ++i) {
if (baudrate == baudrate_table[i])
break;
}
if (i == N_BAUDRATES) {
printf ("## Baudrate %d bps not supported\n",
baudrate);
return 1;
}
printf ("## Switch baudrate to %d bps and press ENTER ...\n",
baudrate);
udelay(50000);
gd->baudrate = baudrate;
#if defined(CONFIG_PPC) || defined(CONFIG_MCF52x2)
gd->bd->bi_baudrate = baudrate;
#endif
serial_setbrg ();
udelay(50000);
for (;;) {
if (getc() == '\r')
break;
}
}
if (*++nxt == '\0') {
if (env > env_data) {
env--;
} else {
*env = '\0';
}
} else {
for (;;) {
*env = *nxt++;
if ((*env == '\0') && (*nxt == '\0'))
break;
++env;
}
}
*++env = '\0';
}
#ifdef CONFIG_NET_MULTI
if (strncmp(name, "eth", 3) == 0) {
char *end;
int num = simple_strtoul(name+3, &end, 10);
if (strcmp(end, "addr") == 0) {
eth_set_enetaddr(num, argv[2]);
}
}
#endif
/* Delete only ? */
if ((argc < 3) || argv[2] == NULL) {
env_crc_update ();
return 0;
}
/*
* Append new definition at the end
*/
for (env=env_data; *env || *(env+1); ++env)
;
if (env > env_data)
++env;
/*
* Overflow when:
* "name" + "=" + "val" +"\0\0" > ENV_SIZE - (env-env_data)
*/
len = strlen(name) + 2;
/* add '=' for first arg, ' ' for all others */
for (i=2; i<argc; ++i) {
len += strlen(argv[i]) + 1;
}
if (len > (&env_data[ENV_SIZE]-env)) {
printf ("## Error: environment overflow, \"%s\" deleted\n", name);
return 1;
}
while ((*env = *name++) != '\0')
env++;
for (i=2; i<argc; ++i) {
char *val = argv[i];
*env = (i==2) ? '=' : ' ';
while ((*++env = *val++) != '\0')
;
}
/* end is marked with double '\0' */
*++env = '\0';
/* Update CRC */
env_crc_update ();
/*
* Some variables should be updated when the corresponding
* entry in the enviornment is changed
*/
if (strcmp(argv[1],"ethaddr") == 0) {
char *s = argv[2]; /* always use only one arg */
char *e;
for (i=0; i<6; ++i) {
bd->bi_enetaddr[i] = s ? simple_strtoul(s, &e, 16) : 0;
if (s) s = (*e) ? e+1 : e;
}
#ifdef CONFIG_NET_MULTI
eth_set_enetaddr(0, argv[2]);
#endif
return 0;
}
if (strcmp(argv[1],"ipaddr") == 0) {
char *s = argv[2]; /* always use only one arg */
char *e;
unsigned long addr;
bd->bi_ip_addr = 0;
for (addr=0, i=0; i<4; ++i) {
ulong val = s ? simple_strtoul(s, &e, 10) : 0;
addr <<= 8;
addr |= (val & 0xFF);
if (s) s = (*e) ? e+1 : e;
}
bd->bi_ip_addr = htonl(addr);
return 0;
}
if (strcmp(argv[1],"loadaddr") == 0) {
load_addr = simple_strtoul(argv[2], NULL, 16);
return 0;
}
#if defined(CONFIG_CMD_NET)
if (strcmp(argv[1],"bootfile") == 0) {
copy_filename (BootFile, argv[2], sizeof(BootFile));
return 0;
}
#endif
#ifdef CONFIG_AMIGAONEG3SE
if (strcmp(argv[1], "vga_fg_color") == 0 ||
strcmp(argv[1], "vga_bg_color") == 0 ) {
extern void video_set_color(unsigned char attr);
extern unsigned char video_get_attr(void);
video_set_color(video_get_attr());
return 0;
}
#endif /* CONFIG_AMIGAONEG3SE */
return 0;
}
static T_U8 *env_read_cfg(T_U8 *buffer, T_U8 *var, T_U8 *config, T_U32 bufsz)
{
T_U32 i, nxt, len, vallen;
const T_U8 *lval, *rval, *nval;
const T_U8 excludech[2] = {'\0', '\n'};
if (!config)
{
return AK_NULL;
}
nxt = 0;
config[0] = '\0';
if (var)
{
len = strlen(var);
}
else
{
len = 0;
}
/* now iterate over the variables and select those that match */
for (i=0; env_check_char_valid(buffer, i, excludech, 1); i=nxt+1) {
// get formated string as : xxxx=xxx
for (nxt=i; env_check_char_valid(buffer, nxt, excludech, 2); ++nxt)
;
// get left string
lval = (char *)env_get_addr(buffer, i);
nval = (char *)env_get_addr(buffer, nxt);
// get right string
rval = strchr(lval, '=');
if (rval != AK_NULL) {
vallen = rval - lval;
rval++;
} else
vallen = nval - lval;
if (var)
{
// match lval as input lval
if (len > 0 && (vallen < len || memcmp(lval, var, len) != 0))
continue;
// get right val length
vallen = nval - rval;
nval = rval;
}
else
{
// redirect to left val
nval = lval;
}
// check lval whether valid
if (0 == vallen)
continue;
if (vallen >= bufsz)
{
vallen = bufsz-1;
}
memcpy(config, nval, vallen); config += vallen;
*config++ = '\0';
return rval;
}
return AK_NULL;
}
uchar env_get_char_memory (int index)
{
return *env_get_addr(index);
}
/************************************************************************
* Set a new environment variable,
* or replace or delete an existing one.
*
* This function will ONLY work with a in-RAM copy of the environment
*/
int _do_setenv(int flag, int argc, char *argv[]){
int i, len, oldval;
int console = -1;
uchar *env, *nxt = NULL;
char *name;
bd_t *bd = gd->bd;
uchar *env_data = env_get_addr(0);
if(!env_data){ /* need copy in RAM */
return(1);
}
name = argv[1];
/*
* search if variable with this name already exists
*/
oldval = -1;
for(env = env_data; *env; env = nxt + 1){
for(nxt = env; *nxt; ++nxt);
if((oldval = envmatch((uchar *)name, env - env_data)) >= 0){
break;
}
}
/*
* Delete any existing definition
*/
if(oldval >= 0){
/* Check for console redirection */
if(strcmp(name, "stdin") == 0){
console = stdin;
} else if(strcmp(name, "stdout") == 0){
console = stdout;
} else if(strcmp(name, "stderr") == 0){
console = stderr;
}
if(console != -1){
if(argc < 3){ /* Cannot delete it! */
printf("## Error: can't delete \"%s\"\n", name);
return(1);
}
/* Try assigning specified device */
if(console_assign(console, argv[2]) < 0){
return(1);
}
#ifdef CONFIG_SERIAL_MULTI
if(serial_assign(argv[2]) < 0){
return(1);
}
#endif
}
/*
* Switch to new baudrate if new baudrate is supported
*/
if(strcmp(argv[1], "baudrate") == 0){
int baudrate = simple_strtoul(argv[2], NULL, 10);
int i;
for(i = 0; i < N_BAUDRATES; ++i){
if(baudrate == baudrate_table[i]){
break;
}
}
if(i == N_BAUDRATES){
printf("## Error: baudrate %d bps is not supported,\n", baudrate);
printf(" choose one from the list:\n\n");
for(i = 0; i < N_BAUDRATES; ++i){
printf("- %7d bps%s\n", baudrate_table[i], baudrate_table[i] == gd->baudrate ? " [current]" : "");
}
printf("\n");
return(1);
}
printf("Switch baudrate to %d bps and press ENTER...\n", baudrate);
udelay(50000);
gd->baudrate = baudrate;
serial_setbrg();
udelay(50000);
for(;;){
if(getc() == '\r'){
break;
}
}
}
if(*++nxt == '\0'){
if(env > env_data){
env--;
} else {
*env = '\0';
}
} else {
for(;;){
*env = *nxt++;
if((*env == '\0') && (*nxt == '\0')){
break;
}
++env;
}
}
*++env = '\0';
}
#ifdef CONFIG_NET_MULTI
if(strncmp(name, "eth", 3) == 0){
char *end;
int num = simple_strtoul(name + 3, &end, 10);
if(strcmp(end, "addr") == 0){
eth_set_enetaddr(num, argv[2]);
}
}
#endif
/* Delete only ? */
if((argc < 3) || argv[2] == NULL){
env_crc_update();
return(0);
}
/*
* Append new definition at the end
*/
for(env = env_data; *env || *(env + 1); ++env);
if(env > env_data){
++env;
}
/*
* Overflow when:
* "name" + "=" + "val" +"\0\0" > ENV_SIZE - (env-env_data)
*/
len = strlen(name) + 2;
/* add '=' for first arg, ' ' for all others */
for(i = 2; i < argc; ++i){
len += strlen(argv[i]) + 1;
}
if(len > (&env_data[ENV_SIZE] - env)){
printf("## Error: environment overflow, \"%s\" deleted\n", name);
return(1);
}
while((*env = *name++) != '\0'){
env++;
}
for(i = 2; i < argc; ++i){
char *val = argv[i];
*env = (i == 2) ? '=' : ' ';
while((*++env = *val++) != '\0');
}
/* end is marked with double '\0' */
*++env = '\0';
/* Update CRC */
env_crc_update();
/*
* Some variables should be updated when the corresponding
* entry in the enviornment is changed
*/
if(strcmp(argv[1], "ethaddr") == 0){
char *s = argv[2]; /* always use only one arg */
char *e;
for(i = 0; i < 6; ++i){
bd->bi_enetaddr[i] = s ? simple_strtoul(s, &e, 16) : 0;
if(s){
s = (*e) ? e + 1 : e;
}
}
#ifdef CONFIG_NET_MULTI
eth_set_enetaddr(0, argv[2]);
#endif
return(0);
}
if(strcmp(argv[1], "ipaddr") == 0){
char *s = argv[2]; /* always use only one arg */
char *e;
unsigned long addr;
bd->bi_ip_addr = 0;
for(addr = 0, i = 0; i < 4; ++i){
ulong val = s ? simple_strtoul(s, &e, 10) : 0;
addr <<= 8;
addr |= (val & 0xFF);
if(s){
s = (*e) ? e + 1 : e;
}
}
bd->bi_ip_addr = htonl(addr);
return(0);
}
if(strcmp(argv[1], "loadaddr") == 0){
load_addr = simple_strtoul(argv[2], NULL, 16);
return(0);
}
#if (CONFIG_COMMANDS & CFG_CMD_NET)
if(strcmp(argv[1], "bootfile") == 0){
copy_filename(BootFile, argv[2], sizeof(BootFile));
return(0);
}
#endif /* CFG_CMD_NET */
return(0);
}