From: Lima Project Developers <dri-devel@lists.freedesktop.org>

Signed-off-by: Qiang Yu <yuq...@gmail.com>
Signed-off-by: Marek Vasut <ma...@denx.de>
Signed-off-by: Heiko Stuebner <he...@sntech.de>
---
 drivers/gpu/drm/lima/lima_mmu.c | 154 ++++++++++++++++++++++++++++++++
 drivers/gpu/drm/lima/lima_mmu.h |  34 +++++++
 2 files changed, 188 insertions(+)
 create mode 100644 drivers/gpu/drm/lima/lima_mmu.c
 create mode 100644 drivers/gpu/drm/lima/lima_mmu.h

diff --git a/drivers/gpu/drm/lima/lima_mmu.c b/drivers/gpu/drm/lima/lima_mmu.c
new file mode 100644
index 000000000000..22ac4db07849
--- /dev/null
+++ b/drivers/gpu/drm/lima/lima_mmu.c
@@ -0,0 +1,154 @@
+/*
+ * Copyright (C) 2017-2018 Lima Project
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a
+ * copy of this software and associated documentation files (the "Software"),
+ * to deal in the Software without restriction, including without limitation
+ * the rights to use, copy, modify, merge, publish, distribute, sublicense,
+ * and/or sell copies of the Software, and to permit persons to whom the
+ * Software is furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
+ * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
+ * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
+ * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
+ * OTHER DEALINGS IN THE SOFTWARE.
+ */
+
+#include <linux/interrupt.h>
+#include <linux/io.h>
+#include <linux/device.h>
+
+#include "lima_device.h"
+#include "lima_mmu.h"
+#include "lima_vm.h"
+#include "lima_object.h"
+#include "lima_regs.h"
+
+#define mmu_write(reg, data) writel(data, ip->iomem + LIMA_MMU_##reg)
+#define mmu_read(reg) readl(ip->iomem + LIMA_MMU_##reg)
+
+#define lima_mmu_send_command(command, condition)           \
+({                                                          \
+       int __timeout, __ret = 0;                            \
+                                                            \
+       mmu_write(COMMAND, command);                         \
+       for (__timeout = 1000; __timeout > 0; __timeout--) { \
+               if (condition)                               \
+                       break;                               \
+       }                                                    \
+       if (!__timeout) {                                    \
+               dev_err(dev->dev, "mmu command %x timeout\n", command); \
+               __ret = -ETIMEDOUT;                          \
+       }                                                    \
+       __ret;                                               \
+})
+
+static irqreturn_t lima_mmu_irq_handler(int irq, void *data)
+{
+       struct lima_ip *ip = data;
+       struct lima_device *dev = ip->dev;
+       u32 status = mmu_read(INT_STATUS);
+       struct lima_sched_pipe *pipe;
+
+       /* for shared irq case */
+       if (!status)
+               return IRQ_NONE;
+
+       if (status & LIMA_MMU_INT_PAGE_FAULT) {
+               u32 fault = mmu_read(PAGE_FAULT_ADDR);
+               dev_err(dev->dev, "mmu page fault at 0x%x from bus id %d of 
type %s on %s\n",
+                       fault, LIMA_MMU_STATUS_BUS_ID(status),
+                       status & LIMA_MMU_STATUS_PAGE_FAULT_IS_WRITE ? "write" 
: "read",
+                       lima_ip_name(ip));
+       }
+
+       if (status & LIMA_MMU_INT_READ_BUS_ERROR) {
+               dev_err(dev->dev, "mmu %s irq bus error\n", lima_ip_name(ip));
+       }
+
+       /* mask all interrupts before resume */
+       mmu_write(INT_MASK, 0);
+       mmu_write(INT_CLEAR, status);
+
+       pipe = dev->pipe + (ip->id == lima_ip_gpmmu ? lima_pipe_gp : 
lima_pipe_pp);
+       lima_sched_pipe_mmu_error(pipe);
+
+       return IRQ_HANDLED;
+}
+
+int lima_mmu_init(struct lima_ip *ip)
+{
+       struct lima_device *dev = ip->dev;
+       int err;
+
+       if (ip->id == lima_ip_ppmmu_bcast)
+               return 0;
+
+       mmu_write(DTE_ADDR, 0xCAFEBABE);
+       if (mmu_read(DTE_ADDR) != 0xCAFEB000) {
+               dev_err(dev->dev, "mmu %s dte write test fail\n", 
lima_ip_name(ip));
+               return -EIO;
+       }
+
+       err = lima_mmu_send_command(LIMA_MMU_COMMAND_HARD_RESET, 
mmu_read(DTE_ADDR) == 0);
+       if (err)
+               return err;
+
+       err = devm_request_irq(dev->dev, ip->irq, lima_mmu_irq_handler,
+                              IRQF_SHARED, lima_ip_name(ip), ip);
+       if (err) {
+               dev_err(dev->dev, "mmu %s fail to request irq\n", 
lima_ip_name(ip));
+               return err;
+       }
+
+       mmu_write(INT_MASK, LIMA_MMU_INT_PAGE_FAULT | 
LIMA_MMU_INT_READ_BUS_ERROR);
+       mmu_write(DTE_ADDR, *lima_bo_get_pages(dev->empty_vm->pd));
+       return lima_mmu_send_command(LIMA_MMU_COMMAND_ENABLE_PAGING,
+                                    mmu_read(STATUS) & 
LIMA_MMU_STATUS_PAGING_ENABLED);
+}
+
+void lima_mmu_fini(struct lima_ip *ip)
+{
+
+}
+
+void lima_mmu_switch_vm(struct lima_ip *ip, struct lima_vm *vm)
+{
+       struct lima_device *dev = ip->dev;
+
+       lima_mmu_send_command(LIMA_MMU_COMMAND_ENABLE_STALL,
+                             mmu_read(STATUS) & LIMA_MMU_STATUS_STALL_ACTIVE);
+
+       if (vm)
+               mmu_write(DTE_ADDR, *lima_bo_get_pages(vm->pd));
+
+       /* flush the TLB */
+       mmu_write(COMMAND, LIMA_MMU_COMMAND_ZAP_CACHE);
+
+       lima_mmu_send_command(LIMA_MMU_COMMAND_DISABLE_STALL,
+                             !(mmu_read(STATUS) & 
LIMA_MMU_STATUS_STALL_ACTIVE));
+}
+
+void lima_mmu_page_fault_resume(struct lima_ip *ip)
+{
+       struct lima_device *dev = ip->dev;
+       u32 status = mmu_read(STATUS);
+
+       if (status & LIMA_MMU_STATUS_PAGE_FAULT_ACTIVE) {
+               dev_info(dev->dev, "mmu resume\n");
+
+               mmu_write(INT_MASK, 0);
+               mmu_write(DTE_ADDR, 0xCAFEBABE);
+               lima_mmu_send_command(LIMA_MMU_COMMAND_HARD_RESET, 
mmu_read(DTE_ADDR) == 0);
+               mmu_write(INT_MASK, LIMA_MMU_INT_PAGE_FAULT | 
LIMA_MMU_INT_READ_BUS_ERROR);
+               mmu_write(DTE_ADDR, *lima_bo_get_pages(dev->empty_vm->pd));
+               lima_mmu_send_command(LIMA_MMU_COMMAND_ENABLE_PAGING,
+                                     mmu_read(STATUS) & 
LIMA_MMU_STATUS_PAGING_ENABLED);
+       }
+}
diff --git a/drivers/gpu/drm/lima/lima_mmu.h b/drivers/gpu/drm/lima/lima_mmu.h
new file mode 100644
index 000000000000..9930521ddfa1
--- /dev/null
+++ b/drivers/gpu/drm/lima/lima_mmu.h
@@ -0,0 +1,34 @@
+/*
+ * Copyright (C) 2017-2018 Lima Project
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a
+ * copy of this software and associated documentation files (the "Software"),
+ * to deal in the Software without restriction, including without limitation
+ * the rights to use, copy, modify, merge, publish, distribute, sublicense,
+ * and/or sell copies of the Software, and to permit persons to whom the
+ * Software is furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
+ * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
+ * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
+ * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
+ * OTHER DEALINGS IN THE SOFTWARE.
+ */
+#ifndef __LIMA_MMU_H__
+#define __LIMA_MMU_H__
+
+struct lima_ip;
+struct lima_vm;
+
+int lima_mmu_init(struct lima_ip *ip);
+void lima_mmu_fini(struct lima_ip *ip);
+
+void lima_mmu_switch_vm(struct lima_ip *ip, struct lima_vm *vm);
+void lima_mmu_page_fault_resume(struct lima_ip *ip);
+
+#endif
-- 
2.17.0

_______________________________________________
dri-devel mailing list
dri-devel@lists.freedesktop.org
https://lists.freedesktop.org/mailman/listinfo/dri-devel

Reply via email to