1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Copyright (c) 2017-2020, The Linux Foundation. All rights reserved.
4 */
5
6 #define pr_fmt(fmt)"[drm-dp] %s: " fmt, __func__
7
8 #include <linux/debugfs.h>
9 #include <drm/drm_connector.h>
10 #include <drm/drm_file.h>
11
12 #include "dp_parser.h"
13 #include "dp_catalog.h"
14 #include "dp_aux.h"
15 #include "dp_ctrl.h"
16 #include "dp_debug.h"
17 #include "dp_display.h"
18
19 #define DEBUG_NAME "msm_dp"
20
21 struct dp_debug_private {
22 struct dentry *root;
23
24 struct dp_usbpd *usbpd;
25 struct dp_link *link;
26 struct dp_panel *panel;
27 struct drm_connector **connector;
28 struct device *dev;
29 struct drm_device *drm_dev;
30
31 struct dp_debug dp_debug;
32 };
33
dp_debug_check_buffer_overflow(int rc,int * max_size,int * len)34 static int dp_debug_check_buffer_overflow(int rc, int *max_size, int *len)
35 {
36 if (rc >= *max_size) {
37 DRM_ERROR("buffer overflow\n");
38 return -EINVAL;
39 }
40 *len += rc;
41 *max_size = SZ_4K - *len;
42
43 return 0;
44 }
45
dp_debug_read_info(struct file * file,char __user * user_buff,size_t count,loff_t * ppos)46 static ssize_t dp_debug_read_info(struct file *file, char __user *user_buff,
47 size_t count, loff_t *ppos)
48 {
49 struct dp_debug_private *debug = file->private_data;
50 char *buf;
51 u32 len = 0, rc = 0;
52 u64 lclk = 0;
53 u32 max_size = SZ_4K;
54 u32 link_params_rate;
55 struct drm_display_mode *drm_mode;
56
57 if (!debug)
58 return -ENODEV;
59
60 if (*ppos)
61 return 0;
62
63 buf = kzalloc(SZ_4K, GFP_KERNEL);
64 if (!buf)
65 return -ENOMEM;
66
67 drm_mode = &debug->panel->dp_mode.drm_mode;
68
69 rc = snprintf(buf + len, max_size, "\tname = %s\n", DEBUG_NAME);
70 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
71 goto error;
72
73 rc = snprintf(buf + len, max_size,
74 "\tdp_panel\n\t\tmax_pclk_khz = %d\n",
75 debug->panel->max_pclk_khz);
76 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
77 goto error;
78
79 rc = snprintf(buf + len, max_size,
80 "\tdrm_dp_link\n\t\trate = %u\n",
81 debug->panel->link_info.rate);
82 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
83 goto error;
84
85 rc = snprintf(buf + len, max_size,
86 "\t\tnum_lanes = %u\n",
87 debug->panel->link_info.num_lanes);
88 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
89 goto error;
90
91 rc = snprintf(buf + len, max_size,
92 "\t\tcapabilities = %lu\n",
93 debug->panel->link_info.capabilities);
94 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
95 goto error;
96
97 rc = snprintf(buf + len, max_size,
98 "\tdp_panel_info:\n\t\tactive = %dx%d\n",
99 drm_mode->hdisplay,
100 drm_mode->vdisplay);
101 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
102 goto error;
103
104 rc = snprintf(buf + len, max_size,
105 "\t\tback_porch = %dx%d\n",
106 drm_mode->htotal - drm_mode->hsync_end,
107 drm_mode->vtotal - drm_mode->vsync_end);
108 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
109 goto error;
110
111 rc = snprintf(buf + len, max_size,
112 "\t\tfront_porch = %dx%d\n",
113 drm_mode->hsync_start - drm_mode->hdisplay,
114 drm_mode->vsync_start - drm_mode->vdisplay);
115 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
116 goto error;
117
118 rc = snprintf(buf + len, max_size,
119 "\t\tsync_width = %dx%d\n",
120 drm_mode->hsync_end - drm_mode->hsync_start,
121 drm_mode->vsync_end - drm_mode->vsync_start);
122 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
123 goto error;
124
125 rc = snprintf(buf + len, max_size,
126 "\t\tactive_low = %dx%d\n",
127 debug->panel->dp_mode.h_active_low,
128 debug->panel->dp_mode.v_active_low);
129 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
130 goto error;
131
132 rc = snprintf(buf + len, max_size,
133 "\t\th_skew = %d\n",
134 drm_mode->hskew);
135 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
136 goto error;
137
138 rc = snprintf(buf + len, max_size,
139 "\t\trefresh rate = %d\n",
140 drm_mode_vrefresh(drm_mode));
141 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
142 goto error;
143
144 rc = snprintf(buf + len, max_size,
145 "\t\tpixel clock khz = %d\n",
146 drm_mode->clock);
147 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
148 goto error;
149
150 rc = snprintf(buf + len, max_size,
151 "\t\tbpp = %d\n",
152 debug->panel->dp_mode.bpp);
153 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
154 goto error;
155
156 /* Link Information */
157 rc = snprintf(buf + len, max_size,
158 "\tdp_link:\n\t\ttest_requested = %d\n",
159 debug->link->sink_request);
160 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
161 goto error;
162
163 rc = snprintf(buf + len, max_size,
164 "\t\tnum_lanes = %d\n",
165 debug->link->link_params.num_lanes);
166 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
167 goto error;
168
169 link_params_rate = debug->link->link_params.rate;
170 rc = snprintf(buf + len, max_size,
171 "\t\tbw_code = %d\n",
172 drm_dp_link_rate_to_bw_code(link_params_rate));
173 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
174 goto error;
175
176 lclk = debug->link->link_params.rate * 1000;
177 rc = snprintf(buf + len, max_size,
178 "\t\tlclk = %lld\n", lclk);
179 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
180 goto error;
181
182 rc = snprintf(buf + len, max_size,
183 "\t\tv_level = %d\n",
184 debug->link->phy_params.v_level);
185 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
186 goto error;
187
188 rc = snprintf(buf + len, max_size,
189 "\t\tp_level = %d\n",
190 debug->link->phy_params.p_level);
191 if (dp_debug_check_buffer_overflow(rc, &max_size, &len))
192 goto error;
193
194 if (copy_to_user(user_buff, buf, len))
195 goto error;
196
197 *ppos += len;
198
199 kfree(buf);
200 return len;
201 error:
202 kfree(buf);
203 return -EINVAL;
204 }
205
dp_test_data_show(struct seq_file * m,void * data)206 static int dp_test_data_show(struct seq_file *m, void *data)
207 {
208 struct drm_device *dev;
209 struct dp_debug_private *debug;
210 struct drm_connector *connector;
211 struct drm_connector_list_iter conn_iter;
212 u32 bpc;
213
214 debug = m->private;
215 dev = debug->drm_dev;
216 drm_connector_list_iter_begin(dev, &conn_iter);
217 drm_for_each_connector_iter(connector, &conn_iter) {
218
219 if (connector->connector_type !=
220 DRM_MODE_CONNECTOR_DisplayPort)
221 continue;
222
223 if (connector->status == connector_status_connected) {
224 bpc = debug->link->test_video.test_bit_depth;
225 seq_printf(m, "hdisplay: %d\n",
226 debug->link->test_video.test_h_width);
227 seq_printf(m, "vdisplay: %d\n",
228 debug->link->test_video.test_v_height);
229 seq_printf(m, "bpc: %u\n",
230 dp_link_bit_depth_to_bpc(bpc));
231 } else
232 seq_puts(m, "0");
233 }
234
235 drm_connector_list_iter_end(&conn_iter);
236
237 return 0;
238 }
239 DEFINE_SHOW_ATTRIBUTE(dp_test_data);
240
dp_test_type_show(struct seq_file * m,void * data)241 static int dp_test_type_show(struct seq_file *m, void *data)
242 {
243 struct dp_debug_private *debug = m->private;
244 struct drm_device *dev = debug->drm_dev;
245 struct drm_connector *connector;
246 struct drm_connector_list_iter conn_iter;
247
248 drm_connector_list_iter_begin(dev, &conn_iter);
249 drm_for_each_connector_iter(connector, &conn_iter) {
250
251 if (connector->connector_type !=
252 DRM_MODE_CONNECTOR_DisplayPort)
253 continue;
254
255 if (connector->status == connector_status_connected)
256 seq_printf(m, "%02x", DP_TEST_LINK_VIDEO_PATTERN);
257 else
258 seq_puts(m, "0");
259 }
260 drm_connector_list_iter_end(&conn_iter);
261
262 return 0;
263 }
264 DEFINE_SHOW_ATTRIBUTE(dp_test_type);
265
dp_test_active_write(struct file * file,const char __user * ubuf,size_t len,loff_t * offp)266 static ssize_t dp_test_active_write(struct file *file,
267 const char __user *ubuf,
268 size_t len, loff_t *offp)
269 {
270 char *input_buffer;
271 int status = 0;
272 struct dp_debug_private *debug;
273 struct drm_device *dev;
274 struct drm_connector *connector;
275 struct drm_connector_list_iter conn_iter;
276 int val = 0;
277
278 debug = ((struct seq_file *)file->private_data)->private;
279 dev = debug->drm_dev;
280
281 if (len == 0)
282 return 0;
283
284 input_buffer = memdup_user_nul(ubuf, len);
285 if (IS_ERR(input_buffer))
286 return PTR_ERR(input_buffer);
287
288 DRM_DEBUG_DRIVER("Copied %d bytes from user\n", (unsigned int)len);
289
290 drm_connector_list_iter_begin(dev, &conn_iter);
291 drm_for_each_connector_iter(connector, &conn_iter) {
292 if (connector->connector_type !=
293 DRM_MODE_CONNECTOR_DisplayPort)
294 continue;
295
296 if (connector->status == connector_status_connected) {
297 status = kstrtoint(input_buffer, 10, &val);
298 if (status < 0)
299 break;
300 DRM_DEBUG_DRIVER("Got %d for test active\n", val);
301 /* To prevent erroneous activation of the compliance
302 * testing code, only accept an actual value of 1 here
303 */
304 if (val == 1)
305 debug->panel->video_test = true;
306 else
307 debug->panel->video_test = false;
308 }
309 }
310 drm_connector_list_iter_end(&conn_iter);
311 kfree(input_buffer);
312 if (status < 0)
313 return status;
314
315 *offp += len;
316 return len;
317 }
318
dp_test_active_show(struct seq_file * m,void * data)319 static int dp_test_active_show(struct seq_file *m, void *data)
320 {
321 struct dp_debug_private *debug = m->private;
322 struct drm_device *dev = debug->drm_dev;
323 struct drm_connector *connector;
324 struct drm_connector_list_iter conn_iter;
325
326 drm_connector_list_iter_begin(dev, &conn_iter);
327 drm_for_each_connector_iter(connector, &conn_iter) {
328 if (connector->connector_type !=
329 DRM_MODE_CONNECTOR_DisplayPort)
330 continue;
331
332 if (connector->status == connector_status_connected) {
333 if (debug->panel->video_test)
334 seq_puts(m, "1");
335 else
336 seq_puts(m, "0");
337 } else
338 seq_puts(m, "0");
339 }
340 drm_connector_list_iter_end(&conn_iter);
341
342 return 0;
343 }
344
dp_test_active_open(struct inode * inode,struct file * file)345 static int dp_test_active_open(struct inode *inode,
346 struct file *file)
347 {
348 return single_open(file, dp_test_active_show,
349 inode->i_private);
350 }
351
352 static const struct file_operations dp_debug_fops = {
353 .open = simple_open,
354 .read = dp_debug_read_info,
355 };
356
357 static const struct file_operations test_active_fops = {
358 .owner = THIS_MODULE,
359 .open = dp_test_active_open,
360 .read = seq_read,
361 .llseek = seq_lseek,
362 .release = single_release,
363 .write = dp_test_active_write
364 };
365
dp_debug_init(struct dp_debug * dp_debug,struct drm_minor * minor)366 static int dp_debug_init(struct dp_debug *dp_debug, struct drm_minor *minor)
367 {
368 int rc = 0;
369 struct dp_debug_private *debug = container_of(dp_debug,
370 struct dp_debug_private, dp_debug);
371
372 debugfs_create_file("dp_debug", 0444, minor->debugfs_root,
373 debug, &dp_debug_fops);
374
375 debugfs_create_file("msm_dp_test_active", 0444,
376 minor->debugfs_root,
377 debug, &test_active_fops);
378
379 debugfs_create_file("msm_dp_test_data", 0444,
380 minor->debugfs_root,
381 debug, &dp_test_data_fops);
382
383 debugfs_create_file("msm_dp_test_type", 0444,
384 minor->debugfs_root,
385 debug, &dp_test_type_fops);
386
387 debug->root = minor->debugfs_root;
388
389 return rc;
390 }
391
dp_debug_get(struct device * dev,struct dp_panel * panel,struct dp_usbpd * usbpd,struct dp_link * link,struct drm_connector ** connector,struct drm_minor * minor)392 struct dp_debug *dp_debug_get(struct device *dev, struct dp_panel *panel,
393 struct dp_usbpd *usbpd, struct dp_link *link,
394 struct drm_connector **connector, struct drm_minor *minor)
395 {
396 int rc = 0;
397 struct dp_debug_private *debug;
398 struct dp_debug *dp_debug;
399
400 if (!dev || !panel || !usbpd || !link) {
401 DRM_ERROR("invalid input\n");
402 rc = -EINVAL;
403 goto error;
404 }
405
406 debug = devm_kzalloc(dev, sizeof(*debug), GFP_KERNEL);
407 if (!debug) {
408 rc = -ENOMEM;
409 goto error;
410 }
411
412 debug->dp_debug.debug_en = false;
413 debug->usbpd = usbpd;
414 debug->link = link;
415 debug->panel = panel;
416 debug->dev = dev;
417 debug->drm_dev = minor->dev;
418 debug->connector = connector;
419
420 dp_debug = &debug->dp_debug;
421 dp_debug->vdisplay = 0;
422 dp_debug->hdisplay = 0;
423 dp_debug->vrefresh = 0;
424
425 rc = dp_debug_init(dp_debug, minor);
426 if (rc) {
427 devm_kfree(dev, debug);
428 goto error;
429 }
430
431 return dp_debug;
432 error:
433 return ERR_PTR(rc);
434 }
435
dp_debug_deinit(struct dp_debug * dp_debug)436 static int dp_debug_deinit(struct dp_debug *dp_debug)
437 {
438 struct dp_debug_private *debug;
439
440 if (!dp_debug)
441 return -EINVAL;
442
443 debug = container_of(dp_debug, struct dp_debug_private, dp_debug);
444
445 debugfs_remove_recursive(debug->root);
446
447 return 0;
448 }
449
dp_debug_put(struct dp_debug * dp_debug)450 void dp_debug_put(struct dp_debug *dp_debug)
451 {
452 struct dp_debug_private *debug;
453
454 if (!dp_debug)
455 return;
456
457 debug = container_of(dp_debug, struct dp_debug_private, dp_debug);
458
459 dp_debug_deinit(dp_debug);
460
461 devm_kfree(debug->dev, debug);
462 }
463