Loading...
1// SPDX-License-Identifier: GPL-2.0 OR MIT
2/* Copyright 2017-2019 Qiang Yu <yuq825@gmail.com> */
3
4#include <linux/interrupt.h>
5#include <linux/iopoll.h>
6#include <linux/device.h>
7
8#include "lima_device.h"
9#include "lima_mmu.h"
10#include "lima_vm.h"
11#include "lima_object.h"
12#include "lima_regs.h"
13
14#define mmu_write(reg, data) writel(data, ip->iomem + reg)
15#define mmu_read(reg) readl(ip->iomem + reg)
16
17#define lima_mmu_send_command(cmd, addr, val, cond) \
18({ \
19 int __ret; \
20 \
21 mmu_write(LIMA_MMU_COMMAND, cmd); \
22 __ret = readl_poll_timeout(ip->iomem + (addr), val, \
23 cond, 0, 100); \
24 if (__ret) \
25 dev_err(dev->dev, \
26 "mmu command %x timeout\n", cmd); \
27 __ret; \
28})
29
30static irqreturn_t lima_mmu_irq_handler(int irq, void *data)
31{
32 struct lima_ip *ip = data;
33 struct lima_device *dev = ip->dev;
34 u32 status = mmu_read(LIMA_MMU_INT_STATUS);
35 struct lima_sched_pipe *pipe;
36
37 /* for shared irq case */
38 if (!status)
39 return IRQ_NONE;
40
41 if (status & LIMA_MMU_INT_PAGE_FAULT) {
42 u32 fault = mmu_read(LIMA_MMU_PAGE_FAULT_ADDR);
43
44 dev_err(dev->dev, "mmu page fault at 0x%x from bus id %d of type %s on %s\n",
45 fault, LIMA_MMU_STATUS_BUS_ID(status),
46 status & LIMA_MMU_STATUS_PAGE_FAULT_IS_WRITE ? "write" : "read",
47 lima_ip_name(ip));
48 }
49
50 if (status & LIMA_MMU_INT_READ_BUS_ERROR)
51 dev_err(dev->dev, "mmu %s irq bus error\n", lima_ip_name(ip));
52
53 /* mask all interrupts before resume */
54 mmu_write(LIMA_MMU_INT_MASK, 0);
55 mmu_write(LIMA_MMU_INT_CLEAR, status);
56
57 pipe = dev->pipe + (ip->id == lima_ip_gpmmu ? lima_pipe_gp : lima_pipe_pp);
58 lima_sched_pipe_mmu_error(pipe);
59
60 return IRQ_HANDLED;
61}
62
63int lima_mmu_init(struct lima_ip *ip)
64{
65 struct lima_device *dev = ip->dev;
66 int err;
67 u32 v;
68
69 if (ip->id == lima_ip_ppmmu_bcast)
70 return 0;
71
72 mmu_write(LIMA_MMU_DTE_ADDR, 0xCAFEBABE);
73 if (mmu_read(LIMA_MMU_DTE_ADDR) != 0xCAFEB000) {
74 dev_err(dev->dev, "mmu %s dte write test fail\n", lima_ip_name(ip));
75 return -EIO;
76 }
77
78 mmu_write(LIMA_MMU_COMMAND, LIMA_MMU_COMMAND_HARD_RESET);
79 err = lima_mmu_send_command(LIMA_MMU_COMMAND_HARD_RESET,
80 LIMA_MMU_DTE_ADDR, v, v == 0);
81 if (err)
82 return err;
83
84 err = devm_request_irq(dev->dev, ip->irq, lima_mmu_irq_handler,
85 IRQF_SHARED, lima_ip_name(ip), ip);
86 if (err) {
87 dev_err(dev->dev, "mmu %s fail to request irq\n", lima_ip_name(ip));
88 return err;
89 }
90
91 mmu_write(LIMA_MMU_INT_MASK, LIMA_MMU_INT_PAGE_FAULT | LIMA_MMU_INT_READ_BUS_ERROR);
92 mmu_write(LIMA_MMU_DTE_ADDR, dev->empty_vm->pd.dma);
93 return lima_mmu_send_command(LIMA_MMU_COMMAND_ENABLE_PAGING,
94 LIMA_MMU_STATUS, v,
95 v & LIMA_MMU_STATUS_PAGING_ENABLED);
96}
97
98void lima_mmu_fini(struct lima_ip *ip)
99{
100
101}
102
103void lima_mmu_switch_vm(struct lima_ip *ip, struct lima_vm *vm)
104{
105 struct lima_device *dev = ip->dev;
106 u32 v;
107
108 lima_mmu_send_command(LIMA_MMU_COMMAND_ENABLE_STALL,
109 LIMA_MMU_STATUS, v,
110 v & LIMA_MMU_STATUS_STALL_ACTIVE);
111
112 if (vm)
113 mmu_write(LIMA_MMU_DTE_ADDR, vm->pd.dma);
114
115 /* flush the TLB */
116 mmu_write(LIMA_MMU_COMMAND, LIMA_MMU_COMMAND_ZAP_CACHE);
117
118 lima_mmu_send_command(LIMA_MMU_COMMAND_DISABLE_STALL,
119 LIMA_MMU_STATUS, v,
120 !(v & LIMA_MMU_STATUS_STALL_ACTIVE));
121}
122
123void lima_mmu_page_fault_resume(struct lima_ip *ip)
124{
125 struct lima_device *dev = ip->dev;
126 u32 status = mmu_read(LIMA_MMU_STATUS);
127 u32 v;
128
129 if (status & LIMA_MMU_STATUS_PAGE_FAULT_ACTIVE) {
130 dev_info(dev->dev, "mmu resume\n");
131
132 mmu_write(LIMA_MMU_INT_MASK, 0);
133 mmu_write(LIMA_MMU_DTE_ADDR, 0xCAFEBABE);
134 lima_mmu_send_command(LIMA_MMU_COMMAND_HARD_RESET,
135 LIMA_MMU_DTE_ADDR, v, v == 0);
136 mmu_write(LIMA_MMU_INT_MASK, LIMA_MMU_INT_PAGE_FAULT | LIMA_MMU_INT_READ_BUS_ERROR);
137 mmu_write(LIMA_MMU_DTE_ADDR, dev->empty_vm->pd.dma);
138 lima_mmu_send_command(LIMA_MMU_COMMAND_ENABLE_PAGING,
139 LIMA_MMU_STATUS, v,
140 v & LIMA_MMU_STATUS_PAGING_ENABLED);
141 }
142}
1// SPDX-License-Identifier: GPL-2.0 OR MIT
2/* Copyright 2017-2019 Qiang Yu <yuq825@gmail.com> */
3
4#include <linux/interrupt.h>
5#include <linux/iopoll.h>
6#include <linux/device.h>
7
8#include "lima_device.h"
9#include "lima_mmu.h"
10#include "lima_vm.h"
11#include "lima_regs.h"
12
13#define mmu_write(reg, data) writel(data, ip->iomem + reg)
14#define mmu_read(reg) readl(ip->iomem + reg)
15
16#define lima_mmu_send_command(cmd, addr, val, cond) \
17({ \
18 int __ret; \
19 \
20 mmu_write(LIMA_MMU_COMMAND, cmd); \
21 __ret = readl_poll_timeout(ip->iomem + (addr), val, \
22 cond, 0, 100); \
23 if (__ret) \
24 dev_err(dev->dev, \
25 "%s command %x timeout\n", \
26 lima_ip_name(ip), cmd); \
27 __ret; \
28})
29
30static irqreturn_t lima_mmu_irq_handler(int irq, void *data)
31{
32 struct lima_ip *ip = data;
33 struct lima_device *dev = ip->dev;
34 u32 status = mmu_read(LIMA_MMU_INT_STATUS);
35 struct lima_sched_pipe *pipe;
36
37 /* for shared irq case */
38 if (!status)
39 return IRQ_NONE;
40
41 if (status & LIMA_MMU_INT_PAGE_FAULT) {
42 u32 fault = mmu_read(LIMA_MMU_PAGE_FAULT_ADDR);
43
44 dev_err(dev->dev, "%s page fault at 0x%x from bus id %d of type %s\n",
45 lima_ip_name(ip), fault, LIMA_MMU_STATUS_BUS_ID(status),
46 status & LIMA_MMU_STATUS_PAGE_FAULT_IS_WRITE ? "write" : "read");
47 }
48
49 if (status & LIMA_MMU_INT_READ_BUS_ERROR)
50 dev_err(dev->dev, "%s irq bus error\n", lima_ip_name(ip));
51
52 /* mask all interrupts before resume */
53 mmu_write(LIMA_MMU_INT_MASK, 0);
54 mmu_write(LIMA_MMU_INT_CLEAR, status);
55
56 pipe = dev->pipe + (ip->id == lima_ip_gpmmu ? lima_pipe_gp : lima_pipe_pp);
57 lima_sched_pipe_mmu_error(pipe);
58
59 return IRQ_HANDLED;
60}
61
62static int lima_mmu_hw_init(struct lima_ip *ip)
63{
64 struct lima_device *dev = ip->dev;
65 int err;
66 u32 v;
67
68 mmu_write(LIMA_MMU_COMMAND, LIMA_MMU_COMMAND_HARD_RESET);
69 err = lima_mmu_send_command(LIMA_MMU_COMMAND_HARD_RESET,
70 LIMA_MMU_DTE_ADDR, v, v == 0);
71 if (err)
72 return err;
73
74 mmu_write(LIMA_MMU_INT_MASK,
75 LIMA_MMU_INT_PAGE_FAULT | LIMA_MMU_INT_READ_BUS_ERROR);
76 mmu_write(LIMA_MMU_DTE_ADDR, dev->empty_vm->pd.dma);
77 return lima_mmu_send_command(LIMA_MMU_COMMAND_ENABLE_PAGING,
78 LIMA_MMU_STATUS, v,
79 v & LIMA_MMU_STATUS_PAGING_ENABLED);
80}
81
82int lima_mmu_resume(struct lima_ip *ip)
83{
84 if (ip->id == lima_ip_ppmmu_bcast)
85 return 0;
86
87 return lima_mmu_hw_init(ip);
88}
89
90void lima_mmu_suspend(struct lima_ip *ip)
91{
92
93}
94
95int lima_mmu_init(struct lima_ip *ip)
96{
97 struct lima_device *dev = ip->dev;
98 int err;
99
100 if (ip->id == lima_ip_ppmmu_bcast)
101 return 0;
102
103 mmu_write(LIMA_MMU_DTE_ADDR, 0xCAFEBABE);
104 if (mmu_read(LIMA_MMU_DTE_ADDR) != 0xCAFEB000) {
105 dev_err(dev->dev, "%s dte write test fail\n", lima_ip_name(ip));
106 return -EIO;
107 }
108
109 err = devm_request_irq(dev->dev, ip->irq, lima_mmu_irq_handler,
110 IRQF_SHARED, lima_ip_name(ip), ip);
111 if (err) {
112 dev_err(dev->dev, "%s fail to request irq\n", lima_ip_name(ip));
113 return err;
114 }
115
116 return lima_mmu_hw_init(ip);
117}
118
119void lima_mmu_fini(struct lima_ip *ip)
120{
121 struct lima_device *dev = ip->dev;
122
123 if (ip->id == lima_ip_ppmmu_bcast)
124 return;
125
126 devm_free_irq(dev->dev, ip->irq, ip);
127}
128
129void lima_mmu_flush_tlb(struct lima_ip *ip)
130{
131 mmu_write(LIMA_MMU_COMMAND, LIMA_MMU_COMMAND_ZAP_CACHE);
132}
133
134void lima_mmu_switch_vm(struct lima_ip *ip, struct lima_vm *vm)
135{
136 struct lima_device *dev = ip->dev;
137 u32 v;
138
139 lima_mmu_send_command(LIMA_MMU_COMMAND_ENABLE_STALL,
140 LIMA_MMU_STATUS, v,
141 v & LIMA_MMU_STATUS_STALL_ACTIVE);
142
143 mmu_write(LIMA_MMU_DTE_ADDR, vm->pd.dma);
144
145 /* flush the TLB */
146 mmu_write(LIMA_MMU_COMMAND, LIMA_MMU_COMMAND_ZAP_CACHE);
147
148 lima_mmu_send_command(LIMA_MMU_COMMAND_DISABLE_STALL,
149 LIMA_MMU_STATUS, v,
150 !(v & LIMA_MMU_STATUS_STALL_ACTIVE));
151}
152
153void lima_mmu_page_fault_resume(struct lima_ip *ip)
154{
155 struct lima_device *dev = ip->dev;
156 u32 status = mmu_read(LIMA_MMU_STATUS);
157 u32 v;
158
159 if (status & LIMA_MMU_STATUS_PAGE_FAULT_ACTIVE) {
160 dev_info(dev->dev, "%s resume\n", lima_ip_name(ip));
161
162 mmu_write(LIMA_MMU_INT_MASK, 0);
163 mmu_write(LIMA_MMU_DTE_ADDR, 0xCAFEBABE);
164 lima_mmu_send_command(LIMA_MMU_COMMAND_HARD_RESET,
165 LIMA_MMU_DTE_ADDR, v, v == 0);
166 mmu_write(LIMA_MMU_INT_MASK, LIMA_MMU_INT_PAGE_FAULT | LIMA_MMU_INT_READ_BUS_ERROR);
167 mmu_write(LIMA_MMU_DTE_ADDR, dev->empty_vm->pd.dma);
168 lima_mmu_send_command(LIMA_MMU_COMMAND_ENABLE_PAGING,
169 LIMA_MMU_STATUS, v,
170 v & LIMA_MMU_STATUS_PAGING_ENABLED);
171 }
172}