| /* |
| * linux/arch/m68k/atari/time.c |
| * |
| * Atari time and real time clock stuff |
| * |
| * Assembled of parts of former atari/config.c 97-12-18 by Roman Hodek |
| * |
| * This file is subject to the terms and conditions of the GNU General Public |
| * License. See the file COPYING in the main directory of this archive |
| * for more details. |
| */ |
| |
| #include <linux/types.h> |
| #include <linux/mc146818rtc.h> |
| #include <linux/interrupt.h> |
| #include <linux/init.h> |
| #include <linux/rtc.h> |
| #include <linux/bcd.h> |
| #include <linux/delay.h> |
| #include <linux/export.h> |
| |
| #include <asm/atariints.h> |
| |
| DEFINE_SPINLOCK(rtc_lock); |
| EXPORT_SYMBOL_GPL(rtc_lock); |
| |
| static irqreturn_t mfp_timer_c_handler(int irq, void *dev_id) |
| { |
| irq_handler_t timer_routine = dev_id; |
| unsigned long flags; |
| |
| local_irq_save(flags); |
| timer_routine(0, NULL); |
| local_irq_restore(flags); |
| |
| return IRQ_HANDLED; |
| } |
| |
| void __init |
| atari_sched_init(irq_handler_t timer_routine) |
| { |
| /* set Timer C data Register */ |
| st_mfp.tim_dt_c = INT_TICKS; |
| /* start timer C, div = 1:100 */ |
| st_mfp.tim_ct_cd = (st_mfp.tim_ct_cd & 15) | 0x60; |
| /* install interrupt service routine for MFP Timer C */ |
| if (request_irq(IRQ_MFP_TIMC, mfp_timer_c_handler, 0, "timer", |
| timer_routine)) |
| pr_err("Couldn't register timer interrupt\n"); |
| } |
| |
| /* ++andreas: gettimeoffset fixed to check for pending interrupt */ |
| |
| #define TICK_SIZE 10000 |
| |
| /* This is always executed with interrupts disabled. */ |
| u32 atari_gettimeoffset(void) |
| { |
| u32 ticks, offset = 0; |
| |
| /* read MFP timer C current value */ |
| ticks = st_mfp.tim_dt_c; |
| /* The probability of underflow is less than 2% */ |
| if (ticks > INT_TICKS - INT_TICKS / 50) |
| /* Check for pending timer interrupt */ |
| if (st_mfp.int_pn_b & (1 << 5)) |
| offset = TICK_SIZE; |
| |
| ticks = INT_TICKS - ticks; |
| ticks = ticks * 10000L / INT_TICKS; |
| |
| return (ticks + offset) * 1000; |
| } |
| |
| |
| static void mste_read(struct MSTE_RTC *val) |
| { |
| #define COPY(v) val->v=(mste_rtc.v & 0xf) |
| do { |
| COPY(sec_ones) ; COPY(sec_tens) ; COPY(min_ones) ; |
| COPY(min_tens) ; COPY(hr_ones) ; COPY(hr_tens) ; |
| COPY(weekday) ; COPY(day_ones) ; COPY(day_tens) ; |
| COPY(mon_ones) ; COPY(mon_tens) ; COPY(year_ones) ; |
| COPY(year_tens) ; |
| /* prevent from reading the clock while it changed */ |
| } while (val->sec_ones != (mste_rtc.sec_ones & 0xf)); |
| #undef COPY |
| } |
| |
| static void mste_write(struct MSTE_RTC *val) |
| { |
| #define COPY(v) mste_rtc.v=val->v |
| do { |
| COPY(sec_ones) ; COPY(sec_tens) ; COPY(min_ones) ; |
| COPY(min_tens) ; COPY(hr_ones) ; COPY(hr_tens) ; |
| COPY(weekday) ; COPY(day_ones) ; COPY(day_tens) ; |
| COPY(mon_ones) ; COPY(mon_tens) ; COPY(year_ones) ; |
| COPY(year_tens) ; |
| /* prevent from writing the clock while it changed */ |
| } while (val->sec_ones != (mste_rtc.sec_ones & 0xf)); |
| #undef COPY |
| } |
| |
| #define RTC_READ(reg) \ |
| ({ unsigned char __val; \ |
| (void) atari_writeb(reg,&tt_rtc.regsel); \ |
| __val = tt_rtc.data; \ |
| __val; \ |
| }) |
| |
| #define RTC_WRITE(reg,val) \ |
| do { \ |
| atari_writeb(reg,&tt_rtc.regsel); \ |
| tt_rtc.data = (val); \ |
| } while(0) |
| |
| |
| #define HWCLK_POLL_INTERVAL 5 |
| |
| int atari_mste_hwclk( int op, struct rtc_time *t ) |
| { |
| int hour, year; |
| int hr24=0; |
| struct MSTE_RTC val; |
| |
| mste_rtc.mode=(mste_rtc.mode | 1); |
| hr24=mste_rtc.mon_tens & 1; |
| mste_rtc.mode=(mste_rtc.mode & ~1); |
| |
| if (op) { |
| /* write: prepare values */ |
| |
| val.sec_ones = t->tm_sec % 10; |
| val.sec_tens = t->tm_sec / 10; |
| val.min_ones = t->tm_min % 10; |
| val.min_tens = t->tm_min / 10; |
| hour = t->tm_hour; |
| if (!hr24) { |
| if (hour > 11) |
| hour += 20 - 12; |
| if (hour == 0 || hour == 20) |
| hour += 12; |
| } |
| val.hr_ones = hour % 10; |
| val.hr_tens = hour / 10; |
| val.day_ones = t->tm_mday % 10; |
| val.day_tens = t->tm_mday / 10; |
| val.mon_ones = (t->tm_mon+1) % 10; |
| val.mon_tens = (t->tm_mon+1) / 10; |
| year = t->tm_year - 80; |
| val.year_ones = year % 10; |
| val.year_tens = year / 10; |
| val.weekday = t->tm_wday; |
| mste_write(&val); |
| mste_rtc.mode=(mste_rtc.mode | 1); |
| val.year_ones = (year % 4); /* leap year register */ |
| mste_rtc.mode=(mste_rtc.mode & ~1); |
| } |
| else { |
| mste_read(&val); |
| t->tm_sec = val.sec_ones + val.sec_tens * 10; |
| t->tm_min = val.min_ones + val.min_tens * 10; |
| hour = val.hr_ones + val.hr_tens * 10; |
| if (!hr24) { |
| if (hour == 12 || hour == 12 + 20) |
| hour -= 12; |
| if (hour >= 20) |
| hour += 12 - 20; |
| } |
| t->tm_hour = hour; |
| t->tm_mday = val.day_ones + val.day_tens * 10; |
| t->tm_mon = val.mon_ones + val.mon_tens * 10 - 1; |
| t->tm_year = val.year_ones + val.year_tens * 10 + 80; |
| t->tm_wday = val.weekday; |
| } |
| return 0; |
| } |
| |
| int atari_tt_hwclk( int op, struct rtc_time *t ) |
| { |
| int sec=0, min=0, hour=0, day=0, mon=0, year=0, wday=0; |
| unsigned long flags; |
| unsigned char ctrl; |
| int pm = 0; |
| |
| ctrl = RTC_READ(RTC_CONTROL); /* control registers are |
| * independent from the UIP */ |
| |
| if (op) { |
| /* write: prepare values */ |
| |
| sec = t->tm_sec; |
| min = t->tm_min; |
| hour = t->tm_hour; |
| day = t->tm_mday; |
| mon = t->tm_mon + 1; |
| year = t->tm_year - atari_rtc_year_offset; |
| wday = t->tm_wday + (t->tm_wday >= 0); |
| |
| if (!(ctrl & RTC_24H)) { |
| if (hour > 11) { |
| pm = 0x80; |
| if (hour != 12) |
| hour -= 12; |
| } |
| else if (hour == 0) |
| hour = 12; |
| } |
| |
| if (!(ctrl & RTC_DM_BINARY)) { |
| sec = bin2bcd(sec); |
| min = bin2bcd(min); |
| hour = bin2bcd(hour); |
| day = bin2bcd(day); |
| mon = bin2bcd(mon); |
| year = bin2bcd(year); |
| if (wday >= 0) |
| wday = bin2bcd(wday); |
| } |
| } |
| |
| /* Reading/writing the clock registers is a bit critical due to |
| * the regular update cycle of the RTC. While an update is in |
| * progress, registers 0..9 shouldn't be touched. |
| * The problem is solved like that: If an update is currently in |
| * progress (the UIP bit is set), the process sleeps for a while |
| * (50ms). This really should be enough, since the update cycle |
| * normally needs 2 ms. |
| * If the UIP bit reads as 0, we have at least 244 usecs until the |
| * update starts. This should be enough... But to be sure, |
| * additionally the RTC_SET bit is set to prevent an update cycle. |
| */ |
| |
| while( RTC_READ(RTC_FREQ_SELECT) & RTC_UIP ) { |
| if (in_atomic() || irqs_disabled()) |
| mdelay(1); |
| else |
| schedule_timeout_interruptible(HWCLK_POLL_INTERVAL); |
| } |
| |
| local_irq_save(flags); |
| RTC_WRITE( RTC_CONTROL, ctrl | RTC_SET ); |
| if (!op) { |
| sec = RTC_READ( RTC_SECONDS ); |
| min = RTC_READ( RTC_MINUTES ); |
| hour = RTC_READ( RTC_HOURS ); |
| day = RTC_READ( RTC_DAY_OF_MONTH ); |
| mon = RTC_READ( RTC_MONTH ); |
| year = RTC_READ( RTC_YEAR ); |
| wday = RTC_READ( RTC_DAY_OF_WEEK ); |
| } |
| else { |
| RTC_WRITE( RTC_SECONDS, sec ); |
| RTC_WRITE( RTC_MINUTES, min ); |
| RTC_WRITE( RTC_HOURS, hour + pm); |
| RTC_WRITE( RTC_DAY_OF_MONTH, day ); |
| RTC_WRITE( RTC_MONTH, mon ); |
| RTC_WRITE( RTC_YEAR, year ); |
| if (wday >= 0) RTC_WRITE( RTC_DAY_OF_WEEK, wday ); |
| } |
| RTC_WRITE( RTC_CONTROL, ctrl & ~RTC_SET ); |
| local_irq_restore(flags); |
| |
| if (!op) { |
| /* read: adjust values */ |
| |
| if (hour & 0x80) { |
| hour &= ~0x80; |
| pm = 1; |
| } |
| |
| if (!(ctrl & RTC_DM_BINARY)) { |
| sec = bcd2bin(sec); |
| min = bcd2bin(min); |
| hour = bcd2bin(hour); |
| day = bcd2bin(day); |
| mon = bcd2bin(mon); |
| year = bcd2bin(year); |
| wday = bcd2bin(wday); |
| } |
| |
| if (!(ctrl & RTC_24H)) { |
| if (!pm && hour == 12) |
| hour = 0; |
| else if (pm && hour != 12) |
| hour += 12; |
| } |
| |
| t->tm_sec = sec; |
| t->tm_min = min; |
| t->tm_hour = hour; |
| t->tm_mday = day; |
| t->tm_mon = mon - 1; |
| t->tm_year = year + atari_rtc_year_offset; |
| t->tm_wday = wday - 1; |
| } |
| |
| return( 0 ); |
| } |
| |
| |
| int atari_mste_set_clock_mmss (unsigned long nowtime) |
| { |
| short real_seconds = nowtime % 60, real_minutes = (nowtime / 60) % 60; |
| struct MSTE_RTC val; |
| unsigned char rtc_minutes; |
| |
| mste_read(&val); |
| rtc_minutes= val.min_ones + val.min_tens * 10; |
| if ((rtc_minutes < real_minutes |
| ? real_minutes - rtc_minutes |
| : rtc_minutes - real_minutes) < 30) |
| { |
| val.sec_ones = real_seconds % 10; |
| val.sec_tens = real_seconds / 10; |
| val.min_ones = real_minutes % 10; |
| val.min_tens = real_minutes / 10; |
| mste_write(&val); |
| } |
| else |
| return -1; |
| return 0; |
| } |
| |
| int atari_tt_set_clock_mmss (unsigned long nowtime) |
| { |
| int retval = 0; |
| short real_seconds = nowtime % 60, real_minutes = (nowtime / 60) % 60; |
| unsigned char save_control, save_freq_select, rtc_minutes; |
| |
| save_control = RTC_READ (RTC_CONTROL); /* tell the clock it's being set */ |
| RTC_WRITE (RTC_CONTROL, save_control | RTC_SET); |
| |
| save_freq_select = RTC_READ (RTC_FREQ_SELECT); /* stop and reset prescaler */ |
| RTC_WRITE (RTC_FREQ_SELECT, save_freq_select | RTC_DIV_RESET2); |
| |
| rtc_minutes = RTC_READ (RTC_MINUTES); |
| if (!(save_control & RTC_DM_BINARY)) |
| rtc_minutes = bcd2bin(rtc_minutes); |
| |
| /* Since we're only adjusting minutes and seconds, don't interfere |
| with hour overflow. This avoids messing with unknown time zones |
| but requires your RTC not to be off by more than 30 minutes. */ |
| if ((rtc_minutes < real_minutes |
| ? real_minutes - rtc_minutes |
| : rtc_minutes - real_minutes) < 30) |
| { |
| if (!(save_control & RTC_DM_BINARY)) |
| { |
| real_seconds = bin2bcd(real_seconds); |
| real_minutes = bin2bcd(real_minutes); |
| } |
| RTC_WRITE (RTC_SECONDS, real_seconds); |
| RTC_WRITE (RTC_MINUTES, real_minutes); |
| } |
| else |
| retval = -1; |
| |
| RTC_WRITE (RTC_FREQ_SELECT, save_freq_select); |
| RTC_WRITE (RTC_CONTROL, save_control); |
| return retval; |
| } |
| |
| /* |
| * Local variables: |
| * c-indent-level: 4 |
| * tab-width: 8 |
| * End: |
| */ |