|
|
@@ -21,15 +21,146 @@
|
|
|
*/
|
|
|
#include "vmm.h"
|
|
|
|
|
|
+#include <subdev/fb.h>
|
|
|
+#include <subdev/timer.h>
|
|
|
+#include <engine/gr.h>
|
|
|
+
|
|
|
#include <nvif/if500d.h>
|
|
|
#include <nvif/unpack.h>
|
|
|
|
|
|
+static inline void
|
|
|
+nv50_vmm_pgt_pte(struct nvkm_vmm *vmm, struct nvkm_mmu_pt *pt,
|
|
|
+ u32 ptei, u32 ptes, struct nvkm_vmm_map *map, u64 addr)
|
|
|
+{
|
|
|
+ u64 next = addr | map->type, data;
|
|
|
+ u32 pten;
|
|
|
+ int log2blk;
|
|
|
+
|
|
|
+ map->type += ptes * map->ctag;
|
|
|
+
|
|
|
+ while (ptes) {
|
|
|
+ for (log2blk = 7; log2blk >= 0; log2blk--) {
|
|
|
+ pten = 1 << log2blk;
|
|
|
+ if (ptes >= pten && IS_ALIGNED(ptei, pten))
|
|
|
+ break;
|
|
|
+ }
|
|
|
+
|
|
|
+ data = next | (log2blk << 7);
|
|
|
+ next += pten * map->next;
|
|
|
+ ptes -= pten;
|
|
|
+
|
|
|
+ while (pten--)
|
|
|
+ VMM_WO064(pt, vmm, ptei++ * 8, data);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+nv50_vmm_pgt_sgl(struct nvkm_vmm *vmm, struct nvkm_mmu_pt *pt,
|
|
|
+ u32 ptei, u32 ptes, struct nvkm_vmm_map *map)
|
|
|
+{
|
|
|
+ VMM_MAP_ITER_SGL(vmm, pt, ptei, ptes, map, nv50_vmm_pgt_pte);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+nv50_vmm_pgt_dma(struct nvkm_vmm *vmm, struct nvkm_mmu_pt *pt,
|
|
|
+ u32 ptei, u32 ptes, struct nvkm_vmm_map *map)
|
|
|
+{
|
|
|
+ if (map->page->shift == PAGE_SHIFT) {
|
|
|
+ VMM_SPAM(vmm, "DMAA %08x %08x PTE(s)", ptei, ptes);
|
|
|
+ nvkm_kmap(pt->memory);
|
|
|
+ while (ptes--) {
|
|
|
+ const u64 data = *map->dma++ | map->type;
|
|
|
+ VMM_WO064(pt, vmm, ptei++ * 8, data);
|
|
|
+ map->type += map->ctag;
|
|
|
+ }
|
|
|
+ nvkm_done(pt->memory);
|
|
|
+ return;
|
|
|
+ }
|
|
|
+
|
|
|
+ VMM_MAP_ITER_DMA(vmm, pt, ptei, ptes, map, nv50_vmm_pgt_pte);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+nv50_vmm_pgt_mem(struct nvkm_vmm *vmm, struct nvkm_mmu_pt *pt,
|
|
|
+ u32 ptei, u32 ptes, struct nvkm_vmm_map *map)
|
|
|
+{
|
|
|
+ VMM_MAP_ITER_MEM(vmm, pt, ptei, ptes, map, nv50_vmm_pgt_pte);
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+nv50_vmm_pgt_unmap(struct nvkm_vmm *vmm,
|
|
|
+ struct nvkm_mmu_pt *pt, u32 ptei, u32 ptes)
|
|
|
+{
|
|
|
+ VMM_FO064(pt, vmm, ptei * 8, 0ULL, ptes);
|
|
|
+}
|
|
|
+
|
|
|
static const struct nvkm_vmm_desc_func
|
|
|
nv50_vmm_pgt = {
|
|
|
+ .unmap = nv50_vmm_pgt_unmap,
|
|
|
+ .mem = nv50_vmm_pgt_mem,
|
|
|
+ .dma = nv50_vmm_pgt_dma,
|
|
|
+ .sgl = nv50_vmm_pgt_sgl,
|
|
|
};
|
|
|
|
|
|
+static bool
|
|
|
+nv50_vmm_pde(struct nvkm_vmm *vmm, struct nvkm_vmm_pt *pgt, u64 *pdata)
|
|
|
+{
|
|
|
+ struct nvkm_mmu_pt *pt;
|
|
|
+ u64 data = 0xdeadcafe00000000ULL;
|
|
|
+ if (pgt && (pt = pgt->pt[0])) {
|
|
|
+ switch (pgt->page) {
|
|
|
+ case 16: data = 0x00000001; break;
|
|
|
+ case 12: data = 0x00000003;
|
|
|
+ switch (nvkm_memory_size(pt->memory)) {
|
|
|
+ case 0x100000: data |= 0x00000000; break;
|
|
|
+ case 0x040000: data |= 0x00000020; break;
|
|
|
+ case 0x020000: data |= 0x00000040; break;
|
|
|
+ case 0x010000: data |= 0x00000060; break;
|
|
|
+ default:
|
|
|
+ WARN_ON(1);
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ WARN_ON(1);
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+
|
|
|
+ switch (nvkm_memory_target(pt->memory)) {
|
|
|
+ case NVKM_MEM_TARGET_VRAM: data |= 0x00000000; break;
|
|
|
+ case NVKM_MEM_TARGET_HOST: data |= 0x00000008; break;
|
|
|
+ case NVKM_MEM_TARGET_NCOH: data |= 0x0000000c; break;
|
|
|
+ default:
|
|
|
+ WARN_ON(1);
|
|
|
+ return false;
|
|
|
+ }
|
|
|
+
|
|
|
+ data |= pt->addr;
|
|
|
+ }
|
|
|
+ *pdata = data;
|
|
|
+ return true;
|
|
|
+}
|
|
|
+
|
|
|
+static void
|
|
|
+nv50_vmm_pgd_pde(struct nvkm_vmm *vmm, struct nvkm_vmm_pt *pgd, u32 pdei)
|
|
|
+{
|
|
|
+ struct nvkm_vmm_join *join;
|
|
|
+ u32 pdeo = vmm->mmu->func->vmm.pd_offset + (pdei * 8);
|
|
|
+ u64 data;
|
|
|
+
|
|
|
+ if (!nv50_vmm_pde(vmm, pgd->pde[pdei], &data))
|
|
|
+ return;
|
|
|
+
|
|
|
+ list_for_each_entry(join, &vmm->join, head) {
|
|
|
+ nvkm_kmap(join->inst);
|
|
|
+ nvkm_wo64(join->inst, pdeo, data);
|
|
|
+ nvkm_done(join->inst);
|
|
|
+ }
|
|
|
+}
|
|
|
+
|
|
|
static const struct nvkm_vmm_desc_func
|
|
|
nv50_vmm_pgd = {
|
|
|
+ .pde = nv50_vmm_pgd_pde,
|
|
|
};
|
|
|
|
|
|
static const struct nvkm_vmm_desc
|
|
|
@@ -46,6 +177,150 @@ nv50_vmm_desc_16[] = {
|
|
|
{}
|
|
|
};
|
|
|
|
|
|
+static void
|
|
|
+nv50_vmm_flush(struct nvkm_vmm *vmm, int level)
|
|
|
+{
|
|
|
+ struct nvkm_subdev *subdev = &vmm->mmu->subdev;
|
|
|
+ struct nvkm_device *device = subdev->device;
|
|
|
+ int i, id;
|
|
|
+
|
|
|
+ mutex_lock(&subdev->mutex);
|
|
|
+ for (i = 0; i < NVKM_SUBDEV_NR; i++) {
|
|
|
+ if (!atomic_read(&vmm->engref[i]))
|
|
|
+ continue;
|
|
|
+
|
|
|
+ /* unfortunate hw bug workaround... */
|
|
|
+ if (i == NVKM_ENGINE_GR && device->gr) {
|
|
|
+ int ret = nvkm_gr_tlb_flush(device->gr);
|
|
|
+ if (ret != -ENODEV)
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ switch (i) {
|
|
|
+ case NVKM_ENGINE_GR : id = 0x00; break;
|
|
|
+ case NVKM_ENGINE_VP :
|
|
|
+ case NVKM_ENGINE_MSPDEC: id = 0x01; break;
|
|
|
+ case NVKM_SUBDEV_BAR : id = 0x06; break;
|
|
|
+ case NVKM_ENGINE_MSPPP :
|
|
|
+ case NVKM_ENGINE_MPEG : id = 0x08; break;
|
|
|
+ case NVKM_ENGINE_BSP :
|
|
|
+ case NVKM_ENGINE_MSVLD : id = 0x09; break;
|
|
|
+ case NVKM_ENGINE_CIPHER:
|
|
|
+ case NVKM_ENGINE_SEC : id = 0x0a; break;
|
|
|
+ case NVKM_ENGINE_CE0 : id = 0x0d; break;
|
|
|
+ default:
|
|
|
+ continue;
|
|
|
+ }
|
|
|
+
|
|
|
+ nvkm_wr32(device, 0x100c80, (id << 16) | 1);
|
|
|
+ if (nvkm_msec(device, 2000,
|
|
|
+ if (!(nvkm_rd32(device, 0x100c80) & 0x00000001))
|
|
|
+ break;
|
|
|
+ ) < 0)
|
|
|
+ nvkm_error(subdev, "%s mmu invalidate timeout\n",
|
|
|
+ nvkm_subdev_name[i]);
|
|
|
+ }
|
|
|
+ mutex_unlock(&subdev->mutex);
|
|
|
+}
|
|
|
+
|
|
|
+static int
|
|
|
+nv50_vmm_valid(struct nvkm_vmm *vmm, void *argv, u32 argc,
|
|
|
+ struct nvkm_vmm_map *map)
|
|
|
+{
|
|
|
+ const struct nvkm_vmm_page *page = map->page;
|
|
|
+ union {
|
|
|
+ struct nv50_vmm_map_vn vn;
|
|
|
+ struct nv50_vmm_map_v0 v0;
|
|
|
+ } *args = argv;
|
|
|
+ struct nvkm_device *device = vmm->mmu->subdev.device;
|
|
|
+ struct nvkm_ram *ram = device->fb->ram;
|
|
|
+ struct nvkm_memory *memory = map->memory;
|
|
|
+ u8 aper, kind, comp, priv, ro;
|
|
|
+ int kindn, ret = -ENOSYS;
|
|
|
+ const u8 *kindm;
|
|
|
+
|
|
|
+ map->type = map->ctag = 0;
|
|
|
+ map->next = 1 << page->shift;
|
|
|
+
|
|
|
+ if (!(ret = nvif_unpack(ret, &argv, &argc, args->v0, 0, 0, false))) {
|
|
|
+ ro = !!args->v0.ro;
|
|
|
+ priv = !!args->v0.priv;
|
|
|
+ kind = args->v0.kind & 0x7f;
|
|
|
+ comp = args->v0.comp & 0x03;
|
|
|
+ } else
|
|
|
+ if (!(ret = nvif_unvers(ret, &argv, &argc, args->vn))) {
|
|
|
+ ro = 0;
|
|
|
+ priv = 0;
|
|
|
+ kind = 0x00;
|
|
|
+ comp = 0;
|
|
|
+ } else {
|
|
|
+ VMM_DEBUG(vmm, "args");
|
|
|
+ return ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ switch (nvkm_memory_target(memory)) {
|
|
|
+ case NVKM_MEM_TARGET_VRAM:
|
|
|
+ if (ram->stolen) {
|
|
|
+ map->type |= ram->stolen;
|
|
|
+ aper = 3;
|
|
|
+ } else {
|
|
|
+ aper = 0;
|
|
|
+ }
|
|
|
+ break;
|
|
|
+ case NVKM_MEM_TARGET_HOST:
|
|
|
+ aper = 2;
|
|
|
+ break;
|
|
|
+ case NVKM_MEM_TARGET_NCOH:
|
|
|
+ aper = 3;
|
|
|
+ break;
|
|
|
+ default:
|
|
|
+ WARN_ON(1);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ kindm = vmm->mmu->func->kind(vmm->mmu, &kindn);
|
|
|
+ if (kind >= kindn || kindm[kind] == 0x7f) {
|
|
|
+ VMM_DEBUG(vmm, "kind %02x", kind);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (map->mem && map->mem->type != kindm[kind]) {
|
|
|
+ VMM_DEBUG(vmm, "kind %02x bankswz: %d %d", kind,
|
|
|
+ kindm[kind], map->mem->type);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (comp) {
|
|
|
+ u32 tags = (nvkm_memory_size(memory) >> 16) * comp;
|
|
|
+ if (aper != 0 || !(page->type & NVKM_VMM_PAGE_COMP)) {
|
|
|
+ VMM_DEBUG(vmm, "comp %d %02x", aper, page->type);
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = nvkm_memory_tags_get(memory, device, tags, NULL,
|
|
|
+ &map->tags);
|
|
|
+ if (ret) {
|
|
|
+ VMM_DEBUG(vmm, "comp %d", ret);
|
|
|
+ return ret;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (map->tags->mn) {
|
|
|
+ u32 tags = map->tags->mn->offset + (map->offset >> 16);
|
|
|
+ map->ctag |= (u64)comp << 49;
|
|
|
+ map->type |= (u64)comp << 47;
|
|
|
+ map->type |= (u64)tags << 49;
|
|
|
+ map->next |= map->ctag;
|
|
|
+ }
|
|
|
+ }
|
|
|
+
|
|
|
+ map->type |= BIT(0); /* Valid. */
|
|
|
+ map->type |= (u64)ro << 3;
|
|
|
+ map->type |= (u64)aper << 4;
|
|
|
+ map->type |= (u64)priv << 6;
|
|
|
+ map->type |= (u64)kind << 40;
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
static void
|
|
|
nv50_vmm_part(struct nvkm_vmm *vmm, struct nvkm_memory *inst)
|
|
|
{
|
|
|
@@ -63,19 +338,35 @@ nv50_vmm_part(struct nvkm_vmm *vmm, struct nvkm_memory *inst)
|
|
|
static int
|
|
|
nv50_vmm_join(struct nvkm_vmm *vmm, struct nvkm_memory *inst)
|
|
|
{
|
|
|
+ const u32 pd_offset = vmm->mmu->func->vmm.pd_offset;
|
|
|
struct nvkm_vmm_join *join;
|
|
|
+ int ret = 0;
|
|
|
+ u64 data;
|
|
|
+ u32 pdei;
|
|
|
|
|
|
if (!(join = kmalloc(sizeof(*join), GFP_KERNEL)))
|
|
|
return -ENOMEM;
|
|
|
join->inst = inst;
|
|
|
list_add_tail(&join->head, &vmm->join);
|
|
|
- return 0;
|
|
|
+
|
|
|
+ nvkm_kmap(join->inst);
|
|
|
+ for (pdei = vmm->start >> 29; pdei <= (vmm->limit - 1) >> 29; pdei++) {
|
|
|
+ if (!nv50_vmm_pde(vmm, vmm->pd->pde[pdei], &data)) {
|
|
|
+ ret = -EINVAL;
|
|
|
+ break;
|
|
|
+ }
|
|
|
+ nvkm_wo64(join->inst, pd_offset + (pdei * 8), data);
|
|
|
+ }
|
|
|
+ nvkm_done(join->inst);
|
|
|
+ return ret;
|
|
|
}
|
|
|
|
|
|
static const struct nvkm_vmm_func
|
|
|
nv50_vmm = {
|
|
|
.join = nv50_vmm_join,
|
|
|
.part = nv50_vmm_part,
|
|
|
+ .valid = nv50_vmm_valid,
|
|
|
+ .flush = nv50_vmm_flush,
|
|
|
.page_block = 1 << 29,
|
|
|
.page = {
|
|
|
{ 16, &nv50_vmm_desc_16[0], NVKM_VMM_PAGE_xVxC },
|
Ben Skeggs