|
1 /* |
|
2 * Functions to help device tree manipulation using libfdt. |
|
3 * It also provides functions to read entries from device tree proc |
|
4 * interface. |
|
5 * |
|
6 * Copyright 2008 IBM Corporation. |
|
7 * Authors: Jerone Young <jyoung5@us.ibm.com> |
|
8 * Hollis Blanchard <hollisb@us.ibm.com> |
|
9 * |
|
10 * This work is licensed under the GNU GPL license version 2 or later. |
|
11 * |
|
12 */ |
|
13 |
|
14 #include <stdio.h> |
|
15 #include <sys/types.h> |
|
16 #include <sys/stat.h> |
|
17 #include <fcntl.h> |
|
18 #include <unistd.h> |
|
19 #include <stdlib.h> |
|
20 |
|
21 #include "config.h" |
|
22 #include "qemu-common.h" |
|
23 #include "sysemu.h" |
|
24 #include "device_tree.h" |
|
25 |
|
26 #include <libfdt.h> |
|
27 |
|
28 void *load_device_tree(const char *filename_path, void *load_addr) |
|
29 { |
|
30 int dt_file_size; |
|
31 int dt_file_load_size; |
|
32 int new_dt_size; |
|
33 int ret; |
|
34 void *dt_file = NULL; |
|
35 void *fdt; |
|
36 |
|
37 dt_file_size = get_image_size(filename_path); |
|
38 if (dt_file_size < 0) { |
|
39 printf("Unable to get size of device tree file '%s'\n", |
|
40 filename_path); |
|
41 goto fail; |
|
42 } |
|
43 |
|
44 /* First allocate space in qemu for device tree */ |
|
45 dt_file = qemu_mallocz(dt_file_size); |
|
46 if (dt_file == NULL) { |
|
47 printf("Unable to allocate memory in qemu for device tree\n"); |
|
48 goto fail; |
|
49 } |
|
50 |
|
51 dt_file_load_size = load_image(filename_path, dt_file); |
|
52 |
|
53 /* Second we place new copy of 2x size in guest memory |
|
54 * This give us enough room for manipulation. |
|
55 */ |
|
56 new_dt_size = dt_file_size * 2; |
|
57 |
|
58 fdt = load_addr; |
|
59 ret = fdt_open_into(dt_file, fdt, new_dt_size); |
|
60 if (ret) { |
|
61 printf("Unable to copy device tree in memory\n"); |
|
62 goto fail; |
|
63 } |
|
64 |
|
65 /* Check sanity of device tree */ |
|
66 if (fdt_check_header(fdt)) { |
|
67 printf ("Device tree file loaded into memory is invalid: %s\n", |
|
68 filename_path); |
|
69 goto fail; |
|
70 } |
|
71 /* free qemu memory with old device tree */ |
|
72 qemu_free(dt_file); |
|
73 return fdt; |
|
74 |
|
75 fail: |
|
76 qemu_free(dt_file); |
|
77 return NULL; |
|
78 } |
|
79 |
|
80 int qemu_devtree_setprop(void *fdt, const char *node_path, |
|
81 const char *property, uint32_t *val_array, int size) |
|
82 { |
|
83 int offset; |
|
84 |
|
85 offset = fdt_path_offset(fdt, node_path); |
|
86 if (offset < 0) |
|
87 return offset; |
|
88 |
|
89 return fdt_setprop(fdt, offset, property, val_array, size); |
|
90 } |
|
91 |
|
92 int qemu_devtree_setprop_cell(void *fdt, const char *node_path, |
|
93 const char *property, uint32_t val) |
|
94 { |
|
95 int offset; |
|
96 |
|
97 offset = fdt_path_offset(fdt, node_path); |
|
98 if (offset < 0) |
|
99 return offset; |
|
100 |
|
101 return fdt_setprop_cell(fdt, offset, property, val); |
|
102 } |
|
103 |
|
104 int qemu_devtree_setprop_string(void *fdt, const char *node_path, |
|
105 const char *property, const char *string) |
|
106 { |
|
107 int offset; |
|
108 |
|
109 offset = fdt_path_offset(fdt, node_path); |
|
110 if (offset < 0) |
|
111 return offset; |
|
112 |
|
113 return fdt_setprop_string(fdt, offset, property, string); |
|
114 } |