forked from luck/tmp_suning_uos_patched
368dd5acd1
Implement the Panasonic MN10300 AM34 CPU subarch and implement SMP support for MN10300. Also implement support for the MN2WS0060 processor and the ASB2364 evaluation board which are AM34 based. Signed-off-by: Akira Takeuchi <takeuchi.akr@jp.panasonic.com> Signed-off-by: Kiyoshi Owada <owada.kiyoshi@jp.panasonic.com> Signed-off-by: David Howells <dhowells@redhat.com>
133 lines
3.9 KiB
C
133 lines
3.9 KiB
C
/* MN10300 RTC management
|
|
*
|
|
* Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
|
|
* Written by David Howells (dhowells@redhat.com)
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public Licence
|
|
* as published by the Free Software Foundation; either version
|
|
* 2 of the Licence, or (at your option) any later version.
|
|
*/
|
|
#include <linux/kernel.h>
|
|
#include <linux/module.h>
|
|
#include <linux/init.h>
|
|
#include <linux/mc146818rtc.h>
|
|
#include <linux/bcd.h>
|
|
#include <linux/timex.h>
|
|
#include <asm/rtc-regs.h>
|
|
#include <asm/rtc.h>
|
|
|
|
DEFINE_SPINLOCK(rtc_lock);
|
|
EXPORT_SYMBOL(rtc_lock);
|
|
|
|
/*
|
|
* Read the current RTC time
|
|
*/
|
|
void read_persistent_clock(struct timespec *ts)
|
|
{
|
|
struct rtc_time tm;
|
|
|
|
get_rtc_time(&tm);
|
|
|
|
ts->tv_nsec = 0;
|
|
ts->tv_sec = mktime(tm.tm_year, tm.tm_mon, tm.tm_mday,
|
|
tm.tm_hour, tm.tm_min, tm.tm_sec);
|
|
|
|
/* if rtc is way off in the past, set something reasonable */
|
|
if (ts->tv_sec < 0)
|
|
ts->tv_sec = mktime(2009, 1, 1, 12, 0, 0);
|
|
}
|
|
|
|
/*
|
|
* In order to set the CMOS clock precisely, set_rtc_mmss has to be called 500
|
|
* ms after the second nowtime has started, because when nowtime is written
|
|
* into the registers of the CMOS clock, it will jump to the next second
|
|
* precisely 500 ms later. Check the Motorola MC146818A or Dallas DS12887 data
|
|
* sheet for details.
|
|
*
|
|
* BUG: This routine does not handle hour overflow properly; it just
|
|
* sets the minutes. Usually you'll only notice that after reboot!
|
|
*/
|
|
static int set_rtc_mmss(unsigned long nowtime)
|
|
{
|
|
unsigned char save_control, save_freq_select;
|
|
int retval = 0;
|
|
int real_seconds, real_minutes, cmos_minutes;
|
|
|
|
/* gets recalled with irq locally disabled */
|
|
spin_lock(&rtc_lock);
|
|
save_control = CMOS_READ(RTC_CONTROL); /* tell the clock it's being
|
|
* set */
|
|
CMOS_WRITE(save_control | RTC_SET, RTC_CONTROL);
|
|
|
|
save_freq_select = CMOS_READ(RTC_FREQ_SELECT); /* stop and reset
|
|
* prescaler */
|
|
CMOS_WRITE(save_freq_select | RTC_DIV_RESET2, RTC_FREQ_SELECT);
|
|
|
|
cmos_minutes = CMOS_READ(RTC_MINUTES);
|
|
if (!(save_control & RTC_DM_BINARY) || RTC_ALWAYS_BCD)
|
|
cmos_minutes = bcd2bin(cmos_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 15 minutes
|
|
*/
|
|
real_seconds = nowtime % 60;
|
|
real_minutes = nowtime / 60;
|
|
if (((abs(real_minutes - cmos_minutes) + 15) / 30) & 1)
|
|
/* correct for half hour time zone */
|
|
real_minutes += 30;
|
|
real_minutes %= 60;
|
|
|
|
if (abs(real_minutes - cmos_minutes) < 30) {
|
|
if (!(save_control & RTC_DM_BINARY) || RTC_ALWAYS_BCD) {
|
|
real_seconds = bin2bcd(real_seconds);
|
|
real_minutes = bin2bcd(real_minutes);
|
|
}
|
|
CMOS_WRITE(real_seconds, RTC_SECONDS);
|
|
CMOS_WRITE(real_minutes, RTC_MINUTES);
|
|
} else {
|
|
printk(KERN_WARNING
|
|
"set_rtc_mmss: can't update from %d to %d\n",
|
|
cmos_minutes, real_minutes);
|
|
retval = -1;
|
|
}
|
|
|
|
/* The following flags have to be released exactly in this order,
|
|
* otherwise the DS12887 (popular MC146818A clone with integrated
|
|
* battery and quartz) will not reset the oscillator and will not
|
|
* update precisely 500 ms later. You won't find this mentioned in
|
|
* the Dallas Semiconductor data sheets, but who believes data
|
|
* sheets anyway ... -- Markus Kuhn
|
|
*/
|
|
CMOS_WRITE(save_control, RTC_CONTROL);
|
|
CMOS_WRITE(save_freq_select, RTC_FREQ_SELECT);
|
|
spin_unlock(&rtc_lock);
|
|
|
|
return retval;
|
|
}
|
|
|
|
int update_persistent_clock(struct timespec now)
|
|
{
|
|
return set_rtc_mmss(now.tv_sec);
|
|
}
|
|
|
|
/*
|
|
* calibrate the TSC clock against the RTC
|
|
*/
|
|
void __init calibrate_clock(void)
|
|
{
|
|
unsigned char status;
|
|
|
|
/* make sure the RTC is running and is set to operate in 24hr mode */
|
|
status = RTSRC;
|
|
RTCRB |= RTCRB_SET;
|
|
RTCRB |= RTCRB_TM_24HR;
|
|
RTCRB &= ~RTCRB_DM_BINARY;
|
|
RTCRA |= RTCRA_DVR;
|
|
RTCRA &= ~RTCRA_DVR;
|
|
RTCRB &= ~RTCRB_SET;
|
|
}
|