// SPDX-License-Identifier: GPL-2.0-only
/*
 * arch/sh/mm/tlb-sh4.c
 *
 * SH-4 specific TLB operations
 *
 * Copyright (C) 1999  Niibe Yutaka
 * Copyright (C) 2002 - 2007 Paul Mundt
 */
#include <linux/kernel.h>
#include <linux/mm.h>
#include <linux/io.h>
#include <asm/mmu_context.h>
#include <asm/cacheflush.h>

void __update_tlb(struct vm_area_struct *vma, unsigned long address, pte_t pte)
{
        unsigned long flags, pteval, vpn;

        /*
         * Handle debugger faulting in for debugee.
         */
        if (vma && current->active_mm != vma->vm_mm)
                return;

        local_irq_save(flags);

        /* Set PTEH register */
        vpn = (address & MMU_VPN_MASK) | get_asid();
        __raw_writel(vpn, MMU_PTEH);

        pteval = pte.pte_low;

        /* Set PTEA register */
#ifdef CONFIG_X2TLB
        /*
         * For the extended mode TLB this is trivial, only the ESZ and
         * EPR bits need to be written out to PTEA, with the remainder of
         * the protection bits (with the exception of the compat-mode SZ
         * and PR bits, which are cleared) being written out in PTEL.
         */
        __raw_writel(pte.pte_high, MMU_PTEA);
#else
        if (cpu_data->flags & CPU_HAS_PTEA) {
                /* The last 3 bits and the first one of pteval contains
                 * the PTEA timing control and space attribute bits
                 */
                __raw_writel(copy_ptea_attributes(pteval), MMU_PTEA);
        }
#endif

        /* Set PTEL register */
        pteval &= _PAGE_FLAGS_HARDWARE_MASK; /* drop software flags */
#ifdef CONFIG_CACHE_WRITETHROUGH
        pteval |= _PAGE_WT;
#endif
        /* conveniently, we want all the software flags to be 0 anyway */
        __raw_writel(pteval, MMU_PTEL);

        /* Load the TLB */
        asm volatile("ldtlb": /* no output */ : /* no input */ : "memory");
        local_irq_restore(flags);
}

void local_flush_tlb_one(unsigned long asid, unsigned long page)
{
        unsigned long addr, data;

        /*
         * NOTE: PTEH.ASID should be set to this MM
         *       _AND_ we need to write ASID to the array.
         *
         * It would be simple if we didn't need to set PTEH.ASID...
         */
        addr = MMU_UTLB_ADDRESS_ARRAY | MMU_PAGE_ASSOC_BIT;
        data = page | asid; /* VALID bit is off */
        jump_to_uncached();
        __raw_writel(data, addr);
        back_to_cached();
}

void local_flush_tlb_all(void)
{
        unsigned long flags, status;
        int i;

        /*
         * Flush all the TLB.
         */
        local_irq_save(flags);
        jump_to_uncached();

        status = __raw_readl(MMUCR);
        status = ((status & MMUCR_URB) >> MMUCR_URB_SHIFT);

        if (status == 0)
                status = MMUCR_URB_NENTRIES;

        for (i = 0; i < status; i++)
                __raw_writel(0x0, MMU_UTLB_ADDRESS_ARRAY | (i << 8));

        for (i = 0; i < 4; i++)
                __raw_writel(0x0, MMU_ITLB_ADDRESS_ARRAY | (i << 8));

        back_to_cached();
        ctrl_barrier();
        local_irq_restore(flags);
}