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
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
|
/* SPDX-License-Identifier: GPL-2.0-only */
#ifdef __MINGW32__
#include <winsock.h>
#else
#include <arpa/inet.h>
#endif
#include <sys/types.h>
#include <sys/stat.h>
#ifndef __MINGW32__
#include <sys/mman.h>
#endif
#include <stdlib.h>
#include <fcntl.h>
#include <string.h>
#include <stdio.h>
#include "cbfs.h"
#include "common.h"
#define ALIGN(x,a) __ALIGN_MASK(x,(typeof(x))(a)-1)
#define __ALIGN_MASK(x,mask) (((x)+(mask))&~(mask))
static void *cbfs_mapped;
static void *cbfs_offset;
static void* virt_to_phys(u32 virt)
{
return cbfs_offset + virt;
}
#ifdef DEBUG
#define debug(x...) printf(x)
#else
#define debug(x...) while(0) {}
#endif
static int cbfs_check_magic(struct cbfs_file *file)
{
return !strcmp(file->magic, CBFS_FILE_MAGIC) ? 1 : 0;
}
static struct cbfs_header *cbfs_master_header(void)
{
struct cbfs_header *header;
void *ptr = virt_to_phys(*((u32*)virt_to_phys(CBFS_HEADPTR_ADDR)));
debug("Check CBFS header at %p\n", ptr);
header = (struct cbfs_header *) ptr;
debug("magic is %08x\n", ntohl(header->magic));
if (ntohl(header->magic) != CBFS_HEADER_MAGIC) {
printf("ERROR: No valid CBFS header found!\n");
return NULL;
}
debug("Found CBFS header at %p\n", ptr);
return header;
}
struct cbfs_file *cbfs_find(const char *name)
{
struct cbfs_header *header = cbfs_master_header();
void *offset;
if (header == NULL)
return NULL;
offset = virt_to_phys(0 - ntohl(header->romsize) + ntohl(header->offset));
int align= ntohl(header->align);
while(1) {
struct cbfs_file *file = (struct cbfs_file *) offset;
if (!cbfs_check_magic(file)) return NULL;
debug("Check %s\n", CBFS_NAME(file));
if (!strcmp(CBFS_NAME(file), name))
return file;
int flen = ntohl(file->len);
int foffset = ntohl(file->offset);
debug("CBFS: follow chain: %p + %x + %x + align -> ", offset, foffset, flen);
void *oldoffset = offset;
offset = (void*)ALIGN((uintptr_t)(offset + foffset + flen), align);
debug("%p\n", (void *)offset);
if (offset <= oldoffset) return NULL;
if (offset < virt_to_phys(0xFFFFFFFF - ntohl(header->romsize)))
return NULL;
}
}
void *cbfs_find_file(const char *name, unsigned int type, unsigned int *len)
{
struct cbfs_file *file = cbfs_find(name);
if (file == NULL) {
printf("CBFS: Could not find file %s\n",
name);
return NULL;
}
if (ntohl(file->type) != type) {
printf("CBFS: File %s is of type %x instead of"
"type %x\n", name, file->type, type);
return NULL;
}
if (len != NULL) *len = file->len;
return (void *) CBFS_SUBHEADER(file);
}
void open_cbfs(const char *filename)
{
struct stat cbfs_stat;
int cbfs_fd;
cbfs_fd = open(filename, O_RDWR);
if (cbfs_fd == -1) {
printf("Couldn't open '%s'\n", filename);
exit(-1);
}
if (fstat(cbfs_fd, &cbfs_stat) == -1) {
printf("Couldn't stat '%s'\n", filename);
exit(-1);
}
cbfs_mapped = mmap(NULL, cbfs_stat.st_size, PROT_READ | PROT_WRITE,
MAP_SHARED, cbfs_fd, 0);
close(cbfs_fd);
if (cbfs_mapped == MAP_FAILED) {
printf("Couldn't map '%s'\n", filename);
exit(-1);
}
cbfs_offset = cbfs_mapped-(0xffffffff-cbfs_stat.st_size+1);
}
|
