/* SMP TLB support routines.
   *
   * Copyright (C) 2006-2008 Panasonic Corporation
   * All Rights Reserved.
   *
   * This program is free software; you can redistribute it and/or
   * modify it under the terms of the GNU General Public License
   * version 2 as published by the Free Software Foundation.
   *
   * This program is distributed in the hope that it will be useful,
   * but WITHOUT ANY WARRANTY; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
   * GNU General Public License for more details.
   */
  #include <linux/interrupt.h>
  #include <linux/spinlock.h>
  #include <linux/init.h>
  #include <linux/jiffies.h>
  #include <linux/cpumask.h>
  #include <linux/err.h>
  #include <linux/kernel.h>
  #include <linux/delay.h>
  #include <linux/sched.h>
  #include <linux/profile.h>
  #include <linux/smp.h>
  #include <asm/tlbflush.h>
  #include <asm/system.h>
  #include <asm/bitops.h>
  #include <asm/processor.h>
  #include <asm/bug.h>
  #include <asm/exceptions.h>
  #include <asm/hardirq.h>
  #include <asm/fpu.h>
  #include <asm/mmu_context.h>
  #include <asm/thread_info.h>
  #include <asm/cpu-regs.h>
  #include <asm/intctl-regs.h>
  
  /*
   * For flush TLB
   */
  #define FLUSH_ALL	0xffffffff
  
  static cpumask_t flush_cpumask;
  static struct mm_struct *flush_mm;
  static unsigned long flush_va;
  static DEFINE_SPINLOCK(tlbstate_lock);
  
  DEFINE_PER_CPU_SHARED_ALIGNED(struct tlb_state, cpu_tlbstate) = {
  	&init_mm, 0
  };
  
  static void flush_tlb_others(cpumask_t cpumask, struct mm_struct *mm,
  			     unsigned long va);
  static void do_flush_tlb_all(void *info);
  
  /**
   * smp_flush_tlb - Callback to invalidate the TLB.
   * @unused: Callback context (ignored).
   */
  void smp_flush_tlb(void *unused)
  {
  	unsigned long cpu_id;
  
  	cpu_id = get_cpu();

  	if (!cpumask_test_cpu(cpu_id, &flush_cpumask))

  		/* This was a BUG() but until someone can quote me the line
  		 * from the intel manual that guarantees an IPI to multiple
  		 * CPUs is retried _only_ on the erroring CPUs its staying as a
  		 * return
  		 *
  		 * BUG();
  		 */
  		goto out;
  
  	if (flush_va == FLUSH_ALL)
  		local_flush_tlb();
  	else
  		local_flush_tlb_page(flush_mm, flush_va);
  
  	smp_mb__before_clear_bit();

  	cpumask_clear_cpu(cpu_id, &flush_cpumask);

  	smp_mb__after_clear_bit();
  out:
  	put_cpu();
  }
  
  /**
   * flush_tlb_others - Tell the specified CPUs to invalidate their TLBs
   * @cpumask: The list of CPUs to target.
   * @mm: The VM context to flush from (if va!=FLUSH_ALL).
   * @va: Virtual address to flush or FLUSH_ALL to flush everything.
   */
  static void flush_tlb_others(cpumask_t cpumask, struct mm_struct *mm,
  			     unsigned long va)
  {
  	cpumask_t tmp;
  
  	/* A couple of sanity checks (to be removed):
  	 * - mask must not be empty
  	 * - current CPU must not be in mask
  	 * - we do not send IPIs to as-yet unbooted CPUs.
  	 */
  	BUG_ON(!mm);

  	BUG_ON(cpumask_empty(&cpumask));
  	BUG_ON(cpumask_test_cpu(smp_processor_id(), &cpumask));

  	cpumask_and(&tmp, &cpumask, cpu_online_mask);
  	BUG_ON(!cpumask_equal(&cpumask, &tmp));

  
  	/* I'm not happy about this global shared spinlock in the MM hot path,
  	 * but we'll see how contended it is.
  	 *
  	 * Temporarily this turns IRQs off, so that lockups are detected by the
  	 * NMI watchdog.
  	 */
  	spin_lock(&tlbstate_lock);
  
  	flush_mm = mm;
  	flush_va = va;
  #if NR_CPUS <= BITS_PER_LONG
  	atomic_set_mask(cpumask.bits[0], &flush_cpumask.bits[0]);
  #else
  #error Not supported.
  #endif
  
  	/* FIXME: if NR_CPUS>=3, change send_IPI_mask */
  	smp_call_function(smp_flush_tlb, NULL, 1);

  	while (!cpumask_empty(&flush_cpumask))

  		/* Lockup detection does not belong here */
  		smp_mb();
  
  	flush_mm = NULL;
  	flush_va = 0;
  	spin_unlock(&tlbstate_lock);
  }
  
  /**
   * flush_tlb_mm - Invalidate TLB of specified VM context
   * @mm: The VM context to invalidate.
   */
  void flush_tlb_mm(struct mm_struct *mm)
  {
  	cpumask_t cpu_mask;
  
  	preempt_disable();

  	cpumask_copy(&cpu_mask, mm_cpumask(mm));
  	cpumask_clear_cpu(smp_processor_id(), &cpu_mask);

  
  	local_flush_tlb();

  	if (!cpumask_empty(&cpu_mask))

  		flush_tlb_others(cpu_mask, mm, FLUSH_ALL);
  
  	preempt_enable();
  }
  
  /**
   * flush_tlb_current_task - Invalidate TLB of current task
   */
  void flush_tlb_current_task(void)
  {
  	struct mm_struct *mm = current->mm;
  	cpumask_t cpu_mask;
  
  	preempt_disable();

  	cpumask_copy(&cpu_mask, mm_cpumask(mm));
  	cpumask_clear_cpu(smp_processor_id(), &cpu_mask);

  
  	local_flush_tlb();

  	if (!cpumask_empty(&cpu_mask))

  		flush_tlb_others(cpu_mask, mm, FLUSH_ALL);
  
  	preempt_enable();
  }
  
  /**
   * flush_tlb_page - Invalidate TLB of page
   * @vma: The VM context to invalidate the page for.
   * @va: The virtual address of the page to invalidate.
   */
  void flush_tlb_page(struct vm_area_struct *vma, unsigned long va)
  {
  	struct mm_struct *mm = vma->vm_mm;
  	cpumask_t cpu_mask;
  
  	preempt_disable();

  	cpumask_copy(&cpu_mask, mm_cpumask(mm));
  	cpumask_clear_cpu(smp_processor_id(), &cpu_mask);

  
  	local_flush_tlb_page(mm, va);

  	if (!cpumask_empty(&cpu_mask))

  		flush_tlb_others(cpu_mask, mm, va);
  
  	preempt_enable();
  }
  
  /**
   * do_flush_tlb_all - Callback to completely invalidate a TLB
   * @unused: Callback context (ignored).
   */
  static void do_flush_tlb_all(void *unused)
  {
  	local_flush_tlb_all();
  }
  
  /**
   * flush_tlb_all - Completely invalidate TLBs on all CPUs
   */
  void flush_tlb_all(void)
  {
  	on_each_cpu(do_flush_tlb_all, 0, 1);
  }