time.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:5k
- /*
- * Carsten Langgaard, carstenl@mips.com
- * Copyright (C) 1999,2000 MIPS Technologies, Inc. All rights reserved.
- *
- * ########################################################################
- *
- * This program is free software; you can distribute it and/or modify it
- * under the terms of the GNU General Public License (Version 2) as
- * published by the Free Software Foundation.
- *
- * This program is distributed in the hope it will be useful, but WITHOUT
- * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
- * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
- * for more details.
- *
- * You should have received a copy of the GNU General Public License along
- * with this program; if not, write to the Free Software Foundation, Inc.,
- * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
- *
- * ########################################################################
- *
- * Setting up the clock on the MIPS boards.
- *
- */
- #include <linux/types.h>
- #include <linux/config.h>
- #include <linux/init.h>
- #include <linux/kernel_stat.h>
- #include <linux/sched.h>
- #include <linux/spinlock.h>
- #include <asm/mipsregs.h>
- #include <asm/ptrace.h>
- #include <asm/hardirq.h>
- #include <asm/div64.h>
- #include <asm/cpu.h>
- #include <asm/time.h>
- #include <linux/interrupt.h>
- #include <linux/mc146818rtc.h>
- #include <linux/timex.h>
- #include <asm/mips-boards/generic.h>
- #include <asm/mips-boards/prom.h>
- static unsigned int r4k_offset; /* Amount to increment compare reg each time */
- static unsigned int r4k_cur; /* What counter should be at next timer irq */
- #define ALLINTS (IE_IRQ0 | IE_IRQ1 | IE_IRQ2 | IE_IRQ3 | IE_IRQ4 | IE_IRQ5)
- #if defined(CONFIG_MIPS_ATLAS)
- static char display_string[] = " LINUX ON ATLAS ";
- #endif
- #if defined(CONFIG_MIPS_MALTA)
- static char display_string[] = " LINUX ON MALTA ";
- #endif
- static unsigned int display_count = 0;
- #define MAX_DISPLAY_COUNT (sizeof(display_string) - 8)
- #define MIPS_CPU_TIMER_IRQ 7
- static unsigned int timer_tick_count=0;
- static inline void ack_r4ktimer(unsigned int newval)
- {
- write_32bit_cp0_register(CP0_COMPARE, newval);
- }
- void mips_timer_interrupt(struct pt_regs *regs)
- {
- if ((timer_tick_count++ % HZ) == 0) {
- mips_display_message(&display_string[display_count++]);
- if (display_count == MAX_DISPLAY_COUNT)
- display_count = 0;
- }
- ll_timer_interrupt(MIPS_CPU_TIMER_IRQ, regs);
- }
- /*
- * Figure out the r4k offset, the amount to increment the compare
- * register for each time tick.
- * Use the RTC to calculate offset.
- */
- static unsigned int __init cal_r4koff(void)
- {
- unsigned int flags;
- __save_and_cli(flags);
- /* Start counter exactly on falling edge of update flag */
- while (CMOS_READ(RTC_REG_A) & RTC_UIP);
- while (!(CMOS_READ(RTC_REG_A) & RTC_UIP));
- /* Start r4k counter. */
- write_32bit_cp0_register(CP0_COUNT, 0);
- /* Read counter exactly on falling edge of update flag */
- while (CMOS_READ(RTC_REG_A) & RTC_UIP);
- while (!(CMOS_READ(RTC_REG_A) & RTC_UIP));
- mips_counter_frequency = read_32bit_cp0_register(CP0_COUNT);
- /* restore interrupts */
- __restore_flags(flags);
- return (mips_counter_frequency / HZ);
- }
- unsigned long __init mips_rtc_get_time(void)
- {
- unsigned int year, mon, day, hour, min, sec;
- unsigned char save_control;
- save_control = CMOS_READ(RTC_CONTROL);
- /* Freeze it. */
- CMOS_WRITE(save_control | RTC_SET, RTC_CONTROL);
- /* Read regs. */
- sec = CMOS_READ(RTC_SECONDS);
- min = CMOS_READ(RTC_MINUTES);
- hour = CMOS_READ(RTC_HOURS);
- if (!(save_control & RTC_24H))
- {
- if ((hour & 0xf) == 0xc)
- hour &= 0x80;
- if (hour & 0x80)
- hour = (hour & 0xf) + 12;
- }
- day = CMOS_READ(RTC_DAY_OF_MONTH);
- mon = CMOS_READ(RTC_MONTH);
- year = CMOS_READ(RTC_YEAR);
- /* Unfreeze clock. */
- CMOS_WRITE(save_control, RTC_CONTROL);
- if ((year += 1900) < 1970)
- year += 100;
- return mktime(year, mon, day, hour, min, sec);
- }
- void __init mips_time_init(void)
- {
- unsigned int est_freq, flags;
- __save_and_cli(flags);
- /* Set Data mode - binary. */
- CMOS_WRITE(CMOS_READ(RTC_CONTROL) | RTC_DM_BINARY, RTC_CONTROL);
- printk("calculating r4koff... ");
- r4k_offset = cal_r4koff();
- printk("%08x(%d)n", r4k_offset, r4k_offset);
- if ((read_32bit_cp0_register(CP0_PRID) & 0xffff00) ==
- (PRID_COMP_MIPS | PRID_IMP_20KC))
- est_freq = r4k_offset*HZ;
- else
- est_freq = 2*r4k_offset*HZ;
- est_freq += 5000; /* round */
- est_freq -= est_freq%10000;
- printk("CPU frequency %d.%02d MHzn", est_freq/1000000,
- (est_freq%1000000)*100/1000000);
- __restore_flags(flags);
- }
- void __init mips_timer_setup(struct irqaction *irq)
- {
- /* we are using the cpu counter for timer interrupts */
- irq->handler = no_action; /* we use our own handler */
- setup_irq(MIPS_CPU_TIMER_IRQ, irq);
- /* to generate the first timer interrupt */
- r4k_cur = (read_32bit_cp0_register(CP0_COUNT) + r4k_offset);
- write_32bit_cp0_register(CP0_COMPARE, r4k_cur);
- set_cp0_status(ALLINTS);
- }