Blame view
drivers/rtc/rtc-pcap.c
4.87 KB
d3c7a3f71
|
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 |
/* * pcap rtc code for Motorola EZX phones * * Copyright (c) 2008 guiming zhuo <gmzhuo@gmail.com> * Copyright (c) 2009 Daniel Ribeiro <drwyrm@gmail.com> * * Based on Motorola's rtc.c Copyright (c) 2003-2005 Motorola * * 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/kernel.h> #include <linux/module.h> #include <linux/init.h> #include <linux/mfd/ezx-pcap.h> #include <linux/rtc.h> |
5a0e3ad6a
|
20 |
#include <linux/slab.h> |
d3c7a3f71
|
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 62 63 64 65 66 67 68 69 70 71 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 |
#include <linux/platform_device.h> struct pcap_rtc { struct pcap_chip *pcap; struct rtc_device *rtc; }; static irqreturn_t pcap_rtc_irq(int irq, void *_pcap_rtc) { struct pcap_rtc *pcap_rtc = _pcap_rtc; unsigned long rtc_events; if (irq == pcap_to_irq(pcap_rtc->pcap, PCAP_IRQ_1HZ)) rtc_events = RTC_IRQF | RTC_UF; else if (irq == pcap_to_irq(pcap_rtc->pcap, PCAP_IRQ_TODA)) rtc_events = RTC_IRQF | RTC_AF; else rtc_events = 0; rtc_update_irq(pcap_rtc->rtc, 1, rtc_events); return IRQ_HANDLED; } static int pcap_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm) { struct platform_device *pdev = to_platform_device(dev); struct pcap_rtc *pcap_rtc = platform_get_drvdata(pdev); struct rtc_time *tm = &alrm->time; unsigned long secs; u32 tod; /* time of day, seconds since midnight */ u32 days; /* days since 1/1/1970 */ ezx_pcap_read(pcap_rtc->pcap, PCAP_REG_RTC_TODA, &tod); secs = tod & PCAP_RTC_TOD_MASK; ezx_pcap_read(pcap_rtc->pcap, PCAP_REG_RTC_DAYA, &days); secs += (days & PCAP_RTC_DAY_MASK) * SEC_PER_DAY; rtc_time_to_tm(secs, tm); return 0; } static int pcap_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm) { struct platform_device *pdev = to_platform_device(dev); struct pcap_rtc *pcap_rtc = platform_get_drvdata(pdev); struct rtc_time *tm = &alrm->time; unsigned long secs; u32 tod, days; rtc_tm_to_time(tm, &secs); tod = secs % SEC_PER_DAY; ezx_pcap_write(pcap_rtc->pcap, PCAP_REG_RTC_TODA, tod); days = secs / SEC_PER_DAY; ezx_pcap_write(pcap_rtc->pcap, PCAP_REG_RTC_DAYA, days); return 0; } static int pcap_rtc_read_time(struct device *dev, struct rtc_time *tm) { struct platform_device *pdev = to_platform_device(dev); struct pcap_rtc *pcap_rtc = platform_get_drvdata(pdev); unsigned long secs; u32 tod, days; ezx_pcap_read(pcap_rtc->pcap, PCAP_REG_RTC_TOD, &tod); secs = tod & PCAP_RTC_TOD_MASK; ezx_pcap_read(pcap_rtc->pcap, PCAP_REG_RTC_DAY, &days); secs += (days & PCAP_RTC_DAY_MASK) * SEC_PER_DAY; rtc_time_to_tm(secs, tm); return rtc_valid_tm(tm); } static int pcap_rtc_set_mmss(struct device *dev, unsigned long secs) { struct platform_device *pdev = to_platform_device(dev); struct pcap_rtc *pcap_rtc = platform_get_drvdata(pdev); u32 tod, days; tod = secs % SEC_PER_DAY; ezx_pcap_write(pcap_rtc->pcap, PCAP_REG_RTC_TOD, tod); days = secs / SEC_PER_DAY; ezx_pcap_write(pcap_rtc->pcap, PCAP_REG_RTC_DAY, days); return 0; } static int pcap_rtc_irq_enable(struct device *dev, int pirq, unsigned int en) { struct platform_device *pdev = to_platform_device(dev); struct pcap_rtc *pcap_rtc = platform_get_drvdata(pdev); if (en) enable_irq(pcap_to_irq(pcap_rtc->pcap, pirq)); else disable_irq(pcap_to_irq(pcap_rtc->pcap, pirq)); return 0; } static int pcap_rtc_alarm_irq_enable(struct device *dev, unsigned int en) { return pcap_rtc_irq_enable(dev, PCAP_IRQ_TODA, en); } |
d3c7a3f71
|
133 134 135 136 137 138 |
static const struct rtc_class_ops pcap_rtc_ops = { .read_time = pcap_rtc_read_time, .read_alarm = pcap_rtc_read_alarm, .set_alarm = pcap_rtc_set_alarm, .set_mmss = pcap_rtc_set_mmss, .alarm_irq_enable = pcap_rtc_alarm_irq_enable, |
d3c7a3f71
|
139 |
}; |
5cc2b9c67
|
140 |
static int __init pcap_rtc_probe(struct platform_device *pdev) |
d3c7a3f71
|
141 142 143 144 |
{ struct pcap_rtc *pcap_rtc; int timer_irq, alarm_irq; int err = -ENOMEM; |
6b5f48622
|
145 146 |
pcap_rtc = devm_kzalloc(&pdev->dev, sizeof(struct pcap_rtc), GFP_KERNEL); |
d3c7a3f71
|
147 148 149 150 |
if (!pcap_rtc) return err; pcap_rtc->pcap = dev_get_drvdata(pdev->dev.parent); |
4b3687f9c
|
151 |
platform_set_drvdata(pdev, pcap_rtc); |
6b5f48622
|
152 153 |
pcap_rtc->rtc = devm_rtc_device_register(&pdev->dev, "pcap", &pcap_rtc_ops, THIS_MODULE); |
a1c805a9b
|
154 155 |
if (IS_ERR(pcap_rtc->rtc)) return PTR_ERR(pcap_rtc->rtc); |
d3c7a3f71
|
156 |
|
d3c7a3f71
|
157 158 |
timer_irq = pcap_to_irq(pcap_rtc->pcap, PCAP_IRQ_1HZ); alarm_irq = pcap_to_irq(pcap_rtc->pcap, PCAP_IRQ_TODA); |
6b5f48622
|
159 160 |
err = devm_request_irq(&pdev->dev, timer_irq, pcap_rtc_irq, 0, "RTC Timer", pcap_rtc); |
d3c7a3f71
|
161 |
if (err) |
a1c805a9b
|
162 |
return err; |
d3c7a3f71
|
163 |
|
6b5f48622
|
164 165 |
err = devm_request_irq(&pdev->dev, alarm_irq, pcap_rtc_irq, 0, "RTC Alarm", pcap_rtc); |
d3c7a3f71
|
166 |
if (err) |
a1c805a9b
|
167 |
return err; |
d3c7a3f71
|
168 169 |
return 0; |
d3c7a3f71
|
170 |
} |
5cc2b9c67
|
171 |
static int __exit pcap_rtc_remove(struct platform_device *pdev) |
d3c7a3f71
|
172 |
{ |
d3c7a3f71
|
173 174 175 176 |
return 0; } static struct platform_driver pcap_rtc_driver = { |
5cc2b9c67
|
177 |
.remove = __exit_p(pcap_rtc_remove), |
d3c7a3f71
|
178 179 |
.driver = { .name = "pcap-rtc", |
d3c7a3f71
|
180 181 |
}, }; |
0de4c7c15
|
182 |
module_platform_driver_probe(pcap_rtc_driver, pcap_rtc_probe); |
d3c7a3f71
|
183 184 185 186 |
MODULE_DESCRIPTION("Motorola pcap rtc driver"); MODULE_AUTHOR("guiming zhuo <gmzhuo@gmail.com>"); MODULE_LICENSE("GPL"); |