+++ /dev/null
-/**************************************************************************
- *
- * BRIEF MODULE DESCRIPTION
- * nvram interface routines.
- *
- * Copyright 2004 IDT Inc. (rischelp@idt.com)
- *
- * 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 SOFTWARE IS PROVIDED ``AS IS'' AND ANY EXPRESS OR IMPLIED
- * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
- * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN
- * NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
- * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
- * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF
- * USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
- * ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
- * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
- * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
- *
- * 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.,
- * 675 Mass Ave, Cambridge, MA 02139, USA.
- *
- *
- **************************************************************************
- * May 2004 rkt, neb
- *
- * Initial Release
- *
- *
- *
- **************************************************************************
- */
-
-#include <linux/ctype.h>
-#include <linux/string.h>
-
-//#include <asm/ds1553rtc.h>
-#include "nvram434.h"
-#define NVRAM_BASE 0xbfff8000
-
-extern void setenv (char *e, char *v, int rewrite);
-extern void unsetenv (char *e);
-extern void mapenv (int (*func)(char *, char *));
-extern char *getenv (char *s);
-extern void purgeenv(void);
-
-static void nvram_initenv(void);
-
-static unsigned char
-nvram_getbyte(int offs)
-{
- return(*((unsigned char*)(NVRAM_BASE + offs)));
-}
-
-static void
-nvram_setbyte(int offs, unsigned char val)
-{
- unsigned char* nvramDataPointer = (unsigned char*)(NVRAM_BASE + offs);
-
- *nvramDataPointer = val;
-}
-
-/*
- * BigEndian!
- */
-static unsigned short
-nvram_getshort(int offs)
-{
- return((nvram_getbyte(offs) << 8) | nvram_getbyte(offs + 1));
-}
-
-static void
-nvram_setshort(int offs, unsigned short val)
-{
- nvram_setbyte(offs, (unsigned char)((val >> 8) & 0xff));
- nvram_setbyte(offs + 1, (unsigned char)(val & 0xff));
-}
-#if 0
-static unsigned int
-nvram_getint(int offs)
-{
- unsigned int val;
- val = nvram_getbyte(offs) << 24;
- val |= nvram_getbyte(offs + 1) << 16;
- val |= nvram_getbyte(offs + 2) << 8;
- val |= nvram_getbyte(offs + 3);
- return(val);
-}
-
-static void
-nvram_setint(int offs, unsigned int val)
-{
- nvram_setbyte(offs, val >> 24);
- nvram_setbyte(offs + 1, val >> 16);
- nvram_setbyte(offs + 2, val >> 8);
- nvram_setbyte(offs + 3, val);
-}
-#endif
-/*
- * calculate NVRAM checksum
- */
-static unsigned short
-nvram_calcsum(void)
-{
- unsigned short sum = NV_MAGIC;
- int i;
-
- for (i = ENV_BASE; i < ENV_TOP; i += 2)
- sum += nvram_getshort(i);
- return(sum);
-}
-
-/*
- * update the nvram checksum
- */
-static void
-nvram_updatesum (void)
-{
- nvram_setshort(NVOFF_CSUM, nvram_calcsum());
-}
-
-/*
- * test validity of nvram by checksumming it
- */
-static int
-nvram_isvalid(void)
-{
- static int is_valid;
-
- if (is_valid)
- return(1);
-
- if (nvram_getshort(NVOFF_MAGIC) != NV_MAGIC) {
- printk("nvram_isvalid FAILED\n");
- //nvram_initenv();
- }
- is_valid = 1;
- return(1);
-}
-
-/* return nvram address of environment string */
-static int
-nvram_matchenv(char *s)
-{
- int envsize, envp, n, i, varsize;
- char *var;
-
- envsize = nvram_getshort(NVOFF_ENVSIZE);
-
- if (envsize > ENV_AVAIL)
- return(0); /* sanity */
-
- envp = ENV_BASE;
-
- if ((n = strlen (s)) > 255)
- return(0);
-
- while (envsize > 0) {
- varsize = nvram_getbyte(envp);
- if (varsize == 0 || (envp + varsize) > ENV_TOP)
- return(0); /* sanity */
- for (i = envp + 1, var = s; i <= envp + n; i++, var++) {
- char c1 = nvram_getbyte(i);
- char c2 = *var;
- if (islower(c1))
- c1 = toupper(c1);
- if (islower(c2))
- c2 = toupper(c2);
- if (c1 != c2)
- break;
- }
- if (i > envp + n) { /* match so far */
- if (n == varsize - 1) /* match on boolean */
- return(envp);
- if (nvram_getbyte(i) == '=') /* exact match on variable */
- return(envp);
- }
- envsize -= varsize;
- envp += varsize;
- }
- return(0);
-}
-
-static void nvram_initenv(void)
-{
- nvram_setshort(NVOFF_MAGIC, NV_MAGIC);
- nvram_setshort(NVOFF_ENVSIZE, 0);
-
- nvram_updatesum();
-}
-
-static void
-nvram_delenv(char *s)
-{
- int nenvp, envp, envsize, nbytes;
-
- envp = nvram_matchenv(s);
- if (envp == 0)
- return;
-
- nenvp = envp + nvram_getbyte(envp);
- envsize = nvram_getshort(NVOFF_ENVSIZE);
- nbytes = envsize - (nenvp - ENV_BASE);
- nvram_setshort(NVOFF_ENVSIZE, envsize - (nenvp - envp));
- while (nbytes--) {
- nvram_setbyte(envp, nvram_getbyte(nenvp));
- envp++;
- nenvp++;
- }
- nvram_updatesum();
-}
-
-static int
-nvram_setenv(char *s, char *v)
-{
- int ns, nv, total;
- int envp;
-
- if (!nvram_isvalid())
- return(-1);
-
- nvram_delenv(s);
- ns = strlen(s);
- if (ns == 0)
- return (-1);
- if (v && *v) {
- nv = strlen(v);
- total = ns + nv + 2;
- }
- else {
- nv = 0;
- total = ns + 1;
- }
- if (total > 255 || total > ENV_AVAIL - nvram_getshort(NVOFF_ENVSIZE))
- return(-1);
-
- envp = ENV_BASE + nvram_getshort(NVOFF_ENVSIZE);
-
- nvram_setbyte(envp, (unsigned char) total);
- envp++;
-
- while (ns--) {
- nvram_setbyte(envp, *s);
- envp++;
- s++;
- }
-
- if (nv) {
- nvram_setbyte(envp, '=');
- envp++;
- while (nv--) {
- nvram_setbyte(envp, *v);
- envp++;
- v++;
- }
- }
- nvram_setshort(NVOFF_ENVSIZE, envp-ENV_BASE);
- nvram_updatesum();
- return 0;
-}
-
-static char *
-nvram_getenv(char *s)
-{
- static char buf[256]; /* FIXME: this cannot be static */
- int envp, ns, nbytes, i;
-
- if (!nvram_isvalid())
- return "INVALID NVRAM"; //((char *)0);
-
- envp = nvram_matchenv(s);
- if (envp == 0)
- return "NOT FOUND"; //((char *)0);
- ns = strlen(s);
- if (nvram_getbyte(envp) == ns + 1) /* boolean */
- buf[0] = '\0';
- else {
- nbytes = nvram_getbyte(envp) - (ns + 2);
- envp += ns + 2;
- for (i = 0; i < nbytes; i++)
- buf[i] = nvram_getbyte(envp++);
- buf[i] = '\0';
- }
- return(buf);
-}
-
-static void
-nvram_unsetenv(char *s)
-{
- if (!nvram_isvalid())
- return;
-
- nvram_delenv(s);
-}
-
-/*
- * apply func to each string in environment
- */
-static void
-nvram_mapenv(int (*func)(char *, char *))
-{
- int envsize, envp, n, i, seeneql;
- char name[256], value[256];
- char c, *s;
-
- if (!nvram_isvalid())
- return;
-
- envsize = nvram_getshort(NVOFF_ENVSIZE);
- envp = ENV_BASE;
-
- while (envsize > 0) {
- value[0] = '\0';
- seeneql = 0;
- s = name;
- n = nvram_getbyte(envp);
- for (i = envp + 1; i < envp + n; i++) {
- c = nvram_getbyte(i);
- if ((c == '=') && !seeneql) {
- *s = '\0';
- s = value;
- seeneql = 1;
- continue;
- }
- *s++ = c;
- }
- *s = '\0';
- (*func)(name, value);
- envsize -= n;
- envp += n;
- }
-}
-#if 0
-static unsigned int
-digit(char c)
-{
- if ('0' <= c && c <= '9')
- return (c - '0');
- if ('A' <= c && c <= 'Z')
- return (10 + c - 'A');
- if ('a' <= c && c <= 'z')
- return (10 + c - 'a');
- return (~0);
-}
-#endif
-/*
- * Wrappers to allow 'special' environment variables to get processed
- */
-void
-setenv(char *e, char *v, int rewrite)
-{
- if (nvram_getenv(e) && !rewrite)
- return;
-
- nvram_setenv(e, v);
-}
-
-char *
-getenv(char *e)
-{
- return(nvram_getenv(e));
-}
-
-void
-unsetenv(char *e)
-{
- nvram_unsetenv(e);
-}
-
-void
-purgeenv()
-{
- int i;
- unsigned char* nvramDataPointer = (unsigned char*)(NVRAM_BASE);
-
- for (i = ENV_BASE; i < ENV_TOP; i++)
- *nvramDataPointer++ = 0;
- nvram_setshort(NVOFF_MAGIC, NV_MAGIC);
- nvram_setshort(NVOFF_ENVSIZE, 0);
- nvram_setshort(NVOFF_CSUM, NV_MAGIC);
-}
-
-void
-mapenv(int (*func)(char *, char *))
-{
- nvram_mapenv(func);
-}
projects / openwrt / staging / chunkeey.git / blobdiff