Linux Audio

Check our new training course

Loading...
v6.2
  1// SPDX-License-Identifier: GPL-2.0
  2/*
  3 * Driver for the RTC in Marvell SoCs.
 
 
 
 
  4 */
  5
  6#include <linux/init.h>
  7#include <linux/kernel.h>
  8#include <linux/rtc.h>
  9#include <linux/bcd.h>
 10#include <linux/bitops.h>
 11#include <linux/io.h>
 12#include <linux/platform_device.h>
 13#include <linux/of.h>
 14#include <linux/delay.h>
 15#include <linux/clk.h>
 16#include <linux/gfp.h>
 17#include <linux/module.h>
 18
 19
 20#define RTC_TIME_REG_OFFS	0
 21#define RTC_SECONDS_OFFS	0
 22#define RTC_MINUTES_OFFS	8
 23#define RTC_HOURS_OFFS		16
 24#define RTC_WDAY_OFFS		24
 25#define RTC_HOURS_12H_MODE	BIT(22) /* 12 hour mode */
 26
 27#define RTC_DATE_REG_OFFS	4
 28#define RTC_MDAY_OFFS		0
 29#define RTC_MONTH_OFFS		8
 30#define RTC_YEAR_OFFS		16
 31
 32#define RTC_ALARM_TIME_REG_OFFS	8
 33#define RTC_ALARM_DATE_REG_OFFS	0xc
 34#define RTC_ALARM_VALID		BIT(7)
 35
 36#define RTC_ALARM_INTERRUPT_MASK_REG_OFFS	0x10
 37#define RTC_ALARM_INTERRUPT_CASUE_REG_OFFS	0x14
 38
 39struct rtc_plat_data {
 40	struct rtc_device *rtc;
 41	void __iomem *ioaddr;
 42	int		irq;
 43	struct clk	*clk;
 44};
 45
 46static int mv_rtc_set_time(struct device *dev, struct rtc_time *tm)
 47{
 48	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
 49	void __iomem *ioaddr = pdata->ioaddr;
 50	u32	rtc_reg;
 51
 52	rtc_reg = (bin2bcd(tm->tm_sec) << RTC_SECONDS_OFFS) |
 53		(bin2bcd(tm->tm_min) << RTC_MINUTES_OFFS) |
 54		(bin2bcd(tm->tm_hour) << RTC_HOURS_OFFS) |
 55		(bin2bcd(tm->tm_wday) << RTC_WDAY_OFFS);
 56	writel(rtc_reg, ioaddr + RTC_TIME_REG_OFFS);
 57
 58	rtc_reg = (bin2bcd(tm->tm_mday) << RTC_MDAY_OFFS) |
 59		(bin2bcd(tm->tm_mon + 1) << RTC_MONTH_OFFS) |
 60		(bin2bcd(tm->tm_year - 100) << RTC_YEAR_OFFS);
 61	writel(rtc_reg, ioaddr + RTC_DATE_REG_OFFS);
 62
 63	return 0;
 64}
 65
 66static int mv_rtc_read_time(struct device *dev, struct rtc_time *tm)
 67{
 68	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
 69	void __iomem *ioaddr = pdata->ioaddr;
 70	u32	rtc_time, rtc_date;
 71	unsigned int year, month, day, hour, minute, second, wday;
 72
 73	rtc_time = readl(ioaddr + RTC_TIME_REG_OFFS);
 74	rtc_date = readl(ioaddr + RTC_DATE_REG_OFFS);
 75
 76	second = rtc_time & 0x7f;
 77	minute = (rtc_time >> RTC_MINUTES_OFFS) & 0x7f;
 78	hour = (rtc_time >> RTC_HOURS_OFFS) & 0x3f; /* assume 24 hour mode */
 79	wday = (rtc_time >> RTC_WDAY_OFFS) & 0x7;
 80
 81	day = rtc_date & 0x3f;
 82	month = (rtc_date >> RTC_MONTH_OFFS) & 0x3f;
 83	year = (rtc_date >> RTC_YEAR_OFFS) & 0xff;
 84
 85	tm->tm_sec = bcd2bin(second);
 86	tm->tm_min = bcd2bin(minute);
 87	tm->tm_hour = bcd2bin(hour);
 88	tm->tm_mday = bcd2bin(day);
 89	tm->tm_wday = bcd2bin(wday);
 90	tm->tm_mon = bcd2bin(month) - 1;
 91	/* hw counts from year 2000, but tm_year is relative to 1900 */
 92	tm->tm_year = bcd2bin(year) + 100;
 93
 94	return 0;
 95}
 96
 97static int mv_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alm)
 98{
 99	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
100	void __iomem *ioaddr = pdata->ioaddr;
101	u32	rtc_time, rtc_date;
102	unsigned int year, month, day, hour, minute, second, wday;
103
104	rtc_time = readl(ioaddr + RTC_ALARM_TIME_REG_OFFS);
105	rtc_date = readl(ioaddr + RTC_ALARM_DATE_REG_OFFS);
106
107	second = rtc_time & 0x7f;
108	minute = (rtc_time >> RTC_MINUTES_OFFS) & 0x7f;
109	hour = (rtc_time >> RTC_HOURS_OFFS) & 0x3f; /* assume 24 hour mode */
110	wday = (rtc_time >> RTC_WDAY_OFFS) & 0x7;
111
112	day = rtc_date & 0x3f;
113	month = (rtc_date >> RTC_MONTH_OFFS) & 0x3f;
114	year = (rtc_date >> RTC_YEAR_OFFS) & 0xff;
115
116	alm->time.tm_sec = bcd2bin(second);
117	alm->time.tm_min = bcd2bin(minute);
118	alm->time.tm_hour = bcd2bin(hour);
119	alm->time.tm_mday = bcd2bin(day);
120	alm->time.tm_wday = bcd2bin(wday);
121	alm->time.tm_mon = bcd2bin(month) - 1;
122	/* hw counts from year 2000, but tm_year is relative to 1900 */
123	alm->time.tm_year = bcd2bin(year) + 100;
124
125	alm->enabled = !!readl(ioaddr + RTC_ALARM_INTERRUPT_MASK_REG_OFFS);
 
 
 
126
127	return rtc_valid_tm(&alm->time);
 
128}
129
130static int mv_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alm)
131{
132	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
133	void __iomem *ioaddr = pdata->ioaddr;
134	u32 rtc_reg = 0;
135
136	if (alm->time.tm_sec >= 0)
137		rtc_reg |= (RTC_ALARM_VALID | bin2bcd(alm->time.tm_sec))
138			<< RTC_SECONDS_OFFS;
139	if (alm->time.tm_min >= 0)
140		rtc_reg |= (RTC_ALARM_VALID | bin2bcd(alm->time.tm_min))
141			<< RTC_MINUTES_OFFS;
142	if (alm->time.tm_hour >= 0)
143		rtc_reg |= (RTC_ALARM_VALID | bin2bcd(alm->time.tm_hour))
144			<< RTC_HOURS_OFFS;
145
146	writel(rtc_reg, ioaddr + RTC_ALARM_TIME_REG_OFFS);
147
148	if (alm->time.tm_mday >= 0)
149		rtc_reg = (RTC_ALARM_VALID | bin2bcd(alm->time.tm_mday))
150			<< RTC_MDAY_OFFS;
151	else
152		rtc_reg = 0;
153
154	if (alm->time.tm_mon >= 0)
155		rtc_reg |= (RTC_ALARM_VALID | bin2bcd(alm->time.tm_mon + 1))
156			<< RTC_MONTH_OFFS;
157
158	if (alm->time.tm_year >= 0)
159		rtc_reg |= (RTC_ALARM_VALID | bin2bcd(alm->time.tm_year - 100))
160			<< RTC_YEAR_OFFS;
161
162	writel(rtc_reg, ioaddr + RTC_ALARM_DATE_REG_OFFS);
163	writel(0, ioaddr + RTC_ALARM_INTERRUPT_CASUE_REG_OFFS);
164	writel(alm->enabled ? 1 : 0,
165	       ioaddr + RTC_ALARM_INTERRUPT_MASK_REG_OFFS);
166
167	return 0;
168}
169
170static int mv_rtc_alarm_irq_enable(struct device *dev, unsigned int enabled)
171{
172	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
 
173	void __iomem *ioaddr = pdata->ioaddr;
174
175	if (pdata->irq < 0)
176		return -EINVAL; /* fall back into rtc-dev's emulation */
177
178	if (enabled)
179		writel(1, ioaddr + RTC_ALARM_INTERRUPT_MASK_REG_OFFS);
180	else
181		writel(0, ioaddr + RTC_ALARM_INTERRUPT_MASK_REG_OFFS);
182	return 0;
183}
184
185static irqreturn_t mv_rtc_interrupt(int irq, void *data)
186{
187	struct rtc_plat_data *pdata = data;
188	void __iomem *ioaddr = pdata->ioaddr;
189
190	/* alarm irq? */
191	if (!readl(ioaddr + RTC_ALARM_INTERRUPT_CASUE_REG_OFFS))
192		return IRQ_NONE;
193
194	/* clear interrupt */
195	writel(0, ioaddr + RTC_ALARM_INTERRUPT_CASUE_REG_OFFS);
196	rtc_update_irq(pdata->rtc, 1, RTC_IRQF | RTC_AF);
197	return IRQ_HANDLED;
198}
199
200static const struct rtc_class_ops mv_rtc_ops = {
201	.read_time	= mv_rtc_read_time,
202	.set_time	= mv_rtc_set_time,
 
 
 
 
 
203	.read_alarm	= mv_rtc_read_alarm,
204	.set_alarm	= mv_rtc_set_alarm,
205	.alarm_irq_enable = mv_rtc_alarm_irq_enable,
206};
207
208static int __init mv_rtc_probe(struct platform_device *pdev)
209{
 
210	struct rtc_plat_data *pdata;
211	u32 rtc_time;
212	int ret = 0;
213
214	pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
215	if (!pdata)
216		return -ENOMEM;
217
218	pdata->ioaddr = devm_platform_ioremap_resource(pdev, 0);
 
219	if (IS_ERR(pdata->ioaddr))
220		return PTR_ERR(pdata->ioaddr);
221
222	pdata->clk = devm_clk_get(&pdev->dev, NULL);
223	/* Not all SoCs require a clock.*/
224	if (!IS_ERR(pdata->clk))
225		clk_prepare_enable(pdata->clk);
226
227	/* make sure the 24 hour mode is enabled */
228	rtc_time = readl(pdata->ioaddr + RTC_TIME_REG_OFFS);
229	if (rtc_time & RTC_HOURS_12H_MODE) {
230		dev_err(&pdev->dev, "12 Hour mode is enabled but not supported.\n");
231		ret = -EINVAL;
232		goto out;
233	}
234
235	/* make sure it is actually functional */
236	if (rtc_time == 0x01000000) {
237		ssleep(1);
238		rtc_time = readl(pdata->ioaddr + RTC_TIME_REG_OFFS);
239		if (rtc_time == 0x01000000) {
240			dev_err(&pdev->dev, "internal RTC not ticking\n");
241			ret = -ENODEV;
242			goto out;
243		}
244	}
245
246	pdata->irq = platform_get_irq(pdev, 0);
247
248	platform_set_drvdata(pdev, pdata);
249
250	pdata->rtc = devm_rtc_allocate_device(&pdev->dev);
 
 
 
 
 
 
 
 
251	if (IS_ERR(pdata->rtc)) {
252		ret = PTR_ERR(pdata->rtc);
253		goto out;
254	}
255
256	if (pdata->irq >= 0) {
257		writel(0, pdata->ioaddr + RTC_ALARM_INTERRUPT_MASK_REG_OFFS);
258		if (devm_request_irq(&pdev->dev, pdata->irq, mv_rtc_interrupt,
259				     IRQF_SHARED,
260				     pdev->name, pdata) < 0) {
261			dev_warn(&pdev->dev, "interrupt not available.\n");
262			pdata->irq = -1;
263		}
264	}
265
266	if (pdata->irq >= 0)
267		device_init_wakeup(&pdev->dev, 1);
268	else
269		clear_bit(RTC_FEATURE_ALARM, pdata->rtc->features);
270
271	pdata->rtc->ops = &mv_rtc_ops;
272	pdata->rtc->range_min = RTC_TIMESTAMP_BEGIN_2000;
273	pdata->rtc->range_max = RTC_TIMESTAMP_END_2099;
274
275	ret = devm_rtc_register_device(pdata->rtc);
276	if (!ret)
277		return 0;
278out:
279	if (!IS_ERR(pdata->clk))
280		clk_disable_unprepare(pdata->clk);
281
282	return ret;
283}
284
285static int __exit mv_rtc_remove(struct platform_device *pdev)
286{
287	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
288
289	if (pdata->irq >= 0)
290		device_init_wakeup(&pdev->dev, 0);
291
292	if (!IS_ERR(pdata->clk))
293		clk_disable_unprepare(pdata->clk);
294
295	return 0;
296}
297
298#ifdef CONFIG_OF
299static const struct of_device_id rtc_mv_of_match_table[] = {
300	{ .compatible = "marvell,orion-rtc", },
301	{}
302};
303MODULE_DEVICE_TABLE(of, rtc_mv_of_match_table);
304#endif
305
306static struct platform_driver mv_rtc_driver = {
307	.remove		= __exit_p(mv_rtc_remove),
308	.driver		= {
309		.name	= "rtc-mv",
310		.of_match_table = of_match_ptr(rtc_mv_of_match_table),
311	},
312};
313
314module_platform_driver_probe(mv_rtc_driver, mv_rtc_probe);
315
316MODULE_AUTHOR("Saeed Bishara <saeed@marvell.com>");
317MODULE_DESCRIPTION("Marvell RTC driver");
318MODULE_LICENSE("GPL");
319MODULE_ALIAS("platform:rtc-mv");
v4.17
 
  1/*
  2 * Driver for the RTC in Marvell SoCs.
  3 *
  4 * This file is licensed under the terms of the GNU General Public
  5 * License version 2.  This program is licensed "as is" without any
  6 * warranty of any kind, whether express or implied.
  7 */
  8
  9#include <linux/init.h>
 10#include <linux/kernel.h>
 11#include <linux/rtc.h>
 12#include <linux/bcd.h>
 13#include <linux/bitops.h>
 14#include <linux/io.h>
 15#include <linux/platform_device.h>
 16#include <linux/of.h>
 17#include <linux/delay.h>
 18#include <linux/clk.h>
 19#include <linux/gfp.h>
 20#include <linux/module.h>
 21
 22
 23#define RTC_TIME_REG_OFFS	0
 24#define RTC_SECONDS_OFFS	0
 25#define RTC_MINUTES_OFFS	8
 26#define RTC_HOURS_OFFS		16
 27#define RTC_WDAY_OFFS		24
 28#define RTC_HOURS_12H_MODE	BIT(22) /* 12 hour mode */
 29
 30#define RTC_DATE_REG_OFFS	4
 31#define RTC_MDAY_OFFS		0
 32#define RTC_MONTH_OFFS		8
 33#define RTC_YEAR_OFFS		16
 34
 35#define RTC_ALARM_TIME_REG_OFFS	8
 36#define RTC_ALARM_DATE_REG_OFFS	0xc
 37#define RTC_ALARM_VALID		BIT(7)
 38
 39#define RTC_ALARM_INTERRUPT_MASK_REG_OFFS	0x10
 40#define RTC_ALARM_INTERRUPT_CASUE_REG_OFFS	0x14
 41
 42struct rtc_plat_data {
 43	struct rtc_device *rtc;
 44	void __iomem *ioaddr;
 45	int		irq;
 46	struct clk	*clk;
 47};
 48
 49static int mv_rtc_set_time(struct device *dev, struct rtc_time *tm)
 50{
 51	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
 52	void __iomem *ioaddr = pdata->ioaddr;
 53	u32	rtc_reg;
 54
 55	rtc_reg = (bin2bcd(tm->tm_sec) << RTC_SECONDS_OFFS) |
 56		(bin2bcd(tm->tm_min) << RTC_MINUTES_OFFS) |
 57		(bin2bcd(tm->tm_hour) << RTC_HOURS_OFFS) |
 58		(bin2bcd(tm->tm_wday) << RTC_WDAY_OFFS);
 59	writel(rtc_reg, ioaddr + RTC_TIME_REG_OFFS);
 60
 61	rtc_reg = (bin2bcd(tm->tm_mday) << RTC_MDAY_OFFS) |
 62		(bin2bcd(tm->tm_mon + 1) << RTC_MONTH_OFFS) |
 63		(bin2bcd(tm->tm_year % 100) << RTC_YEAR_OFFS);
 64	writel(rtc_reg, ioaddr + RTC_DATE_REG_OFFS);
 65
 66	return 0;
 67}
 68
 69static int mv_rtc_read_time(struct device *dev, struct rtc_time *tm)
 70{
 71	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
 72	void __iomem *ioaddr = pdata->ioaddr;
 73	u32	rtc_time, rtc_date;
 74	unsigned int year, month, day, hour, minute, second, wday;
 75
 76	rtc_time = readl(ioaddr + RTC_TIME_REG_OFFS);
 77	rtc_date = readl(ioaddr + RTC_DATE_REG_OFFS);
 78
 79	second = rtc_time & 0x7f;
 80	minute = (rtc_time >> RTC_MINUTES_OFFS) & 0x7f;
 81	hour = (rtc_time >> RTC_HOURS_OFFS) & 0x3f; /* assume 24 hour mode */
 82	wday = (rtc_time >> RTC_WDAY_OFFS) & 0x7;
 83
 84	day = rtc_date & 0x3f;
 85	month = (rtc_date >> RTC_MONTH_OFFS) & 0x3f;
 86	year = (rtc_date >> RTC_YEAR_OFFS) & 0xff;
 87
 88	tm->tm_sec = bcd2bin(second);
 89	tm->tm_min = bcd2bin(minute);
 90	tm->tm_hour = bcd2bin(hour);
 91	tm->tm_mday = bcd2bin(day);
 92	tm->tm_wday = bcd2bin(wday);
 93	tm->tm_mon = bcd2bin(month) - 1;
 94	/* hw counts from year 2000, but tm_year is relative to 1900 */
 95	tm->tm_year = bcd2bin(year) + 100;
 96
 97	return 0;
 98}
 99
100static int mv_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alm)
101{
102	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
103	void __iomem *ioaddr = pdata->ioaddr;
104	u32	rtc_time, rtc_date;
105	unsigned int year, month, day, hour, minute, second, wday;
106
107	rtc_time = readl(ioaddr + RTC_ALARM_TIME_REG_OFFS);
108	rtc_date = readl(ioaddr + RTC_ALARM_DATE_REG_OFFS);
109
110	second = rtc_time & 0x7f;
111	minute = (rtc_time >> RTC_MINUTES_OFFS) & 0x7f;
112	hour = (rtc_time >> RTC_HOURS_OFFS) & 0x3f; /* assume 24 hour mode */
113	wday = (rtc_time >> RTC_WDAY_OFFS) & 0x7;
114
115	day = rtc_date & 0x3f;
116	month = (rtc_date >> RTC_MONTH_OFFS) & 0x3f;
117	year = (rtc_date >> RTC_YEAR_OFFS) & 0xff;
118
119	alm->time.tm_sec = bcd2bin(second);
120	alm->time.tm_min = bcd2bin(minute);
121	alm->time.tm_hour = bcd2bin(hour);
122	alm->time.tm_mday = bcd2bin(day);
123	alm->time.tm_wday = bcd2bin(wday);
124	alm->time.tm_mon = bcd2bin(month) - 1;
125	/* hw counts from year 2000, but tm_year is relative to 1900 */
126	alm->time.tm_year = bcd2bin(year) + 100;
127
128	if (rtc_valid_tm(&alm->time) < 0) {
129		dev_err(dev, "retrieved alarm date/time is not valid.\n");
130		rtc_time_to_tm(0, &alm->time);
131	}
132
133	alm->enabled = !!readl(ioaddr + RTC_ALARM_INTERRUPT_MASK_REG_OFFS);
134	return 0;
135}
136
137static int mv_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alm)
138{
139	struct rtc_plat_data *pdata = dev_get_drvdata(dev);
140	void __iomem *ioaddr = pdata->ioaddr;
141	u32 rtc_reg = 0;
142
143	if (alm->time.tm_sec >= 0)
144		rtc_reg |= (RTC_ALARM_VALID | bin2bcd(alm->time.tm_sec))
145			<< RTC_SECONDS_OFFS;
146	if (alm->time.tm_min >= 0)
147		rtc_reg |= (RTC_ALARM_VALID | bin2bcd(alm->time.tm_min))
148			<< RTC_MINUTES_OFFS;
149	if (alm->time.tm_hour >= 0)
150		rtc_reg |= (RTC_ALARM_VALID | bin2bcd(alm->time.tm_hour))
151			<< RTC_HOURS_OFFS;
152
153	writel(rtc_reg, ioaddr + RTC_ALARM_TIME_REG_OFFS);
154
155	if (alm->time.tm_mday >= 0)
156		rtc_reg = (RTC_ALARM_VALID | bin2bcd(alm->time.tm_mday))
157			<< RTC_MDAY_OFFS;
158	else
159		rtc_reg = 0;
160
161	if (alm->time.tm_mon >= 0)
162		rtc_reg |= (RTC_ALARM_VALID | bin2bcd(alm->time.tm_mon + 1))
163			<< RTC_MONTH_OFFS;
164
165	if (alm->time.tm_year >= 0)
166		rtc_reg |= (RTC_ALARM_VALID | bin2bcd(alm->time.tm_year % 100))
167			<< RTC_YEAR_OFFS;
168
169	writel(rtc_reg, ioaddr + RTC_ALARM_DATE_REG_OFFS);
170	writel(0, ioaddr + RTC_ALARM_INTERRUPT_CASUE_REG_OFFS);
171	writel(alm->enabled ? 1 : 0,
172	       ioaddr + RTC_ALARM_INTERRUPT_MASK_REG_OFFS);
173
174	return 0;
175}
176
177static int mv_rtc_alarm_irq_enable(struct device *dev, unsigned int enabled)
178{
179	struct platform_device *pdev = to_platform_device(dev);
180	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
181	void __iomem *ioaddr = pdata->ioaddr;
182
183	if (pdata->irq < 0)
184		return -EINVAL; /* fall back into rtc-dev's emulation */
185
186	if (enabled)
187		writel(1, ioaddr + RTC_ALARM_INTERRUPT_MASK_REG_OFFS);
188	else
189		writel(0, ioaddr + RTC_ALARM_INTERRUPT_MASK_REG_OFFS);
190	return 0;
191}
192
193static irqreturn_t mv_rtc_interrupt(int irq, void *data)
194{
195	struct rtc_plat_data *pdata = data;
196	void __iomem *ioaddr = pdata->ioaddr;
197
198	/* alarm irq? */
199	if (!readl(ioaddr + RTC_ALARM_INTERRUPT_CASUE_REG_OFFS))
200		return IRQ_NONE;
201
202	/* clear interrupt */
203	writel(0, ioaddr + RTC_ALARM_INTERRUPT_CASUE_REG_OFFS);
204	rtc_update_irq(pdata->rtc, 1, RTC_IRQF | RTC_AF);
205	return IRQ_HANDLED;
206}
207
208static const struct rtc_class_ops mv_rtc_ops = {
209	.read_time	= mv_rtc_read_time,
210	.set_time	= mv_rtc_set_time,
211};
212
213static const struct rtc_class_ops mv_rtc_alarm_ops = {
214	.read_time	= mv_rtc_read_time,
215	.set_time	= mv_rtc_set_time,
216	.read_alarm	= mv_rtc_read_alarm,
217	.set_alarm	= mv_rtc_set_alarm,
218	.alarm_irq_enable = mv_rtc_alarm_irq_enable,
219};
220
221static int __init mv_rtc_probe(struct platform_device *pdev)
222{
223	struct resource *res;
224	struct rtc_plat_data *pdata;
225	u32 rtc_time;
226	int ret = 0;
227
228	pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
229	if (!pdata)
230		return -ENOMEM;
231
232	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
233	pdata->ioaddr = devm_ioremap_resource(&pdev->dev, res);
234	if (IS_ERR(pdata->ioaddr))
235		return PTR_ERR(pdata->ioaddr);
236
237	pdata->clk = devm_clk_get(&pdev->dev, NULL);
238	/* Not all SoCs require a clock.*/
239	if (!IS_ERR(pdata->clk))
240		clk_prepare_enable(pdata->clk);
241
242	/* make sure the 24 hour mode is enabled */
243	rtc_time = readl(pdata->ioaddr + RTC_TIME_REG_OFFS);
244	if (rtc_time & RTC_HOURS_12H_MODE) {
245		dev_err(&pdev->dev, "12 Hour mode is enabled but not supported.\n");
246		ret = -EINVAL;
247		goto out;
248	}
249
250	/* make sure it is actually functional */
251	if (rtc_time == 0x01000000) {
252		ssleep(1);
253		rtc_time = readl(pdata->ioaddr + RTC_TIME_REG_OFFS);
254		if (rtc_time == 0x01000000) {
255			dev_err(&pdev->dev, "internal RTC not ticking\n");
256			ret = -ENODEV;
257			goto out;
258		}
259	}
260
261	pdata->irq = platform_get_irq(pdev, 0);
262
263	platform_set_drvdata(pdev, pdata);
264
265	if (pdata->irq >= 0) {
266		device_init_wakeup(&pdev->dev, 1);
267		pdata->rtc = devm_rtc_device_register(&pdev->dev, pdev->name,
268						 &mv_rtc_alarm_ops,
269						 THIS_MODULE);
270	} else {
271		pdata->rtc = devm_rtc_device_register(&pdev->dev, pdev->name,
272						 &mv_rtc_ops, THIS_MODULE);
273	}
274	if (IS_ERR(pdata->rtc)) {
275		ret = PTR_ERR(pdata->rtc);
276		goto out;
277	}
278
279	if (pdata->irq >= 0) {
280		writel(0, pdata->ioaddr + RTC_ALARM_INTERRUPT_MASK_REG_OFFS);
281		if (devm_request_irq(&pdev->dev, pdata->irq, mv_rtc_interrupt,
282				     IRQF_SHARED,
283				     pdev->name, pdata) < 0) {
284			dev_warn(&pdev->dev, "interrupt not available.\n");
285			pdata->irq = -1;
286		}
287	}
288
289	return 0;
 
 
 
 
 
 
 
 
 
 
 
290out:
291	if (!IS_ERR(pdata->clk))
292		clk_disable_unprepare(pdata->clk);
293
294	return ret;
295}
296
297static int __exit mv_rtc_remove(struct platform_device *pdev)
298{
299	struct rtc_plat_data *pdata = platform_get_drvdata(pdev);
300
301	if (pdata->irq >= 0)
302		device_init_wakeup(&pdev->dev, 0);
303
304	if (!IS_ERR(pdata->clk))
305		clk_disable_unprepare(pdata->clk);
306
307	return 0;
308}
309
310#ifdef CONFIG_OF
311static const struct of_device_id rtc_mv_of_match_table[] = {
312	{ .compatible = "marvell,orion-rtc", },
313	{}
314};
315MODULE_DEVICE_TABLE(of, rtc_mv_of_match_table);
316#endif
317
318static struct platform_driver mv_rtc_driver = {
319	.remove		= __exit_p(mv_rtc_remove),
320	.driver		= {
321		.name	= "rtc-mv",
322		.of_match_table = of_match_ptr(rtc_mv_of_match_table),
323	},
324};
325
326module_platform_driver_probe(mv_rtc_driver, mv_rtc_probe);
327
328MODULE_AUTHOR("Saeed Bishara <saeed@marvell.com>");
329MODULE_DESCRIPTION("Marvell RTC driver");
330MODULE_LICENSE("GPL");
331MODULE_ALIAS("platform:rtc-mv");