Linux kernel & device driver programming

Cross-Referenced Linux and Device Driver Code

[ source navigation ] [ diff markup ] [ identifier search ] [ freetext search ] [ file search ]
Version: [ 2.6.11.8 ] [ 2.6.25 ] [ 2.6.25.8 ] [ 2.6.31.13 ] Architecture: [ i386 ]
  1 /*
  2  * drivers/rtc/rtc-pl031.c
  3  *
  4  * Real Time Clock interface for ARM AMBA PrimeCell 031 RTC
  5  *
  6  * Author: Deepak Saxena <dsaxena@plexity.net>
  7  *
  8  * Copyright 2006 (c) MontaVista Software, Inc.
  9  *
 10  * This program is free software; you can redistribute it and/or
 11  * modify it under the terms of the GNU General Public License
 12  * as published by the Free Software Foundation; either version
 13  * 2 of the License, or (at your option) any later version.
 14  */
 15 #include <linux/module.h>
 16 #include <linux/rtc.h>
 17 #include <linux/init.h>
 18 #include <linux/interrupt.h>
 19 #include <linux/amba/bus.h>
 20 #include <linux/io.h>
 21 
 22 /*
 23  * Register definitions
 24  */
 25 #define RTC_DR          0x00    /* Data read register */
 26 #define RTC_MR          0x04    /* Match register */
 27 #define RTC_LR          0x08    /* Data load register */
 28 #define RTC_CR          0x0c    /* Control register */
 29 #define RTC_IMSC        0x10    /* Interrupt mask and set register */
 30 #define RTC_RIS         0x14    /* Raw interrupt status register */
 31 #define RTC_MIS         0x18    /* Masked interrupt status register */
 32 #define RTC_ICR         0x1c    /* Interrupt clear register */
 33 
 34 struct pl031_local {
 35         struct rtc_device *rtc;
 36         void __iomem *base;
 37 };
 38 
 39 static irqreturn_t pl031_interrupt(int irq, void *dev_id)
 40 {
 41         struct rtc_device *rtc = dev_id;
 42 
 43         rtc_update_irq(rtc, 1, RTC_AF);
 44 
 45         return IRQ_HANDLED;
 46 }
 47 
 48 static int pl031_ioctl(struct device *dev, unsigned int cmd, unsigned long arg)
 49 {
 50         struct pl031_local *ldata = dev_get_drvdata(dev);
 51 
 52         switch (cmd) {
 53         case RTC_AIE_OFF:
 54                 __raw_writel(1, ldata->base + RTC_MIS);
 55                 return 0;
 56         case RTC_AIE_ON:
 57                 __raw_writel(0, ldata->base + RTC_MIS);
 58                 return 0;
 59         }
 60 
 61         return -ENOIOCTLCMD;
 62 }
 63 
 64 static int pl031_read_time(struct device *dev, struct rtc_time *tm)
 65 {
 66         struct pl031_local *ldata = dev_get_drvdata(dev);
 67 
 68         rtc_time_to_tm(__raw_readl(ldata->base + RTC_DR), tm);
 69 
 70         return 0;
 71 }
 72 
 73 static int pl031_set_time(struct device *dev, struct rtc_time *tm)
 74 {
 75         unsigned long time;
 76         struct pl031_local *ldata = dev_get_drvdata(dev);
 77 
 78         rtc_tm_to_time(tm, &time);
 79         __raw_writel(time, ldata->base + RTC_LR);
 80 
 81         return 0;
 82 }
 83 
 84 static int pl031_read_alarm(struct device *dev, struct rtc_wkalrm *alarm)
 85 {
 86         struct pl031_local *ldata = dev_get_drvdata(dev);
 87 
 88         rtc_time_to_tm(__raw_readl(ldata->base + RTC_MR), &alarm->time);
 89         alarm->pending = __raw_readl(ldata->base + RTC_RIS);
 90         alarm->enabled = __raw_readl(ldata->base + RTC_IMSC);
 91 
 92         return 0;
 93 }
 94 
 95 static int pl031_set_alarm(struct device *dev, struct rtc_wkalrm *alarm)
 96 {
 97         struct pl031_local *ldata = dev_get_drvdata(dev);
 98         unsigned long time;
 99 
100         rtc_tm_to_time(&alarm->time, &time);
101 
102         __raw_writel(time, ldata->base + RTC_MR);
103         __raw_writel(!alarm->enabled, ldata->base + RTC_MIS);
104 
105         return 0;
106 }
107 
108 static const struct rtc_class_ops pl031_ops = {
109         .ioctl = pl031_ioctl,
110         .read_time = pl031_read_time,
111         .set_time = pl031_set_time,
112         .read_alarm = pl031_read_alarm,
113         .set_alarm = pl031_set_alarm,
114 };
115 
116 static int pl031_remove(struct amba_device *adev)
117 {
118         struct pl031_local *ldata = dev_get_drvdata(&adev->dev);
119 
120         amba_set_drvdata(adev, NULL);
121         free_irq(adev->irq[0], ldata->rtc);
122         rtc_device_unregister(ldata->rtc);
123         iounmap(ldata->base);
124         kfree(ldata);
125         amba_release_regions(adev);
126 
127         return 0;
128 }
129 
130 static int pl031_probe(struct amba_device *adev, struct amba_id *id)
131 {
132         int ret;
133         struct pl031_local *ldata;
134 
135         ret = amba_request_regions(adev, NULL);
136         if (ret)
137                 goto err_req;
138 
139         ldata = kmalloc(sizeof(struct pl031_local), GFP_KERNEL);
140         if (!ldata) {
141                 ret = -ENOMEM;
142                 goto out;
143         }
144 
145         ldata->base = ioremap(adev->res.start, resource_size(&adev->res));
146         if (!ldata->base) {
147                 ret = -ENOMEM;
148                 goto out_no_remap;
149         }
150 
151         amba_set_drvdata(adev, ldata);
152 
153         if (request_irq(adev->irq[0], pl031_interrupt, IRQF_DISABLED,
154                         "rtc-pl031", ldata->rtc)) {
155                 ret = -EIO;
156                 goto out_no_irq;
157         }
158 
159         ldata->rtc = rtc_device_register("pl031", &adev->dev, &pl031_ops,
160                                          THIS_MODULE);
161         if (IS_ERR(ldata->rtc)) {
162                 ret = PTR_ERR(ldata->rtc);
163                 goto out_no_rtc;
164         }
165 
166         return 0;
167 
168 out_no_rtc:
169         free_irq(adev->irq[0], ldata->rtc);
170 out_no_irq:
171         iounmap(ldata->base);
172         amba_set_drvdata(adev, NULL);
173 out_no_remap:
174         kfree(ldata);
175 out:
176         amba_release_regions(adev);
177 err_req:
178         return ret;
179 }
180 
181 static struct amba_id pl031_ids[] __initdata = {
182         {
183                  .id = 0x00041031,
184                 .mask = 0x000fffff, },
185         {0, 0},
186 };
187 
188 static struct amba_driver pl031_driver = {
189         .drv = {
190                 .name = "rtc-pl031",
191         },
192         .id_table = pl031_ids,
193         .probe = pl031_probe,
194         .remove = pl031_remove,
195 };
196 
197 static int __init pl031_init(void)
198 {
199         return amba_driver_register(&pl031_driver);
200 }
201 
202 static void __exit pl031_exit(void)
203 {
204         amba_driver_unregister(&pl031_driver);
205 }
206 
207 module_init(pl031_init);
208 module_exit(pl031_exit);
209 
210 MODULE_AUTHOR("Deepak Saxena <dsaxena@plexity.net");
211 MODULE_DESCRIPTION("ARM AMBA PL031 RTC Driver");
212 MODULE_LICENSE("GPL");
213 
  This page was automatically generated by the LXR engine.