#include <sys/types.h>
#include <sys/kmem.h>
#include <sys/async.h>
#include <sys/sysmacros.h>
#include <sys/sunddi.h>
#include <sys/ddi_impldefs.h>
#include <sys/vmem.h>
#include <sys/machsystm.h>
#include <sys/iommutsb.h>
#include "px_obj.h"
int
px_mmu_attach(px_t *px_p)
{
dev_info_t *dip = px_p->px_dip;
px_mmu_t *mmu_p;
uint32_t tsb_i = 0;
char map_name[32];
px_dvma_range_prop_t *dvma_prop;
int dvma_prop_len;
uint32_t cache_size, tsb_entries;
mmu_p = kmem_zalloc(sizeof (px_mmu_t), KM_SLEEP);
if (mmu_p == NULL)
return (DDI_FAILURE);
px_p->px_mmu_p = mmu_p;
mmu_p->mmu_px_p = px_p;
mmu_p->mmu_inst = ddi_get_instance(dip);
if (ddi_getlongprop(DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS,
"virtual-dma", (caddr_t)&dvma_prop, &dvma_prop_len) !=
DDI_PROP_SUCCESS) {
DBG(DBG_ATTACH, dip, "Getting virtual-dma failed\n");
kmem_free(mmu_p, sizeof (px_mmu_t));
px_p->px_mmu_p = NULL;
return (DDI_FAILURE);
}
mmu_p->mmu_dvma_base = dvma_prop->dvma_base;
mmu_p->mmu_dvma_end = dvma_prop->dvma_base +
(dvma_prop->dvma_len - 1);
tsb_entries = MMU_BTOP(dvma_prop->dvma_len);
kmem_free(dvma_prop, dvma_prop_len);
mmu_p->mmu_dvma_cache_locks =
kmem_zalloc(px_dvma_page_cache_entries, KM_SLEEP);
mmu_p->dvma_base_pg = MMU_BTOP(mmu_p->mmu_dvma_base);
mmu_p->mmu_dvma_reserve = tsb_entries >> 1;
mmu_p->dvma_end_pg = MMU_BTOP(mmu_p->mmu_dvma_end);
(void) snprintf(map_name, sizeof (map_name), "%s%d_dvma",
ddi_driver_name(dip), ddi_get_instance(dip));
cache_size = MMU_PTOB(px_dvma_page_cache_entries *
px_dvma_page_cache_clustsz);
mmu_p->mmu_dvma_fast_end = mmu_p->mmu_dvma_base +
cache_size - 1;
mmu_p->mmu_dvma_map = vmem_create(map_name,
(void *)(mmu_p->mmu_dvma_fast_end + 1),
MMU_PTOB(tsb_entries) - cache_size, MMU_PAGE_SIZE,
NULL, NULL, NULL, MMU_PAGE_SIZE, VM_SLEEP);
mutex_init(&mmu_p->dvma_debug_lock, NULL, MUTEX_DRIVER, NULL);
for (tsb_i = 0; tsb_i < tsb_entries; tsb_i++) {
r_addr_t ra = 0;
io_attributes_t attr;
caddr_t va;
if (px_lib_iommu_getmap(px_p->px_dip, PCI_TSBID(0, tsb_i),
&attr, &ra) != DDI_SUCCESS)
continue;
va = (caddr_t)(MMU_PTOB(mmu_p->dvma_base_pg + tsb_i));
if (va <= (caddr_t)mmu_p->mmu_dvma_fast_end) {
uint32_t cache_i;
cache_i = tsb_i / px_dvma_page_cache_clustsz;
ASSERT(cache_i < px_dvma_page_cache_entries);
mmu_p->mmu_dvma_cache_locks[cache_i] = 0xFF;
} else {
(void) vmem_xalloc(mmu_p->mmu_dvma_map, MMU_PAGE_SIZE,
MMU_PAGE_SIZE, 0, 0, va, va + MMU_PAGE_SIZE,
VM_NOSLEEP | VM_BESTFIT | VM_PANIC);
}
}
return (DDI_SUCCESS);
}
void
px_mmu_detach(px_t *px_p)
{
px_mmu_t *mmu_p = px_p->px_mmu_p;
(void) px_lib_iommu_detach(px_p);
vmem_destroy(mmu_p->mmu_dvma_map);
kmem_free(mmu_p->mmu_dvma_cache_locks,
px_dvma_page_cache_entries);
if (PX_DVMA_DBG_ON(mmu_p))
px_dvma_debug_fini(mmu_p);
mutex_destroy(&mmu_p->dvma_debug_lock);
kmem_free(mmu_p, sizeof (px_mmu_t));
px_p->px_mmu_p = NULL;
}
int
px_mmu_map_pages(px_mmu_t *mmu_p, ddi_dma_impl_t *mp, px_dvma_addr_t dvma_pg,
size_t npages, size_t pfn_index)
{
dev_info_t *dip = mmu_p->mmu_px_p->px_dip;
px_dvma_addr_t pg_index = MMU_PAGE_INDEX(mmu_p, dvma_pg);
io_attributes_t attr = PX_GET_MP_TTE(mp->dmai_tte);
ASSERT(npages <= mp->dmai_ndvmapages);
DBG(DBG_MAP_WIN, dip, "px_mmu_map_pages:%x+%x=%x "
"npages=0x%x pfn_index=0x%x\n", (uint_t)mmu_p->dvma_base_pg,
(uint_t)pg_index, dvma_pg, (uint_t)npages, (uint_t)pfn_index);
if (px_lib_iommu_map(dip, PCI_TSBID(0, pg_index), npages,
PX_ADD_ATTR_EXTNS(attr, mp->dmai_bdf), (void *)mp, pfn_index,
MMU_MAP_PFN) != DDI_SUCCESS) {
DBG(DBG_MAP_WIN, dip, "px_mmu_map_pages: "
"px_lib_iommu_map failed\n");
return (DDI_FAILURE);
}
if (!PX_MAP_BUFZONE(mp))
goto done;
DBG(DBG_MAP_WIN, dip, "px_mmu_map_pages: redzone pg=%x\n",
pg_index + npages);
ASSERT(PX_HAS_REDZONE(mp));
if (px_lib_iommu_map(dip, PCI_TSBID(0, pg_index + npages), 1,
PX_ADD_ATTR_EXTNS(attr, mp->dmai_bdf), (void *)mp,
pfn_index + npages - 1, MMU_MAP_PFN) != DDI_SUCCESS) {
DBG(DBG_MAP_WIN, dip, "px_mmu_map_pages: mapping "
"REDZONE page failed\n");
if (px_lib_iommu_demap(dip, PCI_TSBID(0, pg_index), npages)
!= DDI_SUCCESS) {
DBG(DBG_MAP_WIN, dip, "px_lib_iommu_demap: failed\n");
}
return (DDI_FAILURE);
}
done:
if (PX_DVMA_DBG_ON(mmu_p))
px_dvma_alloc_debug(mmu_p, (char *)mp->dmai_mapping,
mp->dmai_size, mp);
return (DDI_SUCCESS);
}
void
px_mmu_unmap_pages(px_mmu_t *mmu_p, ddi_dma_impl_t *mp, px_dvma_addr_t dvma_pg,
uint_t npages)
{
px_dvma_addr_t pg_index = MMU_PAGE_INDEX(mmu_p, dvma_pg);
DBG(DBG_UNMAP_WIN, mmu_p->mmu_px_p->px_dip,
"px_mmu_unmap_pages:%x+%x=%x npages=0x%x\n",
(uint_t)mmu_p->dvma_base_pg, (uint_t)pg_index, dvma_pg,
(uint_t)npages);
if (px_lib_iommu_demap(mmu_p->mmu_px_p->px_dip,
PCI_TSBID(0, pg_index), npages) != DDI_SUCCESS) {
DBG(DBG_UNMAP_WIN, mmu_p->mmu_px_p->px_dip,
"px_lib_iommu_demap: failed\n");
}
if (!PX_MAP_BUFZONE(mp))
return;
DBG(DBG_UNMAP_WIN, mmu_p->mmu_px_p->px_dip, "px_mmu_unmap_pages: "
"redzone pg=%x\n", pg_index + npages);
ASSERT(PX_HAS_REDZONE(mp));
if (px_lib_iommu_demap(mmu_p->mmu_px_p->px_dip,
PCI_TSBID(0, pg_index + npages), 1) != DDI_SUCCESS) {
DBG(DBG_UNMAP_WIN, mmu_p->mmu_px_p->px_dip,
"px_lib_iommu_demap: failed\n");
}
}
int
px_mmu_map_window(px_mmu_t *mmu_p, ddi_dma_impl_t *mp, px_window_t win_no)
{
uint32_t obj_pg0_off = mp->dmai_roffset;
uint32_t win_pg0_off = win_no ? 0 : obj_pg0_off;
size_t win_size = mp->dmai_winsize;
size_t pfn_index = win_size * win_no;
size_t obj_off = win_no ? pfn_index - obj_pg0_off : 0;
px_dvma_addr_t dvma_pg = MMU_BTOP(mp->dmai_mapping);
size_t res_size = mp->dmai_object.dmao_size - obj_off + win_pg0_off;
int ret = DDI_SUCCESS;
ASSERT(!(win_size & MMU_PAGE_OFFSET));
if (win_no >= mp->dmai_nwin)
return (ret);
if (res_size < win_size)
win_size = res_size;
mp->dmai_mapping = MMU_PTOB(dvma_pg) | win_pg0_off;
mp->dmai_size = win_size - win_pg0_off;
mp->dmai_offset = obj_off;
pfn_index = MMU_BTOP(pfn_index);
ret = px_mmu_map_pages(mmu_p, mp, dvma_pg, MMU_BTOPR(win_size),
pfn_index);
return (ret);
}
void
px_mmu_unmap_window(px_mmu_t *mmu_p, ddi_dma_impl_t *mp)
{
px_dvma_addr_t dvma_pg = MMU_BTOP(mp->dmai_mapping);
uint_t npages = MMU_BTOP(mp->dmai_winsize);
px_mmu_unmap_pages(mmu_p, mp, dvma_pg, npages);
if (PX_DVMA_DBG_ON(mmu_p))
px_dvma_free_debug(mmu_p, (char *)mp->dmai_mapping,
mp->dmai_size, mp);
}
#if 0
static int px_mmu_tsb_sizes[] = {
0x0,
0x1,
0x2,
0x3,
0x4,
0x5,
0x6,
0x7,
0x8
};
#endif
static char *px_mmu_errsts[] = {
"Protection Error", "Invalid Error", "Timeout", "ECC Error(UE)"
};
static int
px_log_mmu_err(px_t *px_p)
{
return (0);
}