#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: jazzdmatlb.c,v 1.19 2025/12/11 07:25:12 andvar Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/proc.h>
#include <sys/vmem.h>
#include <uvm/uvm_extern.h>
#include <machine/autoconf.h>
#include <sys/bus.h>
#include <arc/jazz/jazzdmatlbreg.h>
#include <arc/jazz/jazzdmatlbvar.h>
#include <mips/cache.h>
extern paddr_t kvtophys(vaddr_t);
#define NDMATLB (JAZZ_DMATLB_SIZE / sizeof(jazz_dma_pte_t))
static bus_space_tag_t dmatlb_iot;
static bus_space_handle_t dmatlb_ioh;
static vmem_t *dmatlb_arena;
static jazz_dma_pte_t *dma_tlb;
void
jazz_dmatlb_init(bus_space_tag_t iot, bus_addr_t ioaddr)
{
int err;
dmatlb_iot = iot;
err = bus_space_map(iot, ioaddr, JAZZ_DMATLB_REGSIZE, 0, &dmatlb_ioh);
if (err != 0)
panic("jazz_dmatlb_init: cannot map 0x%lx", ioaddr);
dma_tlb = (jazz_dma_pte_t *)PICA_TL_BASE;
mips_dcache_wbinv_all();
memset((char *)dma_tlb, 0, JAZZ_DMATLB_SIZE);
dmatlb_arena = vmem_create("dmatlb", 0, NDMATLB,
1,
NULL,
NULL,
NULL,
0,
VM_SLEEP,
IPL_VM);
KASSERT(dmatlb_arena != NULL);
bus_space_write_4(dmatlb_iot, dmatlb_ioh, JAZZ_DMATLBREG_MAP,
MIPS_KSEG1_TO_PHYS(dma_tlb));
bus_space_write_4(dmatlb_iot, dmatlb_ioh, JAZZ_DMATLBREG_LIMIT,
JAZZ_DMATLB_SIZE);
jazz_dmatlb_flush();
}
jazz_dma_pte_t *
jazz_dmatlb_alloc(int npte, bus_size_t boundary, int flags, bus_addr_t *addr)
{
vmem_addr_t start;
int err;
const vm_flag_t vmflags = VM_INSTANTFIT |
((flags & BUS_DMA_WAITOK) ? VM_SLEEP : VM_NOSLEEP);
err = vmem_xalloc(dmatlb_arena, npte,
1,
0,
boundary / JAZZ_DMA_PAGE_SIZE,
VMEM_ADDR_MIN,
VMEM_ADDR_MAX,
vmflags,
&start);
if (err)
return NULL;
*addr = start * JAZZ_DMA_PAGE_SIZE;
return dma_tlb + start;
}
void
jazz_dmatlb_free(bus_addr_t addr, int npte)
{
vmem_addr_t start;
start = addr / JAZZ_DMA_PAGE_SIZE;
vmem_xfree(dmatlb_arena, start, npte);
}
void
jazz_dmatlb_map_va(struct vmspace *vm, vaddr_t va, vsize_t size,
jazz_dma_pte_t *dma_pte)
{
paddr_t pa;
size = jazz_dma_page_round(size + jazz_dma_page_offs(va));
va &= JAZZ_DMA_PAGE_NUM;
while (size > 0) {
if (!VMSPACE_IS_KERNEL_P(vm))
(void)pmap_extract(vm_map_pmap(&vm->vm_map), va, &pa);
else
pa = kvtophys(va);
pa &= JAZZ_DMA_PAGE_NUM;
dma_pte->lo_addr = pa;
dma_pte->hi_addr = 0;
dma_pte++;
va += JAZZ_DMA_PAGE_SIZE;
size -= JAZZ_DMA_PAGE_SIZE;
}
}
void
jazz_dmatlb_map_pa(paddr_t pa, psize_t size, jazz_dma_pte_t *dma_pte)
{
size = jazz_dma_page_round(size + jazz_dma_page_offs(pa));
pa &= JAZZ_DMA_PAGE_NUM;
while (size > 0) {
dma_pte->lo_addr = pa;
dma_pte->hi_addr = 0;
dma_pte++;
pa += JAZZ_DMA_PAGE_SIZE;
size -= JAZZ_DMA_PAGE_SIZE;
}
}
void
jazz_dmatlb_flush(void)
{
bus_space_write_4(dmatlb_iot, dmatlb_ioh, JAZZ_DMATLBREG_IVALID, 0);
}