time.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:4k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * Carsten Langgaard, carstenl@mips.com
  3.  * Copyright (C) 1999,2000 MIPS Technologies, Inc.  All rights reserved.
  4.  *
  5.  * ########################################################################
  6.  *
  7.  *  This program is free software; you can distribute it and/or modify it
  8.  *  under the terms of the GNU General Public License (Version 2) as
  9.  *  published by the Free Software Foundation.
  10.  *
  11.  *  This program is distributed in the hope it will be useful, but WITHOUT
  12.  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13.  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  14.  *  for more details.
  15.  *
  16.  *  You should have received a copy of the GNU General Public License along
  17.  *  with this program; if not, write to the Free Software Foundation, Inc.,
  18.  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
  19.  *
  20.  * ########################################################################
  21.  *
  22.  * Setting up the clock on the MIPS boards.
  23.  *
  24.  */
  25. #include <linux/config.h>
  26. #include <linux/init.h>
  27. #include <linux/kernel_stat.h>
  28. #include <linux/sched.h>
  29. #include <linux/spinlock.h>
  30. #include <linux/mc146818rtc.h>
  31. #include <linux/timex.h>
  32. #include <asm/mipsregs.h>
  33. #include <asm/ptrace.h>
  34. #include <asm/it8172/it8172_int.h>
  35. #include <asm/debug.h>
  36. static unsigned long r4k_offset; /* Amount to increment compare reg each time */
  37. static unsigned long r4k_cur;    /* What counter should be at next timer irq */
  38. extern unsigned int mips_counter_frequency;
  39. extern asmlinkage unsigned int do_IRQ(int irq, struct pt_regs *regs);
  40. /* 
  41.  * Figure out the r4k offset, the amount to increment the compare
  42.  * register for each time tick. 
  43.  * Use the RTC to calculate offset.
  44.  */
  45. static unsigned long __init cal_r4koff(void)
  46. {
  47. unsigned int flags;
  48. __save_and_cli(flags);
  49. /* Start counter exactly on falling edge of update flag */
  50. while (CMOS_READ(RTC_REG_A) & RTC_UIP);
  51. while (!(CMOS_READ(RTC_REG_A) & RTC_UIP));
  52. /* Start r4k counter. */
  53. write_32bit_cp0_register(CP0_COUNT, 0);
  54. /* Read counter exactly on falling edge of update flag */
  55. while (CMOS_READ(RTC_REG_A) & RTC_UIP);
  56. while (!(CMOS_READ(RTC_REG_A) & RTC_UIP));
  57. mips_counter_frequency = read_32bit_cp0_register(CP0_COUNT);
  58. /* restore interrupts */
  59. __restore_flags(flags);
  60. return (mips_counter_frequency / HZ);
  61. }
  62. unsigned long it8172_rtc_get_time(void)
  63. {
  64. unsigned int year, mon, day, hour, min, sec;
  65. unsigned char save_control;
  66. save_control = CMOS_READ(RTC_CONTROL);
  67. /* Freeze it. */
  68. CMOS_WRITE(save_control | RTC_SET, RTC_CONTROL);
  69. /* Read regs. */
  70. sec = CMOS_READ(RTC_SECONDS);
  71. min = CMOS_READ(RTC_MINUTES);
  72. hour = CMOS_READ(RTC_HOURS);
  73. if (!(save_control & RTC_24H))
  74. {
  75. if ((hour & 0xf) == 0xc)
  76.         hour &= 0x80;
  77.         if (hour & 0x80)
  78.         hour = (hour & 0xf) + 12;     
  79. }
  80. day = CMOS_READ(RTC_DAY_OF_MONTH);
  81. mon = CMOS_READ(RTC_MONTH);
  82. year = CMOS_READ(RTC_YEAR);
  83. /* Unfreeze clock. */
  84. CMOS_WRITE(save_control, RTC_CONTROL);
  85. if ((year += 1900) < 1970)
  86.         year += 100;
  87. return mktime(year, mon, day, hour, min, sec);
  88. }
  89. void __init it8172_time_init(void)
  90. {
  91.         unsigned int est_freq, flags;
  92. __save_and_cli(flags);
  93.         /* Set Data mode - binary. */ 
  94.         CMOS_WRITE(CMOS_READ(RTC_CONTROL) | RTC_DM_BINARY, RTC_CONTROL);
  95. printk("calculating r4koff... ");
  96. r4k_offset = cal_r4koff();
  97. printk("%08lx(%d)n", r4k_offset, (int) r4k_offset);
  98. est_freq = 2*r4k_offset*HZ;
  99. est_freq += 5000;    /* round */
  100. est_freq -= est_freq%10000;
  101. printk("CPU frequency %d.%02d MHzn", est_freq/1000000, 
  102.        (est_freq%1000000)*100/1000000);
  103. __restore_flags(flags);
  104. }
  105. #define ALLINTS (IE_IRQ0 | IE_IRQ1 | IE_IRQ2 | IE_IRQ3 | IE_IRQ4 | IE_IRQ5)
  106. void __init it8172_timer_setup(struct irqaction *irq)
  107. {
  108. puts("timer_setupn");
  109. put32(NR_IRQS);
  110. puts("");
  111.         /* we are using the cpu counter for timer interrupts */
  112. setup_irq(MIPS_CPU_TIMER_IRQ, irq);
  113.         /* to generate the first timer interrupt */
  114. r4k_cur = (read_32bit_cp0_register(CP0_COUNT) + r4k_offset);
  115. write_32bit_cp0_register(CP0_COMPARE, r4k_cur);
  116. set_cp0_status(ALLINTS);
  117. }
  118. void local_timer_interrupt(struct pt_regs *regs)
  119. {
  120. do_IRQ(MIPS_CPU_TIMER_IRQ, regs);
  121. }