[SCSI] sg: fix a bug in st_map_user_pages failure path
[usb.git] / arch / sparc / kernel / time.c
blob24814d58f9e10363569ac0a8e3a254c3de111288
1 /* $Id: time.c,v 1.60 2002/01/23 14:33:55 davem Exp $
2 * linux/arch/sparc/kernel/time.c
4 * Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
5 * Copyright (C) 1996 Thomas K. Dyas (tdyas@eden.rutgers.edu)
7 * Chris Davis (cdavis@cois.on.ca) 03/27/1998
8 * Added support for the intersil on the sun4/4200
10 * Gleb Raiko (rajko@mech.math.msu.su) 08/18/1998
11 * Support for MicroSPARC-IIep, PCI CPU.
13 * This file handles the Sparc specific time handling details.
15 * 1997-09-10 Updated NTP code according to technical memorandum Jan '96
16 * "A Kernel Model for Precision Timekeeping" by Dave Mills
18 #include <linux/config.h>
19 #include <linux/errno.h>
20 #include <linux/module.h>
21 #include <linux/sched.h>
22 #include <linux/kernel.h>
23 #include <linux/param.h>
24 #include <linux/string.h>
25 #include <linux/mm.h>
26 #include <linux/interrupt.h>
27 #include <linux/time.h>
28 #include <linux/timex.h>
29 #include <linux/init.h>
30 #include <linux/pci.h>
31 #include <linux/ioport.h>
32 #include <linux/profile.h>
34 #include <asm/oplib.h>
35 #include <asm/timer.h>
36 #include <asm/mostek.h>
37 #include <asm/system.h>
38 #include <asm/irq.h>
39 #include <asm/io.h>
40 #include <asm/idprom.h>
41 #include <asm/machines.h>
42 #include <asm/sun4paddr.h>
43 #include <asm/page.h>
44 #include <asm/pcic.h>
46 extern unsigned long wall_jiffies;
48 DEFINE_SPINLOCK(rtc_lock);
49 enum sparc_clock_type sp_clock_typ;
50 DEFINE_SPINLOCK(mostek_lock);
51 void __iomem *mstk48t02_regs = NULL;
52 static struct mostek48t08 *mstk48t08_regs = NULL;
53 static int set_rtc_mmss(unsigned long);
54 static int sbus_do_settimeofday(struct timespec *tv);
56 #ifdef CONFIG_SUN4
57 struct intersil *intersil_clock;
58 #define intersil_cmd(intersil_reg, intsil_cmd) intersil_reg->int_cmd_reg = \
59 (intsil_cmd)
61 #define intersil_intr(intersil_reg, intsil_cmd) intersil_reg->int_intr_reg = \
62 (intsil_cmd)
64 #define intersil_start(intersil_reg) intersil_cmd(intersil_reg, \
65 ( INTERSIL_START | INTERSIL_32K | INTERSIL_NORMAL | INTERSIL_24H |\
66 INTERSIL_INTR_ENABLE))
68 #define intersil_stop(intersil_reg) intersil_cmd(intersil_reg, \
69 ( INTERSIL_STOP | INTERSIL_32K | INTERSIL_NORMAL | INTERSIL_24H |\
70 INTERSIL_INTR_ENABLE))
72 #define intersil_read_intr(intersil_reg, towhere) towhere = \
73 intersil_reg->int_intr_reg
75 #endif
77 unsigned long profile_pc(struct pt_regs *regs)
79 extern char __copy_user_begin[], __copy_user_end[];
80 extern char __atomic_begin[], __atomic_end[];
81 extern char __bzero_begin[], __bzero_end[];
82 extern char __bitops_begin[], __bitops_end[];
84 unsigned long pc = regs->pc;
86 if (in_lock_functions(pc) ||
87 (pc >= (unsigned long) __copy_user_begin &&
88 pc < (unsigned long) __copy_user_end) ||
89 (pc >= (unsigned long) __atomic_begin &&
90 pc < (unsigned long) __atomic_end) ||
91 (pc >= (unsigned long) __bzero_begin &&
92 pc < (unsigned long) __bzero_end) ||
93 (pc >= (unsigned long) __bitops_begin &&
94 pc < (unsigned long) __bitops_end))
95 pc = regs->u_regs[UREG_RETPC];
96 return pc;
99 __volatile__ unsigned int *master_l10_counter;
100 __volatile__ unsigned int *master_l10_limit;
103 * timer_interrupt() needs to keep up the real-time clock,
104 * as well as call the "do_timer()" routine every clocktick
107 #define TICK_SIZE (tick_nsec / 1000)
109 irqreturn_t timer_interrupt(int irq, void *dev_id, struct pt_regs * regs)
111 /* last time the cmos clock got updated */
112 static long last_rtc_update;
114 #ifndef CONFIG_SMP
115 profile_tick(CPU_PROFILING, regs);
116 #endif
118 /* Protect counter clear so that do_gettimeoffset works */
119 write_seqlock(&xtime_lock);
120 #ifdef CONFIG_SUN4
121 if((idprom->id_machtype == (SM_SUN4 | SM_4_260)) ||
122 (idprom->id_machtype == (SM_SUN4 | SM_4_110))) {
123 int temp;
124 intersil_read_intr(intersil_clock, temp);
125 /* re-enable the irq */
126 enable_pil_irq(10);
128 #endif
129 clear_clock_irq();
131 do_timer(regs);
132 #ifndef CONFIG_SMP
133 update_process_times(user_mode(regs));
134 #endif
137 /* Determine when to update the Mostek clock. */
138 if (ntp_synced() &&
139 xtime.tv_sec > last_rtc_update + 660 &&
140 (xtime.tv_nsec / 1000) >= 500000 - ((unsigned) TICK_SIZE) / 2 &&
141 (xtime.tv_nsec / 1000) <= 500000 + ((unsigned) TICK_SIZE) / 2) {
142 if (set_rtc_mmss(xtime.tv_sec) == 0)
143 last_rtc_update = xtime.tv_sec;
144 else
145 last_rtc_update = xtime.tv_sec - 600; /* do it again in 60 s */
147 write_sequnlock(&xtime_lock);
149 return IRQ_HANDLED;
152 /* Kick start a stopped clock (procedure from the Sun NVRAM/hostid FAQ). */
153 static void __init kick_start_clock(void)
155 struct mostek48t02 *regs = (struct mostek48t02 *)mstk48t02_regs;
156 unsigned char sec;
157 int i, count;
159 prom_printf("CLOCK: Clock was stopped. Kick start ");
161 spin_lock_irq(&mostek_lock);
163 /* Turn on the kick start bit to start the oscillator. */
164 regs->creg |= MSTK_CREG_WRITE;
165 regs->sec &= ~MSTK_STOP;
166 regs->hour |= MSTK_KICK_START;
167 regs->creg &= ~MSTK_CREG_WRITE;
169 spin_unlock_irq(&mostek_lock);
171 /* Delay to allow the clock oscillator to start. */
172 sec = MSTK_REG_SEC(regs);
173 for (i = 0; i < 3; i++) {
174 while (sec == MSTK_REG_SEC(regs))
175 for (count = 0; count < 100000; count++)
176 /* nothing */ ;
177 prom_printf(".");
178 sec = regs->sec;
180 prom_printf("\n");
182 spin_lock_irq(&mostek_lock);
184 /* Turn off kick start and set a "valid" time and date. */
185 regs->creg |= MSTK_CREG_WRITE;
186 regs->hour &= ~MSTK_KICK_START;
187 MSTK_SET_REG_SEC(regs,0);
188 MSTK_SET_REG_MIN(regs,0);
189 MSTK_SET_REG_HOUR(regs,0);
190 MSTK_SET_REG_DOW(regs,5);
191 MSTK_SET_REG_DOM(regs,1);
192 MSTK_SET_REG_MONTH(regs,8);
193 MSTK_SET_REG_YEAR(regs,1996 - MSTK_YEAR_ZERO);
194 regs->creg &= ~MSTK_CREG_WRITE;
196 spin_unlock_irq(&mostek_lock);
198 /* Ensure the kick start bit is off. If it isn't, turn it off. */
199 while (regs->hour & MSTK_KICK_START) {
200 prom_printf("CLOCK: Kick start still on!\n");
202 spin_lock_irq(&mostek_lock);
203 regs->creg |= MSTK_CREG_WRITE;
204 regs->hour &= ~MSTK_KICK_START;
205 regs->creg &= ~MSTK_CREG_WRITE;
206 spin_unlock_irq(&mostek_lock);
209 prom_printf("CLOCK: Kick start procedure successful.\n");
212 /* Return nonzero if the clock chip battery is low. */
213 static __inline__ int has_low_battery(void)
215 struct mostek48t02 *regs = (struct mostek48t02 *)mstk48t02_regs;
216 unsigned char data1, data2;
218 spin_lock_irq(&mostek_lock);
219 data1 = regs->eeprom[0]; /* Read some data. */
220 regs->eeprom[0] = ~data1; /* Write back the complement. */
221 data2 = regs->eeprom[0]; /* Read back the complement. */
222 regs->eeprom[0] = data1; /* Restore the original value. */
223 spin_unlock_irq(&mostek_lock);
225 return (data1 == data2); /* Was the write blocked? */
228 /* Probe for the real time clock chip on Sun4 */
229 static __inline__ void sun4_clock_probe(void)
231 #ifdef CONFIG_SUN4
232 int temp;
233 struct resource r;
235 memset(&r, 0, sizeof(r));
236 if( idprom->id_machtype == (SM_SUN4 | SM_4_330) ) {
237 sp_clock_typ = MSTK48T02;
238 r.start = sun4_clock_physaddr;
239 mstk48t02_regs = sbus_ioremap(&r, 0,
240 sizeof(struct mostek48t02), NULL);
241 mstk48t08_regs = NULL; /* To catch weirdness */
242 intersil_clock = NULL; /* just in case */
244 /* Kick start the clock if it is completely stopped. */
245 if (mostek_read(mstk48t02_regs + MOSTEK_SEC) & MSTK_STOP)
246 kick_start_clock();
247 } else if( idprom->id_machtype == (SM_SUN4 | SM_4_260)) {
248 /* intersil setup code */
249 printk("Clock: INTERSIL at %8x ",sun4_clock_physaddr);
250 sp_clock_typ = INTERSIL;
251 r.start = sun4_clock_physaddr;
252 intersil_clock = (struct intersil *)
253 sbus_ioremap(&r, 0, sizeof(*intersil_clock), "intersil");
254 mstk48t02_regs = 0; /* just be sure */
255 mstk48t08_regs = NULL; /* ditto */
256 /* initialise the clock */
258 intersil_intr(intersil_clock,INTERSIL_INT_100HZ);
260 intersil_start(intersil_clock);
262 intersil_read_intr(intersil_clock, temp);
263 while (!(temp & 0x80))
264 intersil_read_intr(intersil_clock, temp);
266 intersil_read_intr(intersil_clock, temp);
267 while (!(temp & 0x80))
268 intersil_read_intr(intersil_clock, temp);
270 intersil_stop(intersil_clock);
273 #endif
276 /* Probe for the mostek real time clock chip. */
277 static __inline__ void clock_probe(void)
279 struct linux_prom_registers clk_reg[2];
280 char model[128];
281 register int node, cpuunit, bootbus;
282 struct resource r;
284 cpuunit = bootbus = 0;
285 memset(&r, 0, sizeof(r));
287 /* Determine the correct starting PROM node for the probe. */
288 node = prom_getchild(prom_root_node);
289 switch (sparc_cpu_model) {
290 case sun4c:
291 break;
292 case sun4m:
293 node = prom_getchild(prom_searchsiblings(node, "obio"));
294 break;
295 case sun4d:
296 node = prom_getchild(bootbus = prom_searchsiblings(prom_getchild(cpuunit = prom_searchsiblings(node, "cpu-unit")), "bootbus"));
297 break;
298 default:
299 prom_printf("CLOCK: Unsupported architecture!\n");
300 prom_halt();
303 /* Find the PROM node describing the real time clock. */
304 sp_clock_typ = MSTK_INVALID;
305 node = prom_searchsiblings(node,"eeprom");
306 if (!node) {
307 prom_printf("CLOCK: No clock found!\n");
308 prom_halt();
311 /* Get the model name and setup everything up. */
312 model[0] = '\0';
313 prom_getstring(node, "model", model, sizeof(model));
314 if (strcmp(model, "mk48t02") == 0) {
315 sp_clock_typ = MSTK48T02;
316 if (prom_getproperty(node, "reg", (char *) clk_reg, sizeof(clk_reg)) == -1) {
317 prom_printf("clock_probe: FAILED!\n");
318 prom_halt();
320 if (sparc_cpu_model == sun4d)
321 prom_apply_generic_ranges (bootbus, cpuunit, clk_reg, 1);
322 else
323 prom_apply_obio_ranges(clk_reg, 1);
324 /* Map the clock register io area read-only */
325 r.flags = clk_reg[0].which_io;
326 r.start = clk_reg[0].phys_addr;
327 mstk48t02_regs = sbus_ioremap(&r, 0,
328 sizeof(struct mostek48t02), "mk48t02");
329 mstk48t08_regs = NULL; /* To catch weirdness */
330 } else if (strcmp(model, "mk48t08") == 0) {
331 sp_clock_typ = MSTK48T08;
332 if(prom_getproperty(node, "reg", (char *) clk_reg,
333 sizeof(clk_reg)) == -1) {
334 prom_printf("clock_probe: FAILED!\n");
335 prom_halt();
337 if (sparc_cpu_model == sun4d)
338 prom_apply_generic_ranges (bootbus, cpuunit, clk_reg, 1);
339 else
340 prom_apply_obio_ranges(clk_reg, 1);
341 /* Map the clock register io area read-only */
342 /* XXX r/o attribute is somewhere in r.flags */
343 r.flags = clk_reg[0].which_io;
344 r.start = clk_reg[0].phys_addr;
345 mstk48t08_regs = (struct mostek48t08 *) sbus_ioremap(&r, 0,
346 sizeof(struct mostek48t08), "mk48t08");
348 mstk48t02_regs = &mstk48t08_regs->regs;
349 } else {
350 prom_printf("CLOCK: Unknown model name '%s'\n",model);
351 prom_halt();
354 /* Report a low battery voltage condition. */
355 if (has_low_battery())
356 printk(KERN_CRIT "NVRAM: Low battery voltage!\n");
358 /* Kick start the clock if it is completely stopped. */
359 if (mostek_read(mstk48t02_regs + MOSTEK_SEC) & MSTK_STOP)
360 kick_start_clock();
363 void __init sbus_time_init(void)
365 unsigned int year, mon, day, hour, min, sec;
366 struct mostek48t02 *mregs;
368 #ifdef CONFIG_SUN4
369 int temp;
370 struct intersil *iregs;
371 #endif
373 BTFIXUPSET_CALL(bus_do_settimeofday, sbus_do_settimeofday, BTFIXUPCALL_NORM);
374 btfixup();
376 if (ARCH_SUN4)
377 sun4_clock_probe();
378 else
379 clock_probe();
381 sparc_init_timers(timer_interrupt);
383 #ifdef CONFIG_SUN4
384 if(idprom->id_machtype == (SM_SUN4 | SM_4_330)) {
385 #endif
386 mregs = (struct mostek48t02 *)mstk48t02_regs;
387 if(!mregs) {
388 prom_printf("Something wrong, clock regs not mapped yet.\n");
389 prom_halt();
391 spin_lock_irq(&mostek_lock);
392 mregs->creg |= MSTK_CREG_READ;
393 sec = MSTK_REG_SEC(mregs);
394 min = MSTK_REG_MIN(mregs);
395 hour = MSTK_REG_HOUR(mregs);
396 day = MSTK_REG_DOM(mregs);
397 mon = MSTK_REG_MONTH(mregs);
398 year = MSTK_CVT_YEAR( MSTK_REG_YEAR(mregs) );
399 xtime.tv_sec = mktime(year, mon, day, hour, min, sec);
400 xtime.tv_nsec = (INITIAL_JIFFIES % HZ) * (NSEC_PER_SEC / HZ);
401 set_normalized_timespec(&wall_to_monotonic,
402 -xtime.tv_sec, -xtime.tv_nsec);
403 mregs->creg &= ~MSTK_CREG_READ;
404 spin_unlock_irq(&mostek_lock);
405 #ifdef CONFIG_SUN4
406 } else if(idprom->id_machtype == (SM_SUN4 | SM_4_260) ) {
407 /* initialise the intersil on sun4 */
409 iregs=intersil_clock;
410 if(!iregs) {
411 prom_printf("Something wrong, clock regs not mapped yet.\n");
412 prom_halt();
415 intersil_intr(intersil_clock,INTERSIL_INT_100HZ);
416 disable_pil_irq(10);
417 intersil_stop(iregs);
418 intersil_read_intr(intersil_clock, temp);
420 temp = iregs->clk.int_csec;
422 sec = iregs->clk.int_sec;
423 min = iregs->clk.int_min;
424 hour = iregs->clk.int_hour;
425 day = iregs->clk.int_day;
426 mon = iregs->clk.int_month;
427 year = MSTK_CVT_YEAR(iregs->clk.int_year);
429 enable_pil_irq(10);
430 intersil_start(iregs);
432 xtime.tv_sec = mktime(year, mon, day, hour, min, sec);
433 xtime.tv_nsec = (INITIAL_JIFFIES % HZ) * (NSEC_PER_SEC / HZ);
434 set_normalized_timespec(&wall_to_monotonic,
435 -xtime.tv_sec, -xtime.tv_nsec);
436 printk("%u/%u/%u %u:%u:%u\n",day,mon,year,hour,min,sec);
438 #endif
440 /* Now that OBP ticker has been silenced, it is safe to enable IRQ. */
441 local_irq_enable();
444 void __init time_init(void)
446 #ifdef CONFIG_PCI
447 extern void pci_time_init(void);
448 if (pcic_present()) {
449 pci_time_init();
450 return;
452 #endif
453 sbus_time_init();
456 static inline unsigned long do_gettimeoffset(void)
458 return (*master_l10_counter >> 10) & 0x1fffff;
462 * Returns nanoseconds
463 * XXX This is a suboptimal implementation.
465 unsigned long long sched_clock(void)
467 return (unsigned long long)jiffies * (1000000000 / HZ);
470 /* Ok, my cute asm atomicity trick doesn't work anymore.
471 * There are just too many variables that need to be protected
472 * now (both members of xtime, wall_jiffies, et al.)
474 void do_gettimeofday(struct timeval *tv)
476 unsigned long flags;
477 unsigned long seq;
478 unsigned long usec, sec;
479 unsigned long max_ntp_tick = tick_usec - tickadj;
481 do {
482 unsigned long lost;
484 seq = read_seqbegin_irqsave(&xtime_lock, flags);
485 usec = do_gettimeoffset();
486 lost = jiffies - wall_jiffies;
489 * If time_adjust is negative then NTP is slowing the clock
490 * so make sure not to go into next possible interval.
491 * Better to lose some accuracy than have time go backwards..
493 if (unlikely(time_adjust < 0)) {
494 usec = min(usec, max_ntp_tick);
496 if (lost)
497 usec += lost * max_ntp_tick;
499 else if (unlikely(lost))
500 usec += lost * tick_usec;
502 sec = xtime.tv_sec;
503 usec += (xtime.tv_nsec / 1000);
504 } while (read_seqretry_irqrestore(&xtime_lock, seq, flags));
506 while (usec >= 1000000) {
507 usec -= 1000000;
508 sec++;
511 tv->tv_sec = sec;
512 tv->tv_usec = usec;
515 EXPORT_SYMBOL(do_gettimeofday);
517 int do_settimeofday(struct timespec *tv)
519 int ret;
521 write_seqlock_irq(&xtime_lock);
522 ret = bus_do_settimeofday(tv);
523 write_sequnlock_irq(&xtime_lock);
524 clock_was_set();
525 return ret;
528 EXPORT_SYMBOL(do_settimeofday);
530 static int sbus_do_settimeofday(struct timespec *tv)
532 time_t wtm_sec, sec = tv->tv_sec;
533 long wtm_nsec, nsec = tv->tv_nsec;
535 if ((unsigned long)tv->tv_nsec >= NSEC_PER_SEC)
536 return -EINVAL;
539 * This is revolting. We need to set "xtime" correctly. However, the
540 * value in this location is the value at the most recent update of
541 * wall time. Discover what correction gettimeofday() would have
542 * made, and then undo it!
544 nsec -= 1000 * (do_gettimeoffset() +
545 (jiffies - wall_jiffies) * (USEC_PER_SEC / HZ));
547 wtm_sec = wall_to_monotonic.tv_sec + (xtime.tv_sec - sec);
548 wtm_nsec = wall_to_monotonic.tv_nsec + (xtime.tv_nsec - nsec);
550 set_normalized_timespec(&xtime, sec, nsec);
551 set_normalized_timespec(&wall_to_monotonic, wtm_sec, wtm_nsec);
553 ntp_clear();
554 return 0;
558 * BUG: This routine does not handle hour overflow properly; it just
559 * sets the minutes. Usually you won't notice until after reboot!
561 static int set_rtc_mmss(unsigned long nowtime)
563 int real_seconds, real_minutes, mostek_minutes;
564 struct mostek48t02 *regs = (struct mostek48t02 *)mstk48t02_regs;
565 unsigned long flags;
566 #ifdef CONFIG_SUN4
567 struct intersil *iregs = intersil_clock;
568 int temp;
569 #endif
571 /* Not having a register set can lead to trouble. */
572 if (!regs) {
573 #ifdef CONFIG_SUN4
574 if(!iregs)
575 return -1;
576 else {
577 temp = iregs->clk.int_csec;
579 mostek_minutes = iregs->clk.int_min;
581 real_seconds = nowtime % 60;
582 real_minutes = nowtime / 60;
583 if (((abs(real_minutes - mostek_minutes) + 15)/30) & 1)
584 real_minutes += 30; /* correct for half hour time zone */
585 real_minutes %= 60;
587 if (abs(real_minutes - mostek_minutes) < 30) {
588 intersil_stop(iregs);
589 iregs->clk.int_sec=real_seconds;
590 iregs->clk.int_min=real_minutes;
591 intersil_start(iregs);
592 } else {
593 printk(KERN_WARNING
594 "set_rtc_mmss: can't update from %d to %d\n",
595 mostek_minutes, real_minutes);
596 return -1;
599 return 0;
601 #endif
604 spin_lock_irqsave(&mostek_lock, flags);
605 /* Read the current RTC minutes. */
606 regs->creg |= MSTK_CREG_READ;
607 mostek_minutes = MSTK_REG_MIN(regs);
608 regs->creg &= ~MSTK_CREG_READ;
611 * since we're only adjusting minutes and seconds,
612 * don't interfere with hour overflow. This avoids
613 * messing with unknown time zones but requires your
614 * RTC not to be off by more than 15 minutes
616 real_seconds = nowtime % 60;
617 real_minutes = nowtime / 60;
618 if (((abs(real_minutes - mostek_minutes) + 15)/30) & 1)
619 real_minutes += 30; /* correct for half hour time zone */
620 real_minutes %= 60;
622 if (abs(real_minutes - mostek_minutes) < 30) {
623 regs->creg |= MSTK_CREG_WRITE;
624 MSTK_SET_REG_SEC(regs,real_seconds);
625 MSTK_SET_REG_MIN(regs,real_minutes);
626 regs->creg &= ~MSTK_CREG_WRITE;
627 spin_unlock_irqrestore(&mostek_lock, flags);
628 return 0;
629 } else {
630 spin_unlock_irqrestore(&mostek_lock, flags);
631 return -1;