at v2.6.29-rc4 204 lines 4.4 kB view raw
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_ioctl(struct device *dev, unsigned int cmd, 54 unsigned long arg) 55{ 56 /* We do support interrupts, they're generated 57 * using the sysfs interface. 58 */ 59 switch (cmd) { 60 case RTC_PIE_ON: 61 case RTC_PIE_OFF: 62 case RTC_UIE_ON: 63 case RTC_UIE_OFF: 64 case RTC_AIE_ON: 65 case RTC_AIE_OFF: 66 return 0; 67 68 default: 69 return -ENOIOCTLCMD; 70 } 71} 72 73static const struct rtc_class_ops test_rtc_ops = { 74 .proc = test_rtc_proc, 75 .read_time = test_rtc_read_time, 76 .read_alarm = test_rtc_read_alarm, 77 .set_alarm = test_rtc_set_alarm, 78 .set_mmss = test_rtc_set_mmss, 79 .ioctl = test_rtc_ioctl, 80}; 81 82static ssize_t test_irq_show(struct device *dev, 83 struct device_attribute *attr, char *buf) 84{ 85 return sprintf(buf, "%d\n", 42); 86} 87static ssize_t test_irq_store(struct device *dev, 88 struct device_attribute *attr, 89 const char *buf, size_t count) 90{ 91 int retval; 92 struct platform_device *plat_dev = to_platform_device(dev); 93 struct rtc_device *rtc = platform_get_drvdata(plat_dev); 94 95 retval = count; 96 local_irq_disable(); 97 if (strncmp(buf, "tick", 4) == 0) 98 rtc_update_irq(rtc, 1, RTC_PF | RTC_IRQF); 99 else if (strncmp(buf, "alarm", 5) == 0) 100 rtc_update_irq(rtc, 1, RTC_AF | RTC_IRQF); 101 else if (strncmp(buf, "update", 6) == 0) 102 rtc_update_irq(rtc, 1, RTC_UF | RTC_IRQF); 103 else 104 retval = -EINVAL; 105 local_irq_enable(); 106 107 return retval; 108} 109static DEVICE_ATTR(irq, S_IRUGO | S_IWUSR, test_irq_show, test_irq_store); 110 111static int test_probe(struct platform_device *plat_dev) 112{ 113 int err; 114 struct rtc_device *rtc = rtc_device_register("test", &plat_dev->dev, 115 &test_rtc_ops, THIS_MODULE); 116 if (IS_ERR(rtc)) { 117 err = PTR_ERR(rtc); 118 return err; 119 } 120 121 err = device_create_file(&plat_dev->dev, &dev_attr_irq); 122 if (err) 123 goto err; 124 125 platform_set_drvdata(plat_dev, rtc); 126 127 return 0; 128 129err: 130 rtc_device_unregister(rtc); 131 return err; 132} 133 134static int __devexit test_remove(struct platform_device *plat_dev) 135{ 136 struct rtc_device *rtc = platform_get_drvdata(plat_dev); 137 138 rtc_device_unregister(rtc); 139 device_remove_file(&plat_dev->dev, &dev_attr_irq); 140 141 return 0; 142} 143 144static struct platform_driver test_driver = { 145 .probe = test_probe, 146 .remove = __devexit_p(test_remove), 147 .driver = { 148 .name = "rtc-test", 149 .owner = THIS_MODULE, 150 }, 151}; 152 153static int __init test_init(void) 154{ 155 int err; 156 157 if ((err = platform_driver_register(&test_driver))) 158 return err; 159 160 if ((test0 = platform_device_alloc("rtc-test", 0)) == NULL) { 161 err = -ENOMEM; 162 goto exit_driver_unregister; 163 } 164 165 if ((test1 = platform_device_alloc("rtc-test", 1)) == NULL) { 166 err = -ENOMEM; 167 goto exit_free_test0; 168 } 169 170 if ((err = platform_device_add(test0))) 171 goto exit_free_test1; 172 173 if ((err = platform_device_add(test1))) 174 goto exit_device_unregister; 175 176 return 0; 177 178exit_device_unregister: 179 platform_device_unregister(test0); 180 181exit_free_test1: 182 platform_device_put(test1); 183 184exit_free_test0: 185 platform_device_put(test0); 186 187exit_driver_unregister: 188 platform_driver_unregister(&test_driver); 189 return err; 190} 191 192static void __exit test_exit(void) 193{ 194 platform_device_unregister(test0); 195 platform_device_unregister(test1); 196 platform_driver_unregister(&test_driver); 197} 198 199MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>"); 200MODULE_DESCRIPTION("RTC test driver/device"); 201MODULE_LICENSE("GPL"); 202 203module_init(test_init); 204module_exit(test_exit);