X-Git-Url: https://gerrit.opnfv.org/gerrit/gitweb?a=blobdiff_plain;f=qemu%2Froms%2Fopenbios%2Flibopenbios%2Flinuxbios_info.c;fp=qemu%2Froms%2Fopenbios%2Flibopenbios%2Flinuxbios_info.c;h=bef996cf0323ea2d4918f854e33a3776c0da1a5d;hb=e44e3482bdb4d0ebde2d8b41830ac2cdb07948fb;hp=0000000000000000000000000000000000000000;hpb=9ca8dbcc65cfc63d6f5ef3312a33184e1d726e00;p=kvmfornfv.git

diff --git a/qemu/roms/openbios/libopenbios/linuxbios_info.c b/qemu/roms/openbios/libopenbios/linuxbios_info.c
new file mode 100644
index 000000000..bef996cf0
--- /dev/null
+++ b/qemu/roms/openbios/libopenbios/linuxbios_info.c
@@ -0,0 +1,130 @@
+/* Adapted from Etherboot 5.1.8 */
+
+#include "config.h"
+#include "sysinclude.h"
+#include "asm/types.h"
+#include "asm/io.h"
+#include "linuxbios.h"
+#include "libopenbios/ipchecksum.h"
+#include "libopenbios/sys_info.h"
+
+#ifdef CONFIG_DEBUG_BOOT
+#define debug printk
+#else
+#define debug(x...)
+#endif
+
+#define for_each_lbrec(head, rec) \
+	for(rec = (struct lb_record *)(((char *)head) + sizeof(*head)); \
+		(((char *)rec) < (((char *)head) + sizeof(*head) + head->table_bytes))  && \
+		(rec->size >= 1) && \
+		((((char *)rec) + rec->size) <= (((char *)head) + sizeof(*head) + head->table_bytes)); \
+		rec = (struct lb_record *)(((char *)rec) + rec->size))
+
+static void convert_memmap(struct lb_memory *lbmem, struct sys_info *info)
+{
+    int lbcount;
+    int i;
+
+    lbcount = lbmem->size / sizeof(struct lb_memory_range);
+    info->memrange = malloc(lbcount * sizeof(struct memrange));
+    info->n_memranges = 0;
+    for (i = 0; i < lbcount; i++) {
+	debug("%#016llx %#016llx %d\n",
+              (long long)lbmem->map[i].start, (long long)lbmem->map[i].size,
+              (int) lbmem->map[i].type);
+	if (lbmem->map[i].type != LB_MEM_RAM)
+	    continue;
+	info->memrange[info->n_memranges].base = lbmem->map[i].start;
+	info->memrange[info->n_memranges].size = lbmem->map[i].size;
+	info->n_memranges++;
+    }
+}
+
+static int read_lbtable(struct lb_header *head, struct sys_info *info)
+{
+	int retval = 0;
+
+	/* Read linuxbios tables... */
+	struct lb_record *rec;
+
+	for_each_lbrec(head, rec) {
+		switch(rec->tag) {
+		case LB_TAG_MEMORY:
+			convert_memmap((struct lb_memory *) rec, info);
+			retval = 1;
+			break;
+		};
+	}
+	return retval;
+}
+
+static unsigned long count_lb_records(void *start, unsigned long length)
+{
+	struct lb_record *rec;
+	void *end;
+	unsigned long count;
+	count = 0;
+	end = ((char *)start) + length;
+	for(rec = start; ((void *)rec < end) &&
+		((signed long)rec->size <=
+                 ((signed long)end - (signed long)rec));
+		rec = (void *)(((char *)rec) + rec->size)) {
+		count++;
+	}
+	return count;
+}
+
+static int find_lb_table(void *start, void *end, struct lb_header **result)
+{
+	unsigned char *ptr;
+	/* For now be stupid.... */
+	for(ptr = start; (void *)ptr < end; ptr += 16) {
+		struct lb_header *head = (struct lb_header *)ptr;
+		if (	(head->signature[0] != 'L') ||
+			(head->signature[1] != 'B') ||
+			(head->signature[2] != 'I') ||
+			(head->signature[3] != 'O')) {
+			continue;
+		}
+		if (head->header_bytes != sizeof(*head))
+			continue;
+		debug("Found canidate at: %p\n", head);
+		if (ipchksum((uint16_t *)head, sizeof(*head)) != 0)
+			continue;
+		debug("header checksum o.k.\n");
+		if (ipchksum((uint16_t *)(ptr + sizeof(*head)), head->table_bytes) !=
+			head->table_checksum) {
+			continue;
+		}
+		debug("table checksum o.k.\n");
+		if (count_lb_records(ptr + sizeof(*head), head->table_bytes) !=
+			head->table_entries) {
+			continue;
+		}
+		debug("record count o.k.\n");
+		*result = head;
+		return 1;
+	};
+	return 0;
+}
+
+void collect_linuxbios_info(struct sys_info *info)
+{
+	struct lb_header *lb_table;
+	int found;
+	debug("Searching for LinuxBIOS tables...\n");
+	found = 0;
+	if (!found) {
+		found = find_lb_table(phys_to_virt(0x00000), phys_to_virt(0x01000), &lb_table);
+	}
+	if (!found) {
+		found = find_lb_table(phys_to_virt(0xf0000), phys_to_virt(0x100000), &lb_table);
+	}
+	if (!found)
+		return;
+
+	debug("Found LinuxBIOS table at: %p\n", lb_table);
+	info->firmware = "LinuxBIOS";
+	read_lbtable(lb_table, info);
+}