mirror of
https://git.stationery.faith/corn/corn.git
synced 2024-11-13 00:42:08 +00:00
65 lines
1.6 KiB
C
65 lines
1.6 KiB
C
#include "mboot.h"
|
|
|
|
#include <stddef.h>
|
|
#include <lib.h>
|
|
|
|
static void read_cmdline(struct mboot_info *info, struct mboot_tag *tag, char *data, uint8_t len) {
|
|
if (len >= CMDLINE_MAX)
|
|
len = CMDLINE_MAX; // truncate :(
|
|
memcpy(tag->data.cmdline, data, len);
|
|
tag->data.cmdline[len] = '\0';
|
|
info->tags[MBOOT_CMDLINE] = *tag;
|
|
}
|
|
|
|
static void read_xsdp(struct mboot_info *info, struct mboot_tag *tag, char *data) {
|
|
tag->data.rootsdp = (void *) data;
|
|
info->tags[MBOOT_XSDP] = *tag;
|
|
}
|
|
|
|
static uint32_t *read_tag(struct mboot_info *info, uint32_t *data) {
|
|
struct mboot_tag tag;
|
|
tag.type = ((uint16_t*)data)[0];
|
|
tag.size = data[1];
|
|
tag.valid = 1;
|
|
|
|
uint8_t data_len = tag.size - 2 * sizeof(uint32_t);
|
|
|
|
switch (tag.type) {
|
|
case MBOOT_CMDLINE:
|
|
read_cmdline(info, &tag, (char *)(data + 2), data_len);
|
|
break;
|
|
case MBOOT_XSDP:
|
|
read_xsdp(info, &tag, (char *) (data + 2));
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
if(tag.size % 8 != 0) {
|
|
tag.size += 8 - (tag.size % 8);
|
|
}
|
|
|
|
return data + tag.size / sizeof(uint32_t);
|
|
}
|
|
|
|
struct mboot_info mboot_load_info(void *mboot_info) {
|
|
struct mboot_info info = {0};
|
|
|
|
uint32_t* data = (uint32_t*) mboot_info;
|
|
info.total_size = *data++;
|
|
info.reserved = *data++;
|
|
|
|
while((uint8_t*) data < (uint8_t*) mboot_info + info.total_size) {
|
|
data = read_tag(&info, data);
|
|
}
|
|
|
|
return info;
|
|
}
|
|
|
|
struct mboot_tag *mboot_get_tag(struct mboot_info *info, enum mboot_tag_type type) {
|
|
if (info->tags[type].valid) {
|
|
return &info->tags[type];
|
|
} else {
|
|
return NULL;
|
|
}
|
|
}
|