X-Git-Url: https://git.archive.openwrt.org/?p=project%2Fluci.git;a=blobdiff_plain;f=contrib%2Fuserspace-nvram%2Fnvram.c;h=a7425ecca32ce4d6dd14e79c73f2c4902ebe93c7;hp=a2ded149a88b4cfffca8d4d2c4b044d8c78c29f4;hb=a8da3a09a3fb34327cf02306726dad640e309f20;hpb=18193fa5e9790e5c48ac42bb99f7477be2aed7f9

diff --git a/contrib/userspace-nvram/nvram.c b/contrib/userspace-nvram/nvram.c
index a2ded149a..a7425ecca 100644
--- a/contrib/userspace-nvram/nvram.c
+++ b/contrib/userspace-nvram/nvram.c
@@ -14,9 +14,12 @@
 
 #include "nvram.h"
 
-#define TRACE() \
-	printf("%s(%i) in %s()\n", \
-		__FILE__, __LINE__, __FUNCTION__)
+#define TRACE(msg) \
+	printf("%s(%i) in %s(): %s\n", \
+		__FILE__, __LINE__, __FUNCTION__, msg ? msg : "?")
+
+size_t nvram_erase_size = 0;
+
 
 /*
  * -- Helper functions --
@@ -91,18 +94,15 @@ static nvram_tuple_t * _nvram_realloc( nvram_handle_t *h, nvram_tuple_t *t,
 /* (Re)initialize the hash table. */
 static int _nvram_rehash(nvram_handle_t *h)
 {
-	nvram_header_t *header = (nvram_header_t *) &h->mmap[NVRAM_SPACE];
-	char buf[] = "0xXXXXXXXX", *name, *value, *end, *eq;
+	nvram_header_t *header = (nvram_header_t *) &h->mmap[NVRAM_START(nvram_erase_size)];
+	char buf[] = "0xXXXXXXXX", *name, *value, *eq;
 
 	/* (Re)initialize hash table */
 	_nvram_free(h);
 
 	/* Parse and set "name=value\0 ... \0\0" */
 	name = (char *) &header[1];
-	/*
-	end = (char *) header + NVRAM_SPACE - 2;
-	end[0] = end[1] = '\0';
-	*/
+
 	for (; *name; name = value + strlen(value) + 1) {
 		if (!(eq = strchr(name, '=')))
 			break;
@@ -251,7 +251,7 @@ nvram_tuple_t * nvram_getall(nvram_handle_t *h)
 /* Regenerate NVRAM. */
 int nvram_commit(nvram_handle_t *h)
 {
-	nvram_header_t *header = (nvram_header_t *) &h->mmap[NVRAM_SPACE];
+	nvram_header_t *header = (nvram_header_t *) &h->mmap[NVRAM_START(nvram_erase_size)];
 	char *init, *config, *refresh, *ncdl;
 	char *ptr, *end;
 	int i;
@@ -280,6 +280,7 @@ int nvram_commit(nvram_handle_t *h)
 	/* Clear data area */
 	ptr = (char *) header + sizeof(nvram_header_t);
 	memset(ptr, 0xFF, NVRAM_SPACE - sizeof(nvram_header_t));
+	memset(&tmp, 0, sizeof(nvram_header_t));
 
 	/* Leave space for a double NUL at the end */
 	end = (char *) header + NVRAM_SPACE - 2;
@@ -328,15 +329,28 @@ nvram_handle_t * nvram_open(const char *file, int rdonly)
 	nvram_handle_t *h;
 	nvram_header_t *header;
 
+	/* If erase size or file are undefined then try to define them */
+	if( (nvram_erase_size == 0) || (file == NULL) )
+	{
+		/* Finding the mtd will set the appropriate erase size */
+		if( file == NULL )
+			file = nvram_find_mtd();
+		else
+			(void) nvram_find_mtd();
+
+		if( nvram_erase_size == 0 )
+			return NULL;
+	}
+
 	if( (fd = open(file, O_RDWR)) > -1 )
 	{
 		char *mmap_area = (char *) mmap(
-			NULL, 0x10000, PROT_READ | PROT_WRITE,
+			NULL, nvram_erase_size, PROT_READ | PROT_WRITE,
 			( rdonly == NVRAM_RO ) ? MAP_PRIVATE : MAP_SHARED, fd, 0);
 
 		if( mmap_area != MAP_FAILED )
 		{
-			memset(mmap_area, 0xFF, NVRAM_SPACE);
+			memset(mmap_area, 0xFF, NVRAM_START(nvram_erase_size));
 
 			if((h = (nvram_handle_t *) malloc(sizeof(nvram_handle_t))) != NULL)
 			{
@@ -344,9 +358,9 @@ nvram_handle_t * nvram_open(const char *file, int rdonly)
 
 				h->fd     = fd;
 				h->mmap   = mmap_area;
-				h->length = 0x10000;
+				h->length = nvram_erase_size;
 
-				header = (nvram_header_t *) &h->mmap[NVRAM_SPACE];
+				header = (nvram_header_t *) &h->mmap[NVRAM_START(nvram_erase_size)];
 
 				if( header->magic == NVRAM_MAGIC )
 				{
@@ -379,27 +393,30 @@ int nvram_close(nvram_handle_t *h)
 /* Determine NVRAM device node. */
 const char * nvram_find_mtd(void)
 {
-	//return "./samples/nvram.1";
-
 	FILE *fp;
-	int i;
+	int i, esz;
 	char dev[PATH_MAX];
-	char *path;
+	char *path = NULL;
 
-	// "/dev/mtdblock/" + ( 0 < x < 99 ) + "ro" + \0 = 19
+	// "/dev/mtdblock/" + ( 0 < x < 99 ) + \0 = 19
 	if( (path = (char *) malloc(19)) == NULL )
 		return NULL;
 
 	if ((fp = fopen("/proc/mtd", "r"))) {
 		while (fgets(dev, sizeof(dev), fp)) {
-			if (sscanf(dev, "mtd%d:", &i) && strstr(dev, "nvram")) {
-				snprintf(path, 19, "/dev/mtdblock/%d", i);
+			if (strstr(dev, "nvram") && sscanf(dev, "mtd%d: %08x", &i, &esz)) {
+				if( (path = (char *) malloc(19)) != NULL )
+				{
+					nvram_erase_size = esz;
+					snprintf(path, 19, "/dev/mtdblock/%d", i);
+					break;
+				}
 			}
 		}
 		fclose(fp);
 	}
 
-	return (const char *) path;
+	return path;
 }
 
 /* Check NVRAM staging file. */
@@ -419,12 +436,12 @@ const char * nvram_find_staging(void)
 int nvram_to_staging(void)
 {
 	int fdmtd, fdstg, stat;
-	const char *mtd;
-	char buf[0x10000];
+	const char *mtd = nvram_find_mtd();
+	char buf[nvram_erase_size];
 
 	stat = -1;
 
-	if( (mtd = nvram_find_mtd()) != NULL )
+	if( (mtd != NULL) && (nvram_erase_size > 0) )
 	{
 		if( (fdmtd = open(mtd, O_RDONLY)) > -1 )
 		{
@@ -451,12 +468,12 @@ int nvram_to_staging(void)
 int staging_to_nvram(void)
 {
 	int fdmtd, fdstg, stat;
-	const char *mtd;
-	char buf[0x10000];
+	const char *mtd = nvram_find_mtd();
+	char buf[nvram_erase_size];
 
 	stat = -1;
 
-	if( (mtd = nvram_find_mtd()) != NULL )
+	if( (mtd != NULL) && (nvram_erase_size > 0) )
 	{
 		if( (fdstg = open(NVRAM_STAGING, O_RDONLY)) > -1 )
 		{