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
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
|
// SPDX-License-Identifier: Apache-2.0
/*
* Parse flash sub-partitions
*
* Copyright 2013-2018 IBM Corp.
*/
#include <skiboot.h>
#include <opal-api.h>
struct flash_hostboot_toc {
be32 ec;
be32 offset; /* From start of header. 4K aligned */
be32 size;
};
#define FLASH_HOSTBOOT_TOC_MAX_ENTRIES ((FLASH_SUBPART_HEADER_SIZE - 8) \
/sizeof(struct flash_hostboot_toc))
struct flash_hostboot_header {
char eyecatcher[4];
be32 version;
struct flash_hostboot_toc toc[FLASH_HOSTBOOT_TOC_MAX_ENTRIES];
};
int flash_subpart_info(void *part_header, uint32_t header_len,
uint32_t part_size, uint32_t *part_actualp,
uint32_t subid, uint32_t *offset, uint32_t *size)
{
struct flash_hostboot_header *header;
char eyecatcher[5];
uint32_t i, ec, o, s;
uint32_t part_actual;
bool subpart_found;
if (!part_header || ( !offset && !size && !part_actualp)) {
prlog(PR_ERR, "FLASH: invalid parameters: ph %p of %p sz %p "
"tsz %p\n", part_header, offset, size, part_actualp);
return OPAL_PARAMETER;
}
if (header_len < FLASH_SUBPART_HEADER_SIZE) {
prlog(PR_ERR, "FLASH: subpartition header too small 0x%x\n",
header_len);
return OPAL_PARAMETER;
}
header = (struct flash_hostboot_header*) part_header;
/* Perform sanity */
i = be32_to_cpu(header->version);
if (i != 1) {
prerror("FLASH: flash subpartition TOC version unknown %i\n", i);
return OPAL_RESOURCE;
}
/* NULL terminate eyecatcher */
strncpy(eyecatcher, header->eyecatcher, 4);
eyecatcher[4] = '\0';
prlog(PR_DEBUG, "FLASH: flash subpartition eyecatcher %s\n",
eyecatcher);
subpart_found = false;
part_actual = 0;
for (i = 0; i < FLASH_HOSTBOOT_TOC_MAX_ENTRIES; i++) {
ec = be32_to_cpu(header->toc[i].ec);
o = be32_to_cpu(header->toc[i].offset);
s = be32_to_cpu(header->toc[i].size);
/* Check for null terminating entry */
if (!ec && !o && !s)
break;
/* Sanity check the offset and size. */
if (o + s > part_size) {
prerror("FLASH: flash subpartition too big: %i\n", i);
return OPAL_RESOURCE;
}
if (!s) {
prerror("FLASH: flash subpartition zero size: %i\n", i);
return OPAL_RESOURCE;
}
if (o < FLASH_SUBPART_HEADER_SIZE) {
prerror("FLASH: flash subpartition offset too small: "
"%i\n", i);
return OPAL_RESOURCE;
}
/*
* Subpartitions content are different, but multiple toc entries
* may point to the same subpartition.
*/
if (ALIGN_UP(o + s, FLASH_SUBPART_HEADER_SIZE) > part_actual)
part_actual = ALIGN_UP(o + s, FLASH_SUBPART_HEADER_SIZE);
if (ec == subid) {
if (offset)
*offset += o;
if (size)
*size = s;
subpart_found = true;
}
}
if (!subpart_found && (offset || size)) {
prerror("FLASH: flash subpartition not found.\n");
return OPAL_RESOURCE;
}
if (part_actualp)
*part_actualp = part_actual;
return OPAL_SUCCESS;
}
|
