Branch data Line data Source code
1 : : /*
2 : : * Configfs entries for device-tree
3 : : *
4 : : * Copyright (C) 2013 - Pantelis Antoniou <panto@antoniou-consulting.com>
5 : : *
6 : : * This program is free software; you can redistribute it and/or
7 : : * modify it under the terms of the GNU General Public License
8 : : * as published by the Free Software Foundation; either version
9 : : * 2 of the License, or (at your option) any later version.
10 : : */
11 : : #include <linux/ctype.h>
12 : : #include <linux/cpu.h>
13 : : #include <linux/module.h>
14 : : #include <linux/of.h>
15 : : #include <linux/of_fdt.h>
16 : : #include <linux/spinlock.h>
17 : : #include <linux/slab.h>
18 : : #include <linux/proc_fs.h>
19 : : #include <linux/configfs.h>
20 : : #include <linux/types.h>
21 : : #include <linux/stat.h>
22 : : #include <linux/limits.h>
23 : : #include <linux/file.h>
24 : : #include <linux/vmalloc.h>
25 : : #include <linux/firmware.h>
26 : : #include <linux/sizes.h>
27 : :
28 : : #include "of_private.h"
29 : :
30 : : struct cfs_overlay_item {
31 : : struct config_item item;
32 : :
33 : : char path[PATH_MAX];
34 : :
35 : : const struct firmware *fw;
36 : : struct device_node *overlay;
37 : : int ov_id;
38 : :
39 : : void *dtbo;
40 : : int dtbo_size;
41 : : };
42 : :
43 : : static inline struct cfs_overlay_item *to_cfs_overlay_item(
44 : : struct config_item *item)
45 : : {
46 [ # # # # : 0 : return item ? container_of(item, struct cfs_overlay_item, item) : NULL;
# # # # #
# # # #
# ]
47 : : }
48 : :
49 : 0 : static ssize_t cfs_overlay_item_path_show(struct config_item *item,
50 : : char *page)
51 : : {
52 : : struct cfs_overlay_item *overlay = to_cfs_overlay_item(item);
53 : 0 : return sprintf(page, "%s\n", overlay->path);
54 : : }
55 : :
56 : 0 : static ssize_t cfs_overlay_item_path_store(struct config_item *item,
57 : : const char *page, size_t count)
58 : : {
59 : : struct cfs_overlay_item *overlay = to_cfs_overlay_item(item);
60 : : const char *p = page;
61 : : char *s;
62 : : int err;
63 : :
64 : : /* if it's set do not allow changes */
65 [ # # # # ]: 0 : if (overlay->path[0] != '\0' || overlay->dtbo_size > 0)
66 : : return -EPERM;
67 : :
68 : : /* copy to path buffer (and make sure it's always zero terminated */
69 : 0 : count = snprintf(overlay->path, sizeof(overlay->path) - 1, "%s", p);
70 : 0 : overlay->path[sizeof(overlay->path) - 1] = '\0';
71 : :
72 : : /* strip trailing newlines */
73 : 0 : s = overlay->path + strlen(overlay->path);
74 [ # # # # ]: 0 : while (s > overlay->path && *--s == '\n')
75 : 0 : *s = '\0';
76 : :
77 : : pr_debug("%s: path is '%s'\n", __func__, overlay->path);
78 : :
79 : 0 : err = request_firmware(&overlay->fw, overlay->path, NULL);
80 [ # # ]: 0 : if (err != 0)
81 : : goto out_err;
82 : :
83 : 0 : err = of_overlay_fdt_apply((void *)overlay->fw->data,
84 : : (u32)overlay->fw->size, &overlay->ov_id);
85 [ # # ]: 0 : if (err != 0)
86 : : goto out_err;
87 : :
88 : : return count;
89 : :
90 : : out_err:
91 : :
92 : 0 : release_firmware(overlay->fw);
93 : 0 : overlay->fw = NULL;
94 : :
95 : 0 : overlay->path[0] = '\0';
96 : 0 : return err;
97 : : }
98 : :
99 : 0 : static ssize_t cfs_overlay_item_status_show(struct config_item *item,
100 : : char *page)
101 : : {
102 : : struct cfs_overlay_item *overlay = to_cfs_overlay_item(item);
103 : :
104 [ # # ]: 0 : return sprintf(page, "%s\n",
105 : 0 : overlay->ov_id > 0 ? "applied" : "unapplied");
106 : : }
107 : :
108 : : CONFIGFS_ATTR(cfs_overlay_item_, path);
109 : : CONFIGFS_ATTR_RO(cfs_overlay_item_, status);
110 : :
111 : : static struct configfs_attribute *cfs_overlay_attrs[] = {
112 : : &cfs_overlay_item_attr_path,
113 : : &cfs_overlay_item_attr_status,
114 : : NULL,
115 : : };
116 : :
117 : 0 : ssize_t cfs_overlay_item_dtbo_read(struct config_item *item,
118 : : void *buf, size_t max_count)
119 : : {
120 : : struct cfs_overlay_item *overlay = to_cfs_overlay_item(item);
121 : :
122 : : pr_debug("%s: buf=%p max_count=%zu\n", __func__,
123 : : buf, max_count);
124 : :
125 [ # # ]: 0 : if (overlay->dtbo == NULL)
126 : : return 0;
127 : :
128 : : /* copy if buffer provided */
129 [ # # ]: 0 : if (buf != NULL) {
130 : : /* the buffer must be large enough */
131 [ # # ]: 0 : if (overlay->dtbo_size > max_count)
132 : : return -ENOSPC;
133 : :
134 : 0 : memcpy(buf, overlay->dtbo, overlay->dtbo_size);
135 : : }
136 : :
137 : 0 : return overlay->dtbo_size;
138 : : }
139 : :
140 : 0 : ssize_t cfs_overlay_item_dtbo_write(struct config_item *item,
141 : : const void *buf, size_t count)
142 : : {
143 : : struct cfs_overlay_item *overlay = to_cfs_overlay_item(item);
144 : : int err;
145 : :
146 : : /* if it's set do not allow changes */
147 [ # # # # ]: 0 : if (overlay->path[0] != '\0' || overlay->dtbo_size > 0)
148 : : return -EPERM;
149 : :
150 : : /* copy the contents */
151 : 0 : overlay->dtbo = kmemdup(buf, count, GFP_KERNEL);
152 [ # # ]: 0 : if (overlay->dtbo == NULL)
153 : : return -ENOMEM;
154 : :
155 : 0 : overlay->dtbo_size = count;
156 : :
157 : 0 : err = of_overlay_fdt_apply(overlay->dtbo, overlay->dtbo_size,
158 : : &overlay->ov_id);
159 [ # # ]: 0 : if (err != 0)
160 : : goto out_err;
161 : :
162 : : return count;
163 : :
164 : : out_err:
165 : 0 : kfree(overlay->dtbo);
166 : 0 : overlay->dtbo = NULL;
167 : 0 : overlay->dtbo_size = 0;
168 : 0 : overlay->ov_id = 0;
169 : :
170 : 0 : return err;
171 : : }
172 : :
173 : : CONFIGFS_BIN_ATTR(cfs_overlay_item_, dtbo, NULL, SZ_1M);
174 : :
175 : : static struct configfs_bin_attribute *cfs_overlay_bin_attrs[] = {
176 : : &cfs_overlay_item_attr_dtbo,
177 : : NULL,
178 : : };
179 : :
180 : 0 : static void cfs_overlay_release(struct config_item *item)
181 : : {
182 : : struct cfs_overlay_item *overlay = to_cfs_overlay_item(item);
183 : :
184 [ # # ]: 0 : if (overlay->ov_id > 0)
185 : 0 : of_overlay_remove(&overlay->ov_id);
186 [ # # ]: 0 : if (overlay->fw)
187 : 0 : release_firmware(overlay->fw);
188 : : /* kfree with NULL is safe */
189 : 0 : kfree(overlay->dtbo);
190 : 0 : kfree(overlay);
191 : 0 : }
192 : :
193 : : static struct configfs_item_operations cfs_overlay_item_ops = {
194 : : .release = cfs_overlay_release,
195 : : };
196 : :
197 : : static struct config_item_type cfs_overlay_type = {
198 : : .ct_item_ops = &cfs_overlay_item_ops,
199 : : .ct_attrs = cfs_overlay_attrs,
200 : : .ct_bin_attrs = cfs_overlay_bin_attrs,
201 : : .ct_owner = THIS_MODULE,
202 : : };
203 : :
204 : 0 : static struct config_item *cfs_overlay_group_make_item(
205 : : struct config_group *group, const char *name)
206 : : {
207 : : struct cfs_overlay_item *overlay;
208 : :
209 : 0 : overlay = kzalloc(sizeof(*overlay), GFP_KERNEL);
210 [ # # ]: 0 : if (!overlay)
211 : : return ERR_PTR(-ENOMEM);
212 : :
213 : 0 : config_item_init_type_name(&overlay->item, name, &cfs_overlay_type);
214 : 0 : return &overlay->item;
215 : : }
216 : :
217 : 0 : static void cfs_overlay_group_drop_item(struct config_group *group,
218 : : struct config_item *item)
219 : : {
220 : : struct cfs_overlay_item *overlay = to_cfs_overlay_item(item);
221 : :
222 : 0 : config_item_put(&overlay->item);
223 : 0 : }
224 : :
225 : : static struct configfs_group_operations overlays_ops = {
226 : : .make_item = cfs_overlay_group_make_item,
227 : : .drop_item = cfs_overlay_group_drop_item,
228 : : };
229 : :
230 : : static struct config_item_type overlays_type = {
231 : : .ct_group_ops = &overlays_ops,
232 : : .ct_owner = THIS_MODULE,
233 : : };
234 : :
235 : : static struct configfs_group_operations of_cfs_ops = {
236 : : /* empty - we don't allow anything to be created */
237 : : };
238 : :
239 : : static struct config_item_type of_cfs_type = {
240 : : .ct_group_ops = &of_cfs_ops,
241 : : .ct_owner = THIS_MODULE,
242 : : };
243 : :
244 : : struct config_group of_cfs_overlay_group;
245 : :
246 : : static struct configfs_subsystem of_cfs_subsys = {
247 : : .su_group = {
248 : : .cg_item = {
249 : : .ci_namebuf = "device-tree",
250 : : .ci_type = &of_cfs_type,
251 : : },
252 : : },
253 : : .su_mutex = __MUTEX_INITIALIZER(of_cfs_subsys.su_mutex),
254 : : };
255 : :
256 : 404 : static int __init of_cfs_init(void)
257 : : {
258 : : int ret;
259 : :
260 : 404 : pr_info("%s\n", __func__);
261 : :
262 : 404 : config_group_init(&of_cfs_subsys.su_group);
263 : 404 : config_group_init_type_name(&of_cfs_overlay_group, "overlays",
264 : : &overlays_type);
265 : : configfs_add_default_group(&of_cfs_overlay_group,
266 : : &of_cfs_subsys.su_group);
267 : :
268 : 404 : ret = configfs_register_subsystem(&of_cfs_subsys);
269 [ - + ]: 404 : if (ret != 0) {
270 : 0 : pr_err("%s: failed to register subsys\n", __func__);
271 : 0 : goto out;
272 : : }
273 : 404 : pr_info("%s: OK\n", __func__);
274 : : out:
275 : 404 : return ret;
276 : : }
277 : : late_initcall(of_cfs_init);
|
