src/kernel/smbios/smbios.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53

#include <kernel/graphics/vesa.h>
#include <stddef.h>
#include <kernel/smbios/smbios.h>

struct smbios_entry *smbios = 0;

size_t smbios_table_len(struct smbios_header *header)
{
	size_t i;
	const char *strtab = (char *)header + header->length;
	for (i = 1; strtab[i - 1] != '\0' || strtab[i] != '\0'; i++)
		;
	return header->length + i + 1;
}

struct smbios_entry *get_smbios()
{
	if (smbios != 0)
		return smbios;

	char *mem = (char *)0xF0000;
	int length, i;
	unsigned char checksum;
	while ((unsigned int)mem < 0x100000) {
		if (mem[0] == '_' && mem[1] == 'S' && mem[2] == 'M' && mem[3] == '_') {
			length = mem[5];
			checksum = 0;
			for (i = 0; i < length; i++) {
				checksum += mem[i];
			}
			if (checksum == 0)
				break;
		}
		mem += 16;
	}

	if ((unsigned int)mem == 0x100000) {
		warn("No SMBIOS found!");
		return 0;
	}

	smbios = (struct smbios_entry *)mem;
	if (smbios->major_version != 2)
		warn("Non-supported SMBIOS version");
	smbios_table((struct smbios_header *)mem);
	return smbios;
}

void smbios_table(struct smbios_header *header)
{
	// struct smbios_0 *table = (struct smbios_0 *) (header + sizeof(struct smbios_header));
	// serial_printf("\n\n %d", table->bios_version);
}