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
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
|
/* SPDX-License-Identifier: LGPL-2.1-or-later */
#include "edid.h"
#include "efivars-fundamental.h"
#include "proto/edid-discovered.h"
#include "util.h"
#define EDID_FIXED_HEADER_PATTERN "\x00\xFF\xFF\xFF\xFF\xFF\xFF"
assert_cc(sizeof_field(EdidHeader, pattern) == sizeof(EDID_FIXED_HEADER_PATTERN));
int edid_parse_blob(const void *blob, size_t blob_size, EdidHeader *ret_header) {
assert(ret_header);
/* EDID size is at least 128 as per the specification */
if (blob_size < 128)
return -EINVAL;
const EdidHeader *edid_header = ASSERT_PTR(blob);
if (memcmp(edid_header->pattern, EDID_FIXED_HEADER_PATTERN, sizeof(EDID_FIXED_HEADER_PATTERN)) != 0)
return -EINVAL;
*ret_header = (EdidHeader) {
.pattern = EDID_FIXED_HEADER_PATTERN,
.manufacturer_id = be16toh(edid_header->manufacturer_id),
.manufacturer_product_code = le16toh(edid_header->manufacturer_product_code),
.serial_number = le32toh(edid_header->serial_number),
.week_of_manufacture = edid_header->week_of_manufacture,
.year_of_manufacture = edid_header->year_of_manufacture,
.edid_version = edid_header->edid_version,
.edid_revision = edid_header->edid_revision,
};
return 0;
}
int edid_get_panel_id(const EdidHeader *edid_header, char16_t ret_panel[static 8]) {
assert(edid_header);
assert(ret_panel);
for (size_t i = 0; i < 3; i++) {
uint8_t letter = (edid_header->manufacturer_id >> (5 * i)) & 0b11111;
if (letter > 0b11010)
return -EINVAL;
ret_panel[2 - i] = letter + 'A' - 1;
}
ret_panel[3] = LOWERCASE_HEXDIGITS[(edid_header->manufacturer_product_code >> 12) & 0x0F];
ret_panel[4] = LOWERCASE_HEXDIGITS[(edid_header->manufacturer_product_code >> 8) & 0x0F];
ret_panel[5] = LOWERCASE_HEXDIGITS[(edid_header->manufacturer_product_code >> 4) & 0x0F];
ret_panel[6] = LOWERCASE_HEXDIGITS[(edid_header->manufacturer_product_code >> 0) & 0x0F];
ret_panel[7] = L'\0';
return 0;
}
EFI_STATUS edid_get_discovered_panel_id(char16_t **ret_panel) {
assert(ret_panel);
EFI_EDID_DISCOVERED_PROTOCOL *edid_discovered = NULL;
EFI_STATUS status = BS->LocateProtocol(MAKE_GUID_PTR(EFI_EDID_DISCOVERED_PROTOCOL), NULL, (void **) &edid_discovered);
if (EFI_STATUS_IS_ERROR(status))
return status;
if (!edid_discovered)
return EFI_UNSUPPORTED;
if (!edid_discovered->Edid)
return EFI_UNSUPPORTED;
if (edid_discovered->SizeOfEdid == 0)
return EFI_UNSUPPORTED;
EdidHeader header;
if (edid_parse_blob(edid_discovered->Edid, edid_discovered->SizeOfEdid, &header) < 0)
return EFI_INCOMPATIBLE_VERSION;
_cleanup_free_ char16_t *panel = xnew0(char16_t, 8);
if (edid_get_panel_id(&header, panel) < 0)
return EFI_INVALID_PARAMETER;
*ret_panel = TAKE_PTR(panel);
return EFI_SUCCESS;
}
|
