linux/drivers/rtc/rtc-test.c
<<
>>
Prefs
   1/*
   2 * An RTC test device/driver
   3 * Copyright (C) 2005 Tower Technologies
   4 * Author: Alessandro Zummo <a.zummo@towertech.it>
   5 *
   6 * This program is free software; you can redistribute it and/or modify
   7 * it under the terms of the GNU General Public License version 2 as
   8 * published by the Free Software Foundation.
   9 */
  10
  11#include <linux/module.h>
  12#include <linux/err.h>
  13#include <linux/rtc.h>
  14#include <linux/platform_device.h>
  15
  16static struct platform_device *test0 = NULL, *test1 = NULL;
  17
  18static int test_rtc_read_alarm(struct device *dev,
  19        struct rtc_wkalrm *alrm)
  20{
  21        return 0;
  22}
  23
  24static int test_rtc_set_alarm(struct device *dev,
  25        struct rtc_wkalrm *alrm)
  26{
  27        return 0;
  28}
  29
  30static int test_rtc_read_time(struct device *dev,
  31        struct rtc_time *tm)
  32{
  33        rtc_time_to_tm(get_seconds(), tm);
  34        return 0;
  35}
  36
  37static int test_rtc_set_mmss(struct device *dev, unsigned long secs)
  38{
  39        dev_info(dev, "%s, secs = %lu\n", __func__, secs);
  40        return 0;
  41}
  42
  43static int test_rtc_proc(struct device *dev, struct seq_file *seq)
  44{
  45        struct platform_device *plat_dev = to_platform_device(dev);
  46
  47        seq_printf(seq, "test\t\t: yes\n");
  48        seq_printf(seq, "id\t\t: %d\n", plat_dev->id);
  49
  50        return 0;
  51}
  52
  53static int test_rtc_alarm_irq_enable(struct device *dev, unsigned int enable)
  54{
  55        return 0;
  56}
  57
  58static const struct rtc_class_ops test_rtc_ops = {
  59        .proc = test_rtc_proc,
  60        .read_time = test_rtc_read_time,
  61        .read_alarm = test_rtc_read_alarm,
  62        .set_alarm = test_rtc_set_alarm,
  63        .set_mmss = test_rtc_set_mmss,
  64        .alarm_irq_enable = test_rtc_alarm_irq_enable,
  65};
  66
  67static ssize_t test_irq_show(struct device *dev,
  68                                struct device_attribute *attr, char *buf)
  69{
  70        return sprintf(buf, "%d\n", 42);
  71}
  72static ssize_t test_irq_store(struct device *dev,
  73                                struct device_attribute *attr,
  74                                const char *buf, size_t count)
  75{
  76        int retval;
  77        struct platform_device *plat_dev = to_platform_device(dev);
  78        struct rtc_device *rtc = platform_get_drvdata(plat_dev);
  79
  80        retval = count;
  81        if (strncmp(buf, "tick", 4) == 0 && rtc->pie_enabled)
  82                rtc_update_irq(rtc, 1, RTC_PF | RTC_IRQF);
  83        else if (strncmp(buf, "alarm", 5) == 0) {
  84                struct rtc_wkalrm alrm;
  85                int err = rtc_read_alarm(rtc, &alrm);
  86
  87                if (!err && alrm.enabled)
  88                        rtc_update_irq(rtc, 1, RTC_AF | RTC_IRQF);
  89
  90        } else if (strncmp(buf, "update", 6) == 0 && rtc->uie_rtctimer.enabled)
  91                rtc_update_irq(rtc, 1, RTC_UF | RTC_IRQF);
  92        else
  93                retval = -EINVAL;
  94
  95        return retval;
  96}
  97static DEVICE_ATTR(irq, S_IRUGO | S_IWUSR, test_irq_show, test_irq_store);
  98
  99static int test_probe(struct platform_device *plat_dev)
 100{
 101        int err;
 102        struct rtc_device *rtc = rtc_device_register("test", &plat_dev->dev,
 103                                                &test_rtc_ops, THIS_MODULE);
 104        if (IS_ERR(rtc)) {
 105                err = PTR_ERR(rtc);
 106                return err;
 107        }
 108
 109        err = device_create_file(&plat_dev->dev, &dev_attr_irq);
 110        if (err)
 111                goto err;
 112
 113        platform_set_drvdata(plat_dev, rtc);
 114
 115        return 0;
 116
 117err:
 118        rtc_device_unregister(rtc);
 119        return err;
 120}
 121
 122static int __devexit test_remove(struct platform_device *plat_dev)
 123{
 124        struct rtc_device *rtc = platform_get_drvdata(plat_dev);
 125
 126        rtc_device_unregister(rtc);
 127        device_remove_file(&plat_dev->dev, &dev_attr_irq);
 128
 129        return 0;
 130}
 131
 132static struct platform_driver test_driver = {
 133        .probe  = test_probe,
 134        .remove = __devexit_p(test_remove),
 135        .driver = {
 136                .name = "rtc-test",
 137                .owner = THIS_MODULE,
 138        },
 139};
 140
 141static int __init test_init(void)
 142{
 143        int err;
 144
 145        if ((err = platform_driver_register(&test_driver)))
 146                return err;
 147
 148        if ((test0 = platform_device_alloc("rtc-test", 0)) == NULL) {
 149                err = -ENOMEM;
 150                goto exit_driver_unregister;
 151        }
 152
 153        if ((test1 = platform_device_alloc("rtc-test", 1)) == NULL) {
 154                err = -ENOMEM;
 155                goto exit_free_test0;
 156        }
 157
 158        if ((err = platform_device_add(test0)))
 159                goto exit_free_test1;
 160
 161        if ((err = platform_device_add(test1)))
 162                goto exit_device_unregister;
 163
 164        return 0;
 165
 166exit_device_unregister:
 167        platform_device_unregister(test0);
 168
 169exit_free_test1:
 170        platform_device_put(test1);
 171
 172exit_free_test0:
 173        platform_device_put(test0);
 174
 175exit_driver_unregister:
 176        platform_driver_unregister(&test_driver);
 177        return err;
 178}
 179
 180static void __exit test_exit(void)
 181{
 182        platform_device_unregister(test0);
 183        platform_device_unregister(test1);
 184        platform_driver_unregister(&test_driver);
 185}
 186
 187MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>");
 188MODULE_DESCRIPTION("RTC test driver/device");
 189MODULE_LICENSE("GPL");
 190
 191module_init(test_init);
 192module_exit(test_exit);
 193
lxr.linux.no kindly hosted by Redpill Linpro AS, provider of Linux consulting and operations services since 1995.