1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (C) 2010 Google, Inc.
4  * Author: Erik Gilling <konkers@android.com>
5  *
6  * Copyright (C) 2011-2013 NVIDIA Corporation
7  */
8 
9 #include "../dev.h"
10 #include "../debug.h"
11 #include "../cdma.h"
12 #include "../channel.h"
13 
14 #define HOST1X_DEBUG_MAX_PAGE_OFFSET 102400
15 
16 enum {
17 	HOST1X_OPCODE_SETCLASS	= 0x00,
18 	HOST1X_OPCODE_INCR	= 0x01,
19 	HOST1X_OPCODE_NONINCR	= 0x02,
20 	HOST1X_OPCODE_MASK	= 0x03,
21 	HOST1X_OPCODE_IMM	= 0x04,
22 	HOST1X_OPCODE_RESTART	= 0x05,
23 	HOST1X_OPCODE_GATHER	= 0x06,
24 	HOST1X_OPCODE_SETSTRMID = 0x07,
25 	HOST1X_OPCODE_SETAPPID  = 0x08,
26 	HOST1X_OPCODE_SETPYLD   = 0x09,
27 	HOST1X_OPCODE_INCR_W    = 0x0a,
28 	HOST1X_OPCODE_NONINCR_W = 0x0b,
29 	HOST1X_OPCODE_GATHER_W  = 0x0c,
30 	HOST1X_OPCODE_RESTART_W = 0x0d,
31 	HOST1X_OPCODE_EXTEND	= 0x0e,
32 };
33 
34 enum {
35 	HOST1X_OPCODE_EXTEND_ACQUIRE_MLOCK	= 0x00,
36 	HOST1X_OPCODE_EXTEND_RELEASE_MLOCK	= 0x01,
37 };
38 
39 #define INVALID_PAYLOAD				0xffffffff
40 
show_channel_command(struct output * o,u32 val,u32 * payload)41 static unsigned int show_channel_command(struct output *o, u32 val,
42 					 u32 *payload)
43 {
44 	unsigned int mask, subop, num, opcode;
45 
46 	opcode = val >> 28;
47 
48 	switch (opcode) {
49 	case HOST1X_OPCODE_SETCLASS:
50 		mask = val & 0x3f;
51 		if (mask) {
52 			host1x_debug_cont(o, "SETCL(class=%03x, offset=%03x, mask=%02x, [",
53 					    val >> 6 & 0x3ff,
54 					    val >> 16 & 0xfff, mask);
55 			return hweight8(mask);
56 		}
57 
58 		host1x_debug_cont(o, "SETCL(class=%03x)\n", val >> 6 & 0x3ff);
59 		return 0;
60 
61 	case HOST1X_OPCODE_INCR:
62 		num = val & 0xffff;
63 		host1x_debug_cont(o, "INCR(offset=%03x, [",
64 				    val >> 16 & 0xfff);
65 		if (!num)
66 			host1x_debug_cont(o, "])\n");
67 
68 		return num;
69 
70 	case HOST1X_OPCODE_NONINCR:
71 		num = val & 0xffff;
72 		host1x_debug_cont(o, "NONINCR(offset=%03x, [",
73 				    val >> 16 & 0xfff);
74 		if (!num)
75 			host1x_debug_cont(o, "])\n");
76 
77 		return num;
78 
79 	case HOST1X_OPCODE_MASK:
80 		mask = val & 0xffff;
81 		host1x_debug_cont(o, "MASK(offset=%03x, mask=%03x, [",
82 				    val >> 16 & 0xfff, mask);
83 		if (!mask)
84 			host1x_debug_cont(o, "])\n");
85 
86 		return hweight16(mask);
87 
88 	case HOST1X_OPCODE_IMM:
89 		host1x_debug_cont(o, "IMM(offset=%03x, data=%03x)\n",
90 				    val >> 16 & 0xfff, val & 0xffff);
91 		return 0;
92 
93 	case HOST1X_OPCODE_RESTART:
94 		host1x_debug_cont(o, "RESTART(offset=%08x)\n", val << 4);
95 		return 0;
96 
97 	case HOST1X_OPCODE_GATHER:
98 		host1x_debug_cont(o, "GATHER(offset=%03x, insert=%d, type=%d, count=%04x, addr=[",
99 				    val >> 16 & 0xfff, val >> 15 & 0x1,
100 				    val >> 14 & 0x1, val & 0x3fff);
101 		return 1;
102 
103 #if HOST1X_HW >= 6
104 	case HOST1X_OPCODE_SETSTRMID:
105 		host1x_debug_cont(o, "SETSTRMID(offset=%06x)\n",
106 				  val & 0x3fffff);
107 		return 0;
108 
109 	case HOST1X_OPCODE_SETAPPID:
110 		host1x_debug_cont(o, "SETAPPID(appid=%02x)\n", val & 0xff);
111 		return 0;
112 
113 	case HOST1X_OPCODE_SETPYLD:
114 		*payload = val & 0xffff;
115 		host1x_debug_cont(o, "SETPYLD(data=%04x)\n", *payload);
116 		return 0;
117 
118 	case HOST1X_OPCODE_INCR_W:
119 	case HOST1X_OPCODE_NONINCR_W:
120 		host1x_debug_cont(o, "%s(offset=%06x, ",
121 				  opcode == HOST1X_OPCODE_INCR_W ?
122 					"INCR_W" : "NONINCR_W",
123 				  val & 0x3fffff);
124 		if (*payload == 0) {
125 			host1x_debug_cont(o, "[])\n");
126 			return 0;
127 		} else if (*payload == INVALID_PAYLOAD) {
128 			host1x_debug_cont(o, "unknown)\n");
129 			return 0;
130 		} else {
131 			host1x_debug_cont(o, "[");
132 			return *payload;
133 		}
134 
135 	case HOST1X_OPCODE_GATHER_W:
136 		host1x_debug_cont(o, "GATHER_W(count=%04x, addr=[",
137 				  val & 0x3fff);
138 		return 2;
139 #endif
140 
141 	case HOST1X_OPCODE_EXTEND:
142 		subop = val >> 24 & 0xf;
143 		if (subop == HOST1X_OPCODE_EXTEND_ACQUIRE_MLOCK)
144 			host1x_debug_cont(o, "ACQUIRE_MLOCK(index=%d)\n",
145 					    val & 0xff);
146 		else if (subop == HOST1X_OPCODE_EXTEND_RELEASE_MLOCK)
147 			host1x_debug_cont(o, "RELEASE_MLOCK(index=%d)\n",
148 					    val & 0xff);
149 		else
150 			host1x_debug_cont(o, "EXTEND_UNKNOWN(%08x)\n", val);
151 		return 0;
152 
153 	default:
154 		host1x_debug_cont(o, "UNKNOWN\n");
155 		return 0;
156 	}
157 }
158 
show_gather(struct output * o,dma_addr_t phys_addr,unsigned int words,struct host1x_cdma * cdma,dma_addr_t pin_addr,u32 * map_addr)159 static void show_gather(struct output *o, dma_addr_t phys_addr,
160 			unsigned int words, struct host1x_cdma *cdma,
161 			dma_addr_t pin_addr, u32 *map_addr)
162 {
163 	/* Map dmaget cursor to corresponding mem handle */
164 	u32 offset = phys_addr - pin_addr;
165 	unsigned int data_count = 0, i;
166 	u32 payload = INVALID_PAYLOAD;
167 
168 	/*
169 	 * Sometimes we're given different hardware address to the same
170 	 * page - in these cases the offset will get an invalid number and
171 	 * we just have to bail out.
172 	 */
173 	if (offset > HOST1X_DEBUG_MAX_PAGE_OFFSET) {
174 		host1x_debug_output(o, "[address mismatch]\n");
175 		return;
176 	}
177 
178 	for (i = 0; i < words; i++) {
179 		dma_addr_t addr = phys_addr + i * 4;
180 		u32 val = *(map_addr + offset / 4 + i);
181 
182 		if (!data_count) {
183 			host1x_debug_output(o, "    %pad: %08x: ", &addr, val);
184 			data_count = show_channel_command(o, val, &payload);
185 		} else {
186 			host1x_debug_cont(o, "%08x%s", val,
187 					    data_count > 1 ? ", " : "])\n");
188 			data_count--;
189 		}
190 	}
191 }
192 
show_channel_gathers(struct output * o,struct host1x_cdma * cdma)193 static void show_channel_gathers(struct output *o, struct host1x_cdma *cdma)
194 {
195 	struct push_buffer *pb = &cdma->push_buffer;
196 	struct host1x_job *job;
197 
198 	list_for_each_entry(job, &cdma->sync_queue, list) {
199 		unsigned int i;
200 
201 		host1x_debug_output(o, "JOB, syncpt %u: %u timeout: %u num_slots: %u num_handles: %u\n",
202 				    job->syncpt->id, job->syncpt_end, job->timeout,
203 				    job->num_slots, job->num_unpins);
204 
205 		show_gather(o, pb->dma + job->first_get, job->num_slots * 2, cdma,
206 			    pb->dma + job->first_get, pb->mapped + job->first_get);
207 
208 		for (i = 0; i < job->num_cmds; i++) {
209 			struct host1x_job_gather *g;
210 			u32 *mapped;
211 
212 			if (job->cmds[i].is_wait)
213 				continue;
214 
215 			g = &job->cmds[i].gather;
216 
217 			if (job->gather_copy_mapped)
218 				mapped = (u32 *)job->gather_copy_mapped;
219 			else
220 				mapped = host1x_bo_mmap(g->bo);
221 
222 			if (!mapped) {
223 				host1x_debug_output(o, "[could not mmap]\n");
224 				continue;
225 			}
226 
227 			host1x_debug_output(o, "  GATHER at %pad+%#x, %d words\n",
228 					    &g->base, g->offset, g->words);
229 
230 			show_gather(o, g->base + g->offset, g->words, cdma,
231 				    g->base, mapped);
232 
233 			if (!job->gather_copy_mapped)
234 				host1x_bo_munmap(g->bo, mapped);
235 		}
236 	}
237 }
238 
239 #if HOST1X_HW >= 6
240 #include "debug_hw_1x06.c"
241 #else
242 #include "debug_hw_1x01.c"
243 #endif
244 
245 static const struct host1x_debug_ops host1x_debug_ops = {
246 	.show_channel_cdma = host1x_debug_show_channel_cdma,
247 	.show_channel_fifo = host1x_debug_show_channel_fifo,
248 	.show_mlocks = host1x_debug_show_mlocks,
249 };
250