arch/cris/kernel/time.c

   1 /* $Id: time.c,v 1.18 2005/03/04 08:16:17 starvik Exp $
   2  *
   3  *  linux/arch/cris/kernel/time.c
   4  *
   5  *  Copyright (C) 1991, 1992, 1995  Linus Torvalds
   6  *  Copyright (C) 1999, 2000, 2001 Axis Communications AB
   7  *
   8  * 1994-07-02    Alan Modra
   9  *      fixed set_rtc_mmss, fixed time.year for >= 2000, new mktime
  10  * 1995-03-26    Markus Kuhn
  11  *      fixed 500 ms bug at call to set_rtc_mmss, fixed DS12887
  12  *      precision CMOS clock update
  13  * 1996-05-03    Ingo Molnar
  14  *      fixed time warps in do_[slow|fast]_gettimeoffset()
  15  * 1997-09-10   Updated NTP code according to technical memorandum Jan '96
  16  *              "A Kernel Model for Precision Timekeeping" by Dave Mills
  17  *
  18  * Linux/CRIS specific code:
  19  *
  20  * Authors:    Bjorn Wesen
  21  *             Johan Adolfsson
  22  *
  23  */
  24
  25 #include <asm/rtc.h>
  26 #include <linux/errno.h>
  27 #include <linux/module.h>
  28 #include <linux/param.h>
  29 #include <linux/jiffies.h>
  30 #include <linux/bcd.h>
  31 #include <linux/timex.h>
  32 #include <linux/init.h>
  33 #include <linux/profile.h>
  34
  35 u64 jiffies_64 = INITIAL_JIFFIES;
  36
  37 EXPORT_SYMBOL(jiffies_64);
  38
  39 int have_rtc;  /* used to remember if we have an RTC or not */;
  40
  41 #define TICK_SIZE tick
  42
  43 extern unsigned long wall_jiffies;
  44 extern unsigned long loops_per_jiffy; /* init/main.c */
  45 unsigned long loops_per_usec;
  46
  47 extern unsigned long do_slow_gettimeoffset(void);
  48 static unsigned long (*do_gettimeoffset)(void) = do_slow_gettimeoffset;
  49
  50 /*
  51  * This version of gettimeofday has near microsecond resolution.
  52  *
  53  * Note: Division is quite slow on CRIS and do_gettimeofday is called
  54  *       rather often. Maybe we should do some kind of approximation here
  55  *       (a naive approximation would be to divide by 1024).
  56  */
  57 void do_gettimeofday(struct timeval *tv)
  58 {
  59         unsigned long flags;
  60         signed long usec, sec;
  61         local_irq_save(flags);
  62         local_irq_disable();
  63         usec = do_gettimeoffset();
  64         {
  65                 unsigned long lost = jiffies - wall_jiffies;
  66                 if (lost)
  67                         usec += lost * (1000000 / HZ);
  68         }
  69
  70         /*
  71          * If time_adjust is negative then NTP is slowing the clock
  72          * so make sure not to go into next possible interval.
  73          * Better to lose some accuracy than have time go backwards..
  74          */
  75         if (unlikely(time_adjust < 0) && usec > tickadj)
  76                 usec = tickadj;
  77
  78         sec = xtime.tv_sec;
  79         usec += xtime.tv_nsec / 1000;
  80         local_irq_restore(flags);
  81
  82         while (usec >= 1000000) {
  83                 usec -= 1000000;
  84                 sec++;
  85         }
  86
  87         tv->tv_sec = sec;
  88         tv->tv_usec = usec;
  89 }
  90
  91 EXPORT_SYMBOL(do_gettimeofday);
  92
  93 int do_settimeofday(struct timespec *tv)
  94 {
  95         time_t wtm_sec, sec = tv->tv_sec;
  96         long wtm_nsec, nsec = tv->tv_nsec;
  97
  98         if ((unsigned long)tv->tv_nsec >= NSEC_PER_SEC)
  99                 return -EINVAL;
 100
 101         write_seqlock_irq(&xtime_lock);
 102         /*
 103          * This is revolting. We need to set "xtime" correctly. However, the
 104          * value in this location is the value at the most recent update of
 105          * wall time.  Discover what correction gettimeofday() would have
 106          * made, and then undo it!
 107          */
 108         nsec -= do_gettimeoffset() * NSEC_PER_USEC;
 109         nsec -= (jiffies - wall_jiffies) * TICK_NSEC;
 110
 111         wtm_sec  = wall_to_monotonic.tv_sec + (xtime.tv_sec - sec);
 112         wtm_nsec = wall_to_monotonic.tv_nsec + (xtime.tv_nsec - nsec);
 113
 114         set_normalized_timespec(&xtime, sec, nsec);
 115         set_normalized_timespec(&wall_to_monotonic, wtm_sec, wtm_nsec);
 116
 117         time_adjust = 0;                /* stop active adjtime() */
 118         time_status |= STA_UNSYNC;
 119         time_maxerror = NTP_PHASE_LIMIT;
 120         time_esterror = NTP_PHASE_LIMIT;
 121         write_sequnlock_irq(&xtime_lock);
 122         clock_was_set();
 123         return 0;
 124 }
 125
 126 EXPORT_SYMBOL(do_settimeofday);
 127
 128
 129 /*
 130  * BUG: This routine does not handle hour overflow properly; it just
 131  *      sets the minutes. Usually you'll only notice that after reboot!
 132  */
 133
 134 int set_rtc_mmss(unsigned long nowtime)
 135 {
 136         int retval = 0;
 137         int real_seconds, real_minutes, cmos_minutes;
 138
 139         printk(KERN_DEBUG "set_rtc_mmss(%lu)\n", nowtime);
 140
 141         if(!have_rtc)
 142                 return 0;
 143
 144         cmos_minutes = CMOS_READ(RTC_MINUTES);
 145         BCD_TO_BIN(cmos_minutes);
 146
 147         /*
 148          * since we're only adjusting minutes and seconds,
 149          * don't interfere with hour overflow. This avoids
 150          * messing with unknown time zones but requires your
 151          * RTC not to be off by more than 15 minutes
 152          */
 153         real_seconds = nowtime % 60;
 154         real_minutes = nowtime / 60;
 155         if (((abs(real_minutes - cmos_minutes) + 15)/30) & 1)
 156                 real_minutes += 30;             /* correct for half hour time zone */
 157         real_minutes %= 60;
 158
 159         if (abs(real_minutes - cmos_minutes) < 30) {
 160                 BIN_TO_BCD(real_seconds);
 161                 BIN_TO_BCD(real_minutes);
 162                 CMOS_WRITE(real_seconds,RTC_SECONDS);
 163                 CMOS_WRITE(real_minutes,RTC_MINUTES);
 164         } else {
 165                 printk(KERN_WARNING
 166                        "set_rtc_mmss: can't update from %d to %d\n",
 167                        cmos_minutes, real_minutes);
 168                 retval = -1;
 169         }
 170
 171         return retval;
 172 }
 173
 174 /* grab the time from the RTC chip */
 175
 176 unsigned long
 177 get_cmos_time(void)
 178 {
 179         unsigned int year, mon, day, hour, min, sec;
 180
 181         sec = CMOS_READ(RTC_SECONDS);
 182         min = CMOS_READ(RTC_MINUTES);
 183         hour = CMOS_READ(RTC_HOURS);
 184         day = CMOS_READ(RTC_DAY_OF_MONTH);
 185         mon = CMOS_READ(RTC_MONTH);
 186         year = CMOS_READ(RTC_YEAR);
 187
 188         printk(KERN_DEBUG
 189                "rtc: sec 0x%x min 0x%x hour 0x%x day 0x%x mon 0x%x year 0x%x\n",
 190                sec, min, hour, day, mon, year);
 191
 192         BCD_TO_BIN(sec);
 193         BCD_TO_BIN(min);
 194         BCD_TO_BIN(hour);
 195         BCD_TO_BIN(day);
 196         BCD_TO_BIN(mon);
 197         BCD_TO_BIN(year);
 198
 199         if ((year += 1900) < 1970)
 200                 year += 100;
 201
 202         return mktime(year, mon, day, hour, min, sec);
 203 }
 204
 205 /* update xtime from the CMOS settings. used when /dev/rtc gets a SET_TIME.
 206  * TODO: this doesn't reset the fancy NTP phase stuff as do_settimeofday does.
 207  */
 208
 209 void
 210 update_xtime_from_cmos(void)
 211 {
 212         if(have_rtc) {
 213                 xtime.tv_sec = get_cmos_time();
 214                 xtime.tv_nsec = 0;
 215         }
 216 }
 217
 218 extern void cris_profile_sample(struct pt_regs* regs);
 219
 220 void
 221 cris_do_profile(struct pt_regs* regs)
 222 {
 223
 224 #if CONFIG_SYSTEM_PROFILER
 225         cris_profile_sample(regs);
 226 #endif
 227
 228 #if CONFIG_PROFILING
 229         profile_tick(CPU_PROFILING, regs);
 230 #endif
 231 }
 232
 233 /*
 234  * Scheduler clock - returns current time in nanosec units.
 235  */
 236 unsigned long long sched_clock(void)
 237 {
 238         return (unsigned long long)jiffies * (1000000000 / HZ);
 239 }
 240
 241 static int
 242 __init init_udelay(void)
 243 {
 244         loops_per_usec = (loops_per_jiffy * HZ) / 1000000;
 245         return 0;
 246 }
 247
 248 __initcall(init_udelay);