1
2
3
4
5#include <linux/module.h>
6#include <linux/dnotify.h>
7#include <linux/kobject.h>
8#include <asm/uaccess.h>
9#include <asm/semaphore.h>
10
11#include "sysfs.h"
12
13#define to_subsys(k) container_of(k,struct subsystem,kset.kobj)
14#define to_sattr(a) container_of(a,struct subsys_attribute,attr)
15
16
17
18
19
20
21static ssize_t
22subsys_attr_show(struct kobject * kobj, struct attribute * attr, char * page)
23{
24 struct subsystem * s = to_subsys(kobj);
25 struct subsys_attribute * sattr = to_sattr(attr);
26 ssize_t ret = 0;
27
28 if (sattr->show)
29 ret = sattr->show(s,page);
30 return ret;
31}
32
33static ssize_t
34subsys_attr_store(struct kobject * kobj, struct attribute * attr,
35 const char * page, size_t count)
36{
37 struct subsystem * s = to_subsys(kobj);
38 struct subsys_attribute * sattr = to_sattr(attr);
39 ssize_t ret = 0;
40
41 if (sattr->store)
42 ret = sattr->store(s,page,count);
43 return ret;
44}
45
46static struct sysfs_ops subsys_sysfs_ops = {
47 .show = subsys_attr_show,
48 .store = subsys_attr_store,
49};
50
51
52struct sysfs_buffer {
53 size_t count;
54 loff_t pos;
55 char * page;
56 struct sysfs_ops * ops;
57 struct semaphore sem;
58 int needs_read_fill;
59};
60
61
62
63
64
65
66
67
68
69
70
71
72static int fill_read_buffer(struct dentry * dentry, struct sysfs_buffer * buffer)
73{
74 struct attribute * attr = to_attr(dentry);
75 struct kobject * kobj = to_kobj(dentry->d_parent);
76 struct sysfs_ops * ops = buffer->ops;
77 int ret = 0;
78 ssize_t count;
79
80 if (!buffer->page)
81 buffer->page = (char *) get_zeroed_page(GFP_KERNEL);
82 if (!buffer->page)
83 return -ENOMEM;
84
85 count = ops->show(kobj,attr,buffer->page);
86 buffer->needs_read_fill = 0;
87 BUG_ON(count > (ssize_t)PAGE_SIZE);
88 if (count >= 0)
89 buffer->count = count;
90 else
91 ret = count;
92 return ret;
93}
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108static int flush_read_buffer(struct sysfs_buffer * buffer, char __user * buf,
109 size_t count, loff_t * ppos)
110{
111 int error;
112
113 if (*ppos > buffer->count)
114 return 0;
115
116 if (count > (buffer->count - *ppos))
117 count = buffer->count - *ppos;
118
119 error = copy_to_user(buf,buffer->page + *ppos,count);
120 if (!error)
121 *ppos += count;
122 return error ? -EFAULT : count;
123}
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144static ssize_t
145sysfs_read_file(struct file *file, char __user *buf, size_t count, loff_t *ppos)
146{
147 struct sysfs_buffer * buffer = file->private_data;
148 ssize_t retval = 0;
149
150 down(&buffer->sem);
151 if (buffer->needs_read_fill) {
152 if ((retval = fill_read_buffer(file->f_dentry,buffer)))
153 goto out;
154 }
155 pr_debug("%s: count = %d, ppos = %lld, buf = %s\n",
156 __FUNCTION__,count,*ppos,buffer->page);
157 retval = flush_read_buffer(buffer,buf,count,ppos);
158out:
159 up(&buffer->sem);
160 return retval;
161}
162
163
164
165
166
167
168
169
170
171
172
173
174static int
175fill_write_buffer(struct sysfs_buffer * buffer, const char __user * buf, size_t count)
176{
177 int error;
178
179 if (!buffer->page)
180 buffer->page = (char *)get_zeroed_page(GFP_KERNEL);
181 if (!buffer->page)
182 return -ENOMEM;
183
184 if (count >= PAGE_SIZE)
185 count = PAGE_SIZE - 1;
186 error = copy_from_user(buffer->page,buf,count);
187 buffer->needs_read_fill = 1;
188 return error ? -EFAULT : count;
189}
190
191
192
193
194
195
196
197
198
199
200
201
202static int
203flush_write_buffer(struct dentry * dentry, struct sysfs_buffer * buffer, size_t count)
204{
205 struct attribute * attr = to_attr(dentry);
206 struct kobject * kobj = to_kobj(dentry->d_parent);
207 struct sysfs_ops * ops = buffer->ops;
208
209 return ops->store(kobj,attr,buffer->page,count);
210}
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230static ssize_t
231sysfs_write_file(struct file *file, const char __user *buf, size_t count, loff_t *ppos)
232{
233 struct sysfs_buffer * buffer = file->private_data;
234 ssize_t len;
235
236 down(&buffer->sem);
237 len = fill_write_buffer(buffer, buf, count);
238 if (len > 0)
239 len = flush_write_buffer(file->f_dentry, buffer, len);
240 if (len > 0)
241 *ppos += len;
242 up(&buffer->sem);
243 return len;
244}
245
246static int check_perm(struct inode * inode, struct file * file)
247{
248 struct kobject *kobj = sysfs_get_kobject(file->f_dentry->d_parent);
249 struct attribute * attr = to_attr(file->f_dentry);
250 struct sysfs_buffer * buffer;
251 struct sysfs_ops * ops = NULL;
252 int error = 0;
253
254 if (!kobj || !attr)
255 goto Einval;
256
257
258 if (!try_module_get(attr->owner)) {
259 error = -ENODEV;
260 goto Done;
261 }
262
263
264
265
266 if (kobj->kset && kobj->kset->ktype)
267 ops = kobj->kset->ktype->sysfs_ops;
268 else if (kobj->ktype)
269 ops = kobj->ktype->sysfs_ops;
270 else
271 ops = &subsys_sysfs_ops;
272
273
274
275
276 if (!ops)
277 goto Eaccess;
278
279
280
281
282
283 if (file->f_mode & FMODE_WRITE) {
284
285 if (!(inode->i_mode & S_IWUGO) || !ops->store)
286 goto Eaccess;
287
288 }
289
290
291
292
293
294 if (file->f_mode & FMODE_READ) {
295 if (!(inode->i_mode & S_IRUGO) || !ops->show)
296 goto Eaccess;
297 }
298
299
300
301
302 buffer = kmalloc(sizeof(struct sysfs_buffer),GFP_KERNEL);
303 if (buffer) {
304 memset(buffer,0,sizeof(struct sysfs_buffer));
305 init_MUTEX(&buffer->sem);
306 buffer->needs_read_fill = 1;
307 buffer->ops = ops;
308 file->private_data = buffer;
309 } else
310 error = -ENOMEM;
311 goto Done;
312
313 Einval:
314 error = -EINVAL;
315 goto Done;
316 Eaccess:
317 error = -EACCES;
318 module_put(attr->owner);
319 Done:
320 if (error && kobj)
321 kobject_put(kobj);
322 return error;
323}
324
325static int sysfs_open_file(struct inode * inode, struct file * filp)
326{
327 return check_perm(inode,filp);
328}
329
330static int sysfs_release(struct inode * inode, struct file * filp)
331{
332 struct kobject * kobj = to_kobj(filp->f_dentry->d_parent);
333 struct attribute * attr = to_attr(filp->f_dentry);
334 struct module * owner = attr->owner;
335 struct sysfs_buffer * buffer = filp->private_data;
336
337 if (kobj)
338 kobject_put(kobj);
339
340 module_put(owner);
341
342 if (buffer) {
343 if (buffer->page)
344 free_page((unsigned long)buffer->page);
345 kfree(buffer);
346 }
347 return 0;
348}
349
350struct file_operations sysfs_file_operations = {
351 .read = sysfs_read_file,
352 .write = sysfs_write_file,
353 .llseek = generic_file_llseek,
354 .open = sysfs_open_file,
355 .release = sysfs_release,
356};
357
358
359int sysfs_add_file(struct dentry * dir, const struct attribute * attr, int type)
360{
361 struct sysfs_dirent * parent_sd = dir->d_fsdata;
362 umode_t mode = (attr->mode & S_IALLUGO) | S_IFREG;
363 int error = 0;
364
365 down(&dir->d_inode->i_sem);
366 error = sysfs_make_dirent(parent_sd, NULL, (void *) attr, mode, type);
367 up(&dir->d_inode->i_sem);
368
369 return error;
370}
371
372
373
374
375
376
377
378
379int sysfs_create_file(struct kobject * kobj, const struct attribute * attr)
380{
381 BUG_ON(!kobj || !kobj->dentry || !attr);
382
383 return sysfs_add_file(kobj->dentry, attr, SYSFS_KOBJ_ATTR);
384
385}
386
387
388
389
390
391
392
393
394
395
396int sysfs_update_file(struct kobject * kobj, const struct attribute * attr)
397{
398 struct dentry * dir = kobj->dentry;
399 struct dentry * victim;
400 int res = -ENOENT;
401
402 down(&dir->d_inode->i_sem);
403 victim = sysfs_get_dentry(dir, attr->name);
404 if (!IS_ERR(victim)) {
405
406 if (victim->d_inode &&
407 (victim->d_parent->d_inode == dir->d_inode)) {
408 victim->d_inode->i_mtime = CURRENT_TIME;
409 dnotify_parent(victim, DN_MODIFY);
410
411
412
413
414 dput(victim);
415 res = 0;
416 } else
417 d_drop(victim);
418
419
420
421
422 dput(victim);
423 }
424 up(&dir->d_inode->i_sem);
425
426 return res;
427}
428
429
430
431
432
433
434
435
436
437
438void sysfs_remove_file(struct kobject * kobj, const struct attribute * attr)
439{
440 sysfs_hash_and_remove(kobj->dentry,attr->name);
441}
442
443
444EXPORT_SYMBOL_GPL(sysfs_create_file);
445EXPORT_SYMBOL_GPL(sysfs_remove_file);
446EXPORT_SYMBOL_GPL(sysfs_update_file);
447
448