89 lines
1.8 KiB
C
89 lines
1.8 KiB
C
#include <stdint.h>
|
|
#include <stddef.h>
|
|
#include <drivers/gop.h>
|
|
#include <drivers/edid.h>
|
|
#include <mm/pmm.h>
|
|
#include <lib/misc.h>
|
|
#include <lib/libc.h>
|
|
#include <lib/print.h>
|
|
|
|
#if defined (BIOS)
|
|
|
|
#include <lib/real.h>
|
|
|
|
struct edid_info_struct *get_edid_info(void) {
|
|
static struct edid_info_struct *buf = NULL;
|
|
|
|
if (buf == NULL)
|
|
buf = conv_mem_alloc(sizeof(struct edid_info_struct));
|
|
|
|
struct rm_regs r = {0};
|
|
|
|
r.eax = 0x4f15;
|
|
r.ebx = 0x0001;
|
|
r.edi = (uint32_t)rm_off(buf);
|
|
r.ds = (uint32_t)rm_seg(buf);
|
|
r.es = r.ds;
|
|
rm_int(0x10, &r, &r);
|
|
|
|
if ((r.eax & 0x00ff) != 0x4f)
|
|
goto fail;
|
|
if ((r.eax & 0xff00) != 0)
|
|
goto fail;
|
|
|
|
for (size_t i = 0; i < sizeof(struct edid_info_struct); i++)
|
|
if (((uint8_t *)buf)[i] != 0)
|
|
goto success;
|
|
|
|
fail:
|
|
printv("edid: Could not fetch EDID data.\n");
|
|
return NULL;
|
|
|
|
success:
|
|
printv("edid: Success.\n");
|
|
return buf;
|
|
}
|
|
|
|
#endif
|
|
|
|
#if defined (UEFI)
|
|
|
|
#include <efi.h>
|
|
|
|
struct edid_info_struct *get_edid_info(void) {
|
|
if (!gop_ready) {
|
|
goto fail;
|
|
}
|
|
|
|
struct edid_info_struct *buf = ext_mem_alloc(sizeof(struct edid_info_struct));
|
|
|
|
EFI_STATUS status;
|
|
|
|
EFI_EDID_ACTIVE_PROTOCOL *edid = NULL;
|
|
EFI_GUID edid_guid = EFI_EDID_ACTIVE_PROTOCOL_GUID;
|
|
|
|
status = gBS->HandleProtocol(gop_handle, &edid_guid, (void **)&edid);
|
|
|
|
if (status)
|
|
goto fail;
|
|
|
|
if (edid->SizeOfEdid < sizeof(struct edid_info_struct))
|
|
goto fail;
|
|
|
|
memcpy(buf, edid->Edid, sizeof(struct edid_info_struct));
|
|
|
|
for (size_t i = 0; i < sizeof(struct edid_info_struct); i++)
|
|
if (((uint8_t *)buf)[i] != 0)
|
|
goto success;
|
|
|
|
fail:
|
|
printv("edid: Could not fetch EDID data.\n");
|
|
return NULL;
|
|
|
|
success:
|
|
printv("edid: Success.\n");
|
|
return buf;
|
|
}
|
|
|
|
#endif
|