1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <linux/kernel.h>
21#include <linux/module.h>
22#include <linux/interrupt.h>
23#include <linux/i2c.h>
24#include <linux/rtc.h>
25#include <linux/bcd.h>
26#include <linux/workqueue.h>
27
28#define DS1374_REG_TOD0 0x00
29#define DS1374_REG_TOD1 0x01
30#define DS1374_REG_TOD2 0x02
31#define DS1374_REG_TOD3 0x03
32#define DS1374_REG_WDALM0 0x04
33#define DS1374_REG_WDALM1 0x05
34#define DS1374_REG_WDALM2 0x06
35#define DS1374_REG_CR 0x07
36#define DS1374_REG_CR_AIE 0x01
37#define DS1374_REG_CR_WDALM 0x20
38#define DS1374_REG_CR_WACE 0x40
39#define DS1374_REG_SR 0x08
40#define DS1374_REG_SR_OSF 0x80
41#define DS1374_REG_SR_AF 0x01
42#define DS1374_REG_TCR 0x09
43
44static const struct i2c_device_id ds1374_id[] = {
45 { "ds1374", 0 },
46 { }
47};
48MODULE_DEVICE_TABLE(i2c, ds1374_id);
49
50struct ds1374 {
51 struct i2c_client *client;
52 struct rtc_device *rtc;
53 struct work_struct work;
54
55
56
57
58
59 struct mutex mutex;
60 int exiting;
61};
62
63static struct i2c_driver ds1374_driver;
64
65static int ds1374_read_rtc(struct i2c_client *client, u32 *time,
66 int reg, int nbytes)
67{
68 u8 buf[4];
69 int ret;
70 int i;
71
72 if (nbytes > 4) {
73 WARN_ON(1);
74 return -EINVAL;
75 }
76
77 ret = i2c_smbus_read_i2c_block_data(client, reg, nbytes, buf);
78
79 if (ret < 0)
80 return ret;
81 if (ret < nbytes)
82 return -EIO;
83
84 for (i = nbytes - 1, *time = 0; i >= 0; i--)
85 *time = (*time << 8) | buf[i];
86
87 return 0;
88}
89
90static int ds1374_write_rtc(struct i2c_client *client, u32 time,
91 int reg, int nbytes)
92{
93 u8 buf[4];
94 int i;
95
96 if (nbytes > 4) {
97 WARN_ON(1);
98 return -EINVAL;
99 }
100
101 for (i = 0; i < nbytes; i++) {
102 buf[i] = time & 0xff;
103 time >>= 8;
104 }
105
106 return i2c_smbus_write_i2c_block_data(client, reg, nbytes, buf);
107}
108
109static int ds1374_check_rtc_status(struct i2c_client *client)
110{
111 int ret = 0;
112 int control, stat;
113
114 stat = i2c_smbus_read_byte_data(client, DS1374_REG_SR);
115 if (stat < 0)
116 return stat;
117
118 if (stat & DS1374_REG_SR_OSF)
119 dev_warn(&client->dev,
120 "oscillator discontinuity flagged, "
121 "time unreliable\n");
122
123 stat &= ~(DS1374_REG_SR_OSF | DS1374_REG_SR_AF);
124
125 ret = i2c_smbus_write_byte_data(client, DS1374_REG_SR, stat);
126 if (ret < 0)
127 return ret;
128
129
130
131
132
133
134 control = i2c_smbus_read_byte_data(client, DS1374_REG_CR);
135 if (control < 0)
136 return control;
137
138 control &= ~(DS1374_REG_CR_WACE | DS1374_REG_CR_AIE);
139 return i2c_smbus_write_byte_data(client, DS1374_REG_CR, control);
140}
141
142static int ds1374_read_time(struct device *dev, struct rtc_time *time)
143{
144 struct i2c_client *client = to_i2c_client(dev);
145 u32 itime;
146 int ret;
147
148 ret = ds1374_read_rtc(client, &itime, DS1374_REG_TOD0, 4);
149 if (!ret)
150 rtc_time_to_tm(itime, time);
151
152 return ret;
153}
154
155static int ds1374_set_time(struct device *dev, struct rtc_time *time)
156{
157 struct i2c_client *client = to_i2c_client(dev);
158 unsigned long itime;
159
160 rtc_tm_to_time(time, &itime);
161 return ds1374_write_rtc(client, itime, DS1374_REG_TOD0, 4);
162}
163
164
165
166
167
168static int ds1374_read_alarm(struct device *dev, struct rtc_wkalrm *alarm)
169{
170 struct i2c_client *client = to_i2c_client(dev);
171 struct ds1374 *ds1374 = i2c_get_clientdata(client);
172 u32 now, cur_alarm;
173 int cr, sr;
174 int ret = 0;
175
176 if (client->irq <= 0)
177 return -EINVAL;
178
179 mutex_lock(&ds1374->mutex);
180
181 cr = ret = i2c_smbus_read_byte_data(client, DS1374_REG_CR);
182 if (ret < 0)
183 goto out;
184
185 sr = ret = i2c_smbus_read_byte_data(client, DS1374_REG_SR);
186 if (ret < 0)
187 goto out;
188
189 ret = ds1374_read_rtc(client, &now, DS1374_REG_TOD0, 4);
190 if (ret)
191 goto out;
192
193 ret = ds1374_read_rtc(client, &cur_alarm, DS1374_REG_WDALM0, 3);
194 if (ret)
195 goto out;
196
197 rtc_time_to_tm(now + cur_alarm, &alarm->time);
198 alarm->enabled = !!(cr & DS1374_REG_CR_WACE);
199 alarm->pending = !!(sr & DS1374_REG_SR_AF);
200
201out:
202 mutex_unlock(&ds1374->mutex);
203 return ret;
204}
205
206static int ds1374_set_alarm(struct device *dev, struct rtc_wkalrm *alarm)
207{
208 struct i2c_client *client = to_i2c_client(dev);
209 struct ds1374 *ds1374 = i2c_get_clientdata(client);
210 struct rtc_time now;
211 unsigned long new_alarm, itime;
212 int cr;
213 int ret = 0;
214
215 if (client->irq <= 0)
216 return -EINVAL;
217
218 ret = ds1374_read_time(dev, &now);
219 if (ret < 0)
220 return ret;
221
222 rtc_tm_to_time(&alarm->time, &new_alarm);
223 rtc_tm_to_time(&now, &itime);
224
225
226
227
228
229
230
231 if (time_before_eq(new_alarm, itime))
232 new_alarm = 1;
233 else
234 new_alarm -= itime;
235
236 mutex_lock(&ds1374->mutex);
237
238 ret = cr = i2c_smbus_read_byte_data(client, DS1374_REG_CR);
239 if (ret < 0)
240 goto out;
241
242
243
244 cr &= ~DS1374_REG_CR_WACE;
245
246 ret = i2c_smbus_write_byte_data(client, DS1374_REG_CR, cr);
247 if (ret < 0)
248 goto out;
249
250 ret = ds1374_write_rtc(client, new_alarm, DS1374_REG_WDALM0, 3);
251 if (ret)
252 goto out;
253
254 if (alarm->enabled) {
255 cr |= DS1374_REG_CR_WACE | DS1374_REG_CR_AIE;
256 cr &= ~DS1374_REG_CR_WDALM;
257
258 ret = i2c_smbus_write_byte_data(client, DS1374_REG_CR, cr);
259 }
260
261out:
262 mutex_unlock(&ds1374->mutex);
263 return ret;
264}
265
266static irqreturn_t ds1374_irq(int irq, void *dev_id)
267{
268 struct i2c_client *client = dev_id;
269 struct ds1374 *ds1374 = i2c_get_clientdata(client);
270
271 disable_irq_nosync(irq);
272 schedule_work(&ds1374->work);
273 return IRQ_HANDLED;
274}
275
276static void ds1374_work(struct work_struct *work)
277{
278 struct ds1374 *ds1374 = container_of(work, struct ds1374, work);
279 struct i2c_client *client = ds1374->client;
280 int stat, control;
281
282 mutex_lock(&ds1374->mutex);
283
284 stat = i2c_smbus_read_byte_data(client, DS1374_REG_SR);
285 if (stat < 0)
286 return;
287
288 if (stat & DS1374_REG_SR_AF) {
289 stat &= ~DS1374_REG_SR_AF;
290 i2c_smbus_write_byte_data(client, DS1374_REG_SR, stat);
291
292 control = i2c_smbus_read_byte_data(client, DS1374_REG_CR);
293 if (control < 0)
294 goto out;
295
296 control &= ~(DS1374_REG_CR_WACE | DS1374_REG_CR_AIE);
297 i2c_smbus_write_byte_data(client, DS1374_REG_CR, control);
298
299
300
301
302 local_irq_disable();
303 rtc_update_irq(ds1374->rtc, 1, RTC_AF | RTC_IRQF);
304 local_irq_enable();
305 }
306
307out:
308 if (!ds1374->exiting)
309 enable_irq(client->irq);
310
311 mutex_unlock(&ds1374->mutex);
312}
313
314static int ds1374_ioctl(struct device *dev, unsigned int cmd, unsigned long arg)
315{
316 struct i2c_client *client = to_i2c_client(dev);
317 struct ds1374 *ds1374 = i2c_get_clientdata(client);
318 int ret = -ENOIOCTLCMD;
319
320 mutex_lock(&ds1374->mutex);
321
322 switch (cmd) {
323 case RTC_AIE_OFF:
324 ret = i2c_smbus_read_byte_data(client, DS1374_REG_CR);
325 if (ret < 0)
326 goto out;
327
328 ret &= ~DS1374_REG_CR_WACE;
329
330 ret = i2c_smbus_write_byte_data(client, DS1374_REG_CR, ret);
331 if (ret < 0)
332 goto out;
333
334 break;
335
336 case RTC_AIE_ON:
337 ret = i2c_smbus_read_byte_data(client, DS1374_REG_CR);
338 if (ret < 0)
339 goto out;
340
341 ret |= DS1374_REG_CR_WACE | DS1374_REG_CR_AIE;
342 ret &= ~DS1374_REG_CR_WDALM;
343
344 ret = i2c_smbus_write_byte_data(client, DS1374_REG_CR, ret);
345 if (ret < 0)
346 goto out;
347
348 break;
349 }
350
351out:
352 mutex_unlock(&ds1374->mutex);
353 return ret;
354}
355
356static const struct rtc_class_ops ds1374_rtc_ops = {
357 .read_time = ds1374_read_time,
358 .set_time = ds1374_set_time,
359 .read_alarm = ds1374_read_alarm,
360 .set_alarm = ds1374_set_alarm,
361 .ioctl = ds1374_ioctl,
362};
363
364static int ds1374_probe(struct i2c_client *client,
365 const struct i2c_device_id *id)
366{
367 struct ds1374 *ds1374;
368 int ret;
369
370 ds1374 = kzalloc(sizeof(struct ds1374), GFP_KERNEL);
371 if (!ds1374)
372 return -ENOMEM;
373
374 ds1374->client = client;
375 i2c_set_clientdata(client, ds1374);
376
377 INIT_WORK(&ds1374->work, ds1374_work);
378 mutex_init(&ds1374->mutex);
379
380 ret = ds1374_check_rtc_status(client);
381 if (ret)
382 goto out_free;
383
384 if (client->irq > 0) {
385 ret = request_irq(client->irq, ds1374_irq, 0,
386 "ds1374", client);
387 if (ret) {
388 dev_err(&client->dev, "unable to request IRQ\n");
389 goto out_free;
390 }
391 }
392
393 ds1374->rtc = rtc_device_register(client->name, &client->dev,
394 &ds1374_rtc_ops, THIS_MODULE);
395 if (IS_ERR(ds1374->rtc)) {
396 ret = PTR_ERR(ds1374->rtc);
397 dev_err(&client->dev, "unable to register the class device\n");
398 goto out_irq;
399 }
400
401 return 0;
402
403out_irq:
404 if (client->irq > 0)
405 free_irq(client->irq, client);
406
407out_free:
408 i2c_set_clientdata(client, NULL);
409 kfree(ds1374);
410 return ret;
411}
412
413static int __devexit ds1374_remove(struct i2c_client *client)
414{
415 struct ds1374 *ds1374 = i2c_get_clientdata(client);
416
417 if (client->irq > 0) {
418 mutex_lock(&ds1374->mutex);
419 ds1374->exiting = 1;
420 mutex_unlock(&ds1374->mutex);
421
422 free_irq(client->irq, client);
423 flush_scheduled_work();
424 }
425
426 rtc_device_unregister(ds1374->rtc);
427 i2c_set_clientdata(client, NULL);
428 kfree(ds1374);
429 return 0;
430}
431
432#ifdef CONFIG_PM
433static int ds1374_suspend(struct i2c_client *client, pm_message_t state)
434{
435 if (client->irq >= 0 && device_may_wakeup(&client->dev))
436 enable_irq_wake(client->irq);
437 return 0;
438}
439
440static int ds1374_resume(struct i2c_client *client)
441{
442 if (client->irq >= 0 && device_may_wakeup(&client->dev))
443 disable_irq_wake(client->irq);
444 return 0;
445}
446#else
447#define ds1374_suspend NULL
448#define ds1374_resume NULL
449#endif
450
451static struct i2c_driver ds1374_driver = {
452 .driver = {
453 .name = "rtc-ds1374",
454 .owner = THIS_MODULE,
455 },
456 .probe = ds1374_probe,
457 .suspend = ds1374_suspend,
458 .resume = ds1374_resume,
459 .remove = __devexit_p(ds1374_remove),
460 .id_table = ds1374_id,
461};
462
463static int __init ds1374_init(void)
464{
465 return i2c_add_driver(&ds1374_driver);
466}
467
468static void __exit ds1374_exit(void)
469{
470 i2c_del_driver(&ds1374_driver);
471}
472
473module_init(ds1374_init);
474module_exit(ds1374_exit);
475
476MODULE_AUTHOR("Scott Wood <scottwood@freescale.com>");
477MODULE_DESCRIPTION("Maxim/Dallas DS1374 RTC Driver");
478MODULE_LICENSE("GPL");
479