diff options
Diffstat (limited to 'firmware/drivers/rtc/rtc_d2.c')
-rw-r--r-- | firmware/drivers/rtc/rtc_d2.c | 87 |
1 files changed, 87 insertions, 0 deletions
diff --git a/firmware/drivers/rtc/rtc_d2.c b/firmware/drivers/rtc/rtc_d2.c new file mode 100644 index 0000000000..8f60bc20df --- /dev/null +++ b/firmware/drivers/rtc/rtc_d2.c | |||
@@ -0,0 +1,87 @@ | |||
1 | /*************************************************************************** | ||
2 | * __________ __ ___. | ||
3 | * Open \______ \ ____ ____ | | _\_ |__ _______ ___ | ||
4 | * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / | ||
5 | * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < | ||
6 | * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ | ||
7 | * \/ \/ \/ \/ \/ | ||
8 | * $Id$ | ||
9 | * | ||
10 | * Copyright (C) 2009 by Rob Purchase | ||
11 | * | ||
12 | * This program is free software; you can redistribute it and/or | ||
13 | * modify it under the terms of the GNU General Public License | ||
14 | * as published by the Free Software Foundation; either version 2 | ||
15 | * of the License, or (at your option) any later version. | ||
16 | * | ||
17 | * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY | ||
18 | * KIND, either express or implied. | ||
19 | * | ||
20 | ****************************************************************************/ | ||
21 | #include "rtc.h" | ||
22 | #include "system.h" | ||
23 | #include "pcf50606.h" | ||
24 | #include "pcf50635.h" | ||
25 | #include "power-target.h" | ||
26 | |||
27 | void rtc_init(void) | ||
28 | { | ||
29 | } | ||
30 | |||
31 | int rtc_read_datetime(struct tm *tm) | ||
32 | { | ||
33 | unsigned int i; | ||
34 | int rc, oldlevel; | ||
35 | unsigned char buf[7]; | ||
36 | |||
37 | oldlevel = disable_irq_save(); | ||
38 | |||
39 | if (get_pmu_type() == PCF50606) | ||
40 | rc = pcf50606_read_multiple(0x0a, buf, sizeof(buf)); | ||
41 | else | ||
42 | rc = pcf50635_read_multiple(0x59, buf, sizeof(buf)); | ||
43 | |||
44 | restore_irq(oldlevel); | ||
45 | |||
46 | for (i = 0; i < sizeof(buf); i++) | ||
47 | buf[i] = BCD2DEC(buf[i]); | ||
48 | |||
49 | tm->tm_sec = buf[0]; | ||
50 | tm->tm_min = buf[1]; | ||
51 | tm->tm_hour = buf[2]; | ||
52 | tm->tm_wday = buf[3]; | ||
53 | tm->tm_mday = buf[4]; | ||
54 | tm->tm_mon = buf[5] - 1; | ||
55 | tm->tm_year = buf[6] + 100; | ||
56 | |||
57 | return rc; | ||
58 | } | ||
59 | |||
60 | int rtc_write_datetime(const struct tm *tm) | ||
61 | { | ||
62 | unsigned int i; | ||
63 | int rc, oldlevel; | ||
64 | unsigned char buf[7]; | ||
65 | |||
66 | buf[0] = tm->tm_sec; | ||
67 | buf[1] = tm->tm_min; | ||
68 | buf[2] = tm->tm_hour; | ||
69 | buf[3] = tm->tm_wday; | ||
70 | buf[4] = tm->tm_mday; | ||
71 | buf[5] = tm->tm_mon + 1; | ||
72 | buf[6] = tm->tm_year - 100; | ||
73 | |||
74 | for (i = 0; i < sizeof(buf); i++) | ||
75 | buf[i] = DEC2BCD(buf[i]); | ||
76 | |||
77 | oldlevel = disable_irq_save(); | ||
78 | |||
79 | if (get_pmu_type() == PCF50606) | ||
80 | rc = pcf50606_write_multiple(0x0a, buf, sizeof(buf)); | ||
81 | else | ||
82 | rc = pcf50635_write_multiple(0x59, buf, sizeof(buf)); | ||
83 | |||
84 | restore_irq(oldlevel); | ||
85 | |||
86 | return rc; | ||
87 | } | ||