V4L/DVB (8918): saa6752hs: simplify writing to registers
[linux-2.6] / fs / sysfs / file.c
1 /*
2  * fs/sysfs/file.c - sysfs regular (text) file implementation
3  *
4  * Copyright (c) 2001-3 Patrick Mochel
5  * Copyright (c) 2007 SUSE Linux Products GmbH
6  * Copyright (c) 2007 Tejun Heo <teheo@suse.de>
7  *
8  * This file is released under the GPLv2.
9  *
10  * Please see Documentation/filesystems/sysfs.txt for more information.
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 <asm/uaccess.h>
23
24 #include "sysfs.h"
25
26 /*
27  * There's one sysfs_buffer for each open file and one
28  * sysfs_open_dirent for each sysfs_dirent with one or more open
29  * files.
30  *
31  * filp->private_data points to sysfs_buffer and
32  * sysfs_dirent->s_attr.open points to sysfs_open_dirent.  s_attr.open
33  * is protected by sysfs_open_dirent_lock.
34  */
35 static DEFINE_SPINLOCK(sysfs_open_dirent_lock);
36
37 struct sysfs_open_dirent {
38         atomic_t                refcnt;
39         atomic_t                event;
40         wait_queue_head_t       poll;
41         struct list_head        buffers; /* goes through sysfs_buffer.list */
42 };
43
44 struct sysfs_buffer {
45         size_t                  count;
46         loff_t                  pos;
47         char                    * page;
48         struct sysfs_ops        * ops;
49         struct mutex            mutex;
50         int                     needs_read_fill;
51         int                     event;
52         struct list_head        list;
53 };
54
55 /**
56  *      fill_read_buffer - allocate and fill buffer from object.
57  *      @dentry:        dentry pointer.
58  *      @buffer:        data buffer for file.
59  *
60  *      Allocate @buffer->page, if it hasn't been already, then call the
61  *      kobject's show() method to fill the buffer with this attribute's 
62  *      data. 
63  *      This is called only once, on the file's first read unless an error
64  *      is returned.
65  */
66 static int fill_read_buffer(struct dentry * dentry, struct sysfs_buffer * buffer)
67 {
68         struct sysfs_dirent *attr_sd = dentry->d_fsdata;
69         struct kobject *kobj = attr_sd->s_parent->s_dir.kobj;
70         struct sysfs_ops * ops = buffer->ops;
71         int ret = 0;
72         ssize_t count;
73
74         if (!buffer->page)
75                 buffer->page = (char *) get_zeroed_page(GFP_KERNEL);
76         if (!buffer->page)
77                 return -ENOMEM;
78
79         /* need attr_sd for attr and ops, its parent for kobj */
80         if (!sysfs_get_active_two(attr_sd))
81                 return -ENODEV;
82
83         buffer->event = atomic_read(&attr_sd->s_attr.open->event);
84         count = ops->show(kobj, attr_sd->s_attr.attr, buffer->page);
85
86         sysfs_put_active_two(attr_sd);
87
88         /*
89          * The code works fine with PAGE_SIZE return but it's likely to
90          * indicate truncated result or overflow in normal use cases.
91          */
92         if (count >= (ssize_t)PAGE_SIZE) {
93                 print_symbol("fill_read_buffer: %s returned bad count\n",
94                         (unsigned long)ops->show);
95                 /* Try to struggle along */
96                 count = PAGE_SIZE - 1;
97         }
98         if (count >= 0) {
99                 buffer->needs_read_fill = 0;
100                 buffer->count = count;
101         } else {
102                 ret = count;
103         }
104         return ret;
105 }
106
107 /**
108  *      sysfs_read_file - read an attribute. 
109  *      @file:  file pointer.
110  *      @buf:   buffer to fill.
111  *      @count: number of bytes to read.
112  *      @ppos:  starting offset in file.
113  *
114  *      Userspace wants to read an attribute file. The attribute descriptor
115  *      is in the file's ->d_fsdata. The target object is in the directory's
116  *      ->d_fsdata.
117  *
118  *      We call fill_read_buffer() to allocate and fill the buffer from the
119  *      object's show() method exactly once (if the read is happening from
120  *      the beginning of the file). That should fill the entire buffer with
121  *      all the data the object has to offer for that attribute.
122  *      We then call flush_read_buffer() to copy the buffer to userspace
123  *      in the increments specified.
124  */
125
126 static ssize_t
127 sysfs_read_file(struct file *file, char __user *buf, size_t count, loff_t *ppos)
128 {
129         struct sysfs_buffer * buffer = file->private_data;
130         ssize_t retval = 0;
131
132         mutex_lock(&buffer->mutex);
133         if (buffer->needs_read_fill || *ppos == 0) {
134                 retval = fill_read_buffer(file->f_path.dentry,buffer);
135                 if (retval)
136                         goto out;
137         }
138         pr_debug("%s: count = %zd, ppos = %lld, buf = %s\n",
139                  __func__, count, *ppos, buffer->page);
140         retval = simple_read_from_buffer(buf, count, ppos, buffer->page,
141                                          buffer->count);
142 out:
143         mutex_unlock(&buffer->mutex);
144         return retval;
145 }
146
147 /**
148  *      fill_write_buffer - copy buffer from userspace.
149  *      @buffer:        data buffer for file.
150  *      @buf:           data from user.
151  *      @count:         number of bytes in @userbuf.
152  *
153  *      Allocate @buffer->page if it hasn't been already, then
154  *      copy the user-supplied buffer into it.
155  */
156
157 static int 
158 fill_write_buffer(struct sysfs_buffer * buffer, const char __user * buf, size_t count)
159 {
160         int error;
161
162         if (!buffer->page)
163                 buffer->page = (char *)get_zeroed_page(GFP_KERNEL);
164         if (!buffer->page)
165                 return -ENOMEM;
166
167         if (count >= PAGE_SIZE)
168                 count = PAGE_SIZE - 1;
169         error = copy_from_user(buffer->page,buf,count);
170         buffer->needs_read_fill = 1;
171         /* if buf is assumed to contain a string, terminate it by \0,
172            so e.g. sscanf() can scan the string easily */
173         buffer->page[count] = 0;
174         return error ? -EFAULT : count;
175 }
176
177
178 /**
179  *      flush_write_buffer - push buffer to kobject.
180  *      @dentry:        dentry to the attribute
181  *      @buffer:        data buffer for file.
182  *      @count:         number of bytes
183  *
184  *      Get the correct pointers for the kobject and the attribute we're
185  *      dealing with, then call the store() method for the attribute, 
186  *      passing the buffer that we acquired in fill_write_buffer().
187  */
188
189 static int
190 flush_write_buffer(struct dentry * dentry, struct sysfs_buffer * buffer, size_t count)
191 {
192         struct sysfs_dirent *attr_sd = dentry->d_fsdata;
193         struct kobject *kobj = attr_sd->s_parent->s_dir.kobj;
194         struct sysfs_ops * ops = buffer->ops;
195         int rc;
196
197         /* need attr_sd for attr and ops, its parent for kobj */
198         if (!sysfs_get_active_two(attr_sd))
199                 return -ENODEV;
200
201         rc = ops->store(kobj, attr_sd->s_attr.attr, buffer->page, count);
202
203         sysfs_put_active_two(attr_sd);
204
205         return rc;
206 }
207
208
209 /**
210  *      sysfs_write_file - write an attribute.
211  *      @file:  file pointer
212  *      @buf:   data to write
213  *      @count: number of bytes
214  *      @ppos:  starting offset
215  *
216  *      Similar to sysfs_read_file(), though working in the opposite direction.
217  *      We allocate and fill the data from the user in fill_write_buffer(),
218  *      then push it to the kobject in flush_write_buffer().
219  *      There is no easy way for us to know if userspace is only doing a partial
220  *      write, so we don't support them. We expect the entire buffer to come
221  *      on the first write. 
222  *      Hint: if you're writing a value, first read the file, modify only the
223  *      the value you're changing, then write entire buffer back. 
224  */
225
226 static ssize_t
227 sysfs_write_file(struct file *file, const char __user *buf, size_t count, loff_t *ppos)
228 {
229         struct sysfs_buffer * buffer = file->private_data;
230         ssize_t len;
231
232         mutex_lock(&buffer->mutex);
233         len = fill_write_buffer(buffer, buf, count);
234         if (len > 0)
235                 len = flush_write_buffer(file->f_path.dentry, buffer, len);
236         if (len > 0)
237                 *ppos += len;
238         mutex_unlock(&buffer->mutex);
239         return len;
240 }
241
242 /**
243  *      sysfs_get_open_dirent - get or create sysfs_open_dirent
244  *      @sd: target sysfs_dirent
245  *      @buffer: sysfs_buffer for this instance of open
246  *
247  *      If @sd->s_attr.open exists, increment its reference count;
248  *      otherwise, create one.  @buffer is chained to the buffers
249  *      list.
250  *
251  *      LOCKING:
252  *      Kernel thread context (may sleep).
253  *
254  *      RETURNS:
255  *      0 on success, -errno on failure.
256  */
257 static int sysfs_get_open_dirent(struct sysfs_dirent *sd,
258                                  struct sysfs_buffer *buffer)
259 {
260         struct sysfs_open_dirent *od, *new_od = NULL;
261
262  retry:
263         spin_lock(&sysfs_open_dirent_lock);
264
265         if (!sd->s_attr.open && new_od) {
266                 sd->s_attr.open = new_od;
267                 new_od = NULL;
268         }
269
270         od = sd->s_attr.open;
271         if (od) {
272                 atomic_inc(&od->refcnt);
273                 list_add_tail(&buffer->list, &od->buffers);
274         }
275
276         spin_unlock(&sysfs_open_dirent_lock);
277
278         if (od) {
279                 kfree(new_od);
280                 return 0;
281         }
282
283         /* not there, initialize a new one and retry */
284         new_od = kmalloc(sizeof(*new_od), GFP_KERNEL);
285         if (!new_od)
286                 return -ENOMEM;
287
288         atomic_set(&new_od->refcnt, 0);
289         atomic_set(&new_od->event, 1);
290         init_waitqueue_head(&new_od->poll);
291         INIT_LIST_HEAD(&new_od->buffers);
292         goto retry;
293 }
294
295 /**
296  *      sysfs_put_open_dirent - put sysfs_open_dirent
297  *      @sd: target sysfs_dirent
298  *      @buffer: associated sysfs_buffer
299  *
300  *      Put @sd->s_attr.open and unlink @buffer from the buffers list.
301  *      If reference count reaches zero, disassociate and free it.
302  *
303  *      LOCKING:
304  *      None.
305  */
306 static void sysfs_put_open_dirent(struct sysfs_dirent *sd,
307                                   struct sysfs_buffer *buffer)
308 {
309         struct sysfs_open_dirent *od = sd->s_attr.open;
310
311         spin_lock(&sysfs_open_dirent_lock);
312
313         list_del(&buffer->list);
314         if (atomic_dec_and_test(&od->refcnt))
315                 sd->s_attr.open = NULL;
316         else
317                 od = NULL;
318
319         spin_unlock(&sysfs_open_dirent_lock);
320
321         kfree(od);
322 }
323
324 static int sysfs_open_file(struct inode *inode, struct file *file)
325 {
326         struct sysfs_dirent *attr_sd = file->f_path.dentry->d_fsdata;
327         struct kobject *kobj = attr_sd->s_parent->s_dir.kobj;
328         struct sysfs_buffer *buffer;
329         struct sysfs_ops *ops;
330         int error = -EACCES;
331
332         /* need attr_sd for attr and ops, its parent for kobj */
333         if (!sysfs_get_active_two(attr_sd))
334                 return -ENODEV;
335
336         /* every kobject with an attribute needs a ktype assigned */
337         if (kobj->ktype && kobj->ktype->sysfs_ops)
338                 ops = kobj->ktype->sysfs_ops;
339         else {
340                 WARN(1, KERN_ERR "missing sysfs attribute operations for "
341                        "kobject: %s\n", kobject_name(kobj));
342                 goto err_out;
343         }
344
345         /* File needs write support.
346          * The inode's perms must say it's ok, 
347          * and we must have a store method.
348          */
349         if (file->f_mode & FMODE_WRITE) {
350                 if (!(inode->i_mode & S_IWUGO) || !ops->store)
351                         goto err_out;
352         }
353
354         /* File needs read support.
355          * The inode's perms must say it's ok, and we there
356          * must be a show method for it.
357          */
358         if (file->f_mode & FMODE_READ) {
359                 if (!(inode->i_mode & S_IRUGO) || !ops->show)
360                         goto err_out;
361         }
362
363         /* No error? Great, allocate a buffer for the file, and store it
364          * it in file->private_data for easy access.
365          */
366         error = -ENOMEM;
367         buffer = kzalloc(sizeof(struct sysfs_buffer), GFP_KERNEL);
368         if (!buffer)
369                 goto err_out;
370
371         mutex_init(&buffer->mutex);
372         buffer->needs_read_fill = 1;
373         buffer->ops = ops;
374         file->private_data = buffer;
375
376         /* make sure we have open dirent struct */
377         error = sysfs_get_open_dirent(attr_sd, buffer);
378         if (error)
379                 goto err_free;
380
381         /* open succeeded, put active references */
382         sysfs_put_active_two(attr_sd);
383         return 0;
384
385  err_free:
386         kfree(buffer);
387  err_out:
388         sysfs_put_active_two(attr_sd);
389         return error;
390 }
391
392 static int sysfs_release(struct inode *inode, struct file *filp)
393 {
394         struct sysfs_dirent *sd = filp->f_path.dentry->d_fsdata;
395         struct sysfs_buffer *buffer = filp->private_data;
396
397         sysfs_put_open_dirent(sd, buffer);
398
399         if (buffer->page)
400                 free_page((unsigned long)buffer->page);
401         kfree(buffer);
402
403         return 0;
404 }
405
406 /* Sysfs attribute files are pollable.  The idea is that you read
407  * the content and then you use 'poll' or 'select' to wait for
408  * the content to change.  When the content changes (assuming the
409  * manager for the kobject supports notification), poll will
410  * return POLLERR|POLLPRI, and select will return the fd whether
411  * it is waiting for read, write, or exceptions.
412  * Once poll/select indicates that the value has changed, you
413  * need to close and re-open the file, or seek to 0 and read again.
414  * Reminder: this only works for attributes which actively support
415  * it, and it is not possible to test an attribute from userspace
416  * to see if it supports poll (Neither 'poll' nor 'select' return
417  * an appropriate error code).  When in doubt, set a suitable timeout value.
418  */
419 static unsigned int sysfs_poll(struct file *filp, poll_table *wait)
420 {
421         struct sysfs_buffer * buffer = filp->private_data;
422         struct sysfs_dirent *attr_sd = filp->f_path.dentry->d_fsdata;
423         struct sysfs_open_dirent *od = attr_sd->s_attr.open;
424
425         /* need parent for the kobj, grab both */
426         if (!sysfs_get_active_two(attr_sd))
427                 goto trigger;
428
429         poll_wait(filp, &od->poll, wait);
430
431         sysfs_put_active_two(attr_sd);
432
433         if (buffer->event != atomic_read(&od->event))
434                 goto trigger;
435
436         return 0;
437
438  trigger:
439         buffer->needs_read_fill = 1;
440         return POLLERR|POLLPRI;
441 }
442
443 void sysfs_notify(struct kobject *k, char *dir, char *attr)
444 {
445         struct sysfs_dirent *sd = k->sd;
446
447         mutex_lock(&sysfs_mutex);
448
449         if (sd && dir)
450                 sd = sysfs_find_dirent(sd, dir);
451         if (sd && attr)
452                 sd = sysfs_find_dirent(sd, attr);
453         if (sd) {
454                 struct sysfs_open_dirent *od;
455
456                 spin_lock(&sysfs_open_dirent_lock);
457
458                 od = sd->s_attr.open;
459                 if (od) {
460                         atomic_inc(&od->event);
461                         wake_up_interruptible(&od->poll);
462                 }
463
464                 spin_unlock(&sysfs_open_dirent_lock);
465         }
466
467         mutex_unlock(&sysfs_mutex);
468 }
469 EXPORT_SYMBOL_GPL(sysfs_notify);
470
471 const struct file_operations sysfs_file_operations = {
472         .read           = sysfs_read_file,
473         .write          = sysfs_write_file,
474         .llseek         = generic_file_llseek,
475         .open           = sysfs_open_file,
476         .release        = sysfs_release,
477         .poll           = sysfs_poll,
478 };
479
480 int sysfs_add_file_mode(struct sysfs_dirent *dir_sd,
481                         const struct attribute *attr, int type, mode_t amode)
482 {
483         umode_t mode = (amode & S_IALLUGO) | S_IFREG;
484         struct sysfs_addrm_cxt acxt;
485         struct sysfs_dirent *sd;
486         int rc;
487
488         sd = sysfs_new_dirent(attr->name, mode, type);
489         if (!sd)
490                 return -ENOMEM;
491         sd->s_attr.attr = (void *)attr;
492
493         sysfs_addrm_start(&acxt, dir_sd);
494         rc = sysfs_add_one(&acxt, sd);
495         sysfs_addrm_finish(&acxt);
496
497         if (rc)
498                 sysfs_put(sd);
499
500         return rc;
501 }
502
503
504 int sysfs_add_file(struct sysfs_dirent *dir_sd, const struct attribute *attr,
505                    int type)
506 {
507         return sysfs_add_file_mode(dir_sd, attr, type, attr->mode);
508 }
509
510
511 /**
512  *      sysfs_create_file - create an attribute file for an object.
513  *      @kobj:  object we're creating for. 
514  *      @attr:  attribute descriptor.
515  */
516
517 int sysfs_create_file(struct kobject * kobj, const struct attribute * attr)
518 {
519         BUG_ON(!kobj || !kobj->sd || !attr);
520
521         return sysfs_add_file(kobj->sd, attr, SYSFS_KOBJ_ATTR);
522
523 }
524
525
526 /**
527  * sysfs_add_file_to_group - add an attribute file to a pre-existing group.
528  * @kobj: object we're acting for.
529  * @attr: attribute descriptor.
530  * @group: group name.
531  */
532 int sysfs_add_file_to_group(struct kobject *kobj,
533                 const struct attribute *attr, const char *group)
534 {
535         struct sysfs_dirent *dir_sd;
536         int error;
537
538         if (group)
539                 dir_sd = sysfs_get_dirent(kobj->sd, group);
540         else
541                 dir_sd = sysfs_get(kobj->sd);
542
543         if (!dir_sd)
544                 return -ENOENT;
545
546         error = sysfs_add_file(dir_sd, attr, SYSFS_KOBJ_ATTR);
547         sysfs_put(dir_sd);
548
549         return error;
550 }
551 EXPORT_SYMBOL_GPL(sysfs_add_file_to_group);
552
553 /**
554  * sysfs_chmod_file - update the modified mode value on an object attribute.
555  * @kobj: object we're acting for.
556  * @attr: attribute descriptor.
557  * @mode: file permissions.
558  *
559  */
560 int sysfs_chmod_file(struct kobject *kobj, struct attribute *attr, mode_t mode)
561 {
562         struct sysfs_dirent *victim_sd = NULL;
563         struct dentry *victim = NULL;
564         struct inode * inode;
565         struct iattr newattrs;
566         int rc;
567
568         rc = -ENOENT;
569         victim_sd = sysfs_get_dirent(kobj->sd, attr->name);
570         if (!victim_sd)
571                 goto out;
572
573         mutex_lock(&sysfs_rename_mutex);
574         victim = sysfs_get_dentry(victim_sd);
575         mutex_unlock(&sysfs_rename_mutex);
576         if (IS_ERR(victim)) {
577                 rc = PTR_ERR(victim);
578                 victim = NULL;
579                 goto out;
580         }
581
582         inode = victim->d_inode;
583
584         mutex_lock(&inode->i_mutex);
585
586         newattrs.ia_mode = (mode & S_IALLUGO) | (inode->i_mode & ~S_IALLUGO);
587         newattrs.ia_valid = ATTR_MODE | ATTR_CTIME;
588         newattrs.ia_ctime = current_fs_time(inode->i_sb);
589         rc = sysfs_setattr(victim, &newattrs);
590
591         if (rc == 0) {
592                 fsnotify_change(victim, newattrs.ia_valid);
593                 mutex_lock(&sysfs_mutex);
594                 victim_sd->s_mode = newattrs.ia_mode;
595                 mutex_unlock(&sysfs_mutex);
596         }
597
598         mutex_unlock(&inode->i_mutex);
599  out:
600         dput(victim);
601         sysfs_put(victim_sd);
602         return rc;
603 }
604 EXPORT_SYMBOL_GPL(sysfs_chmod_file);
605
606
607 /**
608  *      sysfs_remove_file - remove an object attribute.
609  *      @kobj:  object we're acting for.
610  *      @attr:  attribute descriptor.
611  *
612  *      Hash the attribute name and kill the victim.
613  */
614
615 void sysfs_remove_file(struct kobject * kobj, const struct attribute * attr)
616 {
617         sysfs_hash_and_remove(kobj->sd, attr->name);
618 }
619
620
621 /**
622  * sysfs_remove_file_from_group - remove an attribute file from a group.
623  * @kobj: object we're acting for.
624  * @attr: attribute descriptor.
625  * @group: group name.
626  */
627 void sysfs_remove_file_from_group(struct kobject *kobj,
628                 const struct attribute *attr, const char *group)
629 {
630         struct sysfs_dirent *dir_sd;
631
632         if (group)
633                 dir_sd = sysfs_get_dirent(kobj->sd, group);
634         else
635                 dir_sd = sysfs_get(kobj->sd);
636         if (dir_sd) {
637                 sysfs_hash_and_remove(dir_sd, attr->name);
638                 sysfs_put(dir_sd);
639         }
640 }
641 EXPORT_SYMBOL_GPL(sysfs_remove_file_from_group);
642
643 struct sysfs_schedule_callback_struct {
644         struct kobject          *kobj;
645         void                    (*func)(void *);
646         void                    *data;
647         struct module           *owner;
648         struct work_struct      work;
649 };
650
651 static void sysfs_schedule_callback_work(struct work_struct *work)
652 {
653         struct sysfs_schedule_callback_struct *ss = container_of(work,
654                         struct sysfs_schedule_callback_struct, work);
655
656         (ss->func)(ss->data);
657         kobject_put(ss->kobj);
658         module_put(ss->owner);
659         kfree(ss);
660 }
661
662 /**
663  * sysfs_schedule_callback - helper to schedule a callback for a kobject
664  * @kobj: object we're acting for.
665  * @func: callback function to invoke later.
666  * @data: argument to pass to @func.
667  * @owner: module owning the callback code
668  *
669  * sysfs attribute methods must not unregister themselves or their parent
670  * kobject (which would amount to the same thing).  Attempts to do so will
671  * deadlock, since unregistration is mutually exclusive with driver
672  * callbacks.
673  *
674  * Instead methods can call this routine, which will attempt to allocate
675  * and schedule a workqueue request to call back @func with @data as its
676  * argument in the workqueue's process context.  @kobj will be pinned
677  * until @func returns.
678  *
679  * Returns 0 if the request was submitted, -ENOMEM if storage could not
680  * be allocated, -ENODEV if a reference to @owner isn't available.
681  */
682 int sysfs_schedule_callback(struct kobject *kobj, void (*func)(void *),
683                 void *data, struct module *owner)
684 {
685         struct sysfs_schedule_callback_struct *ss;
686
687         if (!try_module_get(owner))
688                 return -ENODEV;
689         ss = kmalloc(sizeof(*ss), GFP_KERNEL);
690         if (!ss) {
691                 module_put(owner);
692                 return -ENOMEM;
693         }
694         kobject_get(kobj);
695         ss->kobj = kobj;
696         ss->func = func;
697         ss->data = data;
698         ss->owner = owner;
699         INIT_WORK(&ss->work, sysfs_schedule_callback_work);
700         schedule_work(&ss->work);
701         return 0;
702 }
703 EXPORT_SYMBOL_GPL(sysfs_schedule_callback);
704
705
706 EXPORT_SYMBOL_GPL(sysfs_create_file);
707 EXPORT_SYMBOL_GPL(sysfs_remove_file);