[PATCH] RTC: Remove some duplicate BCD definitions
[linux-2.6.git] / arch / sh / kernel / cpu / rtc.c
1 /*
2  * linux/arch/sh/kernel/rtc.c -- SH3 / SH4 on-chip RTC support
3  *
4  *  Copyright (C) 2000  Philipp Rumpf <prumpf@tux.org>
5  *  Copyright (C) 1999  Tetsuya Okada & Niibe Yutaka
6  */
7
8 #include <linux/init.h>
9 #include <linux/kernel.h>
10 #include <linux/sched.h>
11 #include <linux/time.h>
12 #include <linux/bcd.h>
13 #include <asm/io.h>
14 #include <asm/rtc.h>
15
16 void sh_rtc_gettimeofday(struct timespec *ts)
17 {
18         unsigned int sec128, sec, sec2, min, hr, wk, day, mon, yr, yr100, cf_bit;
19         unsigned long flags;
20
21  again:
22         do {
23                 local_irq_save(flags);
24                 ctrl_outb(0, RCR1);  /* Clear CF-bit */
25                 sec128 = ctrl_inb(R64CNT);
26                 sec = ctrl_inb(RSECCNT);
27                 min = ctrl_inb(RMINCNT);
28                 hr  = ctrl_inb(RHRCNT);
29                 wk  = ctrl_inb(RWKCNT);
30                 day = ctrl_inb(RDAYCNT);
31                 mon = ctrl_inb(RMONCNT);
32 #if defined(CONFIG_CPU_SH4)
33                 yr  = ctrl_inw(RYRCNT);
34                 yr100 = (yr >> 8);
35                 yr &= 0xff;
36 #else
37                 yr  = ctrl_inb(RYRCNT);
38                 yr100 = (yr == 0x99) ? 0x19 : 0x20;
39 #endif
40                 sec2 = ctrl_inb(R64CNT);
41                 cf_bit = ctrl_inb(RCR1) & RCR1_CF;
42                 local_irq_restore(flags);
43         } while (cf_bit != 0 || ((sec128 ^ sec2) & RTC_BIT_INVERTED) != 0);
44
45         BCD_TO_BIN(yr100);
46         BCD_TO_BIN(yr);
47         BCD_TO_BIN(mon);
48         BCD_TO_BIN(day);
49         BCD_TO_BIN(hr);
50         BCD_TO_BIN(min);
51         BCD_TO_BIN(sec);
52
53         if (yr > 99 || mon < 1 || mon > 12 || day > 31 || day < 1 ||
54             hr > 23 || min > 59 || sec > 59) {
55                 printk(KERN_ERR
56                        "SH RTC: invalid value, resetting to 1 Jan 2000\n");
57                 local_irq_save(flags);
58                 ctrl_outb(RCR2_RESET, RCR2);  /* Reset & Stop */
59                 ctrl_outb(0, RSECCNT);
60                 ctrl_outb(0, RMINCNT);
61                 ctrl_outb(0, RHRCNT);
62                 ctrl_outb(6, RWKCNT);
63                 ctrl_outb(1, RDAYCNT);
64                 ctrl_outb(1, RMONCNT);
65 #if defined(CONFIG_CPU_SH4)
66                 ctrl_outw(0x2000, RYRCNT);
67 #else
68                 ctrl_outb(0, RYRCNT);
69 #endif
70                 ctrl_outb(RCR2_RTCEN|RCR2_START, RCR2);  /* Start */
71                 goto again;
72         }
73
74 #if RTC_BIT_INVERTED != 0
75         if ((sec128 & RTC_BIT_INVERTED))
76                 sec--;
77 #endif
78
79         ts->tv_sec = mktime(yr100 * 100 + yr, mon, day, hr, min, sec);
80         ts->tv_nsec = ((sec128 * 1000000) / 128) * 1000;
81 }
82
83 /*
84  * Changed to only care about tv_sec, and not the full timespec struct
85  * (i.e. tv_nsec).  It can easily be switched to timespec for future cpus
86  * that support setting usec or nsec RTC values.
87  */
88 int sh_rtc_settimeofday(const time_t secs)
89 {
90         int retval = 0;
91         int real_seconds, real_minutes, cmos_minutes;
92         unsigned long flags;
93
94         local_irq_save(flags);
95         ctrl_outb(RCR2_RESET, RCR2);  /* Reset pre-scaler & stop RTC */
96
97         cmos_minutes = ctrl_inb(RMINCNT);
98         BCD_TO_BIN(cmos_minutes);
99
100         /*
101          * since we're only adjusting minutes and seconds,
102          * don't interfere with hour overflow. This avoids
103          * messing with unknown time zones but requires your
104          * RTC not to be off by more than 15 minutes
105          */
106         real_seconds = secs % 60;
107         real_minutes = secs / 60;
108         if (((abs(real_minutes - cmos_minutes) + 15)/30) & 1)
109                 real_minutes += 30;     /* correct for half hour time zone */
110         real_minutes %= 60;
111
112         if (abs(real_minutes - cmos_minutes) < 30) {
113                 BIN_TO_BCD(real_seconds);
114                 BIN_TO_BCD(real_minutes);
115                 ctrl_outb(real_seconds, RSECCNT);
116                 ctrl_outb(real_minutes, RMINCNT);
117         } else {
118                 printk(KERN_WARNING
119                        "set_rtc_time: can't update from %d to %d\n",
120                        cmos_minutes, real_minutes);
121                 retval = -1;
122         }
123
124         ctrl_outb(RCR2_RTCEN|RCR2_START, RCR2);  /* Start RTC */
125         local_irq_restore(flags);
126
127         return retval;
128 }