Blame view
drivers/rtc/rtc-coh901331.c
7.95 KB
aa958f571 rtc: U300 COH 901... |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 |
/* * Copyright (C) 2007-2009 ST-Ericsson AB * License terms: GNU General Public License (GPL) version 2 * Real Time Clock interface for ST-Ericsson AB COH 901 331 RTC. * Author: Linus Walleij <linus.walleij@stericsson.com> * Based on rtc-pl031.c by Deepak Saxena <dsaxena@plexity.net> * Copyright 2006 (c) MontaVista Software, Inc. */ #include <linux/init.h> #include <linux/module.h> #include <linux/rtc.h> #include <linux/clk.h> #include <linux/interrupt.h> #include <linux/pm.h> #include <linux/platform_device.h> #include <linux/io.h> |
5a0e3ad6a include cleanup: ... |
17 |
#include <linux/slab.h> |
aa958f571 rtc: U300 COH 901... |
18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 |
/* * Registers in the COH 901 331 */ /* Alarm value 32bit (R/W) */ #define COH901331_ALARM 0x00U /* Used to set current time 32bit (R/W) */ #define COH901331_SET_TIME 0x04U /* Indication if current time is valid 32bit (R/-) */ #define COH901331_VALID 0x08U /* Read the current time 32bit (R/-) */ #define COH901331_CUR_TIME 0x0cU /* Event register for the "alarm" interrupt */ #define COH901331_IRQ_EVENT 0x10U /* Mask register for the "alarm" interrupt */ #define COH901331_IRQ_MASK 0x14U /* Force register for the "alarm" interrupt */ #define COH901331_IRQ_FORCE 0x18U /* * Reference to RTC block clock * Notice that the frequent clk_enable()/clk_disable() on this * clock is mainly to be able to turn on/off other clocks in the * hierarchy as needed, the RTC clock is always on anyway. */ struct coh901331_port { struct rtc_device *rtc; struct clk *clk; u32 phybase; u32 physize; void __iomem *virtbase; int irq; #ifdef CONFIG_PM u32 irqmaskstore; #endif }; static irqreturn_t coh901331_interrupt(int irq, void *data) { struct coh901331_port *rtap = data; clk_enable(rtap->clk); /* Ack IRQ */ writel(1, rtap->virtbase + COH901331_IRQ_EVENT); |
378ce74be ARM: 5787/1: U300... |
62 63 64 65 66 67 68 69 |
/* * Disable the interrupt. This is necessary because * the RTC lives on a lower-clocked line and will * not release the IRQ line until after a few (slower) * clock cycles. The interrupt will be re-enabled when * a new alarm is set anyway. */ writel(0, rtap->virtbase + COH901331_IRQ_MASK); |
aa958f571 rtc: U300 COH 901... |
70 |
clk_disable(rtap->clk); |
378ce74be ARM: 5787/1: U300... |
71 |
|
aa958f571 rtc: U300 COH 901... |
72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 |
/* Set alarm flag */ rtc_update_irq(rtap->rtc, 1, RTC_AF); return IRQ_HANDLED; } static int coh901331_read_time(struct device *dev, struct rtc_time *tm) { struct coh901331_port *rtap = dev_get_drvdata(dev); clk_enable(rtap->clk); /* Check if the time is valid */ if (readl(rtap->virtbase + COH901331_VALID)) { rtc_time_to_tm(readl(rtap->virtbase + COH901331_CUR_TIME), tm); clk_disable(rtap->clk); return rtc_valid_tm(tm); } clk_disable(rtap->clk); return -EINVAL; } static int coh901331_set_mmss(struct device *dev, unsigned long secs) { struct coh901331_port *rtap = dev_get_drvdata(dev); clk_enable(rtap->clk); writel(secs, rtap->virtbase + COH901331_SET_TIME); clk_disable(rtap->clk); return 0; } static int coh901331_read_alarm(struct device *dev, struct rtc_wkalrm *alarm) { struct coh901331_port *rtap = dev_get_drvdata(dev); clk_enable(rtap->clk); rtc_time_to_tm(readl(rtap->virtbase + COH901331_ALARM), &alarm->time); alarm->pending = readl(rtap->virtbase + COH901331_IRQ_EVENT) & 1U; alarm->enabled = readl(rtap->virtbase + COH901331_IRQ_MASK) & 1U; clk_disable(rtap->clk); return 0; } static int coh901331_set_alarm(struct device *dev, struct rtc_wkalrm *alarm) { struct coh901331_port *rtap = dev_get_drvdata(dev); unsigned long time; rtc_tm_to_time(&alarm->time, &time); clk_enable(rtap->clk); writel(time, rtap->virtbase + COH901331_ALARM); writel(alarm->enabled, rtap->virtbase + COH901331_IRQ_MASK); clk_disable(rtap->clk); return 0; } static int coh901331_alarm_irq_enable(struct device *dev, unsigned int enabled) { struct coh901331_port *rtap = dev_get_drvdata(dev); clk_enable(rtap->clk); if (enabled) writel(1, rtap->virtbase + COH901331_IRQ_MASK); else writel(0, rtap->virtbase + COH901331_IRQ_MASK); clk_disable(rtap->clk); |
378ce74be ARM: 5787/1: U300... |
141 142 |
return 0; |
aa958f571 rtc: U300 COH 901... |
143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 |
} static struct rtc_class_ops coh901331_ops = { .read_time = coh901331_read_time, .set_mmss = coh901331_set_mmss, .read_alarm = coh901331_read_alarm, .set_alarm = coh901331_set_alarm, .alarm_irq_enable = coh901331_alarm_irq_enable, }; static int __exit coh901331_remove(struct platform_device *pdev) { struct coh901331_port *rtap = dev_get_drvdata(&pdev->dev); if (rtap) { free_irq(rtap->irq, rtap); rtc_device_unregister(rtap->rtc); clk_put(rtap->clk); iounmap(rtap->virtbase); release_mem_region(rtap->phybase, rtap->physize); platform_set_drvdata(pdev, NULL); kfree(rtap); } return 0; } static int __init coh901331_probe(struct platform_device *pdev) { int ret; struct coh901331_port *rtap; struct resource *res; rtap = kzalloc(sizeof(struct coh901331_port), GFP_KERNEL); if (!rtap) return -ENOMEM; res = platform_get_resource(pdev, IORESOURCE_MEM, 0); if (!res) { ret = -ENOENT; goto out_no_resource; } rtap->phybase = res->start; rtap->physize = resource_size(res); if (request_mem_region(rtap->phybase, rtap->physize, "rtc-coh901331") == NULL) { ret = -EBUSY; goto out_no_memregion; } rtap->virtbase = ioremap(rtap->phybase, rtap->physize); if (!rtap->virtbase) { ret = -ENOMEM; goto out_no_remap; } rtap->irq = platform_get_irq(pdev, 0); if (request_irq(rtap->irq, coh901331_interrupt, IRQF_DISABLED, "RTC COH 901 331 Alarm", rtap)) { ret = -EIO; goto out_no_irq; } rtap->clk = clk_get(&pdev->dev, NULL); if (IS_ERR(rtap->clk)) { ret = PTR_ERR(rtap->clk); dev_err(&pdev->dev, "could not get clock "); goto out_no_clk; } /* We enable/disable the clock only to assure it works */ ret = clk_enable(rtap->clk); if (ret) { dev_err(&pdev->dev, "could not enable clock "); goto out_no_clk_enable; } clk_disable(rtap->clk); |
9cf3b5fa6 rtc: fix coh90133... |
224 |
platform_set_drvdata(pdev, rtap); |
aa958f571 rtc: U300 COH 901... |
225 226 227 228 229 230 |
rtap->rtc = rtc_device_register("coh901331", &pdev->dev, &coh901331_ops, THIS_MODULE); if (IS_ERR(rtap->rtc)) { ret = PTR_ERR(rtap->rtc); goto out_no_rtc; } |
aa958f571 rtc: U300 COH 901... |
231 232 233 |
return 0; out_no_rtc: |
9cf3b5fa6 rtc: fix coh90133... |
234 |
platform_set_drvdata(pdev, NULL); |
aa958f571 rtc: U300 COH 901... |
235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 |
out_no_clk_enable: clk_put(rtap->clk); out_no_clk: free_irq(rtap->irq, rtap); out_no_irq: iounmap(rtap->virtbase); out_no_remap: platform_set_drvdata(pdev, NULL); out_no_memregion: release_mem_region(rtap->phybase, SZ_4K); out_no_resource: kfree(rtap); return ret; } #ifdef CONFIG_PM static int coh901331_suspend(struct platform_device *pdev, pm_message_t state) { struct coh901331_port *rtap = dev_get_drvdata(&pdev->dev); /* * If this RTC alarm will be used for waking the system up, * don't disable it of course. Else we just disable the alarm * and await suspension. */ if (device_may_wakeup(&pdev->dev)) { enable_irq_wake(rtap->irq); } else { clk_enable(rtap->clk); rtap->irqmaskstore = readl(rtap->virtbase + COH901331_IRQ_MASK); writel(0, rtap->virtbase + COH901331_IRQ_MASK); clk_disable(rtap->clk); } return 0; } static int coh901331_resume(struct platform_device *pdev) { struct coh901331_port *rtap = dev_get_drvdata(&pdev->dev); |
5a98c04d7 rtc-coh901331: fi... |
274 |
if (device_may_wakeup(&pdev->dev)) { |
aa958f571 rtc: U300 COH 901... |
275 |
disable_irq_wake(rtap->irq); |
5a98c04d7 rtc-coh901331: fi... |
276 |
} else { |
aa958f571 rtc: U300 COH 901... |
277 278 279 |
clk_enable(rtap->clk); writel(rtap->irqmaskstore, rtap->virtbase + COH901331_IRQ_MASK); clk_disable(rtap->clk); |
5a98c04d7 rtc-coh901331: fi... |
280 |
} |
aa958f571 rtc: U300 COH 901... |
281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 |
return 0; } #else #define coh901331_suspend NULL #define coh901331_resume NULL #endif static void coh901331_shutdown(struct platform_device *pdev) { struct coh901331_port *rtap = dev_get_drvdata(&pdev->dev); clk_enable(rtap->clk); writel(0, rtap->virtbase + COH901331_IRQ_MASK); clk_disable(rtap->clk); } static struct platform_driver coh901331_driver = { .driver = { .name = "rtc-coh901331", .owner = THIS_MODULE, }, .remove = __exit_p(coh901331_remove), .suspend = coh901331_suspend, .resume = coh901331_resume, .shutdown = coh901331_shutdown, }; static int __init coh901331_init(void) { return platform_driver_probe(&coh901331_driver, coh901331_probe); } static void __exit coh901331_exit(void) { platform_driver_unregister(&coh901331_driver); } module_init(coh901331_init); module_exit(coh901331_exit); MODULE_AUTHOR("Linus Walleij <linus.walleij@stericsson.com>"); MODULE_DESCRIPTION("ST-Ericsson AB COH 901 331 RTC Driver"); MODULE_LICENSE("GPL"); |