1
2
3
4
5
6
7
8
9
10
11
12
13#include <linux/module.h>
14#include <linux/kobject.h>
15#include <linux/kallsyms.h>
16#include <linux/slab.h>
17#include <linux/fsnotify.h>
18#include <linux/namei.h>
19#include <linux/poll.h>
20#include <linux/list.h>
21#include <linux/mutex.h>
22#include <linux/limits.h>
23#include <asm/uaccess.h>
24
25#include "sysfs.h"
26
27
28static char last_sysfs_file[PATH_MAX];
29void sysfs_printk_last_file(void)
30{
31 printk(KERN_EMERG "last sysfs file: %s\n", last_sysfs_file);
32}
33
34
35
36
37
38
39
40
41
42
43static DEFINE_SPINLOCK(sysfs_open_dirent_lock);
44
45struct sysfs_open_dirent {
46 atomic_t refcnt;
47 atomic_t event;
48 wait_queue_head_t poll;
49 struct list_head buffers;
50};
51
52struct sysfs_buffer {
53 size_t count;
54 loff_t pos;
55 char * page;
56 struct sysfs_ops * ops;
57 struct mutex mutex;
58 int needs_read_fill;
59 int event;
60 struct list_head list;
61};
62
63
64
65
66
67
68
69
70
71
72
73
74static int fill_read_buffer(struct dentry * dentry, struct sysfs_buffer * buffer)
75{
76 struct sysfs_dirent *attr_sd = dentry->d_fsdata;
77 struct kobject *kobj = attr_sd->s_parent->s_dir.kobj;
78 struct sysfs_ops * ops = buffer->ops;
79 int ret = 0;
80 ssize_t count;
81
82 if (!buffer->page)
83 buffer->page = (char *) get_zeroed_page(GFP_KERNEL);
84 if (!buffer->page)
85 return -ENOMEM;
86
87
88 if (!sysfs_get_active_two(attr_sd))
89 return -ENODEV;
90
91 buffer->event = atomic_read(&attr_sd->s_attr.open->event);
92 count = ops->show(kobj, attr_sd->s_attr.attr, buffer->page);
93
94 sysfs_put_active_two(attr_sd);
95
96
97
98
99
100 if (count >= (ssize_t)PAGE_SIZE) {
101 print_symbol("fill_read_buffer: %s returned bad count\n",
102 (unsigned long)ops->show);
103
104 count = PAGE_SIZE - 1;
105 }
106 if (count >= 0) {
107 buffer->needs_read_fill = 0;
108 buffer->count = count;
109 } else {
110 ret = count;
111 }
112 return ret;
113}
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134static ssize_t
135sysfs_read_file(struct file *file, char __user *buf, size_t count, loff_t *ppos)
136{
137 struct sysfs_buffer * buffer = file->private_data;
138 ssize_t retval = 0;
139
140 mutex_lock(&buffer->mutex);
141 if (buffer->needs_read_fill || *ppos == 0) {
142 retval = fill_read_buffer(file->f_path.dentry,buffer);
143 if (retval)
144 goto out;
145 }
146 pr_debug("%s: count = %zd, ppos = %lld, buf = %s\n",
147 __func__, count, *ppos, buffer->page);
148 retval = simple_read_from_buffer(buf, count, ppos, buffer->page,
149 buffer->count);
150out:
151 mutex_unlock(&buffer->mutex);
152 return retval;
153}
154
155
156
157
158
159
160
161
162
163
164
165static int
166fill_write_buffer(struct sysfs_buffer * buffer, const char __user * buf, size_t count)
167{
168 int error;
169
170 if (!buffer->page)
171 buffer->page = (char *)get_zeroed_page(GFP_KERNEL);
172 if (!buffer->page)
173 return -ENOMEM;
174
175 if (count >= PAGE_SIZE)
176 count = PAGE_SIZE - 1;
177 error = copy_from_user(buffer->page,buf,count);
178 buffer->needs_read_fill = 1;
179
180
181 buffer->page[count] = 0;
182 return error ? -EFAULT : count;
183}
184
185
186
187
188
189
190
191
192
193
194
195
196
197static int
198flush_write_buffer(struct dentry * dentry, struct sysfs_buffer * buffer, size_t count)
199{
200 struct sysfs_dirent *attr_sd = dentry->d_fsdata;
201 struct kobject *kobj = attr_sd->s_parent->s_dir.kobj;
202 struct sysfs_ops * ops = buffer->ops;
203 int rc;
204
205
206 if (!sysfs_get_active_two(attr_sd))
207 return -ENODEV;
208
209 rc = ops->store(kobj, attr_sd->s_attr.attr, buffer->page, count);
210
211 sysfs_put_active_two(attr_sd);
212
213 return rc;
214}
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234static ssize_t
235sysfs_write_file(struct file *file, const char __user *buf, size_t count, loff_t *ppos)
236{
237 struct sysfs_buffer * buffer = file->private_data;
238 ssize_t len;
239
240 mutex_lock(&buffer->mutex);
241 len = fill_write_buffer(buffer, buf, count);
242 if (len > 0)
243 len = flush_write_buffer(file->f_path.dentry, buffer, len);
244 if (len > 0)
245 *ppos += len;
246 mutex_unlock(&buffer->mutex);
247 return len;
248}
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265static int sysfs_get_open_dirent(struct sysfs_dirent *sd,
266 struct sysfs_buffer *buffer)
267{
268 struct sysfs_open_dirent *od, *new_od = NULL;
269
270 retry:
271 spin_lock_irq(&sysfs_open_dirent_lock);
272
273 if (!sd->s_attr.open && new_od) {
274 sd->s_attr.open = new_od;
275 new_od = NULL;
276 }
277
278 od = sd->s_attr.open;
279 if (od) {
280 atomic_inc(&od->refcnt);
281 list_add_tail(&buffer->list, &od->buffers);
282 }
283
284 spin_unlock_irq(&sysfs_open_dirent_lock);
285
286 if (od) {
287 kfree(new_od);
288 return 0;
289 }
290
291
292 new_od = kmalloc(sizeof(*new_od), GFP_KERNEL);
293 if (!new_od)
294 return -ENOMEM;
295
296 atomic_set(&new_od->refcnt, 0);
297 atomic_set(&new_od->event, 1);
298 init_waitqueue_head(&new_od->poll);
299 INIT_LIST_HEAD(&new_od->buffers);
300 goto retry;
301}
302
303
304
305
306
307
308
309
310
311
312
313
314static void sysfs_put_open_dirent(struct sysfs_dirent *sd,
315 struct sysfs_buffer *buffer)
316{
317 struct sysfs_open_dirent *od = sd->s_attr.open;
318 unsigned long flags;
319
320 spin_lock_irqsave(&sysfs_open_dirent_lock, flags);
321
322 list_del(&buffer->list);
323 if (atomic_dec_and_test(&od->refcnt))
324 sd->s_attr.open = NULL;
325 else
326 od = NULL;
327
328 spin_unlock_irqrestore(&sysfs_open_dirent_lock, flags);
329
330 kfree(od);
331}
332
333static int sysfs_open_file(struct inode *inode, struct file *file)
334{
335 struct sysfs_dirent *attr_sd = file->f_path.dentry->d_fsdata;
336 struct kobject *kobj = attr_sd->s_parent->s_dir.kobj;
337 struct sysfs_buffer *buffer;
338 struct sysfs_ops *ops;
339 int error = -EACCES;
340 char *p;
341
342 p = d_path(&file->f_path, last_sysfs_file, sizeof(last_sysfs_file));
343 if (p)
344 memmove(last_sysfs_file, p, strlen(p) + 1);
345
346
347 if (!sysfs_get_active_two(attr_sd))
348 return -ENODEV;
349
350
351 if (kobj->ktype && kobj->ktype->sysfs_ops)
352 ops = kobj->ktype->sysfs_ops;
353 else {
354 WARN(1, KERN_ERR "missing sysfs attribute operations for "
355 "kobject: %s\n", kobject_name(kobj));
356 goto err_out;
357 }
358
359
360
361
362
363 if (file->f_mode & FMODE_WRITE) {
364 if (!(inode->i_mode & S_IWUGO) || !ops->store)
365 goto err_out;
366 }
367
368
369
370
371
372 if (file->f_mode & FMODE_READ) {
373 if (!(inode->i_mode & S_IRUGO) || !ops->show)
374 goto err_out;
375 }
376
377
378
379
380 error = -ENOMEM;
381 buffer = kzalloc(sizeof(struct sysfs_buffer), GFP_KERNEL);
382 if (!buffer)
383 goto err_out;
384
385 mutex_init(&buffer->mutex);
386 buffer->needs_read_fill = 1;
387 buffer->ops = ops;
388 file->private_data = buffer;
389
390
391 error = sysfs_get_open_dirent(attr_sd, buffer);
392 if (error)
393 goto err_free;
394
395
396 sysfs_put_active_two(attr_sd);
397 return 0;
398
399 err_free:
400 kfree(buffer);
401 err_out:
402 sysfs_put_active_two(attr_sd);
403 return error;
404}
405
406static int sysfs_release(struct inode *inode, struct file *filp)
407{
408 struct sysfs_dirent *sd = filp->f_path.dentry->d_fsdata;
409 struct sysfs_buffer *buffer = filp->private_data;
410
411 sysfs_put_open_dirent(sd, buffer);
412
413 if (buffer->page)
414 free_page((unsigned long)buffer->page);
415 kfree(buffer);
416
417 return 0;
418}
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433static unsigned int sysfs_poll(struct file *filp, poll_table *wait)
434{
435 struct sysfs_buffer * buffer = filp->private_data;
436 struct sysfs_dirent *attr_sd = filp->f_path.dentry->d_fsdata;
437 struct sysfs_open_dirent *od = attr_sd->s_attr.open;
438
439
440 if (!sysfs_get_active_two(attr_sd))
441 goto trigger;
442
443 poll_wait(filp, &od->poll, wait);
444
445 sysfs_put_active_two(attr_sd);
446
447 if (buffer->event != atomic_read(&od->event))
448 goto trigger;
449
450 return DEFAULT_POLLMASK;
451
452 trigger:
453 buffer->needs_read_fill = 1;
454 return DEFAULT_POLLMASK|POLLERR|POLLPRI;
455}
456
457void sysfs_notify_dirent(struct sysfs_dirent *sd)
458{
459 struct sysfs_open_dirent *od;
460 unsigned long flags;
461
462 spin_lock_irqsave(&sysfs_open_dirent_lock, flags);
463
464 od = sd->s_attr.open;
465 if (od) {
466 atomic_inc(&od->event);
467 wake_up_interruptible(&od->poll);
468 }
469
470 spin_unlock_irqrestore(&sysfs_open_dirent_lock, flags);
471}
472EXPORT_SYMBOL_GPL(sysfs_notify_dirent);
473
474void sysfs_notify(struct kobject *k, const char *dir, const char *attr)
475{
476 struct sysfs_dirent *sd = k->sd;
477
478 mutex_lock(&sysfs_mutex);
479
480 if (sd && dir)
481 sd = sysfs_find_dirent(sd, dir);
482 if (sd && attr)
483 sd = sysfs_find_dirent(sd, attr);
484 if (sd)
485 sysfs_notify_dirent(sd);
486
487 mutex_unlock(&sysfs_mutex);
488}
489EXPORT_SYMBOL_GPL(sysfs_notify);
490
491const struct file_operations sysfs_file_operations = {
492 .read = sysfs_read_file,
493 .write = sysfs_write_file,
494 .llseek = generic_file_llseek,
495 .open = sysfs_open_file,
496 .release = sysfs_release,
497 .poll = sysfs_poll,
498};
499
500int sysfs_add_file_mode(struct sysfs_dirent *dir_sd,
501 const struct attribute *attr, int type, mode_t amode)
502{
503 umode_t mode = (amode & S_IALLUGO) | S_IFREG;
504 struct sysfs_addrm_cxt acxt;
505 struct sysfs_dirent *sd;
506 int rc;
507
508 sd = sysfs_new_dirent(attr->name, mode, type);
509 if (!sd)
510 return -ENOMEM;
511 sd->s_attr.attr = (void *)attr;
512
513 sysfs_addrm_start(&acxt, dir_sd);
514 rc = sysfs_add_one(&acxt, sd);
515 sysfs_addrm_finish(&acxt);
516
517 if (rc)
518 sysfs_put(sd);
519
520 return rc;
521}
522
523
524int sysfs_add_file(struct sysfs_dirent *dir_sd, const struct attribute *attr,
525 int type)
526{
527 return sysfs_add_file_mode(dir_sd, attr, type, attr->mode);
528}
529
530
531
532
533
534
535
536
537int sysfs_create_file(struct kobject * kobj, const struct attribute * attr)
538{
539 BUG_ON(!kobj || !kobj->sd || !attr);
540
541 return sysfs_add_file(kobj->sd, attr, SYSFS_KOBJ_ATTR);
542
543}
544
545
546
547
548
549
550
551
552int sysfs_add_file_to_group(struct kobject *kobj,
553 const struct attribute *attr, const char *group)
554{
555 struct sysfs_dirent *dir_sd;
556 int error;
557
558 if (group)
559 dir_sd = sysfs_get_dirent(kobj->sd, group);
560 else
561 dir_sd = sysfs_get(kobj->sd);
562
563 if (!dir_sd)
564 return -ENOENT;
565
566 error = sysfs_add_file(dir_sd, attr, SYSFS_KOBJ_ATTR);
567 sysfs_put(dir_sd);
568
569 return error;
570}
571EXPORT_SYMBOL_GPL(sysfs_add_file_to_group);
572
573
574
575
576
577
578
579
580int sysfs_chmod_file(struct kobject *kobj, struct attribute *attr, mode_t mode)
581{
582 struct sysfs_dirent *victim_sd = NULL;
583 struct dentry *victim = NULL;
584 struct inode * inode;
585 struct iattr newattrs;
586 int rc;
587
588 rc = -ENOENT;
589 victim_sd = sysfs_get_dirent(kobj->sd, attr->name);
590 if (!victim_sd)
591 goto out;
592
593 mutex_lock(&sysfs_rename_mutex);
594 victim = sysfs_get_dentry(victim_sd);
595 mutex_unlock(&sysfs_rename_mutex);
596 if (IS_ERR(victim)) {
597 rc = PTR_ERR(victim);
598 victim = NULL;
599 goto out;
600 }
601
602 inode = victim->d_inode;
603
604 mutex_lock(&inode->i_mutex);
605
606 newattrs.ia_mode = (mode & S_IALLUGO) | (inode->i_mode & ~S_IALLUGO);
607 newattrs.ia_valid = ATTR_MODE | ATTR_CTIME;
608 newattrs.ia_ctime = current_fs_time(inode->i_sb);
609 rc = sysfs_setattr(victim, &newattrs);
610
611 if (rc == 0) {
612 fsnotify_change(victim, newattrs.ia_valid);
613 mutex_lock(&sysfs_mutex);
614 victim_sd->s_mode = newattrs.ia_mode;
615 mutex_unlock(&sysfs_mutex);
616 }
617
618 mutex_unlock(&inode->i_mutex);
619 out:
620 dput(victim);
621 sysfs_put(victim_sd);
622 return rc;
623}
624EXPORT_SYMBOL_GPL(sysfs_chmod_file);
625
626
627
628
629
630
631
632
633
634
635void sysfs_remove_file(struct kobject * kobj, const struct attribute * attr)
636{
637 sysfs_hash_and_remove(kobj->sd, attr->name);
638}
639
640
641
642
643
644
645
646
647void sysfs_remove_file_from_group(struct kobject *kobj,
648 const struct attribute *attr, const char *group)
649{
650 struct sysfs_dirent *dir_sd;
651
652 if (group)
653 dir_sd = sysfs_get_dirent(kobj->sd, group);
654 else
655 dir_sd = sysfs_get(kobj->sd);
656 if (dir_sd) {
657 sysfs_hash_and_remove(dir_sd, attr->name);
658 sysfs_put(dir_sd);
659 }
660}
661EXPORT_SYMBOL_GPL(sysfs_remove_file_from_group);
662
663struct sysfs_schedule_callback_struct {
664 struct list_head workq_list;
665 struct kobject *kobj;
666 void (*func)(void *);
667 void *data;
668 struct module *owner;
669 struct work_struct work;
670};
671
672static struct workqueue_struct *sysfs_workqueue;
673static DEFINE_MUTEX(sysfs_workq_mutex);
674static LIST_HEAD(sysfs_workq);
675static void sysfs_schedule_callback_work(struct work_struct *work)
676{
677 struct sysfs_schedule_callback_struct *ss = container_of(work,
678 struct sysfs_schedule_callback_struct, work);
679
680 (ss->func)(ss->data);
681 kobject_put(ss->kobj);
682 module_put(ss->owner);
683 mutex_lock(&sysfs_workq_mutex);
684 list_del(&ss->workq_list);
685 mutex_unlock(&sysfs_workq_mutex);
686 kfree(ss);
687}
688
689
690
691
692
693
694
695
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710int sysfs_schedule_callback(struct kobject *kobj, void (*func)(void *),
711 void *data, struct module *owner)
712{
713 struct sysfs_schedule_callback_struct *ss, *tmp;
714
715 if (!try_module_get(owner))
716 return -ENODEV;
717
718 mutex_lock(&sysfs_workq_mutex);
719 list_for_each_entry_safe(ss, tmp, &sysfs_workq, workq_list)
720 if (ss->kobj == kobj) {
721 module_put(owner);
722 mutex_unlock(&sysfs_workq_mutex);
723 return -EAGAIN;
724 }
725 mutex_unlock(&sysfs_workq_mutex);
726
727 if (sysfs_workqueue == NULL) {
728 sysfs_workqueue = create_singlethread_workqueue("sysfsd");
729 if (sysfs_workqueue == NULL) {
730 module_put(owner);
731 return -ENOMEM;
732 }
733 }
734
735 ss = kmalloc(sizeof(*ss), GFP_KERNEL);
736 if (!ss) {
737 module_put(owner);
738 return -ENOMEM;
739 }
740 kobject_get(kobj);
741 ss->kobj = kobj;
742 ss->func = func;
743 ss->data = data;
744 ss->owner = owner;
745 INIT_WORK(&ss->work, sysfs_schedule_callback_work);
746 INIT_LIST_HEAD(&ss->workq_list);
747 mutex_lock(&sysfs_workq_mutex);
748 list_add_tail(&ss->workq_list, &sysfs_workq);
749 mutex_unlock(&sysfs_workq_mutex);
750 queue_work(sysfs_workqueue, &ss->work);
751 return 0;
752}
753EXPORT_SYMBOL_GPL(sysfs_schedule_callback);
754
755
756EXPORT_SYMBOL_GPL(sysfs_create_file);
757EXPORT_SYMBOL_GPL(sysfs_remove_file);
758