Add qemu 2.4.0

[kvmfornfv.git] / qemu / roms / u-boot / board / emk / common / vpd.c

diff --git a/qemu/roms/u-boot/board/emk/common/vpd.c b/qemu/roms/u-boot/board/emk/common/vpd.c
new file mode 100644 (file)
index 0000000..d9af92a
--- /dev/null
+++ b/qemu/roms/u-boot/board/emk/common/vpd.c
@@ -0,0 +1,63 @@
+/*
+ * (C) Copyright 2003
+ * Reinhard Meyer, EMK Elektronik GmbH, r.meyer@emk-elektronik.de
+ *
+ * SPDX-License-Identifier:    GPL-2.0+
+ */
+
+#include <common.h>
+
+/*****************************************************************************
+ * read "factory" part of EEPROM and set some environment variables
+ *****************************************************************************/
+void read_factory_r (void)
+{
+       /* read 'factory' part of EEPROM */
+       uchar buf[81];
+       uchar *p;
+       uint length;
+       uint addr;
+       uint len;
+
+       /* get length first */
+       addr = CONFIG_SYS_FACT_OFFSET;
+       if (eeprom_read (CONFIG_SYS_I2C_FACT_ADDR, addr, buf, 2)) {
+         bailout:
+               printf ("cannot read factory configuration\n");
+               printf ("be sure to set ethaddr yourself!\n");
+               return;
+       }
+       length = buf[0] + (buf[1] << 8);
+       addr += 2;
+
+       /* sanity check */
+       if (length < 20 || length > CONFIG_SYS_FACT_SIZE - 2)
+               goto bailout;
+
+       /* read lines */
+       while (length > 0) {
+               /* read one line */
+               len = length > 80 ? 80 : length;
+               if (eeprom_read (CONFIG_SYS_I2C_FACT_ADDR, addr, buf, len))
+                       goto bailout;
+               /* mark end of buffer */
+               buf[len] = 0;
+               /* search end of line */
+               for (p = buf; *p && *p != 0x0a; p++);
+               if (!*p)
+                       goto bailout;
+               *p++ = 0;
+               /* advance to next line start */
+               length -= p - buf;
+               addr += p - buf;
+               /*printf ("%s\n", buf); */
+               /* search for our specific entry */
+               if (!strncmp ((char *) buf, "[RLA/lan/Ethernet] ", 19)) {
+                       setenv ("ethaddr", (char *)(buf + 19));
+               } else if (!strncmp ((char *) buf, "[BOARD/SERIAL] ", 15)) {
+                       setenv ("serial#", (char *)(buf + 15));
+               } else if (!strncmp ((char *) buf, "[BOARD/TYPE] ", 13)) {
+                       setenv ("board_id", (char *)(buf + 13));
+               }
+       }
+}