00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021
00022
00023
00024
00025
00026
00027
00028
00029
00030
00031
00032
00033 #include <dev/nvmem.h>
00034
00035 #include <stdlib.h>
00036 #include <string.h>
00037
00038 #include <sys/environ.h>
00039
00040 NUTENVIRONMENT *nut_environ;
00041
00042
00043
00044
00045 static size_t read_string(int *addr, char *buf, size_t siz)
00046 {
00047 size_t rc = 0;
00048 char ch;
00049
00050 while (rc <= siz) {
00051 if (NutNvMemLoad(*addr, &ch, 1)) {
00052 rc = 0;
00053 break;
00054 }
00055 (*addr)++;
00056 if (ch == 0) {
00057 break;
00058 }
00059 if (buf) {
00060 *buf++ = ch;
00061 }
00062 rc++;
00063 }
00064 if (buf) {
00065 *buf = 0;
00066 }
00067 return rc;
00068 }
00069
00078 NUTENVIRONMENT *findenv(CONST char *name)
00079 {
00080 NUTENVIRONMENT *envp;
00081 size_t len;
00082 size_t max_len = 0;
00083 char *buf;
00084
00085 if (nut_environ == NULL) {
00086
00087 u_long magic;
00088 int addr = ENVIRON_EE_OFFSET;
00089 NUTENVIRONMENT *prvp = NULL;
00090
00091 if (NutNvMemLoad(addr, &magic, sizeof(magic)) == 0 && magic == ENVIRON_MAGIC) {
00092 addr += 4;
00093
00094 while ((len = read_string(&addr, NULL, MAX_ENVIRON_ITEM_SIZE)) > 0) {
00095 if (len > max_len) {
00096 max_len = len;
00097 }
00098 len = read_string(&addr, NULL, MAX_ENVIRON_ITEM_SIZE);
00099 if (len > max_len) {
00100 max_len = len;
00101 }
00102 }
00103
00104 addr = ENVIRON_EE_OFFSET + sizeof(magic);
00105 if (max_len && (buf = malloc(max_len + 1)) != NULL) {
00106 while ((len = read_string(&addr, buf, max_len)) > 0) {
00107 if ((envp = malloc(sizeof(NUTENVIRONMENT))) == NULL) {
00108 break;
00109 }
00110 memset(envp, 0, sizeof(NUTENVIRONMENT));
00111 if ((envp->env_name = malloc(len + 1)) == NULL) {
00112 free(envp);
00113 break;
00114 }
00115 strcpy(envp->env_name, buf);
00116 len = read_string(&addr, buf, max_len);
00117 if ((envp->env_value = malloc(len + 1)) == NULL) {
00118 break;
00119 }
00120 strcpy(envp->env_value, buf);
00121 if (prvp) {
00122 prvp->env_next = envp;
00123 envp->env_prev = prvp;
00124 } else {
00125 nut_environ = envp;
00126 }
00127 prvp = envp;
00128 }
00129 free(buf);
00130 }
00131 }
00132 }
00133 for (envp = nut_environ; envp; envp = envp->env_next) {
00134 if (strcmp(envp->env_name, name) == 0) {
00135 break;
00136 }
00137 }
00138 return envp;
00139 }
00140