--- embedtools/src/cfi.c	2011/06/20 12:37:07	1.1
+++ embedtools/src/cfi.c	2012/07/22 22:46:47	1.2
@@ -0,0 +1,166 @@
+/*************************************************************************
+ * (C) 2011 AITNET - Sofia/Bulgaria - <office@aitbg.com>
+ *  by Michael Pounov <misho@aitbg.com>
+ *
+ * $Author: misho $
+ * $Id: cfi.c,v 1.2 2012/07/22 22:46:47 misho Exp $
+ *
+ *************************************************************************
+The ELWIX and AITNET software is distributed under the following
+terms:
+
+All of the documentation and software included in the ELWIX and AITNET
+Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>
+
+Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012
+	by Michael Pounov <misho@elwix.org>.  All rights reserved.
+
+Redistribution and use in source and binary forms, with or without
+modification, are permitted provided that the following conditions
+are met:
+1. Redistributions of source code must retain the above copyright
+   notice, this list of conditions and the following disclaimer.
+2. Redistributions in binary form must reproduce the above copyright
+   notice, this list of conditions and the following disclaimer in the
+   documentation and/or other materials provided with the distribution.
+3. All advertising materials mentioning features or use of this software
+   must display the following acknowledgement:
+This product includes software developed by Michael Pounov <misho@elwix.org>
+ELWIX - Embedded LightWeight unIX and its contributors.
+4. Neither the name of AITNET nor the names of its contributors
+   may be used to endorse or promote products derived from this software
+   without specific prior written permission.
+
+THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``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 REGENTS OR CONTRIBUTORS 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.
+*/
+#include "global.h"
+
+
+int Verbose;
+extern char compiled[], compiledby[], compilehost[];
+
+
+static void
+Usage()
+{
+	printf(	"-= CFI =-  Flash interface managment tool\n"
+		"=== %s === %s@%s ===\n\n"
+		"  Syntax: cfi [options] <fact|oem|plr> [arg]\n"
+		"\n"
+		"\t-v\t\tVerbose ...\n"
+		"\t-w\t\tWrite operation for oem or plr ...\n"
+		"\t-f <dev>\tCFI device like [default=/dev/cfi0]...\n"
+		"\n", compiled, compiledby, compilehost);
+}
+
+static uint64_t
+getfactorypr(int fd)
+{
+	uint64_t v;
+
+	if (ioctl(fd, CFIOCGFACTORYPR, &v) < 0)
+		printf("Error:: ioctl(CFIOCGFACTORYPR) #%d - %s\n", errno, strerror(errno));
+
+	return v;
+}
+
+static uint64_t
+getoempr(int fd)
+{
+	uint64_t v;
+
+	if (ioctl(fd, CFIOCGOEMPR, &v) < 0)
+		printf("Error:: ioctl(CFIOCGOEMPR) #%d - %s\n", errno, strerror(errno));
+
+	return v;
+}
+
+static void
+setoempr(int fd, uint64_t v)
+{
+	if (ioctl(fd, CFIOCSOEMPR, &v) < 0)
+		printf("Error:: ioctl(CFIOCSOEMPR) #%d - %s\n", errno, strerror(errno));
+}
+
+static uint32_t
+getplr(int fd)
+{
+	uint32_t plr;
+
+	if (ioctl(fd, CFIOCGPLR, &plr) < 0)
+		printf("Error:: ioctl(CFIOCGPLR) #%d - %s\n", errno, strerror(errno));
+
+	return plr;
+}
+
+static void
+setplr(int fd)
+{
+	if (ioctl(fd, CFIOCSPLR, 0) < 0)
+		printf("Error:: ioctl(CFIOCPLR) #%d - %s\n", errno, strerror(errno));
+}
+
+
+int
+main(int argc, char **argv)
+{
+	char ch, szDev[MAXPATHLEN] = "/dev/cfi0";
+	int d, mode = O_RDONLY;
+
+	while ((ch = getopt(argc, argv, "vhwf:")) != -1)
+		switch (ch) {
+			case 'f':
+				strlcpy(szDev, optarg, sizeof szDev);
+				break;
+			case 'w':
+				mode = O_WRONLY;
+				break;
+			case 'v':
+				Verbose++;
+				break;
+			case 'h':
+			default:
+				Usage();
+				return 1;
+		}
+	argc -= optind;
+	argv += optind;
+	if (!argc || !*argv) {
+		Usage();
+		return 1;
+	}
+
+	d = open(szDev, mode);
+	if (d < 0) {
+		printf("Error:: open device %s #%d - %s\n", szDev, errno, strerror(errno));
+		return 2;
+	}
+
+	if (!strcasecmp(*argv, "fact")) {
+		printf("0x%llx\n", (unsigned long long) getfactorypr(d));
+	} else if (!strcasecmp(*argv, "oem")) {
+		if (mode == O_WRONLY && argv[1])
+			setoempr(d, (uint64_t) strtoull(argv[1], NULL, 0));
+		else
+			printf("0x%llx\n", (unsigned long long) getoempr(d));
+	} else if (!strcasecmp(*argv, "plr")) {
+		if (mode == O_WRONLY /*&& argv[1]*/)
+			setplr(d);
+		else
+			printf("0x%x\n", getplr(d));
+	} else
+		Usage();
+
+	close(d);
+	return 0;
+}