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
111
112
113
114
115
116
117
118
119
|
/*
* This file is part of the coreboot project.
*
* Copyright 2012-2015 Google Inc.
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; version 2 of the License.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc.
*/
#include <boot_device.h>
#include <console/console.h>
#include <fmap.h>
#include <fmap_serialized.h>
#include <stddef.h>
#include <string.h>
/*
* See http://code.google.com/p/flashmap/ for more information on FMAP.
*/
static int find_fmap_directory(struct region_device *fmrd)
{
const struct region_device *boot;
struct fmap *fmap;
size_t fmap_size;
size_t offset = CONFIG_FLASHMAP_OFFSET;
boot_device_init();
boot = boot_device_ro();
if (boot == NULL)
return -1;
fmap_size = sizeof(struct fmap);
fmap = rdev_mmap(boot, offset, fmap_size);
if (fmap == NULL)
return -1;
if (memcmp(fmap->signature, FMAP_SIGNATURE, sizeof(fmap->signature))) {
printk(BIOS_DEBUG, "No FMAP found at %zx offset.\n", offset);
rdev_munmap(boot, fmap);
return -1;
}
printk(BIOS_DEBUG, "FMAP: Found \"%s\" version %d.%d at %zx.\n",
fmap->name, fmap->ver_major, fmap->ver_minor, offset);
printk(BIOS_DEBUG, "FMAP: base = %llx size = %x #areas = %d\n",
(long long)fmap->base, fmap->size, fmap->nareas);
fmap_size += fmap->nareas * sizeof(struct fmap_area);
rdev_munmap(boot, fmap);
return rdev_chain(fmrd, boot, offset, fmap_size);
}
int fmap_locate_area_as_rdev(const char *name, struct region_device *area)
{
struct region ar;
if (fmap_locate_area(name, &ar))
return -1;
return boot_device_ro_subregion(&ar, area);
}
int fmap_locate_area(const char *name, struct region *ar)
{
struct region_device fmrd;
size_t offset;
if (find_fmap_directory(&fmrd))
return -1;
/* Start reading the areas just after fmap header. */
offset = sizeof(struct fmap);
while (1) {
struct fmap_area *area;
area = rdev_mmap(&fmrd, offset, sizeof(*area));
if (area == NULL)
return -1;
if (strcmp((const char *)area->name, name)) {
rdev_munmap(&fmrd, area);
offset += sizeof(struct fmap_area);
continue;
}
printk(BIOS_DEBUG, "FMAP: area %s found\n", name);
printk(BIOS_DEBUG, "FMAP: offset: %x\n", area->offset);
printk(BIOS_DEBUG, "FMAP: size: %d bytes\n", area->size);
ar->offset = area->offset;
ar->size = area->size;
rdev_munmap(&fmrd, area);
return 0;
}
printk(BIOS_DEBUG, "FMAP: area %s not found\n", name);
return -1;
}
|
