#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: pmap_tlb.c,v 1.69 2026/06/06 13:27:16 skrll Exp $");
#define __PMAP_PRIVATE
#include "opt_multiprocessor.h"
#include <sys/param.h>
#include <sys/atomic.h>
#include <sys/cpu.h>
#include <sys/kernel.h>
#include <sys/mutex.h>
#include <sys/proc.h>
#include <sys/systm.h>
#include <uvm/uvm.h>
static kmutex_t pmap_tlb0_lock __cacheline_aligned;
#define IFCONSTANT(x) (__builtin_constant_p((x)) ? (x) : 0)
#if KERNEL_PID > 31
#error "KERNEL_PID expected in range 0-31"
#endif
#define TLBINFO_ASID_MARK_UNUSED(ti, asid) \
__BITMAP_CLR((asid), &(ti)->ti_asid_bitmap)
#define TLBINFO_ASID_MARK_USED(ti, asid) \
__BITMAP_SET((asid), &(ti)->ti_asid_bitmap)
#define TLBINFO_ASID_INUSE_P(ti, asid) \
__BITMAP_ISSET((asid), &(ti)->ti_asid_bitmap)
#define TLBINFO_ASID_RESET(ti) \
do { \
__BITMAP_ZERO(&ti->ti_asid_bitmap); \
for (tlb_asid_t asid = 0; asid <= KERNEL_PID; asid++) \
TLBINFO_ASID_MARK_USED(ti, asid); \
} while (0)
#define TLBINFO_ASID_INITIAL_FREE(asid_max) \
(asid_max + 1 - (1 + KERNEL_PID))
struct pmap_tlb_info pmap_tlb0_info = {
.ti_name = "tlb0",
.ti_asid_hint = KERNEL_PID + 1,
#ifdef PMAP_TLB_NUM_PIDS
.ti_asid_max = IFCONSTANT(PMAP_TLB_NUM_PIDS - 1),
.ti_asids_free = IFCONSTANT(
TLBINFO_ASID_INITIAL_FREE(PMAP_TLB_NUM_PIDS - 1)),
#endif
.ti_asid_bitmap._b[0] = __BITS(0, KERNEL_PID),
#ifdef PMAP_TLB_WIRED_UPAGES
.ti_wired = PMAP_TLB_WIRED_UPAGES,
#endif
.ti_lock = &pmap_tlb0_lock,
.ti_pais = LIST_HEAD_INITIALIZER(pmap_tlb0_info.ti_pais),
#if defined(MULTIPROCESSOR) && PMAP_TLB_MAX > 1
.ti_tlbinvop = TLBINV_NOBODY,
#endif
};
#undef IFCONSTANT
#if defined(MULTIPROCESSOR) && PMAP_TLB_MAX > 1
struct pmap_tlb_info *pmap_tlbs[PMAP_TLB_MAX] = {
[0] = &pmap_tlb0_info,
};
u_int pmap_ntlbs = 1;
#endif
#ifdef MULTIPROCESSOR
__unused static inline bool
pmap_tlb_intersecting_active_p(pmap_t pm, struct pmap_tlb_info *ti)
{
#if PMAP_TLB_MAX == 1
return !kcpuset_iszero(pm->pm_active);
#else
return kcpuset_intersecting_p(pm->pm_active, ti->ti_kcpuset);
#endif
}
static inline bool
pmap_tlb_intersecting_onproc_p(pmap_t pm, struct pmap_tlb_info *ti)
{
#if PMAP_TLB_MAX == 1
return !kcpuset_iszero(pm->pm_onproc);
#else
return kcpuset_intersecting_p(pm->pm_onproc, ti->ti_kcpuset);
#endif
}
#endif
static void
pmap_tlb_pai_check(struct pmap_tlb_info *ti, bool locked_p)
{
#ifdef DIAGNOSTIC
UVMHIST_FUNC(__func__);
UVMHIST_CALLARGS(maphist, "(ti=%#jx)", (uintptr_t)ti, 0, 0, 0);
struct pmap_asid_info *pai;
if (!locked_p)
TLBINFO_LOCK(ti);
LIST_FOREACH(pai, &ti->ti_pais, pai_link) {
KASSERT(pai != NULL);
KASSERT(PAI_PMAP(pai, ti) != pmap_kernel());
KASSERTMSG(pai->pai_asid > KERNEL_PID,
"pm %p asid %#x (%d)", PAI_PMAP(pai, ti), pai->pai_asid,
KERNEL_PID);
KASSERTMSG(pai->pai_asid <= ti->ti_asid_max,
"pm %p asid %#x", PAI_PMAP(pai, ti), pai->pai_asid);
KASSERTMSG(TLBINFO_ASID_INUSE_P(ti, pai->pai_asid),
"pm %p asid %u", PAI_PMAP(pai, ti), pai->pai_asid);
#ifdef MULTIPROCESSOR
KASSERT(pmap_tlb_intersecting_active_p(PAI_PMAP(pai, ti), ti));
#endif
}
if (!locked_p)
TLBINFO_UNLOCK(ti);
UVMHIST_LOG(maphist, " <-- done", 0, 0, 0, 0);
#endif
}
static void
pmap_tlb_pai_reset(struct pmap_tlb_info *ti, struct pmap_asid_info *pai,
struct pmap *pm)
{
UVMHIST_FUNC(__func__);
UVMHIST_CALLARGS(maphist, "(ti=%#jx, pai=%#jx, pm=%#jx): asid %u",
(uintptr_t)ti, (uintptr_t)pai, (uintptr_t)pm, pai->pai_asid);
KASSERT(pai->pai_asid > KERNEL_PID);
KASSERT(pai->pai_asid <= ti->ti_asid_max);
#if defined(MULTIPROCESSOR)
KASSERT(pmap_tlb_intersecting_active_p(pm, ti));
KASSERT(!pmap_tlb_intersecting_onproc_p(pm, ti));
#endif
LIST_REMOVE(pai, pai_link);
#ifdef DIAGNOSTIC
pai->pai_link.le_prev = NULL;
#endif
if (PMAP_TLB_FLUSH_ASID_ON_RESET) {
#ifndef MULTIPROCESSOR
UVMHIST_LOG(maphist, " ... asid %u flushed", pai->pai_asid, 0,
0, 0);
tlb_invalidate_asids(pai->pai_asid, pai->pai_asid);
#endif
if (TLBINFO_ASID_INUSE_P(ti, pai->pai_asid)) {
UVMHIST_LOG(maphist, " ... asid marked unused",
pai->pai_asid, 0, 0, 0);
TLBINFO_ASID_MARK_UNUSED(ti, pai->pai_asid);
ti->ti_asids_free++;
}
}
pai->pai_asid = 0;
#if defined(MULTIPROCESSOR)
#if PMAP_TLB_MAX == 1
kcpuset_zero(pm->pm_active);
#else
kcpuset_remove(pm->pm_active, ti->ti_kcpuset);
#endif
KASSERT(!pmap_tlb_intersecting_active_p(pm, ti));
#endif
UVMHIST_LOG(maphist, " <-- done", 0, 0, 0, 0);
}
void
pmap_tlb_info_evcnt_attach(struct pmap_tlb_info *ti)
{
#if defined(MULTIPROCESSOR) && !defined(PMAP_TLB_NO_SYNCI_EVCNT)
evcnt_attach_dynamic_nozero(&ti->ti_evcnt_synci_desired,
EVCNT_TYPE_MISC, NULL,
ti->ti_name, "icache syncs desired");
evcnt_attach_dynamic_nozero(&ti->ti_evcnt_synci_asts,
EVCNT_TYPE_MISC, &ti->ti_evcnt_synci_desired,
ti->ti_name, "icache sync asts");
evcnt_attach_dynamic_nozero(&ti->ti_evcnt_synci_all,
EVCNT_TYPE_MISC, &ti->ti_evcnt_synci_asts,
ti->ti_name, "icache full syncs");
evcnt_attach_dynamic_nozero(&ti->ti_evcnt_synci_pages,
EVCNT_TYPE_MISC, &ti->ti_evcnt_synci_asts,
ti->ti_name, "icache pages synced");
evcnt_attach_dynamic_nozero(&ti->ti_evcnt_synci_duplicate,
EVCNT_TYPE_MISC, &ti->ti_evcnt_synci_desired,
ti->ti_name, "icache dup pages skipped");
evcnt_attach_dynamic_nozero(&ti->ti_evcnt_synci_deferred,
EVCNT_TYPE_MISC, &ti->ti_evcnt_synci_desired,
ti->ti_name, "icache pages deferred");
#endif
evcnt_attach_dynamic_nozero(&ti->ti_evcnt_asid_reinits,
EVCNT_TYPE_MISC, NULL,
ti->ti_name, "asid pool reinit");
}
void
pmap_tlb_info_init(struct pmap_tlb_info *ti)
{
#if defined(MULTIPROCESSOR)
#if PMAP_TLB_MAX == 1
KASSERT(ti == &pmap_tlb0_info);
#else
if (ti != &pmap_tlb0_info) {
KASSERT(pmap_ntlbs < PMAP_TLB_MAX);
KASSERT(pmap_tlbs[pmap_ntlbs] == NULL);
ti->ti_lock = mutex_obj_alloc(MUTEX_DEFAULT, IPL_SCHED);
TLBINFO_ASID_RESET(ti);
ti->ti_asid_hint = KERNEL_PID + 1;
ti->ti_asid_max = pmap_tlbs[0]->ti_asid_max;
ti->ti_asids_free = TLBINFO_ASID_INITIAL_FREE(ti->ti_asid_max);
ti->ti_tlbinvop = TLBINV_NOBODY;
ti->ti_victim = NULL;
kcpuset_create(&ti->ti_kcpuset, true);
ti->ti_index = pmap_ntlbs++;
ti->ti_wired = 0;
pmap_tlbs[ti->ti_index] = ti;
snprintf(ti->ti_name, sizeof(ti->ti_name), "tlb%u",
ti->ti_index);
pmap_tlb_info_evcnt_attach(ti);
KASSERT(ti->ti_asid_max < PMAP_TLB_BITMAP_LENGTH);
return;
}
#endif
#endif
KASSERT(ti == &pmap_tlb0_info);
KASSERT(ti->ti_lock == &pmap_tlb0_lock);
mutex_init(ti->ti_lock, MUTEX_DEFAULT, IPL_SCHED);
#if defined(MULTIPROCESSOR) && PMAP_TLB_MAX > 1
kcpuset_create(&ti->ti_kcpuset, true);
kcpuset_set(ti->ti_kcpuset, cpu_index(curcpu()));
#endif
const tlb_asid_t asid_max = pmap_md_tlb_asid_max();
if (ti->ti_asid_max == 0 || asid_max < ti->ti_asid_max) {
ti->ti_asid_max = asid_max;
ti->ti_asids_free = TLBINFO_ASID_INITIAL_FREE(ti->ti_asid_max);
}
KASSERT(__type_fit(tlb_asid_t, ti->ti_asid_max + 1));
KASSERT(ti->ti_asid_max < PMAP_TLB_BITMAP_LENGTH);
}
#if defined(MULTIPROCESSOR)
void
pmap_tlb_info_attach(struct pmap_tlb_info *ti, struct cpu_info *ci)
{
KASSERT(!CPU_IS_PRIMARY(ci));
KASSERT(ci->ci_data.cpu_idlelwp != NULL);
KASSERT(cold);
TLBINFO_LOCK(ti);
#if PMAP_TLB_MAX > 1
kcpuset_set(ti->ti_kcpuset, cpu_index(ci));
cpu_set_tlb_info(ci, ti);
#endif
pmap_md_tlb_info_attach(ti, ci);
TLBINFO_UNLOCK(ti);
}
#endif
static size_t
pmap_tlb_asid_count(struct pmap_tlb_info *ti)
{
size_t count = 0;
#ifdef DIAGNOSTIC
for (tlb_asid_t asid = 1; asid <= ti->ti_asid_max; asid++) {
if (TLBINFO_ASID_INUSE_P(ti, asid))
count++;
}
#endif
return count;
}
static void
pmap_tlb_asid_reinitialize(struct pmap_tlb_info *ti, enum tlb_invalidate_op op)
{
UVMHIST_FUNC(__func__);
UVMHIST_CALLARGS(maphist, "(ti=%#jx, op=%ju)", (uintptr_t)ti, op, 0, 0);
pmap_tlb_pai_check(ti, true);
ti->ti_evcnt_asid_reinits.ev_count++;
ti->ti_asids_free = TLBINFO_ASID_INITIAL_FREE(ti->ti_asid_max);
ti->ti_asid_hint = KERNEL_PID + 1;
TLBINFO_ASID_RESET(ti);
switch (op) {
#if defined(MULTIPROCESSOR) && defined(PMAP_TLB_NEED_SHOOTDOWN)
case TLBINV_ALL:
tlb_invalidate_all();
break;
case TLBINV_ALLUSER:
tlb_invalidate_asids(KERNEL_PID + 1, ti->ti_asid_max);
break;
#endif
case TLBINV_NOBODY: {
#if !defined(MULTIPROCESSOR) || defined(PMAP_TLB_NEED_SHOOTDOWN)
pmap_tlb_asid_check();
const u_int asids_found = tlb_record_asids(
ti->ti_asid_bitmap._b, ti->ti_asid_max);
pmap_tlb_asid_check();
const u_int asids_count __diagused = pmap_tlb_asid_count(ti);
KASSERTMSG(asids_found == asids_count,
"found %u != count %u", asids_found, asids_count);
if (__predict_false(asids_found >= ti->ti_asid_max / 2)) {
tlb_invalidate_asids(KERNEL_PID + 1, ti->ti_asid_max);
#else
tlb_invalidate_all();
#endif
TLBINFO_ASID_RESET(ti);
ti->ti_asids_free = TLBINFO_ASID_INITIAL_FREE(
ti->ti_asid_max);
#if !defined(MULTIPROCESSOR) || defined(PMAP_TLB_NEED_SHOOTDOWN)
} else {
ti->ti_asids_free -= asids_found;
}
#endif
KASSERTMSG(ti->ti_asids_free <= ti->ti_asid_max, "%u",
ti->ti_asids_free);
break;
}
default:
panic("%s: unexpected op %d", __func__, op);
}
struct pmap_asid_info *pai, *next;
for (pai = LIST_FIRST(&ti->ti_pais); pai != NULL; pai = next) {
struct pmap * const pm = PAI_PMAP(pai, ti);
next = LIST_NEXT(pai, pai_link);
KASSERT(pm != pmap_kernel());
KASSERT(pai->pai_asid > KERNEL_PID);
#if defined(MULTIPROCESSOR)
if (pmap_tlb_intersecting_onproc_p(pm, ti)) {
if (!TLBINFO_ASID_INUSE_P(ti, pai->pai_asid)) {
TLBINFO_ASID_MARK_USED(ti, pai->pai_asid);
ti->ti_asids_free--;
}
continue;
}
#endif
if (TLBINFO_ASID_INUSE_P(ti, pai->pai_asid)) {
KASSERT(op == TLBINV_NOBODY);
} else {
pmap_tlb_pai_reset(ti, pai, pm);
}
}
size_t free_count __diagused = ti->ti_asid_max - pmap_tlb_asid_count(ti);
KASSERTMSG(free_count == ti->ti_asids_free,
"bitmap error: %zu != %u", free_count, ti->ti_asids_free);
UVMHIST_LOG(maphist, " <-- done", 0, 0, 0, 0);
}
#if defined(MULTIPROCESSOR) && defined(PMAP_TLB_NEED_SHOOTDOWN)
#if PMAP_TLB_MAX == 1
#error shootdown not required for single TLB systems
#endif
void
pmap_tlb_shootdown_process(void)
{
struct cpu_info * const ci = curcpu();
struct pmap_tlb_info * const ti = cpu_tlb_info(ci);
UVMHIST_FUNC(__func__);
UVMHIST_CALLED(maphist);
KASSERT(cpu_intr_p());
KASSERTMSG(ci->ci_cpl >= IPL_SCHED, "%s: cpl (%d) < IPL_SCHED (%d)",
__func__, ci->ci_cpl, IPL_SCHED);
TLBINFO_LOCK(ti);
UVMHIST_LOG(maphist, "ti %#jx", (uintptr_t)ti, 0, 0, 0);
switch (ti->ti_tlbinvop) {
case TLBINV_ONE: {
UVMHIST_LOG(maphist, "TLBINV_ONE ti->ti_victim %#jx", (uintptr_t)ti->ti_victim, 0, 0, 0);
struct pmap_asid_info * const pai = PMAP_PAI(ti->ti_victim, ti);
KASSERT(ti->ti_victim != pmap_kernel());
if (pmap_tlb_intersecting_onproc_p(ti->ti_victim, ti)) {
UVMHIST_LOG(maphist, "... onproc asid %jd", pai->pai_asid, 0, 0, 0);
KASSERT(pai->pai_asid > KERNEL_PID);
pmap_tlb_asid_check();
tlb_invalidate_asids(pai->pai_asid, pai->pai_asid);
pmap_tlb_asid_check();
} else if (pai->pai_asid) {
UVMHIST_LOG(maphist, "... not active asid %jd", pai->pai_asid, 0, 0, 0);
pmap_tlb_pai_reset(ti, pai, PAI_PMAP(pai, ti));
}
break;
}
case TLBINV_ALLUSER:
pmap_tlb_asid_reinitialize(ti, TLBINV_ALLUSER);
break;
case TLBINV_ALLKERNEL:
pmap_tlb_asid_check();
tlb_invalidate_globals();
pmap_tlb_asid_check();
break;
case TLBINV_ALL:
pmap_tlb_asid_reinitialize(ti, TLBINV_ALL);
break;
case TLBINV_NOBODY:
break;
}
ti->ti_victim = NULL;
ti->ti_tlbinvop = TLBINV_NOBODY;
TLBINFO_UNLOCK(ti);
}
#define TLBINV_MAP(op, nobody, one, alluser, allkernel, all) \
(((( (nobody) << 3 * TLBINV_NOBODY) \
| ( (one) << 3 * TLBINV_ONE) \
| ( (alluser) << 3 * TLBINV_ALLUSER) \
| ((allkernel) << 3 * TLBINV_ALLKERNEL) \
| ( (all) << 3 * TLBINV_ALL)) >> 3 * (op)) & 7)
#define TLBINV_USER_MAP(op) \
TLBINV_MAP(op, TLBINV_ONE, TLBINV_ALLUSER, TLBINV_ALLUSER, \
TLBINV_ALL, TLBINV_ALL)
#define TLBINV_KERNEL_MAP(op) \
TLBINV_MAP(op, TLBINV_ALLKERNEL, TLBINV_ALL, TLBINV_ALL, \
TLBINV_ALLKERNEL, TLBINV_ALL)
bool
pmap_tlb_shootdown_bystanders(pmap_t pm)
{
UVMHIST_FUNC(__func__);
UVMHIST_CALLARGS(maphist, "pm %#jx", (uintptr_t)pm, 0, 0, 0);
KASSERT(kpreempt_disabled());
const struct cpu_info * const ci = curcpu();
kcpuset_t *pm_active = ci->ci_shootdowncpus;
kcpuset_copy(pm_active, pm->pm_active);
kcpuset_remove(pm_active, cpu_tlb_info(curcpu())->ti_kcpuset);
const bool kernel_p = (pm == pmap_kernel());
bool ipi_sent = false;
for (size_t i = 0; !kcpuset_iszero(pm_active); i++) {
KASSERT(i < pmap_ntlbs);
struct pmap_tlb_info * const ti = pmap_tlbs[i];
KASSERT(tlbinfo_index(ti) == i);
UVMHIST_LOG(maphist, "ti %#jx", (uintptr_t)ti, 0, 0, 0);
if (!kcpuset_intersecting_p(pm_active, ti->ti_kcpuset))
continue;
struct pmap_asid_info * const pai = PMAP_PAI(pm, ti);
kcpuset_remove(pm_active, ti->ti_kcpuset);
TLBINFO_LOCK(ti);
cpuid_t j = kcpuset_ffs_intersecting(pm->pm_onproc,
ti->ti_kcpuset);
if (j-- > 0) {
if (kernel_p) {
ti->ti_tlbinvop =
TLBINV_KERNEL_MAP(ti->ti_tlbinvop);
ti->ti_victim = NULL;
} else {
KASSERT(pai->pai_asid);
if (__predict_false(ti->ti_victim == pm)) {
KASSERT(ti->ti_tlbinvop == TLBINV_ONE);
} else {
ti->ti_tlbinvop =
TLBINV_USER_MAP(ti->ti_tlbinvop);
if (ti->ti_tlbinvop == TLBINV_ONE)
ti->ti_victim = pm;
else
ti->ti_victim = NULL;
}
}
UVMHIST_LOG(maphist, "tlbinvop %jx victim %#jx", ti->ti_tlbinvop,
(uintptr_t)ti->ti_victim, 0, 0);
TLBINFO_UNLOCK(ti);
cpu_send_ipi(cpu_lookup(j), IPI_SHOOTDOWN);
ipi_sent = true;
continue;
}
if (!pmap_tlb_intersecting_active_p(pm, ti)) {
UVMHIST_LOG(maphist, "pm %#jx not active", (uintptr_t)pm, 0, 0, 0);
KASSERT(!kernel_p);
pmap_tlb_pai_reset(ti, pai, pm);
}
TLBINFO_UNLOCK(ti);
}
UVMHIST_LOG(maphist, " <-- done (ipi_sent=%jd)", ipi_sent, 0, 0, 0);
return ipi_sent;
}
#endif
int
pmap_tlb_update_addr(pmap_t pm, vaddr_t va, pt_entry_t pte, u_int flags)
{
KASSERT(kpreempt_disabled());
struct pmap_tlb_info * const ti = cpu_tlb_info(curcpu());
struct pmap_asid_info * const pai = PMAP_PAI(pm, ti);
int rv = -1;
UVMHIST_FUNC(__func__);
UVMHIST_CALLARGS(maphist, " (pm=%#jx va=%#jx, pte=%#jx flags=%#jx)",
(uintptr_t)pm, va, pte_value(pte), flags);
KASSERTMSG(pte_valid_p(pte), "va %#"PRIxVADDR" %#"PRIxPTE,
va, pte_value(pte));
TLBINFO_LOCK(ti);
if (pm == pmap_kernel() || PMAP_PAI_ASIDVALID_P(pai, ti)) {
pmap_tlb_asid_check();
rv = tlb_update_addr(va, pai->pai_asid, pte,
(flags & PMAP_TLB_INSERT) != 0);
pmap_tlb_asid_check();
UVMHIST_LOG(maphist,
" %jd <-- tlb_update_addr(%#jx, %#jx, %#jx, ...)",
rv, va, pai->pai_asid, pte_value(pte));
KASSERTMSG((flags & PMAP_TLB_INSERT) == 0 || rv == 1,
"pmap %p (asid %u) va %#"PRIxVADDR" pte %#"PRIxPTE" rv %d",
pm, pai->pai_asid, va, pte_value(pte), rv);
}
#if defined(MULTIPROCESSOR) && defined(PMAP_TLB_NEED_SHOOTDOWN)
if (flags & PMAP_TLB_NEED_IPI)
pm->pm_shootdown_pending = 1;
#endif
TLBINFO_UNLOCK(ti);
UVMHIST_LOG(maphist, " <-- done (rv=%jd)", rv, 0, 0, 0);
return rv;
}
void
pmap_tlb_invalidate_addr(pmap_t pm, vaddr_t va)
{
KASSERT(kpreempt_disabled());
struct pmap_tlb_info * const ti = cpu_tlb_info(curcpu());
struct pmap_asid_info * const pai = PMAP_PAI(pm, ti);
UVMHIST_FUNC(__func__);
UVMHIST_CALLARGS(maphist, " (pm=%#jx va=%#jx) ti=%#jx asid=%#jx",
(uintptr_t)pm, va, (uintptr_t)ti, pai->pai_asid);
TLBINFO_LOCK(ti);
if (pm == pmap_kernel() || PMAP_PAI_ASIDVALID_P(pai, ti)) {
pmap_tlb_asid_check();
UVMHIST_LOG(maphist, " invalidating %#jx asid %#jx",
va, pai->pai_asid, 0, 0);
tlb_invalidate_addr(va, pai->pai_asid);
pmap_tlb_asid_check();
}
#if defined(MULTIPROCESSOR) && defined(PMAP_TLB_NEED_SHOOTDOWN)
pm->pm_shootdown_pending = 1;
#endif
TLBINFO_UNLOCK(ti);
UVMHIST_LOG(maphist, " <-- done", 0, 0, 0, 0);
}
static inline void
pmap_tlb_asid_alloc(struct pmap_tlb_info *ti, pmap_t pm,
struct pmap_asid_info *pai)
{
KASSERT(pm != pmap_kernel());
KASSERT(pai->pai_asid == 0);
KASSERT(pai->pai_link.le_prev == NULL);
#if defined(MULTIPROCESSOR)
KASSERT(!pmap_tlb_intersecting_onproc_p(pm, ti));
KASSERT(!pmap_tlb_intersecting_active_p(pm, ti));
#endif
KASSERT(ti->ti_asids_free > 0);
KASSERT(ti->ti_asid_hint > KERNEL_PID);
if (PMAP_TLB_FLUSH_ASID_ON_RESET
&& ti->ti_asid_hint > ti->ti_asid_max) {
ti->ti_asid_hint = KERNEL_PID + 1;
}
KASSERTMSG(ti->ti_asid_hint <= ti->ti_asid_max, "hint %u",
ti->ti_asid_hint);
if (__predict_true(TLBINFO_ASID_INUSE_P(ti, ti->ti_asid_hint))) {
const size_t nbpw = NBBY * sizeof(ti->ti_asid_bitmap._b[0]);
size_t i;
u_long bits;
for (i = 0; (bits = ~ti->ti_asid_bitmap._b[i]) == 0; i++) {
KASSERT(i < __arraycount(ti->ti_asid_bitmap._b) - 1);
}
const u_int n = __builtin_ffsl(bits) - 1;
KASSERTMSG((bits << (nbpw - (n+1))) == (1ul << (nbpw-1)),
"n %u bits %#lx", n, bits);
KASSERT(n < nbpw);
ti->ti_asid_hint = n + i * nbpw;
}
KASSERT(ti->ti_asid_hint > KERNEL_PID);
KASSERT(ti->ti_asid_hint <= ti->ti_asid_max);
KASSERTMSG(PMAP_TLB_FLUSH_ASID_ON_RESET
|| TLBINFO_ASID_INUSE_P(ti, ti->ti_asid_hint - 1),
"hint %u bitmap %p", ti->ti_asid_hint, &ti->ti_asid_bitmap);
KASSERTMSG(!TLBINFO_ASID_INUSE_P(ti, ti->ti_asid_hint),
"hint %u bitmap %p", ti->ti_asid_hint, &ti->ti_asid_bitmap);
pai->pai_asid = ti->ti_asid_hint++;
#ifdef MULTIPROCESSOR
if (PMAP_TLB_FLUSH_ASID_ON_RESET) {
tlb_invalidate_asids(pai->pai_asid, pai->pai_asid);
}
#endif
TLBINFO_ASID_MARK_USED(ti, pai->pai_asid);
LIST_INSERT_HEAD(&ti->ti_pais, pai, pai_link);
ti->ti_asids_free--;
#if defined(MULTIPROCESSOR)
#if PMAP_TLB_MAX == 1
kcpuset_copy(pm->pm_active, kcpuset_running);
#else
kcpuset_merge(pm->pm_active, ti->ti_kcpuset);
#endif
#endif
}
void
pmap_tlb_asid_acquire(pmap_t pm, struct lwp *l)
{
KASSERT(kpreempt_disabled());
struct cpu_info * const ci = l->l_cpu;
struct pmap_tlb_info * const ti = cpu_tlb_info(ci);
struct pmap_asid_info * const pai = PMAP_PAI(pm, ti);
UVMHIST_FUNC(__func__);
UVMHIST_CALLARGS(maphist, "(pm=%#jx, l=%#jx, ti=%#jx)", (uintptr_t)pm,
(uintptr_t)l, (uintptr_t)ti, 0);
if (pm == pmap_kernel()) {
UVMHIST_LOG(maphist, " <-- done (kernel)", 0, 0, 0, 0);
return;
}
TLBINFO_LOCK(ti);
KASSERT(pai->pai_asid <= KERNEL_PID || pai->pai_link.le_prev != NULL);
KASSERT(pai->pai_asid > KERNEL_PID || pai->pai_link.le_prev == NULL);
pmap_tlb_pai_check(ti, true);
if (__predict_false(!tlbinfo_hasasids_p(ti))) {
#if defined(MULTIPROCESSOR)
#if PMAP_TLB_MAX == 1
kcpuset_copy(pm->pm_active, kcpuset_running);
#else
kcpuset_merge(pm->pm_active, ti->ti_kcpuset);
#endif
#endif
} else if (__predict_false(!PMAP_PAI_ASIDVALID_P(pai, ti))) {
if (__predict_false(!tlbinfo_freeasids_p(ti))) {
KASSERT(l == curlwp);
UVMHIST_LOG(maphist, " asid reinit", 0, 0, 0, 0);
pmap_tlb_asid_reinitialize(ti, TLBINV_NOBODY);
KASSERT(tlbinfo_freeasids_p(ti));
}
pmap_tlb_asid_alloc(ti, pm, pai);
UVMHIST_LOG(maphist, "allocated asid %#jx", pai->pai_asid,
0, 0, 0);
}
pmap_tlb_pai_check(ti, true);
#if defined(MULTIPROCESSOR)
KASSERT(kcpuset_isset(pm->pm_active, cpu_index(ci)));
#endif
if (l == curlwp) {
#if defined(MULTIPROCESSOR)
KASSERT(pm != pmap_kernel());
kcpuset_atomic_set(pm->pm_onproc, cpu_index(ci));
#endif
ci->ci_pmap_asid_cur = pai->pai_asid;
UVMHIST_LOG(maphist, "setting asid to %#jx", pai->pai_asid,
0, 0, 0);
pmap_md_asid_activate(pai->pai_asid, pm, l);
pmap_tlb_asid_check();
}
TLBINFO_UNLOCK(ti);
UVMHIST_LOG(maphist, " <-- done", 0, 0, 0, 0);
}
void
pmap_tlb_asid_deactivate(pmap_t pm)
{
UVMHIST_FUNC(__func__);
UVMHIST_CALLARGS(maphist, "pm %#jx", (uintptr_t)pm, 0, 0, 0);
KASSERT(kpreempt_disabled());
#if defined(MULTIPROCESSOR)
if (pm != pmap_kernel() && !kcpuset_iszero(pm->pm_onproc)) {
struct cpu_info * const ci = curcpu();
KASSERT(!cpu_intr_p());
KASSERTMSG(kcpuset_isset(pm->pm_onproc, cpu_index(ci)),
"%s: pmap %p onproc %p doesn't include cpu %d (%p)",
__func__, pm, pm->pm_onproc, cpu_index(ci), ci);
kcpuset_atomic_clear(pm->pm_onproc, cpu_index(ci));
}
#endif
curcpu()->ci_pmap_asid_cur = KERNEL_PID;
pmap_md_asid_deactivate(pm);
pmap_tlb_pai_check(cpu_tlb_info(curcpu()), false);
#if defined(DEBUG)
pmap_tlb_asid_check();
#endif
UVMHIST_LOG(maphist, " <-- done (pm=%#jx)", (uintptr_t)pm, 0, 0, 0);
}
void
pmap_tlb_asid_release_all(struct pmap *pm)
{
UVMHIST_FUNC(__func__);
UVMHIST_CALLARGS(maphist, "(pm=%#jx)", (uintptr_t)pm, 0, 0, 0);
KASSERT(pm != pmap_kernel());
#if defined(MULTIPROCESSOR)
struct cpu_info * const ci __diagused = curcpu();
KASSERT(!kcpuset_isotherset(pm->pm_onproc, cpu_index(ci)));
#if PMAP_TLB_MAX > 1
for (u_int i = 0; !kcpuset_iszero(pm->pm_active); i++) {
KASSERT(i < pmap_ntlbs);
struct pmap_tlb_info * const ti = pmap_tlbs[i];
#else
struct pmap_tlb_info * const ti = &pmap_tlb0_info;
#endif
struct pmap_asid_info * const pai = PMAP_PAI(pm, ti);
TLBINFO_LOCK(ti);
if (PMAP_PAI_ASIDVALID_P(pai, ti)) {
if (ti->ti_victim == pm)
ti->ti_victim = NULL;
if (__predict_true(tlbinfo_hasasids_p(ti)))
pmap_tlb_pai_reset(ti, pai, pm);
}
KASSERT(pai->pai_link.le_prev == NULL);
TLBINFO_UNLOCK(ti);
#if PMAP_TLB_MAX > 1
}
#endif
for (size_t i = 0; i < (PMAP_TLB_MAX > 1 ? pmap_ntlbs : 1); i++) {
KASSERTMSG(pm->pm_pai[i].pai_asid == 0,
"pm %p i %zu asid %u",
pm, i, pm->pm_pai[i].pai_asid);
}
#else
struct pmap_tlb_info * const ti = &pmap_tlb0_info;
struct pmap_asid_info * const pai = PMAP_PAI(pm, ti);
TLBINFO_LOCK(ti);
if (pai->pai_asid > KERNEL_PID) {
if (curcpu()->ci_pmap_asid_cur == pai->pai_asid) {
tlb_invalidate_asids(pai->pai_asid, pai->pai_asid);
} else {
pmap_tlb_pai_reset(ti, pai, pm);
}
}
TLBINFO_UNLOCK(ti);
#endif
UVMHIST_LOG(maphist, " <-- done", 0, 0, 0, 0);
}
void
pmap_tlb_asid_check(void)
{
UVMHIST_FUNC(__func__);
UVMHIST_CALLED(maphist);
#ifdef DEBUG
kpreempt_disable();
const tlb_asid_t asid __debugused = tlb_get_asid();
UVMHIST_LOG(maphist, " asid %u vs pmap_cur_asid %u", asid,
curcpu()->ci_pmap_asid_cur, 0, 0);
KDASSERTMSG(asid == curcpu()->ci_pmap_asid_cur,
"%s: asid (%#x) != current asid (%#x)",
__func__, asid, curcpu()->ci_pmap_asid_cur);
kpreempt_enable();
#endif
UVMHIST_LOG(maphist, " <-- done", 0, 0, 0, 0);
}
#ifdef DEBUG
void
pmap_tlb_check(pmap_t pm, bool (*func)(void *, vaddr_t, tlb_asid_t, pt_entry_t))
{
struct pmap_tlb_info * const ti = cpu_tlb_info(curcpu());
struct pmap_asid_info * const pai = PMAP_PAI(pm, ti);
TLBINFO_LOCK(ti);
if (pm == pmap_kernel() || pai->pai_asid > KERNEL_PID)
tlb_walk(pm, func);
TLBINFO_UNLOCK(ti);
}
#endif
#ifdef DDB
void
pmap_db_tlb_print(struct pmap *pm,
void (*pr)(const char *, ...) __printflike(1, 2))
{
#if !defined(MULTIPROCESSOR) || PMAP_TLB_MAX == 1
pr(" asid %5u\n", pm->pm_pai[0].pai_asid);
#else
for (size_t i = 0; i < (PMAP_TLB_MAX > 1 ? pmap_ntlbs : 1); i++) {
pr(" tlb %zu asid %5u\n", i, pm->pm_pai[i].pai_asid);
}
#endif
}
#endif