[SPARC64]: Unify timer interrupt handler.

Things were scattered all over the place, split between
SMP and non-SMP.

Unify it all so that dyntick support is easier to add.

Signed-off-by: David S. Miller <davem@davemloft.net>

4 files changed, 21 insertions, 141 deletions

diff --git a/arch/sparc64/kernel/irq.c b/arch/sparc64/kernel/irq.c
index c443db184371..d1bb3b3f2639 100644
--- a/arch/sparc64/kernel/irq.c
+++ b/arch/sparc64/kernel/irq.c
@@ -589,32 +589,6 @@ void ack_bad_irq(unsigned int virt_irq)
                ino, virt_irq);
 }
 
-#ifndef CONFIG_SMP
-extern irqreturn_t timer_interrupt(int, void *);
-
-void timer_irq(int irq, struct pt_regs *regs)
-{
-        unsigned long clr_mask = 1 << irq;
-        unsigned long tick_mask = tick_ops->softint_mask;
-        struct pt_regs *old_regs;
-
-        if (get_softint() & tick_mask) {
-                irq = 0;
-                clr_mask = tick_mask;
-        }
-        clear_softint(clr_mask);
-
-        old_regs = set_irq_regs(regs);
-        irq_enter();
-
-        kstat_this_cpu.irqs[0]++;
-        timer_interrupt(irq, NULL);
-
-        irq_exit();
-        set_irq_regs(old_regs);
-}
-#endif
-
 void handler_irq(int irq, struct pt_regs *regs)
 {
         struct ino_bucket *bucket;
diff --git a/arch/sparc64/kernel/smp.c b/arch/sparc64/kernel/smp.c
index fc99f7b8012f..39deb0346eb5 100644
--- a/arch/sparc64/kernel/smp.c
+++ b/arch/sparc64/kernel/smp.c
@@ -45,7 +45,7 @@
 extern void calibrate_delay(void);
 
 /* Please don't make this stuff initdata!!!  --DaveM */
-static unsigned char boot_cpu_id;
+unsigned char boot_cpu_id;
 
 cpumask_t cpu_online_map __read_mostly = CPU_MASK_NONE;
 cpumask_t phys_cpu_present_map __read_mostly = CPU_MASK_NONE;
@@ -81,8 +81,6 @@ void __init smp_store_cpu_info(int id)
         struct device_node *dp;
         int def;
 
-        /* multiplier and counter set by
-           smp_setup_percpu_timer()  */
         cpu_data(id).udelay_val                 = loops_per_jiffy;
 
         cpu_find_by_mid(id, &dp);
@@ -1180,75 +1178,10 @@ void smp_penguin_jailcell(int irq, struct pt_regs *regs)
         preempt_enable();
 }
 
-#define prof_multiplier(__cpu)          cpu_data(__cpu).multiplier
-#define prof_counter(__cpu)             cpu_data(__cpu).counter
-
-void smp_percpu_timer_interrupt(struct pt_regs *regs)
-{
-        unsigned long compare, tick, pstate;
-        int cpu = smp_processor_id();
-        int user = user_mode(regs);
-        struct pt_regs *old_regs;
-
-        /*
-         * Check for level 14 softint.
-         */
-        {
-                unsigned long tick_mask = tick_ops->softint_mask;
-
-                if (!(get_softint() & tick_mask)) {
-                        extern void handler_irq(int, struct pt_regs *);
-
-                        handler_irq(14, regs);
-                        return;
-                }
-                clear_softint(tick_mask);
-        }
-
-        old_regs = set_irq_regs(regs);
-        do {
-                profile_tick(CPU_PROFILING);
-                if (!--prof_counter(cpu)) {
-                        irq_enter();
-
-                        if (cpu == boot_cpu_id) {
-                                kstat_this_cpu.irqs[0]++;
-                                timer_tick_interrupt(regs);
-                        }
-
-                        update_process_times(user);
-
-                        irq_exit();
-
-                        prof_counter(cpu) = prof_multiplier(cpu);
-                }
-
-                /* Guarantee that the following sequences execute
-                 * uninterrupted.
-                 */
-                __asm__ __volatile__("rdpr      %%pstate, %0\n\t"
-                                     "wrpr      %0, %1, %%pstate"
-                                     : "=r" (pstate)
-                                     : "i" (PSTATE_IE));
-
-                compare = tick_ops->add_compare(current_tick_offset);
-                tick = tick_ops->get_tick();
-
-                /* Restore PSTATE_IE. */
-                __asm__ __volatile__("wrpr      %0, 0x0, %%pstate"
-                                     : /* no outputs */
-                                     : "r" (pstate));
-        } while (time_after_eq(tick, compare));
-        set_irq_regs(old_regs);
-}
-
 static void __init smp_setup_percpu_timer(void)
 {
-        int cpu = smp_processor_id();
         unsigned long pstate;
 
-        prof_counter(cpu) = prof_multiplier(cpu) = 1;
-
         /* Guarantee that the following sequences execute
          * uninterrupted.
          */
@@ -1269,28 +1202,12 @@ void __init smp_tick_init(void)
 {
         boot_cpu_id = hard_smp_processor_id();
         current_tick_offset = timer_tick_offset;
-
-        prof_counter(boot_cpu_id) = prof_multiplier(boot_cpu_id) = 1;
 }
 
 /* /proc/profile writes can call this, don't __init it please. */
-static DEFINE_SPINLOCK(prof_setup_lock);
-
 int setup_profiling_timer(unsigned int multiplier)
 {
-        unsigned long flags;
-        int i;
-
-        if ((!multiplier) || (timer_tick_offset / multiplier) < 1000)
-                return -EINVAL;
-
-        spin_lock_irqsave(&prof_setup_lock, flags);
-        for_each_possible_cpu(i)
-                prof_multiplier(i) = multiplier;
-        current_tick_offset = (timer_tick_offset / multiplier);
-        spin_unlock_irqrestore(&prof_setup_lock, flags);
-
-        return 0;
+        return -EINVAL;
 }
 
 static void __init smp_tune_scheduling(void)
diff --git a/arch/sparc64/kernel/time.c b/arch/sparc64/kernel/time.c
index d457079118dc..48e1217c1e42 100644
--- a/arch/sparc64/kernel/time.c
+++ b/arch/sparc64/kernel/time.c
@@ -31,6 +31,7 @@
 #include <linux/profile.h>
 #include <linux/miscdevice.h>
 #include <linux/rtc.h>
+#include <linux/kernel_stat.h>
 
 #include <asm/oplib.h>
 #include <asm/mostek.h>
@@ -423,12 +424,6 @@ static struct sparc64_tick_ops hbtick_operations __read_mostly = {
         .softint_mask   =       1UL << 0,
 };
 
-/* timer_interrupt() needs to keep up the real-time clock,
- * as well as call the "do_timer()" routine every clocktick
- *
- * NOTE: On SUN5 systems the ticker interrupt comes in using 2
- *       interrupts, one at level14 and one with softint bit 0.
- */
 unsigned long timer_tick_offset __read_mostly;
 
 static unsigned long timer_ticks_per_nsec_quotient __read_mostly;
@@ -487,18 +482,27 @@ void notify_arch_cmos_timer(void)
         mod_timer(&sync_cmos_timer, jiffies + 1);
 }
 
-irqreturn_t timer_interrupt(int irq, void *dev_id)
+void timer_interrupt(int irq, struct pt_regs *regs)
 {
+        struct pt_regs *old_regs = set_irq_regs(regs);
         unsigned long ticks, compare, pstate;
+        unsigned long tick_mask = tick_ops->softint_mask;
+
+        clear_softint(tick_mask);
+
+        irq_enter();
 
-        write_seqlock(&xtime_lock);
+        kstat_this_cpu.irqs[0]++;
 
         do {
-#ifndef CONFIG_SMP
                 profile_tick(CPU_PROFILING);
                 update_process_times(user_mode(get_irq_regs()));
-#endif
-                do_timer(1);
+
+                if (smp_processor_id() == boot_cpu_id) {
+                        write_seqlock(&xtime_lock);
+                        do_timer(1);
+                        write_sequnlock(&xtime_lock);
+                }
 
                 /* Guarantee that the following sequences execute
                  * uninterrupted.
@@ -515,24 +519,13 @@ irqreturn_t timer_interrupt(int irq, void *dev_id)
                 __asm__ __volatile__("wrpr      %0, 0x0, %%pstate"
                                      : /* no outputs */
                                      : "r" (pstate));
-        } while (time_after_eq(ticks, compare));
+        } while (unlikely(time_after_eq(ticks, compare)));
 
-        write_sequnlock(&xtime_lock);
+        irq_exit();
 
-        return IRQ_HANDLED;
+        set_irq_regs(old_regs);
 }
 
-#ifdef CONFIG_SMP
-void timer_tick_interrupt(struct pt_regs *regs)
-{
-        write_seqlock(&xtime_lock);
-
-        do_timer(1);
-
-        write_sequnlock(&xtime_lock);
-}
-#endif
-
 /* Kick start a stopped clock (procedure from the Sun NVRAM/hostid FAQ). */
 static void __init kick_start_clock(void)
 {
diff --git a/arch/sparc64/kernel/ttable.S b/arch/sparc64/kernel/ttable.S
index d7d2a8bdc66e..7575aa371da8 100644
--- a/arch/sparc64/kernel/ttable.S
+++ b/arch/sparc64/kernel/ttable.S
@@ -60,11 +60,7 @@ tl0_irq4:	BTRAP(0x44)
 tl0_irq5:       TRAP_IRQ(handler_irq, 5)
 tl0_irq6:       BTRAP(0x46) BTRAP(0x47) BTRAP(0x48) BTRAP(0x49)
 tl0_irq10:      BTRAP(0x4a) BTRAP(0x4b) BTRAP(0x4c) BTRAP(0x4d)
-#ifndef CONFIG_SMP
-tl0_irq14:      TRAP_IRQ(timer_irq, 14)
-#else
-tl0_irq14:      TICK_SMP_IRQ
-#endif
+tl0_irq14:      TRAP_IRQ(timer_interrupt, 14)
 tl0_irq15:      TRAP_IRQ(handler_irq, 15)
 tl0_resv050:    BTRAP(0x50) BTRAP(0x51) BTRAP(0x52) BTRAP(0x53) BTRAP(0x54) BTRAP(0x55)
 tl0_resv056:    BTRAP(0x56) BTRAP(0x57) BTRAP(0x58) BTRAP(0x59) BTRAP(0x5a) BTRAP(0x5b)