Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2 | * "High Precision Event Timer" based timekeeping. |
| 3 | * |
| 4 | * Copyright (c) 1991,1992,1995 Linus Torvalds |
| 5 | * Copyright (c) 1994 Alan Modra |
| 6 | * Copyright (c) 1995 Markus Kuhn |
| 7 | * Copyright (c) 1996 Ingo Molnar |
| 8 | * Copyright (c) 1998 Andrea Arcangeli |
Vojtech Pavlik | 2f82bde | 2006-06-26 13:58:38 +0200 | [diff] [blame] | 9 | * Copyright (c) 2002,2006 Vojtech Pavlik |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 10 | * Copyright (c) 2003 Andi Kleen |
| 11 | * RTC support code taken from arch/i386/kernel/timers/time_hpet.c |
| 12 | */ |
| 13 | |
Thomas Gleixner | b8ce335 | 2007-10-12 23:04:07 +0200 | [diff] [blame] | 14 | #include <linux/clockchips.h> |
Thomas Gleixner | 081e10b | 2008-01-30 13:30:27 +0100 | [diff] [blame] | 15 | #include <linux/init.h> |
| 16 | #include <linux/interrupt.h> |
| 17 | #include <linux/module.h> |
| 18 | #include <linux/time.h> |
Thomas Gleixner | b8ce335 | 2007-10-12 23:04:07 +0200 | [diff] [blame] | 19 | |
Thomas Gleixner | 28318da | 2007-07-21 17:11:18 +0200 | [diff] [blame] | 20 | #include <asm/i8253.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 21 | #include <asm/hpet.h> |
Joerg Roedel | 6b37f5a | 2007-05-02 19:27:06 +0200 | [diff] [blame] | 22 | #include <asm/nmi.h> |
Andi Kleen | 2aae950 | 2007-07-21 17:10:01 +0200 | [diff] [blame] | 23 | #include <asm/vgtod.h> |
Glauber de Oliveira Costa | ee238e5 | 2008-01-30 13:31:10 +0100 | [diff] [blame] | 24 | #include <asm/time.h> |
| 25 | #include <asm/timer.h> |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 26 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 27 | volatile unsigned long __jiffies __section_jiffies = INITIAL_JIFFIES; |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 28 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 29 | unsigned long profile_pc(struct pt_regs *regs) |
| 30 | { |
| 31 | unsigned long pc = instruction_pointer(regs); |
| 32 | |
Andi Kleen | 31679f3 | 2006-09-26 10:52:28 +0200 | [diff] [blame] | 33 | /* Assume the lock function has either no stack frame or a copy |
H. Peter Anvin | 65ea5b0 | 2008-01-30 13:30:56 +0100 | [diff] [blame] | 34 | of flags from PUSHF |
Andi Kleen | 31679f3 | 2006-09-26 10:52:28 +0200 | [diff] [blame] | 35 | Eflags always has bits 22 and up cleared unlike kernel addresses. */ |
Glauber Costa | 8de0b8a | 2008-07-11 14:10:13 -0300 | [diff] [blame] | 36 | if (!user_mode_vm(regs) && in_lock_functions(pc)) { |
Glauber Costa | 3927fa9 | 2008-07-11 13:53:43 -0300 | [diff] [blame] | 37 | #ifdef CONFIG_FRAME_POINTER |
| 38 | return *(unsigned long *)(regs->bp + sizeof(long)); |
| 39 | #else |
H. Peter Anvin | 65ea5b0 | 2008-01-30 13:30:56 +0100 | [diff] [blame] | 40 | unsigned long *sp = (unsigned long *)regs->sp; |
Andi Kleen | 31679f3 | 2006-09-26 10:52:28 +0200 | [diff] [blame] | 41 | if (sp[0] >> 22) |
| 42 | return sp[0]; |
| 43 | if (sp[1] >> 22) |
| 44 | return sp[1]; |
Glauber Costa | 3927fa9 | 2008-07-11 13:53:43 -0300 | [diff] [blame] | 45 | #endif |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 | } |
| 47 | return pc; |
| 48 | } |
| 49 | EXPORT_SYMBOL(profile_pc); |
| 50 | |
Glauber Costa | 461ebd1 | 2008-07-11 15:25:13 -0300 | [diff] [blame^] | 51 | irqreturn_t timer_interrupt(int irq, void *dev_id) |
Thomas Gleixner | b8ce335 | 2007-10-12 23:04:07 +0200 | [diff] [blame] | 52 | { |
Thomas Gleixner | 4e77ae3 | 2007-10-12 23:04:07 +0200 | [diff] [blame] | 53 | add_pda(irq0_irqs, 1); |
| 54 | |
Thomas Gleixner | b8ce335 | 2007-10-12 23:04:07 +0200 | [diff] [blame] | 55 | global_clock_event->event_handler(global_clock_event); |
| 56 | |
| 57 | return IRQ_HANDLED; |
| 58 | } |
| 59 | |
Joerg Roedel | 6b37f5a | 2007-05-02 19:27:06 +0200 | [diff] [blame] | 60 | /* calibrate_cpu is used on systems with fixed rate TSCs to determine |
| 61 | * processor frequency */ |
| 62 | #define TICK_COUNT 100000000 |
Alok Kataria | 8fbbc4b | 2008-07-01 11:43:34 -0700 | [diff] [blame] | 63 | unsigned long __init calibrate_cpu(void) |
Joerg Roedel | 6b37f5a | 2007-05-02 19:27:06 +0200 | [diff] [blame] | 64 | { |
Thomas Gleixner | 2618f86 | 2007-07-21 17:10:18 +0200 | [diff] [blame] | 65 | int tsc_start, tsc_now; |
| 66 | int i, no_ctr_free; |
| 67 | unsigned long evntsel3 = 0, pmc3 = 0, pmc_now = 0; |
| 68 | unsigned long flags; |
Joerg Roedel | 6b37f5a | 2007-05-02 19:27:06 +0200 | [diff] [blame] | 69 | |
Thomas Gleixner | 2618f86 | 2007-07-21 17:10:18 +0200 | [diff] [blame] | 70 | for (i = 0; i < 4; i++) |
| 71 | if (avail_to_resrv_perfctr_nmi_bit(i)) |
| 72 | break; |
| 73 | no_ctr_free = (i == 4); |
| 74 | if (no_ctr_free) { |
| 75 | i = 3; |
| 76 | rdmsrl(MSR_K7_EVNTSEL3, evntsel3); |
| 77 | wrmsrl(MSR_K7_EVNTSEL3, 0); |
| 78 | rdmsrl(MSR_K7_PERFCTR3, pmc3); |
| 79 | } else { |
| 80 | reserve_perfctr_nmi(MSR_K7_PERFCTR0 + i); |
| 81 | reserve_evntsel_nmi(MSR_K7_EVNTSEL0 + i); |
| 82 | } |
| 83 | local_irq_save(flags); |
Li Zefan | 3eb0567 | 2008-02-08 04:19:25 -0800 | [diff] [blame] | 84 | /* start measuring cycles, incrementing from 0 */ |
Thomas Gleixner | 2618f86 | 2007-07-21 17:10:18 +0200 | [diff] [blame] | 85 | wrmsrl(MSR_K7_PERFCTR0 + i, 0); |
| 86 | wrmsrl(MSR_K7_EVNTSEL0 + i, 1 << 22 | 3 << 16 | 0x76); |
| 87 | rdtscl(tsc_start); |
| 88 | do { |
| 89 | rdmsrl(MSR_K7_PERFCTR0 + i, pmc_now); |
Andi Kleen | 6d63de8 | 2008-01-30 13:32:39 +0100 | [diff] [blame] | 90 | tsc_now = get_cycles(); |
Thomas Gleixner | 2618f86 | 2007-07-21 17:10:18 +0200 | [diff] [blame] | 91 | } while ((tsc_now - tsc_start) < TICK_COUNT); |
Joerg Roedel | 6b37f5a | 2007-05-02 19:27:06 +0200 | [diff] [blame] | 92 | |
Thomas Gleixner | 2618f86 | 2007-07-21 17:10:18 +0200 | [diff] [blame] | 93 | local_irq_restore(flags); |
| 94 | if (no_ctr_free) { |
| 95 | wrmsrl(MSR_K7_EVNTSEL3, 0); |
| 96 | wrmsrl(MSR_K7_PERFCTR3, pmc3); |
| 97 | wrmsrl(MSR_K7_EVNTSEL3, evntsel3); |
| 98 | } else { |
| 99 | release_perfctr_nmi(MSR_K7_PERFCTR0 + i); |
| 100 | release_evntsel_nmi(MSR_K7_EVNTSEL0 + i); |
| 101 | } |
Joerg Roedel | 6b37f5a | 2007-05-02 19:27:06 +0200 | [diff] [blame] | 102 | |
Thomas Gleixner | 2618f86 | 2007-07-21 17:10:18 +0200 | [diff] [blame] | 103 | return pmc_now * tsc_khz / (tsc_now - tsc_start); |
Joerg Roedel | 6b37f5a | 2007-05-02 19:27:06 +0200 | [diff] [blame] | 104 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 105 | |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 106 | static struct irqaction irq0 = { |
Glauber Costa | 461ebd1 | 2008-07-11 15:25:13 -0300 | [diff] [blame^] | 107 | .handler = timer_interrupt, |
Venki Pallipadi | 5fa3a24 | 2007-10-12 23:04:06 +0200 | [diff] [blame] | 108 | .flags = IRQF_DISABLED | IRQF_IRQPOLL | IRQF_NOBALANCING, |
Bernhard Walle | e6d828f | 2007-05-08 00:35:28 -0700 | [diff] [blame] | 109 | .mask = CPU_MASK_NONE, |
Thomas Gleixner | 2618f86 | 2007-07-21 17:10:18 +0200 | [diff] [blame] | 110 | .name = "timer" |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 111 | }; |
| 112 | |
Glauber de Oliveira Costa | ee238e5 | 2008-01-30 13:31:10 +0100 | [diff] [blame] | 113 | void __init hpet_time_init(void) |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 114 | { |
Thomas Gleixner | b8ce335 | 2007-10-12 23:04:07 +0200 | [diff] [blame] | 115 | if (!hpet_enable()) |
| 116 | setup_pit_timer(); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 117 | |
Glauber Costa | 2ff2983 | 2008-07-11 14:21:29 -0300 | [diff] [blame] | 118 | irq0.mask = cpumask_of_cpu(0); |
Thomas Gleixner | b8ce335 | 2007-10-12 23:04:07 +0200 | [diff] [blame] | 119 | setup_irq(0, &irq0); |
Glauber de Oliveira Costa | ee238e5 | 2008-01-30 13:31:10 +0100 | [diff] [blame] | 120 | } |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 121 | |
Glauber de Oliveira Costa | ee238e5 | 2008-01-30 13:31:10 +0100 | [diff] [blame] | 122 | void __init time_init(void) |
| 123 | { |
Alok Kataria | 8fbbc4b | 2008-07-01 11:43:34 -0700 | [diff] [blame] | 124 | tsc_init(); |
john stultz | 2d0c87c | 2007-02-16 01:28:18 -0800 | [diff] [blame] | 125 | if (cpu_has(&boot_cpu_data, X86_FEATURE_RDTSCP)) |
Vojtech Pavlik | c08c820 | 2006-09-26 10:52:28 +0200 | [diff] [blame] | 126 | vgetcpu_mode = VGETCPU_RDTSCP; |
| 127 | else |
| 128 | vgetcpu_mode = VGETCPU_LSL; |
| 129 | |
Glauber de Oliveira Costa | ee238e5 | 2008-01-30 13:31:10 +0100 | [diff] [blame] | 130 | late_time_init = choose_time_init(); |
Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 131 | } |