treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / rtc / rtc-m48t35.c
blobe8194f1f01a8ba88dc8501d286720cb5ea52e69b
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Driver for the SGS-Thomson M48T35 Timekeeper RAM chip
5 * Copyright (C) 2000 Silicon Graphics, Inc.
6 * Written by Ulf Carlsson (ulfc@engr.sgi.com)
8 * Copyright (C) 2008 Thomas Bogendoerfer
10 * Based on code written by Paul Gortmaker.
13 #include <linux/module.h>
14 #include <linux/rtc.h>
15 #include <linux/slab.h>
16 #include <linux/platform_device.h>
17 #include <linux/bcd.h>
18 #include <linux/io.h>
19 #include <linux/err.h>
21 struct m48t35_rtc {
22 u8 pad[0x7ff8]; /* starts at 0x7ff8 */
23 #ifdef CONFIG_SGI_IP27
24 u8 hour;
25 u8 min;
26 u8 sec;
27 u8 control;
28 u8 year;
29 u8 month;
30 u8 date;
31 u8 day;
32 #else
33 u8 control;
34 u8 sec;
35 u8 min;
36 u8 hour;
37 u8 day;
38 u8 date;
39 u8 month;
40 u8 year;
41 #endif
44 #define M48T35_RTC_SET 0x80
45 #define M48T35_RTC_READ 0x40
47 struct m48t35_priv {
48 struct rtc_device *rtc;
49 struct m48t35_rtc __iomem *reg;
50 size_t size;
51 unsigned long baseaddr;
52 spinlock_t lock;
55 static int m48t35_read_time(struct device *dev, struct rtc_time *tm)
57 struct m48t35_priv *priv = dev_get_drvdata(dev);
58 u8 control;
61 * Only the values that we read from the RTC are set. We leave
62 * tm_wday, tm_yday and tm_isdst untouched. Even though the
63 * RTC has RTC_DAY_OF_WEEK, we ignore it, as it is only updated
64 * by the RTC when initially set to a non-zero value.
66 spin_lock_irq(&priv->lock);
67 control = readb(&priv->reg->control);
68 writeb(control | M48T35_RTC_READ, &priv->reg->control);
69 tm->tm_sec = readb(&priv->reg->sec);
70 tm->tm_min = readb(&priv->reg->min);
71 tm->tm_hour = readb(&priv->reg->hour);
72 tm->tm_mday = readb(&priv->reg->date);
73 tm->tm_mon = readb(&priv->reg->month);
74 tm->tm_year = readb(&priv->reg->year);
75 writeb(control, &priv->reg->control);
76 spin_unlock_irq(&priv->lock);
78 tm->tm_sec = bcd2bin(tm->tm_sec);
79 tm->tm_min = bcd2bin(tm->tm_min);
80 tm->tm_hour = bcd2bin(tm->tm_hour);
81 tm->tm_mday = bcd2bin(tm->tm_mday);
82 tm->tm_mon = bcd2bin(tm->tm_mon);
83 tm->tm_year = bcd2bin(tm->tm_year);
86 * Account for differences between how the RTC uses the values
87 * and how they are defined in a struct rtc_time;
89 tm->tm_year += 70;
90 if (tm->tm_year <= 69)
91 tm->tm_year += 100;
93 tm->tm_mon--;
94 return 0;
97 static int m48t35_set_time(struct device *dev, struct rtc_time *tm)
99 struct m48t35_priv *priv = dev_get_drvdata(dev);
100 unsigned char mon, day, hrs, min, sec;
101 unsigned int yrs;
102 u8 control;
104 yrs = tm->tm_year + 1900;
105 mon = tm->tm_mon + 1; /* tm_mon starts at zero */
106 day = tm->tm_mday;
107 hrs = tm->tm_hour;
108 min = tm->tm_min;
109 sec = tm->tm_sec;
111 if (yrs < 1970)
112 return -EINVAL;
114 yrs -= 1970;
115 if (yrs > 255) /* They are unsigned */
116 return -EINVAL;
118 if (yrs > 169)
119 return -EINVAL;
121 if (yrs >= 100)
122 yrs -= 100;
124 sec = bin2bcd(sec);
125 min = bin2bcd(min);
126 hrs = bin2bcd(hrs);
127 day = bin2bcd(day);
128 mon = bin2bcd(mon);
129 yrs = bin2bcd(yrs);
131 spin_lock_irq(&priv->lock);
132 control = readb(&priv->reg->control);
133 writeb(control | M48T35_RTC_SET, &priv->reg->control);
134 writeb(yrs, &priv->reg->year);
135 writeb(mon, &priv->reg->month);
136 writeb(day, &priv->reg->date);
137 writeb(hrs, &priv->reg->hour);
138 writeb(min, &priv->reg->min);
139 writeb(sec, &priv->reg->sec);
140 writeb(control, &priv->reg->control);
141 spin_unlock_irq(&priv->lock);
142 return 0;
145 static const struct rtc_class_ops m48t35_ops = {
146 .read_time = m48t35_read_time,
147 .set_time = m48t35_set_time,
150 static int m48t35_probe(struct platform_device *pdev)
152 struct resource *res;
153 struct m48t35_priv *priv;
155 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
156 if (!res)
157 return -ENODEV;
158 priv = devm_kzalloc(&pdev->dev, sizeof(struct m48t35_priv), GFP_KERNEL);
159 if (!priv)
160 return -ENOMEM;
162 priv->size = resource_size(res);
164 * kludge: remove the #ifndef after ioc3 resource
165 * conflicts are resolved
167 #ifndef CONFIG_SGI_IP27
168 if (!devm_request_mem_region(&pdev->dev, res->start, priv->size,
169 pdev->name))
170 return -EBUSY;
171 #endif
172 priv->baseaddr = res->start;
173 priv->reg = devm_ioremap(&pdev->dev, priv->baseaddr, priv->size);
174 if (!priv->reg)
175 return -ENOMEM;
177 spin_lock_init(&priv->lock);
179 platform_set_drvdata(pdev, priv);
181 priv->rtc = devm_rtc_device_register(&pdev->dev, "m48t35",
182 &m48t35_ops, THIS_MODULE);
183 return PTR_ERR_OR_ZERO(priv->rtc);
186 static struct platform_driver m48t35_platform_driver = {
187 .driver = {
188 .name = "rtc-m48t35",
190 .probe = m48t35_probe,
193 module_platform_driver(m48t35_platform_driver);
195 MODULE_AUTHOR("Thomas Bogendoerfer <tsbogend@alpha.franken.de>");
196 MODULE_DESCRIPTION("M48T35 RTC driver");
197 MODULE_LICENSE("GPL");
198 MODULE_ALIAS("platform:rtc-m48t35");