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
|
// SPDX-License-Identifier: LGPL-2.1-or-later
/*
* libfdt - Flat Device Tree manipulation
* Testcase/tool for rearranging blocks of a dtb
* Copyright (C) 2006 David Gibson, IBM Corporation.
*/
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <limits.h>
#include <stdint.h>
#include <libfdt.h>
#include "tests.h"
#include "testdata.h"
static int nopulate_struct(char *buf, const char *fdt)
{
int offset, nextoffset = 0;
uint32_t tag;
char *p;
p = buf;
do {
offset = nextoffset;
tag = fdt_next_tag(fdt, offset, &nextoffset);
memcpy(p, (const char *)fdt + fdt_off_dt_struct(fdt) + offset,
nextoffset - offset);
p += nextoffset - offset;
*((fdt32_t *)p) = cpu_to_fdt32(FDT_NOP);
p += FDT_TAGSIZE;
} while (tag != FDT_END);
return p - buf;
}
int main(int argc, char *argv[])
{
char *fdt, *fdt2, *buf;
int newsize, struct_start, struct_end_old, struct_end_new, delta;
const char *inname;
char outname[PATH_MAX];
test_init(argc, argv);
if (argc != 2)
CONFIG("Usage: %s <dtb file>", argv[0]);
inname = argv[1];
fdt = load_blob(argv[1]);
sprintf(outname, "noppy.%s", inname);
if (fdt_version(fdt) < 17)
FAIL("Can't deal with version <17");
buf = xmalloc(2 * fdt_size_dt_struct(fdt));
newsize = nopulate_struct(buf, fdt);
verbose_printf("Nopulated structure block has new size %d\n", newsize);
/* Replace old strcutre block with the new */
fdt2 = xmalloc(fdt_totalsize(fdt) + newsize);
struct_start = fdt_off_dt_struct(fdt);
delta = newsize - fdt_size_dt_struct(fdt);
struct_end_old = struct_start + fdt_size_dt_struct(fdt);
struct_end_new = struct_start + newsize;
memcpy(fdt2, fdt, struct_start);
memcpy(fdt2 + struct_start, buf, newsize);
memcpy(fdt2 + struct_end_new, fdt + struct_end_old,
fdt_totalsize(fdt) - struct_end_old);
fdt_set_totalsize(fdt2, fdt_totalsize(fdt) + delta);
fdt_set_size_dt_struct(fdt2, newsize);
if (fdt_off_mem_rsvmap(fdt) > struct_start)
fdt_set_off_mem_rsvmap(fdt2, fdt_off_mem_rsvmap(fdt) + delta);
if (fdt_off_dt_strings(fdt) > struct_start)
fdt_set_off_dt_strings(fdt2, fdt_off_dt_strings(fdt) + delta);
save_blob(outname, fdt2);
PASS();
}
|
