| /* | |
| * RTC subsystem, dev interface | |
| * | |
| * Copyright (C) 2005 Tower Technologies | |
| * Author: Alessandro Zummo <a.zummo@towertech.it> | |
| * | |
| * based on arch/arm/common/rtctime.c | |
| * | |
| * This program is free software; you can redistribute it and/or modify | |
| * it under the terms of the GNU General Public License version 2 as | |
| * published by the Free Software Foundation. | |
| */ | |
| #include <linux/module.h> | |
| #include <linux/rtc.h> | |
| static struct class *rtc_dev_class; | |
| static dev_t rtc_devt; | |
| #define RTC_DEV_MAX 16 /* 16 RTCs should be enough for everyone... */ | |
| static int rtc_dev_open(struct inode *inode, struct file *file) | |
| { | |
| int err; | |
| struct rtc_device *rtc = container_of(inode->i_cdev, | |
| struct rtc_device, char_dev); | |
| const struct rtc_class_ops *ops = rtc->ops; | |
| /* We keep the lock as long as the device is in use | |
| * and return immediately if busy | |
| */ | |
| if (!(mutex_trylock(&rtc->char_lock))) | |
| return -EBUSY; | |
| file->private_data = &rtc->class_dev; | |
| err = ops->open ? ops->open(rtc->class_dev.dev) : 0; | |
| if (err == 0) { | |
| spin_lock_irq(&rtc->irq_lock); | |
| rtc->irq_data = 0; | |
| spin_unlock_irq(&rtc->irq_lock); | |
| return 0; | |
| } | |
| /* something has gone wrong, release the lock */ | |
| mutex_unlock(&rtc->char_lock); | |
| return err; | |
| } | |
| #ifdef CONFIG_RTC_INTF_DEV_UIE_EMUL | |
| /* | |
| * Routine to poll RTC seconds field for change as often as possible, | |
| * after first RTC_UIE use timer to reduce polling | |
| */ | |
| static void rtc_uie_task(void *data) | |
| { | |
| struct rtc_device *rtc = data; | |
| struct rtc_time tm; | |
| int num = 0; | |
| int err; | |
| err = rtc_read_time(&rtc->class_dev, &tm); | |
| local_irq_disable(); | |
| spin_lock(&rtc->irq_lock); | |
| if (rtc->stop_uie_polling || err) { | |
| rtc->uie_task_active = 0; | |
| } else if (rtc->oldsecs != tm.tm_sec) { | |
| num = (tm.tm_sec + 60 - rtc->oldsecs) % 60; | |
| rtc->oldsecs = tm.tm_sec; | |
| rtc->uie_timer.expires = jiffies + HZ - (HZ/10); | |
| rtc->uie_timer_active = 1; | |
| rtc->uie_task_active = 0; | |
| add_timer(&rtc->uie_timer); | |
| } else if (schedule_work(&rtc->uie_task) == 0) { | |
| rtc->uie_task_active = 0; | |
| } | |
| spin_unlock(&rtc->irq_lock); | |
| if (num) | |
| rtc_update_irq(&rtc->class_dev, num, RTC_UF | RTC_IRQF); | |
| local_irq_enable(); | |
| } | |
| static void rtc_uie_timer(unsigned long data) | |
| { | |
| struct rtc_device *rtc = (struct rtc_device *)data; | |
| unsigned long flags; | |
| spin_lock_irqsave(&rtc->irq_lock, flags); | |
| rtc->uie_timer_active = 0; | |
| rtc->uie_task_active = 1; | |
| if ((schedule_work(&rtc->uie_task) == 0)) | |
| rtc->uie_task_active = 0; | |
| spin_unlock_irqrestore(&rtc->irq_lock, flags); | |
| } | |
| static void clear_uie(struct rtc_device *rtc) | |
| { | |
| spin_lock_irq(&rtc->irq_lock); | |
| if (rtc->irq_active) { | |
| rtc->stop_uie_polling = 1; | |
| if (rtc->uie_timer_active) { | |
| spin_unlock_irq(&rtc->irq_lock); | |
| del_timer_sync(&rtc->uie_timer); | |
| spin_lock_irq(&rtc->irq_lock); | |
| rtc->uie_timer_active = 0; | |
| } | |
| if (rtc->uie_task_active) { | |
| spin_unlock_irq(&rtc->irq_lock); | |
| flush_scheduled_work(); | |
| spin_lock_irq(&rtc->irq_lock); | |
| } | |
| rtc->irq_active = 0; | |
| } | |
| spin_unlock_irq(&rtc->irq_lock); | |
| } | |
| static int set_uie(struct rtc_device *rtc) | |
| { | |
| struct rtc_time tm; | |
| int err; | |
| err = rtc_read_time(&rtc->class_dev, &tm); | |
| if (err) | |
| return err; | |
| spin_lock_irq(&rtc->irq_lock); | |
| if (!rtc->irq_active) { | |
| rtc->irq_active = 1; | |
| rtc->stop_uie_polling = 0; | |
| rtc->oldsecs = tm.tm_sec; | |
| rtc->uie_task_active = 1; | |
| if (schedule_work(&rtc->uie_task) == 0) | |
| rtc->uie_task_active = 0; | |
| } | |
| rtc->irq_data = 0; | |
| spin_unlock_irq(&rtc->irq_lock); | |
| return 0; | |
| } | |
| #endif /* CONFIG_RTC_INTF_DEV_UIE_EMUL */ | |
| static ssize_t | |
| rtc_dev_read(struct file *file, char __user *buf, size_t count, loff_t *ppos) | |
| { | |
| struct rtc_device *rtc = to_rtc_device(file->private_data); | |
| DECLARE_WAITQUEUE(wait, current); | |
| unsigned long data; | |
| ssize_t ret; | |
| if (count != sizeof(unsigned int) && count < sizeof(unsigned long)) | |
| return -EINVAL; | |
| add_wait_queue(&rtc->irq_queue, &wait); | |
| do { | |
| __set_current_state(TASK_INTERRUPTIBLE); | |
| spin_lock_irq(&rtc->irq_lock); | |
| data = rtc->irq_data; | |
| rtc->irq_data = 0; | |
| spin_unlock_irq(&rtc->irq_lock); | |
| if (data != 0) { | |
| ret = 0; | |
| break; | |
| } | |
| if (file->f_flags & O_NONBLOCK) { | |
| ret = -EAGAIN; | |
| break; | |
| } | |
| if (signal_pending(current)) { | |
| ret = -ERESTARTSYS; | |
| break; | |
| } | |
| schedule(); | |
| } while (1); | |
| set_current_state(TASK_RUNNING); | |
| remove_wait_queue(&rtc->irq_queue, &wait); | |
| if (ret == 0) { | |
| /* Check for any data updates */ | |
| if (rtc->ops->read_callback) | |
| data = rtc->ops->read_callback(rtc->class_dev.dev, | |
| data); | |
| if (sizeof(int) != sizeof(long) && | |
| count == sizeof(unsigned int)) | |
| ret = put_user(data, (unsigned int __user *)buf) ?: | |
| sizeof(unsigned int); | |
| else | |
| ret = put_user(data, (unsigned long __user *)buf) ?: | |
| sizeof(unsigned long); | |
| } | |
| return ret; | |
| } | |
| static unsigned int rtc_dev_poll(struct file *file, poll_table *wait) | |
| { | |
| struct rtc_device *rtc = to_rtc_device(file->private_data); | |
| unsigned long data; | |
| poll_wait(file, &rtc->irq_queue, wait); | |
| data = rtc->irq_data; | |
| return (data != 0) ? (POLLIN | POLLRDNORM) : 0; | |
| } | |
| static int rtc_dev_ioctl(struct inode *inode, struct file *file, | |
| unsigned int cmd, unsigned long arg) | |
| { | |
| int err = 0; | |
| struct class_device *class_dev = file->private_data; | |
| struct rtc_device *rtc = to_rtc_device(class_dev); | |
| const struct rtc_class_ops *ops = rtc->ops; | |
| struct rtc_time tm; | |
| struct rtc_wkalrm alarm; | |
| void __user *uarg = (void __user *) arg; | |
| /* check that the calling task has appropriate permissions | |
| * for certain ioctls. doing this check here is useful | |
| * to avoid duplicate code in each driver. | |
| */ | |
| switch (cmd) { | |
| case RTC_EPOCH_SET: | |
| case RTC_SET_TIME: | |
| if (!capable(CAP_SYS_TIME)) | |
| return -EACCES; | |
| break; | |
| case RTC_IRQP_SET: | |
| if (arg > rtc->max_user_freq && !capable(CAP_SYS_RESOURCE)) | |
| return -EACCES; | |
| break; | |
| case RTC_PIE_ON: | |
| if (!capable(CAP_SYS_RESOURCE)) | |
| return -EACCES; | |
| break; | |
| } | |
| /* avoid conflicting IRQ users */ | |
| if (cmd == RTC_PIE_ON || cmd == RTC_PIE_OFF || cmd == RTC_IRQP_SET) { | |
| spin_lock_irq(&rtc->irq_task_lock); | |
| if (rtc->irq_task) | |
| err = -EBUSY; | |
| spin_unlock_irq(&rtc->irq_task_lock); | |
| if (err < 0) | |
| return err; | |
| } | |
| /* try the driver's ioctl interface */ | |
| if (ops->ioctl) { | |
| err = ops->ioctl(class_dev->dev, cmd, arg); | |
| if (err != -ENOIOCTLCMD) | |
| return err; | |
| } | |
| /* if the driver does not provide the ioctl interface | |
| * or if that particular ioctl was not implemented | |
| * (-ENOIOCTLCMD), we will try to emulate here. | |
| */ | |
| switch (cmd) { | |
| case RTC_ALM_READ: | |
| err = rtc_read_alarm(class_dev, &alarm); | |
| if (err < 0) | |
| return err; | |
| if (copy_to_user(uarg, &alarm.time, sizeof(tm))) | |
| return -EFAULT; | |
| break; | |
| case RTC_ALM_SET: | |
| if (copy_from_user(&alarm.time, uarg, sizeof(tm))) | |
| return -EFAULT; | |
| alarm.enabled = 0; | |
| alarm.pending = 0; | |
| alarm.time.tm_mday = -1; | |
| alarm.time.tm_mon = -1; | |
| alarm.time.tm_year = -1; | |
| alarm.time.tm_wday = -1; | |
| alarm.time.tm_yday = -1; | |
| alarm.time.tm_isdst = -1; | |
| err = rtc_set_alarm(class_dev, &alarm); | |
| break; | |
| case RTC_RD_TIME: | |
| err = rtc_read_time(class_dev, &tm); | |
| if (err < 0) | |
| return err; | |
| if (copy_to_user(uarg, &tm, sizeof(tm))) | |
| return -EFAULT; | |
| break; | |
| case RTC_SET_TIME: | |
| if (copy_from_user(&tm, uarg, sizeof(tm))) | |
| return -EFAULT; | |
| err = rtc_set_time(class_dev, &tm); | |
| break; | |
| case RTC_IRQP_READ: | |
| if (ops->irq_set_freq) | |
| err = put_user(rtc->irq_freq, (unsigned long *) arg); | |
| break; | |
| case RTC_IRQP_SET: | |
| if (ops->irq_set_freq) | |
| err = rtc_irq_set_freq(class_dev, rtc->irq_task, arg); | |
| break; | |
| #if 0 | |
| case RTC_EPOCH_SET: | |
| #ifndef rtc_epoch | |
| /* | |
| * There were no RTC clocks before 1900. | |
| */ | |
| if (arg < 1900) { | |
| err = -EINVAL; | |
| break; | |
| } | |
| rtc_epoch = arg; | |
| err = 0; | |
| #endif | |
| break; | |
| case RTC_EPOCH_READ: | |
| err = put_user(rtc_epoch, (unsigned long __user *)uarg); | |
| break; | |
| #endif | |
| case RTC_WKALM_SET: | |
| if (copy_from_user(&alarm, uarg, sizeof(alarm))) | |
| return -EFAULT; | |
| err = rtc_set_alarm(class_dev, &alarm); | |
| break; | |
| case RTC_WKALM_RD: | |
| err = rtc_read_alarm(class_dev, &alarm); | |
| if (err < 0) | |
| return err; | |
| if (copy_to_user(uarg, &alarm, sizeof(alarm))) | |
| return -EFAULT; | |
| break; | |
| #ifdef CONFIG_RTC_INTF_DEV_UIE_EMUL | |
| case RTC_UIE_OFF: | |
| clear_uie(rtc); | |
| return 0; | |
| case RTC_UIE_ON: | |
| return set_uie(rtc); | |
| #endif | |
| default: | |
| err = -ENOTTY; | |
| break; | |
| } | |
| return err; | |
| } | |
| static int rtc_dev_release(struct inode *inode, struct file *file) | |
| { | |
| struct rtc_device *rtc = to_rtc_device(file->private_data); | |
| #ifdef CONFIG_RTC_INTF_DEV_UIE_EMUL | |
| clear_uie(rtc); | |
| #endif | |
| if (rtc->ops->release) | |
| rtc->ops->release(rtc->class_dev.dev); | |
| mutex_unlock(&rtc->char_lock); | |
| return 0; | |
| } | |
| static int rtc_dev_fasync(int fd, struct file *file, int on) | |
| { | |
| struct rtc_device *rtc = to_rtc_device(file->private_data); | |
| return fasync_helper(fd, file, on, &rtc->async_queue); | |
| } | |
| static struct file_operations rtc_dev_fops = { | |
| .owner = THIS_MODULE, | |
| .llseek = no_llseek, | |
| .read = rtc_dev_read, | |
| .poll = rtc_dev_poll, | |
| .ioctl = rtc_dev_ioctl, | |
| .open = rtc_dev_open, | |
| .release = rtc_dev_release, | |
| .fasync = rtc_dev_fasync, | |
| }; | |
| /* insertion/removal hooks */ | |
| static int rtc_dev_add_device(struct class_device *class_dev, | |
| struct class_interface *class_intf) | |
| { | |
| int err = 0; | |
| struct rtc_device *rtc = to_rtc_device(class_dev); | |
| if (rtc->id >= RTC_DEV_MAX) { | |
| dev_err(class_dev->dev, "too many RTCs\n"); | |
| return -EINVAL; | |
| } | |
| mutex_init(&rtc->char_lock); | |
| spin_lock_init(&rtc->irq_lock); | |
| init_waitqueue_head(&rtc->irq_queue); | |
| #ifdef CONFIG_RTC_INTF_DEV_UIE_EMUL | |
| INIT_WORK(&rtc->uie_task, rtc_uie_task, rtc); | |
| setup_timer(&rtc->uie_timer, rtc_uie_timer, (unsigned long)rtc); | |
| #endif | |
| cdev_init(&rtc->char_dev, &rtc_dev_fops); | |
| rtc->char_dev.owner = rtc->owner; | |
| if (cdev_add(&rtc->char_dev, MKDEV(MAJOR(rtc_devt), rtc->id), 1)) { | |
| dev_err(class_dev->dev, | |
| "failed to add char device %d:%d\n", | |
| MAJOR(rtc_devt), rtc->id); | |
| return -ENODEV; | |
| } | |
| rtc->rtc_dev = class_device_create(rtc_dev_class, NULL, | |
| MKDEV(MAJOR(rtc_devt), rtc->id), | |
| class_dev->dev, "rtc%d", rtc->id); | |
| if (IS_ERR(rtc->rtc_dev)) { | |
| dev_err(class_dev->dev, "cannot create rtc_dev device\n"); | |
| err = PTR_ERR(rtc->rtc_dev); | |
| goto err_cdev_del; | |
| } | |
| dev_info(class_dev->dev, "rtc intf: dev (%d:%d)\n", | |
| MAJOR(rtc->rtc_dev->devt), | |
| MINOR(rtc->rtc_dev->devt)); | |
| return 0; | |
| err_cdev_del: | |
| cdev_del(&rtc->char_dev); | |
| return err; | |
| } | |
| static void rtc_dev_remove_device(struct class_device *class_dev, | |
| struct class_interface *class_intf) | |
| { | |
| struct rtc_device *rtc = to_rtc_device(class_dev); | |
| if (rtc->rtc_dev) { | |
| dev_dbg(class_dev->dev, "removing char %d:%d\n", | |
| MAJOR(rtc->rtc_dev->devt), | |
| MINOR(rtc->rtc_dev->devt)); | |
| class_device_unregister(rtc->rtc_dev); | |
| cdev_del(&rtc->char_dev); | |
| } | |
| } | |
| /* interface registration */ | |
| static struct class_interface rtc_dev_interface = { | |
| .add = &rtc_dev_add_device, | |
| .remove = &rtc_dev_remove_device, | |
| }; | |
| static int __init rtc_dev_init(void) | |
| { | |
| int err; | |
| rtc_dev_class = class_create(THIS_MODULE, "rtc-dev"); | |
| if (IS_ERR(rtc_dev_class)) | |
| return PTR_ERR(rtc_dev_class); | |
| err = alloc_chrdev_region(&rtc_devt, 0, RTC_DEV_MAX, "rtc"); | |
| if (err < 0) { | |
| printk(KERN_ERR "%s: failed to allocate char dev region\n", | |
| __FILE__); | |
| goto err_destroy_class; | |
| } | |
| err = rtc_interface_register(&rtc_dev_interface); | |
| if (err < 0) { | |
| printk(KERN_ERR "%s: failed to register the interface\n", | |
| __FILE__); | |
| goto err_unregister_chrdev; | |
| } | |
| return 0; | |
| err_unregister_chrdev: | |
| unregister_chrdev_region(rtc_devt, RTC_DEV_MAX); | |
| err_destroy_class: | |
| class_destroy(rtc_dev_class); | |
| return err; | |
| } | |
| static void __exit rtc_dev_exit(void) | |
| { | |
| class_interface_unregister(&rtc_dev_interface); | |
| class_destroy(rtc_dev_class); | |
| unregister_chrdev_region(rtc_devt, RTC_DEV_MAX); | |
| } | |
| subsys_initcall(rtc_dev_init); | |
| module_exit(rtc_dev_exit); | |
| MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>"); | |
| MODULE_DESCRIPTION("RTC class dev interface"); | |
| MODULE_LICENSE("GPL"); |