0545e9dc6d
commit d1edce71135cc6d98c0a4b5729774542b676e769 Author: sophgo-forum-service <forum_service@sophgo.com> Date: Fri Mar 15 16:07:33 2024 +0800 [fix] recommend using ssh method to clone repo. [fix] fix sensor driver repo branch name.
125 lines
2.4 KiB
C
125 lines
2.4 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
|
|
#include <linux/mm.h>
|
|
#include <linux/smp.h>
|
|
#include <linux/sched.h>
|
|
|
|
#define XUANTIE
|
|
#ifdef XUANTIE
|
|
#include <asm/mmu_context.h>
|
|
|
|
void flush_tlb_all(void)
|
|
{
|
|
#ifdef CONFIG_NO_SFENCE_VMA
|
|
csr_write(CSR_SMCIR, 1 << 26);
|
|
#else
|
|
__asm__ __volatile__ ("sfence.vma" : : : "memory");
|
|
#endif
|
|
}
|
|
|
|
void flush_tlb_mm(struct mm_struct *mm)
|
|
{
|
|
int newpid = cpu_asid(mm);
|
|
|
|
#ifdef CONFIG_NO_SFENCE_VMA
|
|
csr_write(CSR_SMCIR, (1 << 27) | newpid);
|
|
#else
|
|
__asm__ __volatile__ ("sfence.vma zero, %0"
|
|
:
|
|
: "r"(newpid)
|
|
: "memory");
|
|
#endif
|
|
}
|
|
|
|
void flush_tlb_page(struct vm_area_struct *vma, unsigned long addr)
|
|
{
|
|
int newpid = cpu_asid(vma->vm_mm);
|
|
|
|
#ifdef CONFIG_NO_SFENCE_VMA
|
|
csr_write(CSR_SMCIR, (1 << 27) | newpid);
|
|
#else
|
|
addr &= PAGE_MASK;
|
|
|
|
__asm__ __volatile__ ("sfence.vma %0, %1"
|
|
:
|
|
: "r"(addr), "r"(newpid)
|
|
: "memory");
|
|
#endif
|
|
}
|
|
|
|
void flush_tlb_range(struct vm_area_struct *vma, unsigned long start,
|
|
unsigned long end)
|
|
{
|
|
unsigned long newpid = cpu_asid(vma->vm_mm);
|
|
|
|
#ifdef CONFIG_NO_SFENCE_VMA
|
|
csr_write(CSR_SMCIR, (1 << 27) | newpid);
|
|
#else
|
|
start &= PAGE_MASK;
|
|
end += PAGE_SIZE - 1;
|
|
end &= PAGE_MASK;
|
|
|
|
while (start < end) {
|
|
__asm__ __volatile__ ("sfence.vma %0, %1"
|
|
:
|
|
: "r"(start), "r"(newpid)
|
|
: "memory");
|
|
start += PAGE_SIZE;
|
|
}
|
|
#endif
|
|
}
|
|
#else
|
|
|
|
#include <asm/sbi.h>
|
|
|
|
void flush_tlb_all(void)
|
|
{
|
|
sbi_remote_sfence_vma(NULL, 0, -1);
|
|
}
|
|
|
|
/*
|
|
* This function must not be called with cmask being null.
|
|
* Kernel may panic if cmask is NULL.
|
|
*/
|
|
static void __sbi_tlb_flush_range(struct cpumask *cmask, unsigned long start,
|
|
unsigned long size)
|
|
{
|
|
struct cpumask hmask;
|
|
unsigned int cpuid;
|
|
|
|
if (cpumask_empty(cmask))
|
|
return;
|
|
|
|
cpuid = get_cpu();
|
|
|
|
if (cpumask_any_but(cmask, cpuid) >= nr_cpu_ids) {
|
|
/* local cpu is the only cpu present in cpumask */
|
|
if (size <= PAGE_SIZE)
|
|
local_flush_tlb_page(start);
|
|
else
|
|
local_flush_tlb_all();
|
|
} else {
|
|
riscv_cpuid_to_hartid_mask(cmask, &hmask);
|
|
sbi_remote_sfence_vma(cpumask_bits(&hmask), start, size);
|
|
}
|
|
|
|
put_cpu();
|
|
}
|
|
|
|
void flush_tlb_mm(struct mm_struct *mm)
|
|
{
|
|
__sbi_tlb_flush_range(mm_cpumask(mm), 0, -1);
|
|
}
|
|
|
|
void flush_tlb_page(struct vm_area_struct *vma, unsigned long addr)
|
|
{
|
|
__sbi_tlb_flush_range(mm_cpumask(vma->vm_mm), addr, PAGE_SIZE);
|
|
}
|
|
|
|
void flush_tlb_range(struct vm_area_struct *vma, unsigned long start,
|
|
unsigned long end)
|
|
{
|
|
__sbi_tlb_flush_range(mm_cpumask(vma->vm_mm), start, end - start);
|
|
}
|
|
#endif
|