staging: wfx: fix rate control handling
[linux/fpc-iii.git] / drivers / rtc / rtc-pcf8523.c
blobb24c908f5f064ce916dba6a892d0a6f37c494203
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (C) 2012 Avionic Design GmbH
4 */
6 #include <linux/bcd.h>
7 #include <linux/i2c.h>
8 #include <linux/module.h>
9 #include <linux/rtc.h>
10 #include <linux/of.h>
12 #define DRIVER_NAME "rtc-pcf8523"
14 #define REG_CONTROL1 0x00
15 #define REG_CONTROL1_CAP_SEL (1 << 7)
16 #define REG_CONTROL1_STOP (1 << 5)
18 #define REG_CONTROL3 0x02
19 #define REG_CONTROL3_PM_BLD (1 << 7) /* battery low detection disabled */
20 #define REG_CONTROL3_PM_VDD (1 << 6) /* switch-over disabled */
21 #define REG_CONTROL3_PM_DSM (1 << 5) /* direct switching mode */
22 #define REG_CONTROL3_PM_MASK 0xe0
23 #define REG_CONTROL3_BLF (1 << 2) /* battery low bit, read-only */
25 #define REG_SECONDS 0x03
26 #define REG_SECONDS_OS (1 << 7)
28 #define REG_MINUTES 0x04
29 #define REG_HOURS 0x05
30 #define REG_DAYS 0x06
31 #define REG_WEEKDAYS 0x07
32 #define REG_MONTHS 0x08
33 #define REG_YEARS 0x09
35 #define REG_OFFSET 0x0e
36 #define REG_OFFSET_MODE BIT(7)
38 static int pcf8523_read(struct i2c_client *client, u8 reg, u8 *valuep)
40 struct i2c_msg msgs[2];
41 u8 value = 0;
42 int err;
44 msgs[0].addr = client->addr;
45 msgs[0].flags = 0;
46 msgs[0].len = sizeof(reg);
47 msgs[0].buf = &reg;
49 msgs[1].addr = client->addr;
50 msgs[1].flags = I2C_M_RD;
51 msgs[1].len = sizeof(value);
52 msgs[1].buf = &value;
54 err = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
55 if (err < 0)
56 return err;
58 *valuep = value;
60 return 0;
63 static int pcf8523_write(struct i2c_client *client, u8 reg, u8 value)
65 u8 buffer[2] = { reg, value };
66 struct i2c_msg msg;
67 int err;
69 msg.addr = client->addr;
70 msg.flags = 0;
71 msg.len = sizeof(buffer);
72 msg.buf = buffer;
74 err = i2c_transfer(client->adapter, &msg, 1);
75 if (err < 0)
76 return err;
78 return 0;
81 static int pcf8523_voltage_low(struct i2c_client *client)
83 u8 value;
84 int err;
86 err = pcf8523_read(client, REG_CONTROL3, &value);
87 if (err < 0)
88 return err;
90 return !!(value & REG_CONTROL3_BLF);
93 static int pcf8523_load_capacitance(struct i2c_client *client)
95 u32 load;
96 u8 value;
97 int err;
99 err = pcf8523_read(client, REG_CONTROL1, &value);
100 if (err < 0)
101 return err;
103 load = 12500;
104 of_property_read_u32(client->dev.of_node, "quartz-load-femtofarads",
105 &load);
107 switch (load) {
108 default:
109 dev_warn(&client->dev, "Unknown quartz-load-femtofarads value: %d. Assuming 12500",
110 load);
111 /* fall through */
112 case 12500:
113 value |= REG_CONTROL1_CAP_SEL;
114 break;
115 case 7000:
116 value &= ~REG_CONTROL1_CAP_SEL;
117 break;
120 err = pcf8523_write(client, REG_CONTROL1, value);
122 return err;
125 static int pcf8523_set_pm(struct i2c_client *client, u8 pm)
127 u8 value;
128 int err;
130 err = pcf8523_read(client, REG_CONTROL3, &value);
131 if (err < 0)
132 return err;
134 value = (value & ~REG_CONTROL3_PM_MASK) | pm;
136 err = pcf8523_write(client, REG_CONTROL3, value);
137 if (err < 0)
138 return err;
140 return 0;
143 static int pcf8523_stop_rtc(struct i2c_client *client)
145 u8 value;
146 int err;
148 err = pcf8523_read(client, REG_CONTROL1, &value);
149 if (err < 0)
150 return err;
152 value |= REG_CONTROL1_STOP;
154 err = pcf8523_write(client, REG_CONTROL1, value);
155 if (err < 0)
156 return err;
158 return 0;
161 static int pcf8523_start_rtc(struct i2c_client *client)
163 u8 value;
164 int err;
166 err = pcf8523_read(client, REG_CONTROL1, &value);
167 if (err < 0)
168 return err;
170 value &= ~REG_CONTROL1_STOP;
172 err = pcf8523_write(client, REG_CONTROL1, value);
173 if (err < 0)
174 return err;
176 return 0;
179 static int pcf8523_rtc_read_time(struct device *dev, struct rtc_time *tm)
181 struct i2c_client *client = to_i2c_client(dev);
182 u8 start = REG_SECONDS, regs[7];
183 struct i2c_msg msgs[2];
184 int err;
186 err = pcf8523_voltage_low(client);
187 if (err < 0) {
188 return err;
189 } else if (err > 0) {
190 dev_err(dev, "low voltage detected, time is unreliable\n");
191 return -EINVAL;
194 msgs[0].addr = client->addr;
195 msgs[0].flags = 0;
196 msgs[0].len = 1;
197 msgs[0].buf = &start;
199 msgs[1].addr = client->addr;
200 msgs[1].flags = I2C_M_RD;
201 msgs[1].len = sizeof(regs);
202 msgs[1].buf = regs;
204 err = i2c_transfer(client->adapter, msgs, ARRAY_SIZE(msgs));
205 if (err < 0)
206 return err;
208 if (regs[0] & REG_SECONDS_OS)
209 return -EINVAL;
211 tm->tm_sec = bcd2bin(regs[0] & 0x7f);
212 tm->tm_min = bcd2bin(regs[1] & 0x7f);
213 tm->tm_hour = bcd2bin(regs[2] & 0x3f);
214 tm->tm_mday = bcd2bin(regs[3] & 0x3f);
215 tm->tm_wday = regs[4] & 0x7;
216 tm->tm_mon = bcd2bin(regs[5] & 0x1f) - 1;
217 tm->tm_year = bcd2bin(regs[6]) + 100;
219 return 0;
222 static int pcf8523_rtc_set_time(struct device *dev, struct rtc_time *tm)
224 struct i2c_client *client = to_i2c_client(dev);
225 struct i2c_msg msg;
226 u8 regs[8];
227 int err;
230 * The hardware can only store values between 0 and 99 in it's YEAR
231 * register (with 99 overflowing to 0 on increment).
232 * After 2100-02-28 we could start interpreting the year to be in the
233 * interval [2100, 2199], but there is no path to switch in a smooth way
234 * because the chip handles YEAR=0x00 (and the out-of-spec
235 * YEAR=0xa0) as a leap year, but 2100 isn't.
237 if (tm->tm_year < 100 || tm->tm_year >= 200)
238 return -EINVAL;
240 err = pcf8523_stop_rtc(client);
241 if (err < 0)
242 return err;
244 regs[0] = REG_SECONDS;
245 /* This will purposely overwrite REG_SECONDS_OS */
246 regs[1] = bin2bcd(tm->tm_sec);
247 regs[2] = bin2bcd(tm->tm_min);
248 regs[3] = bin2bcd(tm->tm_hour);
249 regs[4] = bin2bcd(tm->tm_mday);
250 regs[5] = tm->tm_wday;
251 regs[6] = bin2bcd(tm->tm_mon + 1);
252 regs[7] = bin2bcd(tm->tm_year - 100);
254 msg.addr = client->addr;
255 msg.flags = 0;
256 msg.len = sizeof(regs);
257 msg.buf = regs;
259 err = i2c_transfer(client->adapter, &msg, 1);
260 if (err < 0) {
262 * If the time cannot be set, restart the RTC anyway. Note
263 * that errors are ignored if the RTC cannot be started so
264 * that we have a chance to propagate the original error.
266 pcf8523_start_rtc(client);
267 return err;
270 return pcf8523_start_rtc(client);
273 #ifdef CONFIG_RTC_INTF_DEV
274 static int pcf8523_rtc_ioctl(struct device *dev, unsigned int cmd,
275 unsigned long arg)
277 struct i2c_client *client = to_i2c_client(dev);
278 int ret;
280 switch (cmd) {
281 case RTC_VL_READ:
282 ret = pcf8523_voltage_low(client);
283 if (ret < 0)
284 return ret;
286 if (copy_to_user((void __user *)arg, &ret, sizeof(int)))
287 return -EFAULT;
289 return 0;
290 default:
291 return -ENOIOCTLCMD;
294 #else
295 #define pcf8523_rtc_ioctl NULL
296 #endif
298 static int pcf8523_rtc_read_offset(struct device *dev, long *offset)
300 struct i2c_client *client = to_i2c_client(dev);
301 int err;
302 u8 value;
303 s8 val;
305 err = pcf8523_read(client, REG_OFFSET, &value);
306 if (err < 0)
307 return err;
309 /* sign extend the 7-bit offset value */
310 val = value << 1;
311 *offset = (value & REG_OFFSET_MODE ? 4069 : 4340) * (val >> 1);
313 return 0;
316 static int pcf8523_rtc_set_offset(struct device *dev, long offset)
318 struct i2c_client *client = to_i2c_client(dev);
319 long reg_m0, reg_m1;
320 u8 value;
322 reg_m0 = clamp(DIV_ROUND_CLOSEST(offset, 4340), -64L, 63L);
323 reg_m1 = clamp(DIV_ROUND_CLOSEST(offset, 4069), -64L, 63L);
325 if (abs(reg_m0 * 4340 - offset) < abs(reg_m1 * 4069 - offset))
326 value = reg_m0 & 0x7f;
327 else
328 value = (reg_m1 & 0x7f) | REG_OFFSET_MODE;
330 return pcf8523_write(client, REG_OFFSET, value);
333 static const struct rtc_class_ops pcf8523_rtc_ops = {
334 .read_time = pcf8523_rtc_read_time,
335 .set_time = pcf8523_rtc_set_time,
336 .ioctl = pcf8523_rtc_ioctl,
337 .read_offset = pcf8523_rtc_read_offset,
338 .set_offset = pcf8523_rtc_set_offset,
341 static int pcf8523_probe(struct i2c_client *client,
342 const struct i2c_device_id *id)
344 struct rtc_device *rtc;
345 int err;
347 if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C))
348 return -ENODEV;
350 err = pcf8523_load_capacitance(client);
351 if (err < 0)
352 dev_warn(&client->dev, "failed to set xtal load capacitance: %d",
353 err);
355 err = pcf8523_set_pm(client, 0);
356 if (err < 0)
357 return err;
359 rtc = devm_rtc_device_register(&client->dev, DRIVER_NAME,
360 &pcf8523_rtc_ops, THIS_MODULE);
361 if (IS_ERR(rtc))
362 return PTR_ERR(rtc);
364 return 0;
367 static const struct i2c_device_id pcf8523_id[] = {
368 { "pcf8523", 0 },
371 MODULE_DEVICE_TABLE(i2c, pcf8523_id);
373 #ifdef CONFIG_OF
374 static const struct of_device_id pcf8523_of_match[] = {
375 { .compatible = "nxp,pcf8523" },
376 { .compatible = "microcrystal,rv8523" },
379 MODULE_DEVICE_TABLE(of, pcf8523_of_match);
380 #endif
382 static struct i2c_driver pcf8523_driver = {
383 .driver = {
384 .name = DRIVER_NAME,
385 .of_match_table = of_match_ptr(pcf8523_of_match),
387 .probe = pcf8523_probe,
388 .id_table = pcf8523_id,
390 module_i2c_driver(pcf8523_driver);
392 MODULE_AUTHOR("Thierry Reding <thierry.reding@avionic-design.de>");
393 MODULE_DESCRIPTION("NXP PCF8523 RTC driver");
394 MODULE_LICENSE("GPL v2");